1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (c) 2015, Sony Mobile Communications Inc.
4 * Copyright (c) 2013, The Linux Foundation. All rights reserved.
5 */
6
7 #include <linux/module.h>
8 #include <linux/skbuff.h>
9 #include <linux/rpmsg.h>
10
11 #include "qrtr.h"
12
13 struct qrtr_smd_dev {
14 struct qrtr_endpoint ep;
15 struct rpmsg_endpoint *channel;
16 struct device *dev;
17 };
18
19 /* from smd to qrtr */
qcom_smd_qrtr_callback(struct rpmsg_device * rpdev,void * data,int len,void * priv,u32 addr)20 static int qcom_smd_qrtr_callback(struct rpmsg_device *rpdev,
21 void *data, int len, void *priv, u32 addr)
22 {
23 struct qrtr_smd_dev *qdev = dev_get_drvdata(&rpdev->dev);
24 int rc;
25
26 if (!qdev)
27 return -EAGAIN;
28
29 rc = qrtr_endpoint_post(&qdev->ep, data, len);
30 if (rc == -EINVAL) {
31 dev_err(qdev->dev, "invalid ipcrouter packet\n");
32 /* return 0 to let smd drop the packet */
33 rc = 0;
34 }
35
36 return rc;
37 }
38
39 /* from qrtr to smd */
qcom_smd_qrtr_send(struct qrtr_endpoint * ep,struct sk_buff * skb)40 static int qcom_smd_qrtr_send(struct qrtr_endpoint *ep, struct sk_buff *skb)
41 {
42 struct qrtr_smd_dev *qdev = container_of(ep, struct qrtr_smd_dev, ep);
43 int rc;
44
45 rc = skb_linearize(skb);
46 if (rc)
47 goto out;
48
49 rc = rpmsg_send(qdev->channel, skb->data, skb->len);
50
51 out:
52 if (rc)
53 kfree_skb(skb);
54 else
55 consume_skb(skb);
56 return rc;
57 }
58
qcom_smd_qrtr_probe(struct rpmsg_device * rpdev)59 static int qcom_smd_qrtr_probe(struct rpmsg_device *rpdev)
60 {
61 struct qrtr_smd_dev *qdev;
62 int rc;
63
64 qdev = devm_kzalloc(&rpdev->dev, sizeof(*qdev), GFP_KERNEL);
65 if (!qdev)
66 return -ENOMEM;
67
68 qdev->channel = rpdev->ept;
69 qdev->dev = &rpdev->dev;
70 qdev->ep.xmit = qcom_smd_qrtr_send;
71
72 rc = qrtr_endpoint_register(&qdev->ep, QRTR_EP_NID_AUTO);
73 if (rc)
74 return rc;
75
76 dev_set_drvdata(&rpdev->dev, qdev);
77
78 dev_dbg(&rpdev->dev, "Qualcomm SMD QRTR driver probed\n");
79
80 return 0;
81 }
82
qcom_smd_qrtr_remove(struct rpmsg_device * rpdev)83 static void qcom_smd_qrtr_remove(struct rpmsg_device *rpdev)
84 {
85 struct qrtr_smd_dev *qdev = dev_get_drvdata(&rpdev->dev);
86
87 qrtr_endpoint_unregister(&qdev->ep);
88
89 dev_set_drvdata(&rpdev->dev, NULL);
90 }
91
92 static const struct rpmsg_device_id qcom_smd_qrtr_smd_match[] = {
93 { "IPCRTR" },
94 {}
95 };
96
97 static struct rpmsg_driver qcom_smd_qrtr_driver = {
98 .probe = qcom_smd_qrtr_probe,
99 .remove = qcom_smd_qrtr_remove,
100 .callback = qcom_smd_qrtr_callback,
101 .id_table = qcom_smd_qrtr_smd_match,
102 .drv = {
103 .name = "qcom_smd_qrtr",
104 },
105 };
106
107 module_rpmsg_driver(qcom_smd_qrtr_driver);
108
109 MODULE_ALIAS("rpmsg:IPCRTR");
110 MODULE_DESCRIPTION("Qualcomm IPC-Router SMD interface driver");
111 MODULE_LICENSE("GPL v2");
112