2 * Copyright (c) 2016, Linaro Ltd.
3 * Copyright (c) 2015, Sony Mobile Communications Inc.
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.
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.
15 #include <linux/module.h>
16 #include <linux/slab.h>
17 #include <linux/rpmsg.h>
18 #include <linux/soc/qcom/wcnss_ctrl.h>
19 #include <linux/platform_device.h>
21 #include <net/bluetooth/bluetooth.h>
22 #include <net/bluetooth/hci_core.h>
29 struct rpmsg_endpoint *acl_channel;
30 struct rpmsg_endpoint *cmd_channel;
33 static int btqcomsmd_recv(struct hci_dev *hdev, unsigned int type,
34 const void *data, size_t count)
38 /* Use GFP_ATOMIC as we're in IRQ context */
39 skb = bt_skb_alloc(count, GFP_ATOMIC);
45 hci_skb_pkt_type(skb) = type;
46 memcpy(skb_put(skb, count), data, count);
48 return hci_recv_frame(hdev, skb);
51 static int btqcomsmd_acl_callback(struct rpmsg_device *rpdev, void *data,
52 int count, void *priv, u32 addr)
54 struct btqcomsmd *btq = priv;
56 btq->hdev->stat.byte_rx += count;
57 return btqcomsmd_recv(btq->hdev, HCI_ACLDATA_PKT, data, count);
60 static int btqcomsmd_cmd_callback(struct rpmsg_device *rpdev, void *data,
61 int count, void *priv, u32 addr)
63 struct btqcomsmd *btq = priv;
65 return btqcomsmd_recv(btq->hdev, HCI_EVENT_PKT, data, count);
68 static int btqcomsmd_send(struct hci_dev *hdev, struct sk_buff *skb)
70 struct btqcomsmd *btq = hci_get_drvdata(hdev);
73 switch (hci_skb_pkt_type(skb)) {
75 ret = rpmsg_send(btq->acl_channel, skb->data, skb->len);
77 hdev->stat.byte_tx += skb->len;
80 ret = rpmsg_send(btq->cmd_channel, skb->data, skb->len);
93 static int btqcomsmd_open(struct hci_dev *hdev)
98 static int btqcomsmd_close(struct hci_dev *hdev)
103 static int btqcomsmd_probe(struct platform_device *pdev)
105 struct btqcomsmd *btq;
106 struct hci_dev *hdev;
110 btq = devm_kzalloc(&pdev->dev, sizeof(*btq), GFP_KERNEL);
114 wcnss = dev_get_drvdata(pdev->dev.parent);
116 btq->acl_channel = qcom_wcnss_open_channel(wcnss, "APPS_RIVA_BT_ACL",
117 btqcomsmd_acl_callback, btq);
118 if (IS_ERR(btq->acl_channel))
119 return PTR_ERR(btq->acl_channel);
121 btq->cmd_channel = qcom_wcnss_open_channel(wcnss, "APPS_RIVA_BT_CMD",
122 btqcomsmd_cmd_callback, btq);
123 if (IS_ERR(btq->cmd_channel))
124 return PTR_ERR(btq->cmd_channel);
126 hdev = hci_alloc_dev();
130 hci_set_drvdata(hdev, btq);
132 SET_HCIDEV_DEV(hdev, &pdev->dev);
135 hdev->open = btqcomsmd_open;
136 hdev->close = btqcomsmd_close;
137 hdev->send = btqcomsmd_send;
138 hdev->set_bdaddr = qca_set_bdaddr_rome;
140 ret = hci_register_dev(hdev);
146 platform_set_drvdata(pdev, btq);
151 static int btqcomsmd_remove(struct platform_device *pdev)
153 struct btqcomsmd *btq = platform_get_drvdata(pdev);
155 hci_unregister_dev(btq->hdev);
156 hci_free_dev(btq->hdev);
158 rpmsg_destroy_ept(btq->cmd_channel);
159 rpmsg_destroy_ept(btq->acl_channel);
164 static const struct of_device_id btqcomsmd_of_match[] = {
165 { .compatible = "qcom,wcnss-bt", },
168 MODULE_DEVICE_TABLE(of, btqcomsmd_of_match);
170 static struct platform_driver btqcomsmd_driver = {
171 .probe = btqcomsmd_probe,
172 .remove = btqcomsmd_remove,
175 .of_match_table = btqcomsmd_of_match,
179 module_platform_driver(btqcomsmd_driver);
181 MODULE_AUTHOR("Bjorn Andersson <bjorn.andersson@sonymobile.com>");
182 MODULE_DESCRIPTION("Qualcomm SMD HCI driver");
183 MODULE_LICENSE("GPL v2");