1950a7388SArnaud Pouliquen // SPDX-License-Identifier: GPL-2.0
2950a7388SArnaud Pouliquen /*
3950a7388SArnaud Pouliquen * Copyright (C) STMicroelectronics 2020 - All Rights Reserved
4950a7388SArnaud Pouliquen */
5950a7388SArnaud Pouliquen #include <linux/device.h>
6950a7388SArnaud Pouliquen #include <linux/kernel.h>
7950a7388SArnaud Pouliquen #include <linux/module.h>
8950a7388SArnaud Pouliquen #include <linux/rpmsg.h>
9950a7388SArnaud Pouliquen #include <linux/rpmsg/ns.h>
10950a7388SArnaud Pouliquen #include <linux/slab.h>
11950a7388SArnaud Pouliquen
12950a7388SArnaud Pouliquen #include "rpmsg_internal.h"
13950a7388SArnaud Pouliquen
14950a7388SArnaud Pouliquen /**
15950a7388SArnaud Pouliquen * rpmsg_ns_register_device() - register name service device based on rpdev
16950a7388SArnaud Pouliquen * @rpdev: prepared rpdev to be used for creating endpoints
17950a7388SArnaud Pouliquen *
18950a7388SArnaud Pouliquen * This function wraps rpmsg_register_device() preparing the rpdev for use as
19950a7388SArnaud Pouliquen * basis for the rpmsg name service device.
20950a7388SArnaud Pouliquen */
rpmsg_ns_register_device(struct rpmsg_device * rpdev)21950a7388SArnaud Pouliquen int rpmsg_ns_register_device(struct rpmsg_device *rpdev)
22950a7388SArnaud Pouliquen {
23950a7388SArnaud Pouliquen rpdev->src = RPMSG_NS_ADDR;
24950a7388SArnaud Pouliquen rpdev->dst = RPMSG_NS_ADDR;
25950a7388SArnaud Pouliquen
26*bb17d110SKrzysztof Kozlowski return rpmsg_register_device_override(rpdev, "rpmsg_ns");
27950a7388SArnaud Pouliquen }
28950a7388SArnaud Pouliquen EXPORT_SYMBOL(rpmsg_ns_register_device);
29950a7388SArnaud Pouliquen
30950a7388SArnaud Pouliquen /* invoked when a name service announcement arrives */
rpmsg_ns_cb(struct rpmsg_device * rpdev,void * data,int len,void * priv,u32 src)31950a7388SArnaud Pouliquen static int rpmsg_ns_cb(struct rpmsg_device *rpdev, void *data, int len,
32950a7388SArnaud Pouliquen void *priv, u32 src)
33950a7388SArnaud Pouliquen {
34950a7388SArnaud Pouliquen struct rpmsg_ns_msg *msg = data;
35950a7388SArnaud Pouliquen struct rpmsg_device *newch;
36950a7388SArnaud Pouliquen struct rpmsg_channel_info chinfo;
37950a7388SArnaud Pouliquen struct device *dev = rpdev->dev.parent;
38950a7388SArnaud Pouliquen int ret;
39950a7388SArnaud Pouliquen
40950a7388SArnaud Pouliquen #if defined(CONFIG_DYNAMIC_DEBUG)
41950a7388SArnaud Pouliquen dynamic_hex_dump("NS announcement: ", DUMP_PREFIX_NONE, 16, 1,
42950a7388SArnaud Pouliquen data, len, true);
43950a7388SArnaud Pouliquen #endif
44950a7388SArnaud Pouliquen
45950a7388SArnaud Pouliquen if (len != sizeof(*msg)) {
46950a7388SArnaud Pouliquen dev_err(dev, "malformed ns msg (%d)\n", len);
47950a7388SArnaud Pouliquen return -EINVAL;
48950a7388SArnaud Pouliquen }
49950a7388SArnaud Pouliquen
50950a7388SArnaud Pouliquen /* don't trust the remote processor for null terminating the name */
51950a7388SArnaud Pouliquen msg->name[RPMSG_NAME_SIZE - 1] = '\0';
52950a7388SArnaud Pouliquen
53950a7388SArnaud Pouliquen strncpy(chinfo.name, msg->name, sizeof(chinfo.name));
54950a7388SArnaud Pouliquen chinfo.src = RPMSG_ADDR_ANY;
55950a7388SArnaud Pouliquen chinfo.dst = rpmsg32_to_cpu(rpdev, msg->addr);
56950a7388SArnaud Pouliquen
57950a7388SArnaud Pouliquen dev_info(dev, "%sing channel %s addr 0x%x\n",
58950a7388SArnaud Pouliquen rpmsg32_to_cpu(rpdev, msg->flags) & RPMSG_NS_DESTROY ?
59950a7388SArnaud Pouliquen "destroy" : "creat", msg->name, chinfo.dst);
60950a7388SArnaud Pouliquen
61950a7388SArnaud Pouliquen if (rpmsg32_to_cpu(rpdev, msg->flags) & RPMSG_NS_DESTROY) {
62950a7388SArnaud Pouliquen ret = rpmsg_release_channel(rpdev, &chinfo);
63950a7388SArnaud Pouliquen if (ret)
64950a7388SArnaud Pouliquen dev_err(dev, "rpmsg_destroy_channel failed: %d\n", ret);
65950a7388SArnaud Pouliquen } else {
66950a7388SArnaud Pouliquen newch = rpmsg_create_channel(rpdev, &chinfo);
67950a7388SArnaud Pouliquen if (!newch)
68950a7388SArnaud Pouliquen dev_err(dev, "rpmsg_create_channel failed\n");
69950a7388SArnaud Pouliquen }
70950a7388SArnaud Pouliquen
71950a7388SArnaud Pouliquen return 0;
72950a7388SArnaud Pouliquen }
73950a7388SArnaud Pouliquen
rpmsg_ns_probe(struct rpmsg_device * rpdev)74950a7388SArnaud Pouliquen static int rpmsg_ns_probe(struct rpmsg_device *rpdev)
75950a7388SArnaud Pouliquen {
76950a7388SArnaud Pouliquen struct rpmsg_endpoint *ns_ept;
77950a7388SArnaud Pouliquen struct rpmsg_channel_info ns_chinfo = {
78950a7388SArnaud Pouliquen .src = RPMSG_NS_ADDR,
79950a7388SArnaud Pouliquen .dst = RPMSG_NS_ADDR,
80950a7388SArnaud Pouliquen .name = "name_service",
81950a7388SArnaud Pouliquen };
82950a7388SArnaud Pouliquen
83950a7388SArnaud Pouliquen /*
84950a7388SArnaud Pouliquen * Create the NS announcement service endpoint associated to the RPMsg
85950a7388SArnaud Pouliquen * device. The endpoint will be automatically destroyed when the RPMsg
86950a7388SArnaud Pouliquen * device will be deleted.
87950a7388SArnaud Pouliquen */
88950a7388SArnaud Pouliquen ns_ept = rpmsg_create_ept(rpdev, rpmsg_ns_cb, NULL, ns_chinfo);
89950a7388SArnaud Pouliquen if (!ns_ept) {
90950a7388SArnaud Pouliquen dev_err(&rpdev->dev, "failed to create the ns ept\n");
91950a7388SArnaud Pouliquen return -ENOMEM;
92950a7388SArnaud Pouliquen }
93950a7388SArnaud Pouliquen rpdev->ept = ns_ept;
94950a7388SArnaud Pouliquen
95950a7388SArnaud Pouliquen return 0;
96950a7388SArnaud Pouliquen }
97950a7388SArnaud Pouliquen
98950a7388SArnaud Pouliquen static struct rpmsg_driver rpmsg_ns_driver = {
99950a7388SArnaud Pouliquen .drv.name = KBUILD_MODNAME,
100950a7388SArnaud Pouliquen .probe = rpmsg_ns_probe,
101950a7388SArnaud Pouliquen };
102950a7388SArnaud Pouliquen
rpmsg_ns_init(void)103950a7388SArnaud Pouliquen static int rpmsg_ns_init(void)
104950a7388SArnaud Pouliquen {
105950a7388SArnaud Pouliquen int ret;
106950a7388SArnaud Pouliquen
107950a7388SArnaud Pouliquen ret = register_rpmsg_driver(&rpmsg_ns_driver);
108950a7388SArnaud Pouliquen if (ret < 0)
109950a7388SArnaud Pouliquen pr_err("%s: Failed to register rpmsg driver\n", __func__);
110950a7388SArnaud Pouliquen
111950a7388SArnaud Pouliquen return ret;
112950a7388SArnaud Pouliquen }
113950a7388SArnaud Pouliquen postcore_initcall(rpmsg_ns_init);
114950a7388SArnaud Pouliquen
rpmsg_ns_exit(void)115950a7388SArnaud Pouliquen static void rpmsg_ns_exit(void)
116950a7388SArnaud Pouliquen {
117950a7388SArnaud Pouliquen unregister_rpmsg_driver(&rpmsg_ns_driver);
118950a7388SArnaud Pouliquen }
119950a7388SArnaud Pouliquen module_exit(rpmsg_ns_exit);
120950a7388SArnaud Pouliquen
121950a7388SArnaud Pouliquen MODULE_DESCRIPTION("Name service announcement rpmsg driver");
122950a7388SArnaud Pouliquen MODULE_AUTHOR("Arnaud Pouliquen <arnaud.pouliquen@st.com>");
123950a7388SArnaud Pouliquen MODULE_ALIAS("rpmsg:" KBUILD_MODNAME);
124950a7388SArnaud Pouliquen MODULE_LICENSE("GPL v2");
125