| Message ID | 20240912170025.455167-6-valentina.fernandezalanis@microchip.com (mailing list archive) |
|---|---|
| State | New |
| Headers | show |
| Series | Add Microchip IPC mailbox and remoteproc support | expand |
On 12/09/2024 19:00, Valentina Fernandez wrote: > The Microchip family of RISC-V SoCs typically has one or more clusters. > These clusters can be configured to run in Asymmetric Multi-Processing > (AMP) mode. > > Add a remoteproc platform driver to be able to load and boot firmware > to the remote processor(s). ... > + > +static int mchp_ipc_rproc_prepare(struct rproc *rproc) > +{ > + struct mchp_ipc_rproc *priv = rproc->priv; > + struct device_node *np = priv->dev->of_node; > + struct rproc_mem_entry *mem; > + struct reserved_mem *rmem; > + struct of_phandle_iterator it; > + u64 device_address; > + > + reinit_completion(&priv->start_done); > + > + of_phandle_iterator_init(&it, np, "memory-region", NULL, 0); > + while (of_phandle_iterator_next(&it) == 0) { > + /* > + * Ignore the first memory region which will be used vdev > + * buffer. No need to do extra handlings, rproc_add_virtio_dev > + * will handle it. > + */ > + if (!strcmp(it.node->name, "vdev0buffer")) What? If you ignore the first, then why are you checking names? This does not make sense. Especially that your binding did not say anything about these phandles being somehow special. > + continue; > + > + if (!strcmp(it.node->name, "rsc-table")) Nope. > + continue; > + > + rmem = of_reserved_mem_lookup(it.node); > + if (!rmem) { > + of_node_put(it.node); > + dev_err(priv->dev, "unable to acquire memory-region\n"); > + return -EINVAL; > + } > + > + device_address = rmem->base; > + > + mem = rproc_mem_entry_init(priv->dev, NULL, (dma_addr_t)rmem->base, > + rmem->size, device_address, mchp_ipc_rproc_mem_alloc, > + mchp_ipc_rproc_mem_release, it.node->name); > + > + if (!mem) { > + of_node_put(it.node); > + return -ENOMEM; > + } > + > + rproc_add_carveout(rproc, mem); > + } > + > + return 0; > +} > + > +static int mchp_ipc_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw) > +{ > + int ret; > + > + ret = rproc_elf_load_rsc_table(rproc, fw); > + if (ret) > + dev_info(&rproc->dev, "No resource table in elf\n"); > + > + return 0; > +} > + > +static void mchp_ipc_rproc_kick(struct rproc *rproc, int vqid) > +{ > + struct mchp_ipc_rproc *priv = (struct mchp_ipc_rproc *)rproc->priv; > + struct mchp_ipc_msg msg; > + int ret; > + > + msg.buf = (void *)&vqid; > + msg.size = sizeof(vqid); > + > + ret = mbox_send_message(priv->mbox_channel, (void *)&msg); > + if (ret < 0) > + dev_err(priv->dev, > + "failed to send mbox message, status = %d\n", ret); > +} > + > +static int mchp_ipc_rproc_attach(struct rproc *rproc) > +{ > + return 0; > +} > + > +static struct resource_table > +*mchp_ipc_rproc_get_loaded_rsc_table(struct rproc *rproc, size_t *table_sz) > +{ > + struct mchp_ipc_rproc *priv = rproc->priv; > + > + if (!priv->rsc_table) > + return NULL; > + > + *table_sz = SZ_1K; > + return (struct resource_table *)priv->rsc_table; > +} > + > +static const struct rproc_ops mchp_ipc_rproc_ops = { > + .prepare = mchp_ipc_rproc_prepare, > + .start = mchp_ipc_rproc_start, > + .get_loaded_rsc_table = mchp_ipc_rproc_get_loaded_rsc_table, > + .attach = mchp_ipc_rproc_attach, > + .stop = mchp_ipc_rproc_stop, > + .kick = mchp_ipc_rproc_kick, > + .load = rproc_elf_load_segments, > + .parse_fw = mchp_ipc_rproc_parse_fw, > + .find_loaded_rsc_table = rproc_elf_find_loaded_rsc_table, > + .sanity_check = rproc_elf_sanity_check, > + .get_boot_addr = rproc_elf_get_boot_addr, > +}; > + > +static int mchp_ipc_rproc_addr_init(struct mchp_ipc_rproc *priv, > + struct platform_device *pdev) > +{ > + struct device *dev = &pdev->dev; > + struct device_node *np = dev->of_node; > + int i, err, rmem_np; > + > + rmem_np = of_count_phandle_with_args(np, "memory-region", NULL); > + if (rmem_np <= 0) > + return 0; > + > + for (i = 0; i < rmem_np; i++) { > + struct device_node *node; > + struct resource res; > + > + node = of_parse_phandle(np, "memory-region", i); > + if (!node) > + continue; > + > + if (!strncmp(node->name, "vdev", strlen("vdev"))) { Uh? Why do you look for node names? What if I call the name differently? Why would that matter? > + of_node_put(node); > + continue; > + } > + > + if (!strcmp(node->name, "rsc-table")) { No, really. Why are you checking for these? NAK > + err = of_address_to_resource(node, 0, &res); > + if (err) { > + of_node_put(node); > + return dev_err_probe(dev, err, > + "unable to resolve memory region\n"); > + } > + priv->rsc_table = devm_ioremap(&pdev->dev, > + res.start, resource_size(&res)); > + of_node_put(node); > + } > + } > + > + return 0; > +} Best regards, Krzysztof
On 16/09/2024 21:18, Krzysztof Kozlowski wrote: > EXTERNAL EMAIL: Do not click links or open attachments unless you know the content is safe > > On 12/09/2024 19:00, Valentina Fernandez wrote: >> The Microchip family of RISC-V SoCs typically has one or more clusters. >> These clusters can be configured to run in Asymmetric Multi-Processing >> (AMP) mode. >> >> Add a remoteproc platform driver to be able to load and boot firmware >> to the remote processor(s). > > ... > >> + >> +static int mchp_ipc_rproc_prepare(struct rproc *rproc) >> +{ >> + struct mchp_ipc_rproc *priv = rproc->priv; >> + struct device_node *np = priv->dev->of_node; >> + struct rproc_mem_entry *mem; >> + struct reserved_mem *rmem; >> + struct of_phandle_iterator it; >> + u64 device_address; >> + >> + reinit_completion(&priv->start_done); >> + >> + of_phandle_iterator_init(&it, np, "memory-region", NULL, 0); >> + while (of_phandle_iterator_next(&it) == 0) { >> + /* >> + * Ignore the first memory region which will be used vdev >> + * buffer. No need to do extra handlings, rproc_add_virtio_dev >> + * will handle it. >> + */ >> + if (!strcmp(it.node->name, "vdev0buffer")) > > What? If you ignore the first, then why are you checking names? This > does not make sense. Especially that your binding did not say anything > about these phandles being somehow special. The idea in the code above is to skip the vdev buffer allocation and carveout registration. Later, when the remoteproc virtio driver registers the virtio device (rproc_add_virtio_dev), it will attempt to find the carveout. Since the carveout wasn’t registered, it will use the first memory region from the parent by calling of_reserved_mem_device_init_by_idx. This behavior is based on some existing platform drivers. However, upon further inspection, it seems that some newer drivers use rproc_of_resm_mem_entry_init to allocate vdev buffers. I will restructure this section and rephase/drop the comment. With regards the bindings, I'll explain better all the memory regions for v2. Just for everyone’s information, we have the following use cases: Early boot: Remote processors are booted by another entity before Linux, so we only need to attach. For this mode, we require the resource table as a memory region in the device tree. Late boot - Linux is responsible for loading the firmware and starting it on the remote processors. For this, we need the region used for the firmware image. In both cases, rpmsg communication is optional. This means that the vdev buffers and vrings memory regions are also optional. There could also be a mixed case where we start with early boot mode by attaching to an existing remoteproc, and then stop, start, and load another firmware once Linux has booted. In this case, we would require the resource table and firmware image region, and optionally, vdev buffers and vrings. > >> + continue; >> + >> + if (!strcmp(it.node->name, "rsc-table")) > > Nope. Since the resource table is only needed for early boot mode and does not need to be a carveout region, we are skipping that. I will work on making the resource table a fixed index in the memory-region property so that it doesn't have a fixed name. Thanks, Valentina > >> + continue; >> + >> + rmem = of_reserved_mem_lookup(it.node); >> + if (!rmem) { >> + of_node_put(it.node); >> + dev_err(priv->dev, "unable to acquire memory-region\n"); >> + return -EINVAL; >> + } >> + >> + device_address = rmem->base; >> + >> + mem = rproc_mem_entry_init(priv->dev, NULL, (dma_addr_t)rmem->base, >> + rmem->size, device_address, mchp_ipc_rproc_mem_alloc, >> + mchp_ipc_rproc_mem_release, it.node->name); >> + >> + if (!mem) { >> + of_node_put(it.node); >> + return -ENOMEM; >> + } >> + >> + rproc_add_carveout(rproc, mem); >> + } >> + >> + return 0; >> +} >> + >> +static int mchp_ipc_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw) >> +{ >> + int ret; >> + >> + ret = rproc_elf_load_rsc_table(rproc, fw); >> + if (ret) >> + dev_info(&rproc->dev, "No resource table in elf\n"); >> + >> + return 0; >> +} >> + >> +static void mchp_ipc_rproc_kick(struct rproc *rproc, int vqid) >> +{ >> + struct mchp_ipc_rproc *priv = (struct mchp_ipc_rproc *)rproc->priv; >> + struct mchp_ipc_msg msg; >> + int ret; >> + >> + msg.buf = (void *)&vqid; >> + msg.size = sizeof(vqid); >> + >> + ret = mbox_send_message(priv->mbox_channel, (void *)&msg); >> + if (ret < 0) >> + dev_err(priv->dev, >> + "failed to send mbox message, status = %d\n", ret); >> +} >> + >> +static int mchp_ipc_rproc_attach(struct rproc *rproc) >> +{ >> + return 0; >> +} >> + >> +static struct resource_table >> +*mchp_ipc_rproc_get_loaded_rsc_table(struct rproc *rproc, size_t *table_sz) >> +{ >> + struct mchp_ipc_rproc *priv = rproc->priv; >> + >> + if (!priv->rsc_table) >> + return NULL; >> + >> + *table_sz = SZ_1K; >> + return (struct resource_table *)priv->rsc_table; >> +} >> + >> +static const struct rproc_ops mchp_ipc_rproc_ops = { >> + .prepare = mchp_ipc_rproc_prepare, >> + .start = mchp_ipc_rproc_start, >> + .get_loaded_rsc_table = mchp_ipc_rproc_get_loaded_rsc_table, >> + .attach = mchp_ipc_rproc_attach, >> + .stop = mchp_ipc_rproc_stop, >> + .kick = mchp_ipc_rproc_kick, >> + .load = rproc_elf_load_segments, >> + .parse_fw = mchp_ipc_rproc_parse_fw, >> + .find_loaded_rsc_table = rproc_elf_find_loaded_rsc_table, >> + .sanity_check = rproc_elf_sanity_check, >> + .get_boot_addr = rproc_elf_get_boot_addr, >> +}; >> + >> +static int mchp_ipc_rproc_addr_init(struct mchp_ipc_rproc *priv, >> + struct platform_device *pdev) >> +{ >> + struct device *dev = &pdev->dev; >> + struct device_node *np = dev->of_node; >> + int i, err, rmem_np; >> + >> + rmem_np = of_count_phandle_with_args(np, "memory-region", NULL); >> + if (rmem_np <= 0) >> + return 0; >> + >> + for (i = 0; i < rmem_np; i++) { >> + struct device_node *node; >> + struct resource res; >> + >> + node = of_parse_phandle(np, "memory-region", i); >> + if (!node) >> + continue; >> + >> + if (!strncmp(node->name, "vdev", strlen("vdev"))) { > > Uh? Why do you look for node names? What if I call the name differently? > Why would that matter? > >> + of_node_put(node); >> + continue; >> + } >> + >> + if (!strcmp(node->name, "rsc-table")) { > > No, really. Why are you checking for these? > > NAK > > >> + err = of_address_to_resource(node, 0, &res); >> + if (err) { >> + of_node_put(node); >> + return dev_err_probe(dev, err, >> + "unable to resolve memory region\n"); >> + } >> + priv->rsc_table = devm_ioremap(&pdev->dev, >> + res.start, resource_size(&res)); >> + of_node_put(node); >> + } >> + } >> + >> + return 0; >> +} > > > Best regards, > Krzysztof >
On 18/09/2024 17:51, Valentina.FernandezAlanis@microchip.com wrote: > On 16/09/2024 21:18, Krzysztof Kozlowski wrote: >> EXTERNAL EMAIL: Do not click links or open attachments unless you know the content is safe >> >> On 12/09/2024 19:00, Valentina Fernandez wrote: >>> The Microchip family of RISC-V SoCs typically has one or more clusters. >>> These clusters can be configured to run in Asymmetric Multi-Processing >>> (AMP) mode. >>> >>> Add a remoteproc platform driver to be able to load and boot firmware >>> to the remote processor(s). >> >> ... >> >>> + >>> +static int mchp_ipc_rproc_prepare(struct rproc *rproc) >>> +{ >>> + struct mchp_ipc_rproc *priv = rproc->priv; >>> + struct device_node *np = priv->dev->of_node; >>> + struct rproc_mem_entry *mem; >>> + struct reserved_mem *rmem; >>> + struct of_phandle_iterator it; >>> + u64 device_address; >>> + >>> + reinit_completion(&priv->start_done); >>> + >>> + of_phandle_iterator_init(&it, np, "memory-region", NULL, 0); >>> + while (of_phandle_iterator_next(&it) == 0) { >>> + /* >>> + * Ignore the first memory region which will be used vdev >>> + * buffer. No need to do extra handlings, rproc_add_virtio_dev >>> + * will handle it. >>> + */ >>> + if (!strcmp(it.node->name, "vdev0buffer")) >> >> What? If you ignore the first, then why are you checking names? This >> does not make sense. Especially that your binding did not say anything >> about these phandles being somehow special. > > The idea in the code above is to skip the vdev buffer allocation and > carveout registration. Later, when the remoteproc virtio driver > registers the virtio device (rproc_add_virtio_dev), it will attempt to > find the carveout. Since the carveout wasn’t registered, it will use the > first memory region from the parent by calling > of_reserved_mem_device_init_by_idx. > > This behavior is based on some existing platform drivers. However, upon > further inspection, it seems that some newer drivers use > rproc_of_resm_mem_entry_init to allocate vdev buffers. > > I will restructure this section and rephase/drop the comment. > > With regards the bindings, I'll explain better all the memory regions > for v2. > > Just for everyone’s information, we have the following use cases: > > Early boot: Remote processors are booted by another entity before Linux, > so we only need to attach. For this mode, we require the resource table > as a memory region in the device tree. > > Late boot - Linux is responsible for loading the firmware and starting > it on the remote processors. For this, we need the region used for the > firmware image. > > In both cases, rpmsg communication is optional. This means that the vdev > buffers and vrings memory regions are also optional. > > There could also be a mixed case where we start with early boot mode by > attaching to an existing remoteproc, and then stop, start, and load > another firmware once Linux has booted. In this case, we would require > the resource table and firmware image region, and optionally, vdev > buffers and vrings. > >> >>> + continue; >>> + >>> + if (!strcmp(it.node->name, "rsc-table")) >> >> Nope. > Since the resource table is only needed for early boot mode and does not > need to be a carveout region, we are skipping that. > > I will work on making the resource table a fixed index in the > memory-region property so that it doesn't have a fixed name. The list of memory-regions already HAS fixed indices. All this is not only confusing, but incorrect. I commented that if I call the node "rsc-not-a-table" your code will stop working. Best regards, Krzysztof
diff --git a/drivers/remoteproc/Kconfig b/drivers/remoteproc/Kconfig index dda2ada215b7..f973ed1d0635 100644 --- a/drivers/remoteproc/Kconfig +++ b/drivers/remoteproc/Kconfig @@ -54,6 +54,18 @@ config INGENIC_VPU_RPROC This can be either built-in or a loadable module. If unsure say N. +config MCHP_IPC_REMOTEPROC + tristate "Microchip IPC remoteproc support" + depends on MCHP_SBI_IPC_MBOX || COMPILE_TEST + depends on RISCV_SBI + help + Say y here to support booting and loading firmware to remote + processors on various Microchip family of RISC-V SoCs via the + remote processor framework. + This can be either built-in or a loadable module. + If compiled as module, the module will be called mchp_ipc_remoteproc. + If unsure say N. + config MTK_SCP tristate "Mediatek SCP support" depends on ARCH_MEDIATEK || COMPILE_TEST diff --git a/drivers/remoteproc/Makefile b/drivers/remoteproc/Makefile index 91314a9b43ce..3e3a27d2e848 100644 --- a/drivers/remoteproc/Makefile +++ b/drivers/remoteproc/Makefile @@ -14,6 +14,7 @@ obj-$(CONFIG_REMOTEPROC_CDEV) += remoteproc_cdev.o obj-$(CONFIG_IMX_REMOTEPROC) += imx_rproc.o obj-$(CONFIG_IMX_DSP_REMOTEPROC) += imx_dsp_rproc.o obj-$(CONFIG_INGENIC_VPU_RPROC) += ingenic_rproc.o +obj-$(CONFIG_MCHP_IPC_REMOTEPROC) += mchp_ipc_remoteproc.o obj-$(CONFIG_MTK_SCP) += mtk_scp.o mtk_scp_ipi.o obj-$(CONFIG_OMAP_REMOTEPROC) += omap_remoteproc.o obj-$(CONFIG_WKUP_M3_RPROC) += wkup_m3_rproc.o diff --git a/drivers/remoteproc/mchp_ipc_remoteproc.c b/drivers/remoteproc/mchp_ipc_remoteproc.c new file mode 100644 index 000000000000..95446dbc7993 --- /dev/null +++ b/drivers/remoteproc/mchp_ipc_remoteproc.c @@ -0,0 +1,461 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Microchip IPC Remoteproc driver + * + * Copyright (c) 2021 - 2024 Microchip Technology Inc. All rights reserved. + * + * Author: Valentina Fernandez <valentina.fernandezalanis@microchip.com> + * + * Derived from the imx_rproc implementation: + * Copyright (c) 2017 Pengutronix, Oleksij Rempel <kernel@pengutronix.de> + */ + +#include <linux/err.h> +#include <linux/kernel.h> +#include <linux/mailbox_client.h> +#include <linux/module.h> +#include <linux/of_address.h> +#include <linux/of_reserved_mem.h> +#include <linux/of.h> +#include <linux/platform_device.h> +#include <linux/remoteproc.h> +#include <linux/workqueue.h> + +#include <asm/sbi.h> +#include <asm/vendorid_list.h> +#include <linux/mailbox/mchp-ipc.h> + +#include "remoteproc_internal.h" + +#define SBI_EXT_MICROCHIP_TECHNOLOGY (SBI_EXT_VENDOR_START | \ + MICROCHIP_VENDOR_ID) + +#define MIV_RPROC_MEM_MAX 2 + +enum { + SBI_EXT_RPROC_STATE = 0x3, + SBI_EXT_RPROC_START, + SBI_EXT_RPROC_STOP, +}; + +/** + * enum mchp_ipc_rproc_mbox_messages - predefined mailbox messages + * + * @MCHP_IPC_RPROC_MBOX_READY: a ready message response from a remote context indicating + * that the remote context is up and running. + * + * @MIV_RP_MBOX_PENDING_MSG: Not currently in use, but reserved for future use + * to inform the receiver that there is a message awaiting in its receive-side + * vring. At the moment, one can explicitly send the index of the triggered + * virtqueue as a payload. + * + * @MIV_RP_MBOX_STOP: a stop request for the remote context + * + * @MIV_RP_MBOX_END_MSG: Indicates end of known/defined messages. + * This should be the last definition. + * + */ +enum mchp_ipc_rproc_mbox_messages { + MCHP_IPC_RPROC_MBOX_READY = 0xFFFFFF00, + MCHP_IPC_RPROC_MBOX_PENDING_MSG = 0xFFFFFF01, + MCHP_IPC_RPROC_MBOX_STOP = 0xFFFFFF02, + MCHP_IPC_RPROC_MBOX_END_MSG = 0xFFFFFF03, +}; + +struct mchp_ipc_rproc { + struct device *dev; + struct rproc *rproc; + struct mbox_chan *mbox_channel; + struct workqueue_struct *workqueue; + struct mbox_client mbox_client; + struct completion start_done; + struct work_struct rproc_work; + struct mchp_ipc_msg message; + void __iomem *rsc_table; + bool initialized; + u32 chan_id; +}; + +static int mchp_ipc_rproc_start(struct rproc *rproc) +{ + struct mchp_ipc_rproc *priv = rproc->priv; + struct device_node *np = priv->dev->of_node; + struct sbiret ret; + int result; + + ret = sbi_ecall(SBI_EXT_MICROCHIP_TECHNOLOGY, SBI_EXT_RPROC_START, + priv->chan_id, rproc->bootaddr, 0, 0, 0, 0); + + if (ret.error) + return sbi_err_map_linux_errno(ret.error); + + result = wait_for_completion_timeout(&priv->start_done, + msecs_to_jiffies(5000)); + + if (!of_property_present(np, "microchip,skip-start-wait") && result == 0) { + dev_err(priv->dev, "timeout waiting for ready notification\n"); + return -ETIMEDOUT; + } + + return 0; +} + +static int mchp_ipc_rproc_stop(struct rproc *rproc) +{ + struct mchp_ipc_rproc *priv = rproc->priv; + struct sbiret ret; + + ret = sbi_ecall(SBI_EXT_MICROCHIP_TECHNOLOGY, SBI_EXT_RPROC_STOP, + priv->chan_id, MCHP_IPC_RPROC_MBOX_STOP, 0, 0, 0, 0); + + if (ret.error) + return sbi_err_map_linux_errno(ret.error); + + return ret.value; +} + +static int mchp_ipc_rproc_mem_alloc(struct rproc *rproc, struct rproc_mem_entry *mem) +{ + struct device *dev = rproc->dev.parent; + void *va; + + dev_dbg(dev, "map memory: %pad+%zx\n", &mem->dma, mem->len); + va = ioremap_wc(mem->dma, mem->len); + if (IS_ERR_OR_NULL(va)) { + dev_err(dev, "Unable to map memory region: %p+%zx\n", + &mem->dma, mem->len); + return -ENOMEM; + } + + mem->va = va; + + return 0; +} + +static int mchp_ipc_rproc_mem_release(struct rproc *rproc, + struct rproc_mem_entry *mem) +{ + dev_dbg(rproc->dev.parent, "unmap memory: %pad\n", &mem->dma); + iounmap(mem->va); + + return 0; +} + +static int mchp_ipc_rproc_prepare(struct rproc *rproc) +{ + struct mchp_ipc_rproc *priv = rproc->priv; + struct device_node *np = priv->dev->of_node; + struct rproc_mem_entry *mem; + struct reserved_mem *rmem; + struct of_phandle_iterator it; + u64 device_address; + + reinit_completion(&priv->start_done); + + of_phandle_iterator_init(&it, np, "memory-region", NULL, 0); + while (of_phandle_iterator_next(&it) == 0) { + /* + * Ignore the first memory region which will be used vdev + * buffer. No need to do extra handlings, rproc_add_virtio_dev + * will handle it. + */ + if (!strcmp(it.node->name, "vdev0buffer")) + continue; + + if (!strcmp(it.node->name, "rsc-table")) + continue; + + rmem = of_reserved_mem_lookup(it.node); + if (!rmem) { + of_node_put(it.node); + dev_err(priv->dev, "unable to acquire memory-region\n"); + return -EINVAL; + } + + device_address = rmem->base; + + mem = rproc_mem_entry_init(priv->dev, NULL, (dma_addr_t)rmem->base, + rmem->size, device_address, mchp_ipc_rproc_mem_alloc, + mchp_ipc_rproc_mem_release, it.node->name); + + if (!mem) { + of_node_put(it.node); + return -ENOMEM; + } + + rproc_add_carveout(rproc, mem); + } + + return 0; +} + +static int mchp_ipc_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw) +{ + int ret; + + ret = rproc_elf_load_rsc_table(rproc, fw); + if (ret) + dev_info(&rproc->dev, "No resource table in elf\n"); + + return 0; +} + +static void mchp_ipc_rproc_kick(struct rproc *rproc, int vqid) +{ + struct mchp_ipc_rproc *priv = (struct mchp_ipc_rproc *)rproc->priv; + struct mchp_ipc_msg msg; + int ret; + + msg.buf = (void *)&vqid; + msg.size = sizeof(vqid); + + ret = mbox_send_message(priv->mbox_channel, (void *)&msg); + if (ret < 0) + dev_err(priv->dev, + "failed to send mbox message, status = %d\n", ret); +} + +static int mchp_ipc_rproc_attach(struct rproc *rproc) +{ + return 0; +} + +static struct resource_table +*mchp_ipc_rproc_get_loaded_rsc_table(struct rproc *rproc, size_t *table_sz) +{ + struct mchp_ipc_rproc *priv = rproc->priv; + + if (!priv->rsc_table) + return NULL; + + *table_sz = SZ_1K; + return (struct resource_table *)priv->rsc_table; +} + +static const struct rproc_ops mchp_ipc_rproc_ops = { + .prepare = mchp_ipc_rproc_prepare, + .start = mchp_ipc_rproc_start, + .get_loaded_rsc_table = mchp_ipc_rproc_get_loaded_rsc_table, + .attach = mchp_ipc_rproc_attach, + .stop = mchp_ipc_rproc_stop, + .kick = mchp_ipc_rproc_kick, + .load = rproc_elf_load_segments, + .parse_fw = mchp_ipc_rproc_parse_fw, + .find_loaded_rsc_table = rproc_elf_find_loaded_rsc_table, + .sanity_check = rproc_elf_sanity_check, + .get_boot_addr = rproc_elf_get_boot_addr, +}; + +static int mchp_ipc_rproc_addr_init(struct mchp_ipc_rproc *priv, + struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct device_node *np = dev->of_node; + int i, err, rmem_np; + + rmem_np = of_count_phandle_with_args(np, "memory-region", NULL); + if (rmem_np <= 0) + return 0; + + for (i = 0; i < rmem_np; i++) { + struct device_node *node; + struct resource res; + + node = of_parse_phandle(np, "memory-region", i); + if (!node) + continue; + + if (!strncmp(node->name, "vdev", strlen("vdev"))) { + of_node_put(node); + continue; + } + + if (!strcmp(node->name, "rsc-table")) { + err = of_address_to_resource(node, 0, &res); + if (err) { + of_node_put(node); + return dev_err_probe(dev, err, + "unable to resolve memory region\n"); + } + priv->rsc_table = devm_ioremap(&pdev->dev, + res.start, resource_size(&res)); + of_node_put(node); + } + } + + return 0; +} + +static void mchp_ipc_rproc_vq_work(struct work_struct *work) +{ + struct mchp_ipc_rproc *priv = container_of(work, struct mchp_ipc_rproc, rproc_work); + struct device *dev = priv->rproc->dev.parent; + + u32 msg = priv->message.buf[0]; + + /* + * Currently, we are expected to receive the following messages + * from the remote cluster: a ready message or receive the index + * of the triggered virtqueue as a payload. + * We can silently ignore any other type of mailbox messages since + * they are not meant for us and are meant to be received by the + * remote cluster only. + */ + switch (msg) { + case MCHP_IPC_RPROC_MBOX_READY: + complete(&priv->start_done); + break; + default: + if (msg >= MCHP_IPC_RPROC_MBOX_READY && msg < MCHP_IPC_RPROC_MBOX_END_MSG) + return; + if (msg > priv->rproc->max_notifyid) { + dev_info(dev, "dropping unknown message 0x%x", msg); + return; + } + /* msg contains the index of the triggered vring */ + if (rproc_vq_interrupt(priv->rproc, msg) == IRQ_NONE) + dev_dbg(dev, "no message was found in vqid %d\n", msg); + } +} + +static void mchp_ipc_rproc_rx_callback(struct mbox_client *mbox_client, void *msg) +{ + struct rproc *rproc = dev_get_drvdata(mbox_client->dev); + struct mchp_ipc_rproc *priv = rproc->priv; + + priv->message = *(struct mchp_ipc_msg *)msg; + queue_work(priv->workqueue, &priv->rproc_work); +} + +static int mchp_ipc_rproc_mbox_init(struct rproc *rproc) +{ + struct mchp_ipc_rproc *priv = rproc->priv; + struct device *dev = priv->dev; + struct mbox_client *mbox_client; + + mbox_client = &priv->mbox_client; + mbox_client->dev = dev; + mbox_client->tx_block = true; + mbox_client->tx_tout = 100; + mbox_client->knows_txdone = false; + mbox_client->rx_callback = mchp_ipc_rproc_rx_callback; + + priv->mbox_channel = mbox_request_channel(mbox_client, 0); + if (IS_ERR(priv->mbox_channel)) + return dev_err_probe(mbox_client->dev, + PTR_ERR(priv->mbox_channel), + "failed to request mailbox channel\n"); + + priv->chan_id = mchp_ipc_get_chan_id(priv->mbox_channel); + + return 0; +} + +static int mchp_ipc_rproc_get_state(u32 chan) +{ + struct sbiret ret; + + ret = sbi_ecall(SBI_EXT_MICROCHIP_TECHNOLOGY, SBI_EXT_RPROC_STATE, + chan, 0, 0, 0, 0, 0); + + if (ret.error) + return sbi_err_map_linux_errno(ret.error); + + return ret.value; +} + +static int mchp_ipc_rproc_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct device_node *np = dev->of_node; + struct mchp_ipc_rproc *priv; + struct rproc *rproc; + int ret; + + rproc = devm_rproc_alloc(dev, np->name, &mchp_ipc_rproc_ops, + NULL, sizeof(*priv)); + if (!rproc) + return -ENOMEM; + + priv = rproc->priv; + priv->rproc = rproc; + priv->dev = dev; + + priv->workqueue = create_workqueue(dev_name(dev)); + if (!priv->workqueue) + return dev_err_probe(dev, -ENOMEM, "cannot create workqueue\n"); + + INIT_WORK(&priv->rproc_work, mchp_ipc_rproc_vq_work); + init_completion(&priv->start_done); + + ret = mchp_ipc_rproc_mbox_init(rproc); + if (ret) + goto err_put_wkq; + + ret = mchp_ipc_rproc_addr_init(priv, pdev); + if (ret) + goto err_put_mbox; + + /* + * Check if the remote cluster has been booted by another entity + * (i.e. bootloader) and set rproc state accordingly + */ + rproc->state = mchp_ipc_rproc_get_state(priv->chan_id); + if (ret < 0) { + dev_err_probe(dev, ret, "Couldn't get cluster boot mode\n"); + goto err_put_mbox; + } + + if (rproc->state != RPROC_DETACHED) + rproc->auto_boot = of_property_present(np, "microchip,auto-boot"); + + /* error recovery is not supported at present */ + rproc->recovery_disabled = true; + + dev_set_drvdata(dev, rproc); + + ret = devm_rproc_add(dev, rproc); + if (ret) { + dev_err_probe(dev, ret, "rproc_add failed\n"); + goto err_put_mbox; + } + + return 0; + +err_put_mbox: + mbox_free_channel(priv->mbox_channel); +err_put_wkq: + destroy_workqueue(priv->workqueue); + + return ret; +} + +static void mchp_ipc_rproc_remove(struct platform_device *pdev) +{ + struct rproc *rproc = platform_get_drvdata(pdev); + struct mchp_ipc_rproc *priv = rproc->priv; + + mbox_free_channel(priv->mbox_channel); + destroy_workqueue(priv->workqueue); +} + +static const struct of_device_id mchp_ipc_rproc_of_match[] __maybe_unused = { + { .compatible = "microchip,ipc-remoteproc", }, + {} +}; +MODULE_DEVICE_TABLE(of, mchp_ipc_rproc_of_match); + +static struct platform_driver mchp_ipc_rproc_driver = { + .probe = mchp_ipc_rproc_probe, + .remove_new = mchp_ipc_rproc_remove, + .driver = { + .name = "microchip-ipc-rproc", + .of_match_table = of_match_ptr(mchp_ipc_rproc_of_match), + }, +}; + +module_platform_driver(mchp_ipc_rproc_driver); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Valentina Fernandez <valentina.fernandezalanis@microchip.com>"); +MODULE_DESCRIPTION("Microchip IPC Remote Processor control driver");
The Microchip family of RISC-V SoCs typically has one or more clusters. These clusters can be configured to run in Asymmetric Multi-Processing (AMP) mode. Add a remoteproc platform driver to be able to load and boot firmware to the remote processor(s). The driver uses SBI (RISC-V Supervisor Binary Interface) ecalls to request software running in machine-privileged mode (M-mode) to start/stop the remote processor(s). Inter-processor communication is supported through the virtio rpmsg stack using shared memory and the Microchip IPC mailbox driver. Currently, the driver the following features are supported: - Start/stop a remote software context - Kick function implementation for RPMsg Communication - Attach to a remote context loaded by another entity (bootloader) Error Recovery and Power Management features are not currently supported Signed-off-by: Valentina Fernandez <valentina.fernandezalanis@microchip.com> --- drivers/remoteproc/Kconfig | 12 + drivers/remoteproc/Makefile | 1 + drivers/remoteproc/mchp_ipc_remoteproc.c | 461 +++++++++++++++++++++++ 3 files changed, 474 insertions(+) create mode 100644 drivers/remoteproc/mchp_ipc_remoteproc.c