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/soc/qcom/smd.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 qcom_smd_channel
*acl_channel
;
30 struct qcom_smd_channel
*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 qcom_smd_channel
*channel
,
52 const void *data
, size_t count
)
54 struct btqcomsmd
*btq
= qcom_smd_get_drvdata(channel
);
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 qcom_smd_channel
*channel
,
61 const void *data
, size_t count
)
63 struct btqcomsmd
*btq
= qcom_smd_get_drvdata(channel
);
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
= qcom_smd_send(btq
->acl_channel
, skb
->data
, skb
->len
);
77 hdev
->stat
.byte_tx
+= skb
->len
;
80 ret
= qcom_smd_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
);
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
);
123 if (IS_ERR(btq
->cmd_channel
))
124 return PTR_ERR(btq
->cmd_channel
);
126 qcom_smd_set_drvdata(btq
->acl_channel
, btq
);
127 qcom_smd_set_drvdata(btq
->cmd_channel
, btq
);
129 hdev
= hci_alloc_dev();
133 hci_set_drvdata(hdev
, btq
);
135 SET_HCIDEV_DEV(hdev
, &pdev
->dev
);
138 hdev
->open
= btqcomsmd_open
;
139 hdev
->close
= btqcomsmd_close
;
140 hdev
->send
= btqcomsmd_send
;
141 hdev
->set_bdaddr
= qca_set_bdaddr_rome
;
143 ret
= hci_register_dev(hdev
);
149 platform_set_drvdata(pdev
, btq
);
154 static int btqcomsmd_remove(struct platform_device
*pdev
)
156 struct btqcomsmd
*btq
= platform_get_drvdata(pdev
);
158 hci_unregister_dev(btq
->hdev
);
159 hci_free_dev(btq
->hdev
);
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");