firmware: scmi: use a protocol's own channel if assigned

SCMI specification allows any protocol to have its own channel for
the transport. While the current SCMI driver may assign its channel
from a device tree, the core function, devm_scmi_process_msg(), doesn't
use a protocol's channel, but always use an agent's channel.

With this commit, devm_scmi_process_msg() tries to find and use
a protocol's channel. If it doesn't exist, use an agent's.

Signed-off-by: AKASHI Takahiro <takahiro.akashi@linaro.org>
Reviewed-by: Etienne Carriere <etienne.carriere@foss.st.com>
Reviewed-by: Simon Glass <sjg@chromium.org>
This commit is contained in:
AKASHI Takahiro 2023-10-11 19:06:55 +09:00 committed by Tom Rini
parent c6230cd842
commit 689204be97
5 changed files with 18 additions and 12 deletions

View File

@ -94,13 +94,14 @@ static int setup_channel(struct udevice *dev, struct scmi_mbox_channel *chan)
} }
static int scmi_mbox_get_channel(struct udevice *dev, static int scmi_mbox_get_channel(struct udevice *dev,
struct udevice *protocol,
struct scmi_channel **channel) struct scmi_channel **channel)
{ {
struct scmi_mbox_channel *base_chan = dev_get_plat(dev); struct scmi_mbox_channel *base_chan = dev_get_plat(dev);
struct scmi_mbox_channel *chan; struct scmi_mbox_channel *chan;
int ret; int ret;
if (!dev_read_prop(dev, "shmem", NULL)) { if (!dev_read_prop(protocol, "shmem", NULL)) {
/* Uses agent base channel */ /* Uses agent base channel */
*channel = container_of(base_chan, struct scmi_channel, ref); *channel = container_of(base_chan, struct scmi_channel, ref);
@ -112,7 +113,7 @@ static int scmi_mbox_get_channel(struct udevice *dev,
return -ENOMEM; return -ENOMEM;
/* Setup a dedicated channel for the protocol */ /* Setup a dedicated channel for the protocol */
ret = setup_channel(dev, chan); ret = setup_channel(protocol, chan);
if (ret) { if (ret) {
free(chan); free(chan);
return ret; return ret;

View File

@ -324,6 +324,7 @@ static int setup_channel(struct udevice *dev, struct scmi_optee_channel *chan)
} }
static int scmi_optee_get_channel(struct udevice *dev, static int scmi_optee_get_channel(struct udevice *dev,
struct udevice *protocol,
struct scmi_channel **channel) struct scmi_channel **channel)
{ {
struct scmi_optee_channel *base_chan = dev_get_plat(dev); struct scmi_optee_channel *base_chan = dev_get_plat(dev);
@ -331,7 +332,7 @@ static int scmi_optee_get_channel(struct udevice *dev,
u32 channel_id; u32 channel_id;
int ret; int ret;
if (dev_read_u32(dev, "linaro,optee-channel-id", &channel_id)) { if (dev_read_u32(protocol, "linaro,optee-channel-id", &channel_id)) {
/* Uses agent base channel */ /* Uses agent base channel */
*channel = container_of(base_chan, struct scmi_channel, ref); *channel = container_of(base_chan, struct scmi_channel, ref);
@ -343,7 +344,7 @@ static int scmi_optee_get_channel(struct udevice *dev,
if (!chan) if (!chan)
return -ENOMEM; return -ENOMEM;
ret = setup_channel(dev, chan); ret = setup_channel(protocol, chan);
if (ret) { if (ret) {
free(chan); free(chan);
return ret; return ret;

View File

@ -144,13 +144,14 @@ static const struct scmi_agent_ops *transport_dev_ops(struct udevice *dev)
* On return, @channel will be set. * On return, @channel will be set.
* Return 0 on success and a negative errno on failure * Return 0 on success and a negative errno on failure
*/ */
static int scmi_of_get_channel(struct udevice *dev, struct scmi_channel **channel) static int scmi_of_get_channel(struct udevice *dev, struct udevice *protocol,
struct scmi_channel **channel)
{ {
const struct scmi_agent_ops *ops; const struct scmi_agent_ops *ops;
ops = transport_dev_ops(dev); ops = transport_dev_ops(dev);
if (ops->of_get_channel) if (ops->of_get_channel)
return ops->of_get_channel(dev, channel); return ops->of_get_channel(dev, protocol, channel);
else else
return -EPROTONOSUPPORT; return -EPROTONOSUPPORT;
} }
@ -166,7 +167,7 @@ int devm_scmi_of_get_channel(struct udevice *dev)
return -ENODEV; return -ENODEV;
priv = dev_get_parent_priv(protocol); priv = dev_get_parent_priv(protocol);
ret = scmi_of_get_channel(protocol->parent, &priv->channel); ret = scmi_of_get_channel(protocol->parent, protocol, &priv->channel);
if (ret == -EPROTONOSUPPORT) { if (ret == -EPROTONOSUPPORT) {
/* Drivers without a get_channel operator don't need a channel ref */ /* Drivers without a get_channel operator don't need a channel ref */
priv->channel = NULL; priv->channel = NULL;

View File

@ -81,6 +81,7 @@ static int setup_channel(struct udevice *dev, struct scmi_smccc_channel *chan)
} }
static int scmi_smccc_get_channel(struct udevice *dev, static int scmi_smccc_get_channel(struct udevice *dev,
struct udevice *protocol,
struct scmi_channel **channel) struct scmi_channel **channel)
{ {
struct scmi_smccc_channel *base_chan = dev_get_plat(dev); struct scmi_smccc_channel *base_chan = dev_get_plat(dev);
@ -88,7 +89,7 @@ static int scmi_smccc_get_channel(struct udevice *dev,
u32 func_id; u32 func_id;
int ret; int ret;
if (dev_read_u32(dev, "arm,smc-id", &func_id)) { if (dev_read_u32(protocol, "arm,smc-id", &func_id)) {
/* Uses agent base channel */ /* Uses agent base channel */
*channel = container_of(base_chan, struct scmi_channel, ref); *channel = container_of(base_chan, struct scmi_channel, ref);
@ -100,7 +101,7 @@ static int scmi_smccc_get_channel(struct udevice *dev,
if (!chan) if (!chan)
return -ENOMEM; return -ENOMEM;
ret = setup_channel(dev, chan); ret = setup_channel(protocol, chan);
if (ret) { if (ret) {
free(chan); free(chan);
return ret; return ret;

View File

@ -16,16 +16,18 @@ struct scmi_agent_ops {
/* /*
* of_get_channel - Get SCMI channel from SCMI agent device tree node * of_get_channel - Get SCMI channel from SCMI agent device tree node
* *
* @dev: SCMI protocol device using the transport * @dev: SCMI agent device using the transport
* @protocol: SCMI protocol device using the transport
* @channel: Output reference to SCMI channel upon success * @channel: Output reference to SCMI channel upon success
* Return 0 upon success and a negative errno on failure * Return 0 upon success and a negative errno on failure
*/ */
int (*of_get_channel)(struct udevice *dev, struct scmi_channel **channel); int (*of_get_channel)(struct udevice *dev, struct udevice *protocol,
struct scmi_channel **channel);
/* /*
* process_msg - Request transport to get the SCMI message processed * process_msg - Request transport to get the SCMI message processed
* *
* @dev: SCMI protocol device using the transport * @dev: SCMI agent device using the transport
* @msg: SCMI message to be transmitted * @msg: SCMI message to be transmitted
*/ */
int (*process_msg)(struct udevice *dev, struct scmi_channel *channel, int (*process_msg)(struct udevice *dev, struct scmi_channel *channel,