Blame view
net/qrtr/mhi.c
2.79 KB
6e728f321 net: qrtr: Add MH... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 |
// SPDX-License-Identifier: GPL-2.0 /* * Copyright (c) 2018-2020, The Linux Foundation. All rights reserved. */ #include <linux/mhi.h> #include <linux/mod_devicetable.h> #include <linux/module.h> #include <linux/skbuff.h> #include <net/sock.h> #include "qrtr.h" struct qrtr_mhi_dev { struct qrtr_endpoint ep; struct mhi_device *mhi_dev; struct device *dev; }; /* From MHI to QRTR */ static void qcom_mhi_qrtr_dl_callback(struct mhi_device *mhi_dev, struct mhi_result *mhi_res) { struct qrtr_mhi_dev *qdev = dev_get_drvdata(&mhi_dev->dev); int rc; if (!qdev || mhi_res->transaction_status) return; rc = qrtr_endpoint_post(&qdev->ep, mhi_res->buf_addr, mhi_res->bytes_xferd); if (rc == -EINVAL) dev_err(qdev->dev, "invalid ipcrouter packet "); } /* From QRTR to MHI */ static void qcom_mhi_qrtr_ul_callback(struct mhi_device *mhi_dev, struct mhi_result *mhi_res) { struct sk_buff *skb = mhi_res->buf_addr; if (skb->sk) sock_put(skb->sk); consume_skb(skb); } /* Send data over MHI */ static int qcom_mhi_qrtr_send(struct qrtr_endpoint *ep, struct sk_buff *skb) { struct qrtr_mhi_dev *qdev = container_of(ep, struct qrtr_mhi_dev, ep); int rc; rc = skb_linearize(skb); if (rc) goto free_skb; rc = mhi_queue_skb(qdev->mhi_dev, DMA_TO_DEVICE, skb, skb->len, MHI_EOT); if (rc) goto free_skb; if (skb->sk) sock_hold(skb->sk); return rc; free_skb: kfree_skb(skb); return rc; } static int qcom_mhi_qrtr_probe(struct mhi_device *mhi_dev, const struct mhi_device_id *id) { struct qrtr_mhi_dev *qdev; int rc; qdev = devm_kzalloc(&mhi_dev->dev, sizeof(*qdev), GFP_KERNEL); if (!qdev) return -ENOMEM; qdev->mhi_dev = mhi_dev; qdev->dev = &mhi_dev->dev; qdev->ep.xmit = qcom_mhi_qrtr_send; dev_set_drvdata(&mhi_dev->dev, qdev); rc = qrtr_endpoint_register(&qdev->ep, QRTR_EP_NID_AUTO); if (rc) return rc; dev_dbg(qdev->dev, "Qualcomm MHI QRTR driver probed "); return 0; } static void qcom_mhi_qrtr_remove(struct mhi_device *mhi_dev) { struct qrtr_mhi_dev *qdev = dev_get_drvdata(&mhi_dev->dev); qrtr_endpoint_unregister(&qdev->ep); dev_set_drvdata(&mhi_dev->dev, NULL); } static const struct mhi_device_id qcom_mhi_qrtr_id_table[] = { { .chan = "IPCR" }, {} }; MODULE_DEVICE_TABLE(mhi, qcom_mhi_qrtr_id_table); static struct mhi_driver qcom_mhi_qrtr_driver = { .probe = qcom_mhi_qrtr_probe, .remove = qcom_mhi_qrtr_remove, .dl_xfer_cb = qcom_mhi_qrtr_dl_callback, .ul_xfer_cb = qcom_mhi_qrtr_ul_callback, .id_table = qcom_mhi_qrtr_id_table, .driver = { .name = "qcom_mhi_qrtr", }, }; module_mhi_driver(qcom_mhi_qrtr_driver); MODULE_AUTHOR("Chris Lew <clew@codeaurora.org>"); MODULE_AUTHOR("Manivannan Sadhasivam <manivannan.sadhasivam@linaro.org>"); MODULE_DESCRIPTION("Qualcomm IPC-Router MHI interface driver"); MODULE_LICENSE("GPL v2"); |