mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-07-25 04:19:43 +09:00
41575d8e4c
This construct is quite long-winded. In earlier days it made some sense since auto-allocation was a strange concept. But with driver model now used pretty universally, we can shorten this to 'auto'. This reduces verbosity and makes it easier to read. Coincidentally it also ensures that every declaration is on one line, thus making dtoc's job easier. Signed-off-by: Simon Glass <sjg@chromium.org>
90 lines
1.9 KiB
C
90 lines
1.9 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2020 Linaro Limited.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <errno.h>
|
|
#include <scmi_agent.h>
|
|
#include <scmi_agent-uclass.h>
|
|
#include <dm/devres.h>
|
|
#include <dm/device-internal.h>
|
|
#include <linux/arm-smccc.h>
|
|
#include <linux/compat.h>
|
|
|
|
#include "smt.h"
|
|
|
|
#define SMCCC_RET_NOT_SUPPORTED ((unsigned long)-1)
|
|
|
|
/**
|
|
* struct scmi_smccc_channel - Description of an SCMI SMCCC transport
|
|
* @func_id: SMCCC function ID used by the SCMI transport
|
|
* @smt: Shared memory buffer
|
|
*/
|
|
struct scmi_smccc_channel {
|
|
ulong func_id;
|
|
struct scmi_smt smt;
|
|
};
|
|
|
|
static int scmi_smccc_process_msg(struct udevice *dev, struct scmi_msg *msg)
|
|
{
|
|
struct scmi_smccc_channel *chan = dev_get_priv(dev);
|
|
struct arm_smccc_res res;
|
|
int ret;
|
|
|
|
ret = scmi_write_msg_to_smt(dev, &chan->smt, msg);
|
|
if (ret)
|
|
return ret;
|
|
|
|
arm_smccc_smc(chan->func_id, 0, 0, 0, 0, 0, 0, 0, &res);
|
|
if (res.a0 == SMCCC_RET_NOT_SUPPORTED)
|
|
ret = -ENXIO;
|
|
else
|
|
ret = scmi_read_resp_from_smt(dev, &chan->smt, msg);
|
|
|
|
scmi_clear_smt_channel(&chan->smt);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int scmi_smccc_probe(struct udevice *dev)
|
|
{
|
|
struct scmi_smccc_channel *chan = dev_get_priv(dev);
|
|
u32 func_id;
|
|
int ret;
|
|
|
|
if (dev_read_u32(dev, "arm,smc-id", &func_id)) {
|
|
dev_err(dev, "Missing property func-id\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
chan->func_id = func_id;
|
|
|
|
ret = scmi_dt_get_smt_buffer(dev, &chan->smt);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to get smt resources: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct udevice_id scmi_smccc_ids[] = {
|
|
{ .compatible = "arm,scmi-smc" },
|
|
{ }
|
|
};
|
|
|
|
static const struct scmi_agent_ops scmi_smccc_ops = {
|
|
.process_msg = scmi_smccc_process_msg,
|
|
};
|
|
|
|
U_BOOT_DRIVER(scmi_smccc) = {
|
|
.name = "scmi-over-smccc",
|
|
.id = UCLASS_SCMI_AGENT,
|
|
.of_match = scmi_smccc_ids,
|
|
.priv_auto = sizeof(struct scmi_smccc_channel),
|
|
.probe = scmi_smccc_probe,
|
|
.ops = &scmi_smccc_ops,
|
|
};
|