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");
112