Loading...
1/*
2 * Copyright (c) 2015, Sony Mobile Communications Inc.
3 * Copyright (c) 2013, The Linux Foundation. All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 and
7 * only version 2 as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 */
14
15#include <linux/module.h>
16#include <linux/skbuff.h>
17#include <linux/rpmsg.h>
18
19#include "qrtr.h"
20
21struct qrtr_smd_dev {
22 struct qrtr_endpoint ep;
23 struct rpmsg_endpoint *channel;
24 struct device *dev;
25};
26
27/* from smd to qrtr */
28static int qcom_smd_qrtr_callback(struct rpmsg_device *rpdev,
29 void *data, int len, void *priv, u32 addr)
30{
31 struct qrtr_smd_dev *qdev = dev_get_drvdata(&rpdev->dev);
32 int rc;
33
34 if (!qdev)
35 return -EAGAIN;
36
37 rc = qrtr_endpoint_post(&qdev->ep, data, len);
38 if (rc == -EINVAL) {
39 dev_err(qdev->dev, "invalid ipcrouter packet\n");
40 /* return 0 to let smd drop the packet */
41 rc = 0;
42 }
43
44 return rc;
45}
46
47/* from qrtr to smd */
48static int qcom_smd_qrtr_send(struct qrtr_endpoint *ep, struct sk_buff *skb)
49{
50 struct qrtr_smd_dev *qdev = container_of(ep, struct qrtr_smd_dev, ep);
51 int rc;
52
53 rc = skb_linearize(skb);
54 if (rc)
55 goto out;
56
57 rc = rpmsg_send(qdev->channel, skb->data, skb->len);
58
59out:
60 if (rc)
61 kfree_skb(skb);
62 else
63 consume_skb(skb);
64 return rc;
65}
66
67static int qcom_smd_qrtr_probe(struct rpmsg_device *rpdev)
68{
69 struct qrtr_smd_dev *qdev;
70 int rc;
71
72 qdev = devm_kzalloc(&rpdev->dev, sizeof(*qdev), GFP_KERNEL);
73 if (!qdev)
74 return -ENOMEM;
75
76 qdev->channel = rpdev->ept;
77 qdev->dev = &rpdev->dev;
78 qdev->ep.xmit = qcom_smd_qrtr_send;
79
80 rc = qrtr_endpoint_register(&qdev->ep, QRTR_EP_NID_AUTO);
81 if (rc)
82 return rc;
83
84 dev_set_drvdata(&rpdev->dev, qdev);
85
86 dev_dbg(&rpdev->dev, "Qualcomm SMD QRTR driver probed\n");
87
88 return 0;
89}
90
91static void qcom_smd_qrtr_remove(struct rpmsg_device *rpdev)
92{
93 struct qrtr_smd_dev *qdev = dev_get_drvdata(&rpdev->dev);
94
95 qrtr_endpoint_unregister(&qdev->ep);
96
97 dev_set_drvdata(&rpdev->dev, NULL);
98}
99
100static const struct rpmsg_device_id qcom_smd_qrtr_smd_match[] = {
101 { "IPCRTR" },
102 {}
103};
104
105static struct rpmsg_driver qcom_smd_qrtr_driver = {
106 .probe = qcom_smd_qrtr_probe,
107 .remove = qcom_smd_qrtr_remove,
108 .callback = qcom_smd_qrtr_callback,
109 .id_table = qcom_smd_qrtr_smd_match,
110 .drv = {
111 .name = "qcom_smd_qrtr",
112 },
113};
114
115module_rpmsg_driver(qcom_smd_qrtr_driver);
116
117MODULE_ALIAS("rpmsg:IPCRTR");
118MODULE_DESCRIPTION("Qualcomm IPC-Router SMD interface driver");
119MODULE_LICENSE("GPL v2");
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(&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 */
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(qdev->channel, skb->data, 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(&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
83static 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
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");