1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78
|
// SPDX-License-Identifier: GPL-2.0-only
/*
* Copyright (C) 2013 - 2025 Intel Corporation
*/
#include <linux/export.h>
#include <linux/io.h>
#include "abi/ipu7_fw_syscom_abi.h"
#include "ipu7.h"
#include "ipu7-syscom.h"
static void __iomem *ipu7_syscom_get_indices(struct ipu7_syscom_context *ctx,
u32 q)
{
return ctx->queue_indices + (q * sizeof(struct syscom_queue_indices_s));
}
void *ipu7_syscom_get_token(struct ipu7_syscom_context *ctx, int q)
{
struct syscom_queue_config *queue_params = &ctx->queue_configs[q];
void __iomem *queue_indices = ipu7_syscom_get_indices(ctx, q);
u32 write_index = readl(queue_indices +
offsetof(struct syscom_queue_indices_s,
write_index));
u32 read_index = readl(queue_indices +
offsetof(struct syscom_queue_indices_s,
read_index));
void *token = NULL;
if (q < ctx->num_output_queues) {
/* Output queue */
bool empty = (write_index == read_index);
if (!empty)
token = queue_params->token_array_mem +
read_index *
queue_params->token_size_in_bytes;
} else {
/* Input queue */
bool full = (read_index == ((write_index + 1U) %
(u32)queue_params->max_capacity));
if (!full)
token = queue_params->token_array_mem +
write_index * queue_params->token_size_in_bytes;
}
return token;
}
EXPORT_SYMBOL_NS_GPL(ipu7_syscom_get_token, "INTEL_IPU7");
void ipu7_syscom_put_token(struct ipu7_syscom_context *ctx, int q)
{
struct syscom_queue_config *queue_params = &ctx->queue_configs[q];
void __iomem *queue_indices = ipu7_syscom_get_indices(ctx, q);
u32 offset, index;
if (q < ctx->num_output_queues)
/* Output queue */
offset = offsetof(struct syscom_queue_indices_s, read_index);
else
/* Input queue */
offset = offsetof(struct syscom_queue_indices_s, write_index);
index = readl(queue_indices + offset);
writel((index + 1U) % queue_params->max_capacity,
queue_indices + offset);
}
EXPORT_SYMBOL_NS_GPL(ipu7_syscom_put_token, "INTEL_IPU7");
struct syscom_queue_params_config *
ipu7_syscom_get_queue_config(struct syscom_config_s *config)
{
return (struct syscom_queue_params_config *)(&config[1]);
}
EXPORT_SYMBOL_NS_GPL(ipu7_syscom_get_queue_config, "INTEL_IPU7");
|