mirror of
https://git.yoctoproject.org/meta-arm
synced 2026-05-30 12:30:14 +00:00
arm-bsp/kernel: Add rpmsg_arm_mailbox to corstone1000
Adds out-of-tree rpmsg_arm_mailbox driver patches into linux kernel to communicate with external system using MHUs in corstone1000 platform. The host can communicate with external system using the driver under /dev/rpmsg0_ctrl0. Signed-off-by: Emekcan Aras <emekcan.aras@arm.com> Signed-off-by: Jon Mason <jon.mason@arm.com>
This commit is contained in:
Emekcan
Jon Mason
+222
@@ -0,0 +1,222 @@
|
|||||||
|
Upstream-Status: Pending [Not submitted to upstream yet]
|
||||||
|
Signed-off-by: Emekcan Aras <emekcan.aras@arm.com>
|
||||||
|
|
||||||
|
From e683c37ee51717e625c8a598056cf4bb1bdadcbc Mon Sep 17 00:00:00 2001
|
||||||
|
From: Emekcan <emekcan.aras@arm.com>
|
||||||
|
Date: Wed, 17 Aug 2022 14:21:42 +0100
|
||||||
|
Subject: [PATCH] Add rpsmg driver for corstone1000
|
||||||
|
|
||||||
|
Adds rpsmg driver to communicate with external
|
||||||
|
system in corstone1000 platform.
|
||||||
|
|
||||||
|
Signed-off-by: Emekcan Aras <emekcan.aras@arm.com>
|
||||||
|
---
|
||||||
|
drivers/rpmsg/Kconfig | 10 ++
|
||||||
|
drivers/rpmsg/Makefile | 1 +
|
||||||
|
drivers/rpmsg/rpmsg_arm_mailbox.c | 164 ++++++++++++++++++++++
|
||||||
|
3 files changed, 175 insertions(+)
|
||||||
|
create mode 100644 drivers/rpmsg/rpmsg_arm_mailbox.c
|
||||||
|
|
||||||
|
diff --git a/drivers/rpmsg/Kconfig b/drivers/rpmsg/Kconfig
|
||||||
|
index 0b4407abdf13..c276bd17bffe 100644
|
||||||
|
--- a/drivers/rpmsg/Kconfig
|
||||||
|
+++ b/drivers/rpmsg/Kconfig
|
||||||
|
@@ -73,4 +73,14 @@ config RPMSG_VIRTIO
|
||||||
|
select RPMSG_NS
|
||||||
|
select VIRTIO
|
||||||
|
|
||||||
|
+config RPMSG_ARM
|
||||||
|
+ tristate "ARM RPMSG driver"
|
||||||
|
+ select RPMSG
|
||||||
|
+ depends on HAS_IOMEM
|
||||||
|
+ depends on MAILBOX
|
||||||
|
+ help
|
||||||
|
+ Say y here to enable support for rpmsg lient driver which is built
|
||||||
|
+ around mailbox client using Arm MHUv2.1 as physical medium.This
|
||||||
|
+ driver enables communication which remote processor using MHU.
|
||||||
|
+
|
||||||
|
endmenu
|
||||||
|
diff --git a/drivers/rpmsg/Makefile b/drivers/rpmsg/Makefile
|
||||||
|
index 8d452656f0ee..34e9c146cd64 100644
|
||||||
|
--- a/drivers/rpmsg/Makefile
|
||||||
|
+++ b/drivers/rpmsg/Makefile
|
||||||
|
@@ -1,5 +1,6 @@
|
||||||
|
# SPDX-License-Identifier: GPL-2.0
|
||||||
|
obj-$(CONFIG_RPMSG) += rpmsg_core.o
|
||||||
|
+obj-$(CONFIG_RPMSG_ARM) += rpmsg_arm_mailbox.o
|
||||||
|
obj-$(CONFIG_RPMSG_CHAR) += rpmsg_char.o
|
||||||
|
obj-$(CONFIG_RPMSG_NS) += rpmsg_ns.o
|
||||||
|
obj-$(CONFIG_RPMSG_MTK_SCP) += mtk_rpmsg.o
|
||||||
|
diff --git a/drivers/rpmsg/rpmsg_arm_mailbox.c b/drivers/rpmsg/rpmsg_arm_mailbox.c
|
||||||
|
new file mode 100644
|
||||||
|
index 000000000000..4a80102669f6
|
||||||
|
--- /dev/null
|
||||||
|
+++ b/drivers/rpmsg/rpmsg_arm_mailbox.c
|
||||||
|
@@ -0,0 +1,164 @@
|
||||||
|
+// SPDX-License-Identifier: GPL-2.0
|
||||||
|
+/*
|
||||||
|
+ * rpmsg client driver using mailbox client interface
|
||||||
|
+ *
|
||||||
|
+ * Copyright (C) 2019 ARM Ltd.
|
||||||
|
+ *
|
||||||
|
+ */
|
||||||
|
+
|
||||||
|
+#include <linux/bitmap.h>
|
||||||
|
+#include <linux/export.h>
|
||||||
|
+#include <linux/io.h>
|
||||||
|
+#include <linux/kernel.h>
|
||||||
|
+#include <linux/ktime.h>
|
||||||
|
+#include <linux/mailbox_client.h>
|
||||||
|
+#include <linux/module.h>
|
||||||
|
+#include <linux/of_address.h>
|
||||||
|
+#include <linux/of_device.h>
|
||||||
|
+#include <linux/processor.h>
|
||||||
|
+#include <linux/semaphore.h>
|
||||||
|
+#include <linux/slab.h>
|
||||||
|
+#include <linux/rpmsg.h>
|
||||||
|
+#include "rpmsg_internal.h"
|
||||||
|
+#include <linux/mailbox/arm_mhuv2_message.h>
|
||||||
|
+
|
||||||
|
+#define RPMSG_NAME "arm_rpmsg"
|
||||||
|
+#define RPMSG_ADDR_ANY 0xFFFFFFFF
|
||||||
|
+
|
||||||
|
+struct arm_channel {
|
||||||
|
+ struct rpmsg_endpoint ept;
|
||||||
|
+ struct mbox_client cl;
|
||||||
|
+ struct mbox_chan *mbox;
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+#define arm_channel_from_rpmsg(_ept) container_of(_ept, struct arm_channel, ept)
|
||||||
|
+#define arm_channel_from_mbox(_ept) container_of(_ept, struct arm_channel, cl)
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+static void arm_msg_rx_handler(struct mbox_client *cl, void *mssg)
|
||||||
|
+{
|
||||||
|
+ struct arm_mhuv2_mbox_msg *msg = mssg;
|
||||||
|
+ struct arm_channel* channel = arm_channel_from_mbox(cl);
|
||||||
|
+ int err = channel->ept.cb(channel->ept.rpdev, msg->data, 4, channel->ept.priv, RPMSG_ADDR_ANY);
|
||||||
|
+ if(err) {
|
||||||
|
+ printk("ARM Mailbox: Endpoint callback failed with error: %d", err);
|
||||||
|
+ }
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+static void arm_destroy_ept(struct rpmsg_endpoint *ept)
|
||||||
|
+{
|
||||||
|
+ struct arm_channel *channel = arm_channel_from_rpmsg(ept);
|
||||||
|
+ mbox_free_channel(channel->mbox);
|
||||||
|
+ kfree(channel);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static int arm_send(struct rpmsg_endpoint *ept, void *data, int len)
|
||||||
|
+{
|
||||||
|
+ struct arm_channel *channel = arm_channel_from_rpmsg(ept);
|
||||||
|
+
|
||||||
|
+ mbox_send_message(channel->mbox, data);
|
||||||
|
+ return 0;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static int arm_sendto(struct rpmsg_endpoint *ept, void *data, int len, u32 dest)
|
||||||
|
+{
|
||||||
|
+ struct arm_mhuv2_mbox_msg msg;
|
||||||
|
+ struct arm_channel *channel = arm_channel_from_rpmsg(ept);
|
||||||
|
+ msg.data = data;
|
||||||
|
+ msg.len = len;
|
||||||
|
+ mbox_send_message(channel->mbox, &msg);
|
||||||
|
+ return 0;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+static const struct rpmsg_endpoint_ops arm_endpoint_ops = {
|
||||||
|
+ .destroy_ept = arm_destroy_ept,
|
||||||
|
+ .send = arm_send,
|
||||||
|
+ .sendto = arm_sendto,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+static struct rpmsg_endpoint *arm_create_ept(struct rpmsg_device *rpdev,
|
||||||
|
+ rpmsg_rx_cb_t cb, void *priv, struct rpmsg_channel_info chinfo)
|
||||||
|
+{
|
||||||
|
+ struct arm_channel *channel;
|
||||||
|
+
|
||||||
|
+ channel = kzalloc(sizeof(*channel), GFP_KERNEL);
|
||||||
|
+
|
||||||
|
+ // Initialize rpmsg endpoint
|
||||||
|
+ kref_init(&channel->ept.refcount);
|
||||||
|
+ channel->ept.rpdev = rpdev;
|
||||||
|
+ channel->ept.cb = cb;
|
||||||
|
+ channel->ept.priv = priv;
|
||||||
|
+ channel->ept.ops = &arm_endpoint_ops;
|
||||||
|
+
|
||||||
|
+ // Initialize mailbox client
|
||||||
|
+ channel->cl.dev = rpdev->dev.parent;
|
||||||
|
+ channel->cl.rx_callback = arm_msg_rx_handler;
|
||||||
|
+ channel->cl.tx_done = NULL; /* operate in blocking mode */
|
||||||
|
+ channel->cl.tx_block = true;
|
||||||
|
+ channel->cl.tx_tout = 500; /* by half a second */
|
||||||
|
+ channel->cl.knows_txdone = false; /* depending upon protocol */
|
||||||
|
+
|
||||||
|
+ channel->mbox = mbox_request_channel_byname(&channel->cl, chinfo.name);
|
||||||
|
+ if (IS_ERR_OR_NULL(channel->mbox)) {
|
||||||
|
+ printk("RPMsg ARM: Cannot get channel by name: '%s'\n", chinfo.name);
|
||||||
|
+ return -1;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ return &channel->ept;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static const struct rpmsg_device_ops arm_device_ops = {
|
||||||
|
+ .create_ept = arm_create_ept,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+static void arm_release_device(struct device *dev)
|
||||||
|
+{
|
||||||
|
+ struct rpmsg_device *rpdev = to_rpmsg_device(dev);
|
||||||
|
+
|
||||||
|
+ kfree(rpdev);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+static int client_probe(struct platform_device *pdev)
|
||||||
|
+{
|
||||||
|
+ struct device *dev = &pdev->dev;
|
||||||
|
+ struct rpmsg_device *rpdev;
|
||||||
|
+
|
||||||
|
+ rpdev = kzalloc(sizeof(*rpdev), GFP_KERNEL);
|
||||||
|
+ if (!rpdev)
|
||||||
|
+ return -ENOMEM;
|
||||||
|
+
|
||||||
|
+ /* Assign callbacks for rpmsg_device */
|
||||||
|
+ rpdev->ops = &arm_device_ops;
|
||||||
|
+
|
||||||
|
+ /* Assign public information to the rpmsg_device */
|
||||||
|
+ memcpy(rpdev->id.name, RPMSG_NAME, strlen(RPMSG_NAME));
|
||||||
|
+
|
||||||
|
+ rpdev->dev.parent = dev;
|
||||||
|
+ rpdev->dev.release = arm_release_device;
|
||||||
|
+
|
||||||
|
+ return rpmsg_chrdev_register_device(rpdev);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static const struct of_device_id client_of_match[] = {
|
||||||
|
+ { .compatible = "arm,client", .data = NULL },
|
||||||
|
+ { /* Sentinel */ },
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+static struct platform_driver client_driver = {
|
||||||
|
+ .driver = {
|
||||||
|
+ .name = "arm-mhu-client",
|
||||||
|
+ .of_match_table = client_of_match,
|
||||||
|
+ },
|
||||||
|
+ .probe = client_probe,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+module_platform_driver(client_driver);
|
||||||
|
+
|
||||||
|
+MODULE_LICENSE("GPL v2");
|
||||||
|
+MODULE_DESCRIPTION("ARM RPMSG Driver");
|
||||||
|
+MODULE_AUTHOR("Tushar Khandelwal <tushar.khandelwal@arm.com>");
|
||||||
|
--
|
||||||
|
2.17.1
|
||||||
|
|
||||||
@@ -92,4 +92,9 @@ CONFIG_LIBCRC32C=y
|
|||||||
CONFIG_DEBUG_FS=y
|
CONFIG_DEBUG_FS=y
|
||||||
CONFIG_PANIC_TIMEOUT=5
|
CONFIG_PANIC_TIMEOUT=5
|
||||||
CONFIG_STACKTRACE=y
|
CONFIG_STACKTRACE=y
|
||||||
CONFIG_EXTSYS_CTRL=y
|
CONFIG_EXTSYS_CTRL=y
|
||||||
|
CONFIG_MAILBOX=y
|
||||||
|
CONFIG_ARM_MHU_V2=y
|
||||||
|
CONFIG_RPMSG=y
|
||||||
|
CONFIG_RPMSG_CHAR=y
|
||||||
|
CONFIG_RPMSG_ARM=y
|
||||||
|
|||||||
@@ -42,6 +42,7 @@ SRC_URI:append:corstone1000 = " \
|
|||||||
file://defconfig \
|
file://defconfig \
|
||||||
file://0001-UPSTREAM-firmware-arm_ffa-Handle-compatibility-with-.patch \
|
file://0001-UPSTREAM-firmware-arm_ffa-Handle-compatibility-with-.patch \
|
||||||
file://0002-Add-external-system-driver.patch \
|
file://0002-Add-external-system-driver.patch \
|
||||||
|
file://0003-Add-rpsmg-driver-for-corstone1000.patch \
|
||||||
"
|
"
|
||||||
|
|
||||||
SRC_URI:append:corstone1000 = " ${@bb.utils.contains('MACHINE_FEATURES', \
|
SRC_URI:append:corstone1000 = " ${@bb.utils.contains('MACHINE_FEATURES', \
|
||||||
|
|||||||
Reference in New Issue
Block a user