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#include <linux/platform_device.h>
27#include <net/bluetooth/bluetooth.h>
28#include <net/bluetooth/hci_core.h>
29#include <net/bluetooth/hci.h>
30
31#include <linux/ti_wilink_st.h>
32#include <linux/module.h>
33
34
35#define VERSION "1.0"
36#define MAX_BT_CHNL_IDS 3
37
38
39
40
41#define BT_REGISTER_TIMEOUT 6000
42
43
44
45
46
47
48
49
50
51
52struct ti_st {
53 struct hci_dev *hdev;
54 int reg_status;
55 long (*st_write) (struct sk_buff *);
56 struct completion wait_reg_completion;
57};
58
59
60static inline void ti_st_tx_complete(struct ti_st *hst, int pkt_type)
61{
62 struct hci_dev *hdev = hst->hdev;
63
64
65 switch (pkt_type) {
66 case HCI_COMMAND_PKT:
67 hdev->stat.cmd_tx++;
68 break;
69
70 case HCI_ACLDATA_PKT:
71 hdev->stat.acl_tx++;
72 break;
73
74 case HCI_SCODATA_PKT:
75 hdev->stat.sco_tx++;
76 break;
77 }
78}
79
80
81
82
83
84
85
86static void st_reg_completion_cb(void *priv_data, int data)
87{
88 struct ti_st *lhst = priv_data;
89
90
91 lhst->reg_status = data;
92
93 complete(&lhst->wait_reg_completion);
94}
95
96
97
98static long st_receive(void *priv_data, struct sk_buff *skb)
99{
100 struct ti_st *lhst = priv_data;
101 int err;
102
103 if (!skb)
104 return -EFAULT;
105
106 if (!lhst) {
107 kfree_skb(skb);
108 return -EFAULT;
109 }
110
111
112 err = hci_recv_frame(lhst->hdev, skb);
113 if (err < 0) {
114 BT_ERR("Unable to push skb to HCI core(%d)", err);
115 return err;
116 }
117
118 lhst->hdev->stat.byte_rx += skb->len;
119
120 return 0;
121}
122
123
124
125static struct st_proto_s ti_st_proto[MAX_BT_CHNL_IDS] = {
126 {
127 .chnl_id = HCI_EVENT_PKT,
128 .hdr_len = sizeof(struct hci_event_hdr),
129 .offset_len_in_hdr = offsetof(struct hci_event_hdr, plen),
130 .len_size = 1,
131 .reserve = 8,
132 },
133 {
134 .chnl_id = HCI_ACLDATA_PKT,
135 .hdr_len = sizeof(struct hci_acl_hdr),
136 .offset_len_in_hdr = offsetof(struct hci_acl_hdr, dlen),
137 .len_size = 2,
138 .reserve = 8,
139 },
140 {
141 .chnl_id = HCI_SCODATA_PKT,
142 .hdr_len = sizeof(struct hci_sco_hdr),
143 .offset_len_in_hdr = offsetof(struct hci_sco_hdr, dlen),
144 .len_size = 1,
145 .reserve = 8,
146 },
147};
148
149
150static int ti_st_open(struct hci_dev *hdev)
151{
152 unsigned long timeleft;
153 struct ti_st *hst;
154 int err, i;
155
156 BT_DBG("%s %p", hdev->name, hdev);
157
158
159 hst = hci_get_drvdata(hdev);
160
161 for (i = 0; i < MAX_BT_CHNL_IDS; i++) {
162 ti_st_proto[i].priv_data = hst;
163 ti_st_proto[i].max_frame_size = HCI_MAX_FRAME_SIZE;
164 ti_st_proto[i].recv = st_receive;
165 ti_st_proto[i].reg_complete_cb = st_reg_completion_cb;
166
167
168 init_completion(&hst->wait_reg_completion);
169
170
171
172
173
174 hst->reg_status = -EINPROGRESS;
175
176 err = st_register(&ti_st_proto[i]);
177 if (!err)
178 goto done;
179
180 if (err != -EINPROGRESS) {
181 BT_ERR("st_register failed %d", err);
182 return err;
183 }
184
185
186
187
188 BT_DBG("waiting for registration "
189 "completion signal from ST");
190 timeleft = wait_for_completion_timeout
191 (&hst->wait_reg_completion,
192 msecs_to_jiffies(BT_REGISTER_TIMEOUT));
193 if (!timeleft) {
194 BT_ERR("Timeout(%d sec),didn't get reg "
195 "completion signal from ST",
196 BT_REGISTER_TIMEOUT / 1000);
197 return -ETIMEDOUT;
198 }
199
200
201
202 if (hst->reg_status != 0) {
203 BT_ERR("ST registration completed with invalid "
204 "status %d", hst->reg_status);
205 return -EAGAIN;
206 }
207
208done:
209 hst->st_write = ti_st_proto[i].write;
210 if (!hst->st_write) {
211 BT_ERR("undefined ST write function");
212 for (i = 0; i < MAX_BT_CHNL_IDS; i++) {
213
214 err = st_unregister(&ti_st_proto[i]);
215 if (err)
216 BT_ERR("st_unregister() failed with "
217 "error %d", err);
218 hst->st_write = NULL;
219 }
220 return -EIO;
221 }
222 }
223 return 0;
224}
225
226
227static int ti_st_close(struct hci_dev *hdev)
228{
229 int err, i;
230 struct ti_st *hst = hci_get_drvdata(hdev);
231
232 for (i = MAX_BT_CHNL_IDS-1; i >= 0; i--) {
233 err = st_unregister(&ti_st_proto[i]);
234 if (err)
235 BT_ERR("st_unregister(%d) failed with error %d",
236 ti_st_proto[i].chnl_id, err);
237 }
238
239 hst->st_write = NULL;
240
241 return err;
242}
243
244static int ti_st_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
245{
246 struct ti_st *hst;
247 long len;
248 int pkt_type;
249
250 hst = hci_get_drvdata(hdev);
251
252
253 memcpy(skb_push(skb, 1), &hci_skb_pkt_type(skb), 1);
254
255 BT_DBG("%s: type %d len %d", hdev->name, hci_skb_pkt_type(skb),
256 skb->len);
257
258
259
260
261
262 pkt_type = hci_skb_pkt_type(skb);
263 len = hst->st_write(skb);
264 if (len < 0) {
265 kfree_skb(skb);
266 BT_ERR("ST write failed (%ld)", len);
267
268 return -EAGAIN;
269 }
270
271
272 hdev->stat.byte_tx += len;
273 ti_st_tx_complete(hst, pkt_type);
274
275 return 0;
276}
277
278static int bt_ti_probe(struct platform_device *pdev)
279{
280 static struct ti_st *hst;
281 struct hci_dev *hdev;
282 int err;
283
284 hst = devm_kzalloc(&pdev->dev, sizeof(struct ti_st), GFP_KERNEL);
285 if (!hst)
286 return -ENOMEM;
287
288
289 hdev = hci_alloc_dev();
290 if (!hdev)
291 return -ENOMEM;
292
293 BT_DBG("hdev %p", hdev);
294
295 hst->hdev = hdev;
296 hdev->bus = HCI_UART;
297 hci_set_drvdata(hdev, hst);
298 hdev->open = ti_st_open;
299 hdev->close = ti_st_close;
300 hdev->flush = NULL;
301 hdev->send = ti_st_send_frame;
302
303 err = hci_register_dev(hdev);
304 if (err < 0) {
305 BT_ERR("Can't register HCI device error %d", err);
306 hci_free_dev(hdev);
307 return err;
308 }
309
310 BT_DBG("HCI device registered (hdev %p)", hdev);
311
312 dev_set_drvdata(&pdev->dev, hst);
313 return 0;
314}
315
316static int bt_ti_remove(struct platform_device *pdev)
317{
318 struct hci_dev *hdev;
319 struct ti_st *hst = dev_get_drvdata(&pdev->dev);
320
321 if (!hst)
322 return -EFAULT;
323
324 BT_DBG("%s", hst->hdev->name);
325
326 hdev = hst->hdev;
327 ti_st_close(hdev);
328 hci_unregister_dev(hdev);
329
330 hci_free_dev(hdev);
331
332 dev_set_drvdata(&pdev->dev, NULL);
333 return 0;
334}
335
336static struct platform_driver btwilink_driver = {
337 .probe = bt_ti_probe,
338 .remove = bt_ti_remove,
339 .driver = {
340 .name = "btwilink",
341 },
342};
343
344module_platform_driver(btwilink_driver);
345
346
347
348MODULE_AUTHOR("Raja Mani <raja_mani@ti.com>");
349MODULE_DESCRIPTION("Bluetooth Driver for TI Shared Transport" VERSION);
350MODULE_VERSION(VERSION);
351MODULE_LICENSE("GPL");
352