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
13struct qrtr_smd_dev {
14 struct qrtr_endpoint ep;
15 struct rpmsg_endpoint *channel;
16 struct device *dev;
17};
18
19/* from smd to qrtr */
20static 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(dev: &rpdev->dev);
24 int rc;
25
26 if (!qdev)
27 return -EAGAIN;
28
29 rc = qrtr_endpoint_post(ep: &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 */
40static 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(ept: qdev->channel, data: skb->data, len: skb->len);
50
51out:
52 if (rc)
53 kfree_skb(skb);
54 else
55 consume_skb(skb);
56 return rc;
57}
58
59static int qcom_smd_qrtr_probe(struct rpmsg_device *rpdev)
60{
61 struct qrtr_smd_dev *qdev;
62 int rc;
63
64 qdev = devm_kzalloc(dev: &rpdev->dev, size: 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(ep: &qdev->ep, QRTR_EP_NID_AUTO);
73 if (rc)
74 return rc;
75
76 dev_set_drvdata(dev: &rpdev->dev, data: qdev);
77
78 dev_dbg(&rpdev->dev, "Qualcomm SMD QRTR driver probed\n");
79
80 return 0;
81}
82
83static void qcom_smd_qrtr_remove(struct rpmsg_device *rpdev)
84{
85 struct qrtr_smd_dev *qdev = dev_get_drvdata(dev: &rpdev->dev);
86
87 qrtr_endpoint_unregister(ep: &qdev->ep);
88
89 dev_set_drvdata(dev: &rpdev->dev, NULL);
90}
91
92static const struct rpmsg_device_id qcom_smd_qrtr_smd_match[] = {
93 { "IPCRTR" },
94 {}
95};
96
97static 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
107module_rpmsg_driver(qcom_smd_qrtr_driver);
108
109MODULE_ALIAS("rpmsg:IPCRTR");
110MODULE_DESCRIPTION("Qualcomm IPC-Router SMD interface driver");
111MODULE_LICENSE("GPL v2");
112

source code of linux/net/qrtr/smd.c