[PATCH 1/8] firmware: arm_scmi: Introduce setup_shmem_iomap
Cristian Marussi
cristian.marussi at arm.com
Mon Jul 8 02:26:16 PDT 2024
On Sun, Jul 07, 2024 at 09:48:58AM -0700, Nikunj Kela wrote:
>
> On 7/6/2024 5:20 PM, Cristian Marussi wrote:
> > From: Peng Fan <peng.fan at nxp.com>
> >
> > To get the address of shmem could be generalized by introducing
> > setup_shmem_iomap. Then the duplicated code in mailbox.c, optee.c
> > and smc.c could be dropped.
> >
> > Signed-off-by: Peng Fan <peng.fan at nxp.com>
> > [ Cristian: make use of the new helper also in smc.c ]
> > Signed-off-by: Cristian Marussi <cristian.marussi at arm.com>
> > ---
> > drivers/firmware/arm_scmi/common.h | 2 ++
> > drivers/firmware/arm_scmi/mailbox.c | 27 ++++------------------
> > drivers/firmware/arm_scmi/optee.c | 35 ++++------------------------
> > drivers/firmware/arm_scmi/shmem.c | 36 +++++++++++++++++++++++++++++
> > drivers/firmware/arm_scmi/smc.c | 23 +++---------------
> > 5 files changed, 49 insertions(+), 74 deletions(-)
> >
> > diff --git a/drivers/firmware/arm_scmi/common.h b/drivers/firmware/arm_scmi/common.h
> > index 4b8c5250cdb5..b4c217641e3a 100644
> > --- a/drivers/firmware/arm_scmi/common.h
> > +++ b/drivers/firmware/arm_scmi/common.h
> > @@ -327,6 +327,8 @@ bool shmem_poll_done(struct scmi_shared_mem __iomem *shmem,
> > struct scmi_xfer *xfer);
> > bool shmem_channel_free(struct scmi_shared_mem __iomem *shmem);
> > bool shmem_channel_intr_enabled(struct scmi_shared_mem __iomem *shmem);
> > +void __iomem *setup_shmem_iomap(struct scmi_chan_info *cinfo, struct device *dev,
> > + bool tx);
> >
> > /* declarations for message passing transports */
> > struct scmi_msg_payld;
> > diff --git a/drivers/firmware/arm_scmi/mailbox.c b/drivers/firmware/arm_scmi/mailbox.c
> > index 0219a12e3209..b0a579f31905 100644
> > --- a/drivers/firmware/arm_scmi/mailbox.c
> > +++ b/drivers/firmware/arm_scmi/mailbox.c
> > @@ -178,11 +178,8 @@ static int mailbox_chan_setup(struct scmi_chan_info *cinfo, struct device *dev,
> > const char *desc = tx ? "Tx" : "Rx";
> > struct device *cdev = cinfo->dev;
> > struct scmi_mailbox *smbox;
> > - struct device_node *shmem;
> > - int ret, a2p_rx_chan, p2a_chan, p2a_rx_chan, idx = tx ? 0 : 1;
> > + int ret, a2p_rx_chan, p2a_chan, p2a_rx_chan;
> > struct mbox_client *cl;
> > - resource_size_t size;
> > - struct resource res;
> >
> > ret = mailbox_chan_validate(cdev, &a2p_rx_chan, &p2a_chan, &p2a_rx_chan);
> > if (ret)
> > @@ -195,25 +192,9 @@ static int mailbox_chan_setup(struct scmi_chan_info *cinfo, struct device *dev,
> > if (!smbox)
> > return -ENOMEM;
> >
> > - shmem = of_parse_phandle(cdev->of_node, "shmem", idx);
> > - if (!of_device_is_compatible(shmem, "arm,scmi-shmem")) {
> > - of_node_put(shmem);
> > - return -ENXIO;
> > - }
> > -
> > - ret = of_address_to_resource(shmem, 0, &res);
> > - of_node_put(shmem);
> > - if (ret) {
> > - dev_err(cdev, "failed to get SCMI %s shared memory\n", desc);
> > - return ret;
> > - }
> > -
> > - size = resource_size(&res);
> > - smbox->shmem = devm_ioremap(dev, res.start, size);
> > - if (!smbox->shmem) {
> > - dev_err(dev, "failed to ioremap SCMI %s shared memory\n", desc);
> > - return -EADDRNOTAVAIL;
> > - }
> > + smbox->shmem = setup_shmem_iomap(cinfo, dev, tx);
> > + if (IS_ERR(smbox->shmem))
> > + return PTR_ERR(smbox->shmem);
> >
> > cl = &smbox->cl;
> > cl->dev = cdev;
> > diff --git a/drivers/firmware/arm_scmi/optee.c b/drivers/firmware/arm_scmi/optee.c
> > index 4e7944b91e38..8abcd668108c 100644
> > --- a/drivers/firmware/arm_scmi/optee.c
> > +++ b/drivers/firmware/arm_scmi/optee.c
> > @@ -368,38 +368,11 @@ static int setup_dynamic_shmem(struct device *dev, struct scmi_optee_channel *ch
> > static int setup_static_shmem(struct device *dev, struct scmi_chan_info *cinfo,
> > struct scmi_optee_channel *channel)
> > {
> > - struct device_node *np;
> > - resource_size_t size;
> > - struct resource res;
> > - int ret;
> > -
> > - np = of_parse_phandle(cinfo->dev->of_node, "shmem", 0);
> > - if (!of_device_is_compatible(np, "arm,scmi-shmem")) {
> > - ret = -ENXIO;
> > - goto out;
> > - }
> > -
> > - ret = of_address_to_resource(np, 0, &res);
> > - if (ret) {
> > - dev_err(dev, "Failed to get SCMI Tx shared memory\n");
> > - goto out;
> > - }
> > -
> > - size = resource_size(&res);
> > + channel->req.shmem = setup_shmem_iomap(cinfo, dev, true);
> > + if (IS_ERR(channel->req.shmem))
> > + return PTR_ERR(channel->req.shmem);
> >
> > - channel->req.shmem = devm_ioremap(dev, res.start, size);
> > - if (!channel->req.shmem) {
> > - dev_err(dev, "Failed to ioremap SCMI Tx shared memory\n");
> > - ret = -EADDRNOTAVAIL;
> > - goto out;
> > - }
> > -
> > - ret = 0;
> > -
> > -out:
> > - of_node_put(np);
> > -
> > - return ret;
> > + return 0;
> > }
> >
> > static int setup_shmem(struct device *dev, struct scmi_chan_info *cinfo,
> > diff --git a/drivers/firmware/arm_scmi/shmem.c b/drivers/firmware/arm_scmi/shmem.c
> > index b74e5a740f2c..c31f188d74ef 100644
> > --- a/drivers/firmware/arm_scmi/shmem.c
> > +++ b/drivers/firmware/arm_scmi/shmem.c
> > @@ -7,6 +7,8 @@
> >
> > #include <linux/ktime.h>
> > #include <linux/io.h>
> > +#include <linux/of.h>
> > +#include <linux/of_address.h>
> > #include <linux/processor.h>
> > #include <linux/types.h>
> >
> > @@ -133,3 +135,37 @@ bool shmem_channel_intr_enabled(struct scmi_shared_mem __iomem *shmem)
> > {
> > return ioread32(&shmem->flags) & SCMI_SHMEM_FLAG_INTR_ENABLED;
> > }
> > +
> > +void *__iomem
> > +setup_shmem_iomap(struct scmi_chan_info *cinfo, struct device *dev, bool tx)
> > +{
> > + const char *desc = tx ? "Tx" : "Rx";
> > + int ret, idx = tx ? 0 : 1;
> > + struct device *cdev = cinfo->dev;
> > + struct device_node *shmem;
> > + resource_size_t size;
> > + struct resource res;
> > + void __iomem *addr;
> > +
> > + shmem = of_parse_phandle(cdev->of_node, "shmem", idx);
> > + if (!of_device_is_compatible(shmem, "arm,scmi-shmem")) {
> > + of_node_put(shmem);
> > + return ERR_PTR(-ENXIO);
> > + }
> > +
> > + ret = of_address_to_resource(shmem, 0, &res);
> > + of_node_put(shmem);
> > + if (ret) {
> > + dev_err(cdev, "failed to get SCMI %s shared memory\n", desc);
> > + return ERR_PTR(ret);
> > + }
> > +
> > + size = resource_size(&res);
> > + addr = devm_ioremap(dev, res.start, size);
> > + if (!addr) {
> > + dev_err(dev, "failed to ioremap SCMI %s shared memory\n", desc);
> > + return ERR_PTR(-EADDRNOTAVAIL);
> > + }
> > +
> > + return addr;
> > +}
> > diff --git a/drivers/firmware/arm_scmi/smc.c b/drivers/firmware/arm_scmi/smc.c
> > index 39936e1dd30e..a640a4312472 100644
> > --- a/drivers/firmware/arm_scmi/smc.c
> > +++ b/drivers/firmware/arm_scmi/smc.c
> > @@ -132,7 +132,6 @@ static int smc_chan_setup(struct scmi_chan_info *cinfo, struct device *dev,
> > struct scmi_smc *scmi_info;
> > resource_size_t size;
> > struct resource res;
> > - struct device_node *np;
> > u32 func_id;
> > int ret;
> >
> > @@ -143,25 +142,9 @@ static int smc_chan_setup(struct scmi_chan_info *cinfo, struct device *dev,
> > if (!scmi_info)
> > return -ENOMEM;
> >
> > - np = of_parse_phandle(cdev->of_node, "shmem", 0);
> > - if (!of_device_is_compatible(np, "arm,scmi-shmem")) {
> > - of_node_put(np);
> > - return -ENXIO;
> > - }
> > -
> > - ret = of_address_to_resource(np, 0, &res);
> > - of_node_put(np);
> > - if (ret) {
> > - dev_err(cdev, "failed to get SCMI Tx shared memory\n");
> > - return ret;
> > - }
> > -
> > - size = resource_size(&res);
>
> Hi Peng/Cristian,
>
> This will break Qualcomm smc transport as we need shmem 'size' to get to
> the cap-id.
>
...ops..sorry....that's on me I quickly extended Peng patch to address also SMC
and missed this...I'l review...
Thanks for havig a look !
Cristian
More information about the linux-arm-kernel
mailing list