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