Commit | Line | Data |
---|---|---|
9aebfd4a SW |
1 | // SPDX-License-Identifier: GPL-2.0 |
2 | // Copyright (c) 2019 MediaTek Inc. | |
3 | ||
4 | /* | |
5 | * Bluetooth support for MediaTek SDIO devices | |
6 | * | |
7 | * This file is written based on btsdio.c and btmtkuart.c. | |
8 | * | |
9 | * Author: Sean Wang <sean.wang@mediatek.com> | |
10 | * | |
11 | */ | |
12 | ||
13 | #include <asm/unaligned.h> | |
14 | #include <linux/atomic.h> | |
15 | #include <linux/firmware.h> | |
16 | #include <linux/init.h> | |
17 | #include <linux/iopoll.h> | |
18 | #include <linux/kernel.h> | |
19 | #include <linux/module.h> | |
7f3c563c | 20 | #include <linux/pm_runtime.h> |
9aebfd4a SW |
21 | #include <linux/skbuff.h> |
22 | ||
23 | #include <linux/mmc/host.h> | |
24 | #include <linux/mmc/sdio_ids.h> | |
25 | #include <linux/mmc/sdio_func.h> | |
26 | ||
27 | #include <net/bluetooth/bluetooth.h> | |
28 | #include <net/bluetooth/hci_core.h> | |
29 | ||
30 | #include "h4_recv.h" | |
31 | ||
32 | #define VERSION "0.1" | |
33 | ||
34 | #define FIRMWARE_MT7663 "mediatek/mt7663pr2h.bin" | |
35 | #define FIRMWARE_MT7668 "mediatek/mt7668pr2h.bin" | |
36 | ||
7f3c563c SW |
37 | #define MTKBTSDIO_AUTOSUSPEND_DELAY 8000 |
38 | ||
39 | static bool enable_autosuspend; | |
40 | ||
9aebfd4a SW |
41 | struct btmtksdio_data { |
42 | const char *fwname; | |
43 | }; | |
44 | ||
45 | static const struct btmtksdio_data mt7663_data = { | |
46 | .fwname = FIRMWARE_MT7663, | |
47 | }; | |
48 | ||
49 | static const struct btmtksdio_data mt7668_data = { | |
50 | .fwname = FIRMWARE_MT7668, | |
51 | }; | |
52 | ||
53 | static const struct sdio_device_id btmtksdio_table[] = { | |
54 | {SDIO_DEVICE(SDIO_VENDOR_ID_MEDIATEK, 0x7663), | |
55 | .driver_data = (kernel_ulong_t)&mt7663_data }, | |
56 | {SDIO_DEVICE(SDIO_VENDOR_ID_MEDIATEK, 0x7668), | |
57 | .driver_data = (kernel_ulong_t)&mt7668_data }, | |
58 | { } /* Terminating entry */ | |
59 | }; | |
60 | ||
61 | #define MTK_REG_CHLPCR 0x4 /* W1S */ | |
62 | #define C_INT_EN_SET BIT(0) | |
63 | #define C_INT_EN_CLR BIT(1) | |
2e47cc2b SW |
64 | #define C_FW_OWN_REQ_SET BIT(8) /* For write */ |
65 | #define C_COM_DRV_OWN BIT(8) /* For read */ | |
9aebfd4a SW |
66 | #define C_FW_OWN_REQ_CLR BIT(9) |
67 | ||
68 | #define MTK_REG_CSDIOCSR 0x8 | |
69 | #define SDIO_RE_INIT_EN BIT(0) | |
70 | #define SDIO_INT_CTL BIT(2) | |
71 | ||
72 | #define MTK_REG_CHCR 0xc | |
73 | #define C_INT_CLR_CTRL BIT(1) | |
74 | ||
75 | /* CHISR have the same bits field definition with CHIER */ | |
76 | #define MTK_REG_CHISR 0x10 | |
77 | #define MTK_REG_CHIER 0x14 | |
78 | #define FW_OWN_BACK_INT BIT(0) | |
79 | #define RX_DONE_INT BIT(1) | |
80 | #define TX_EMPTY BIT(2) | |
81 | #define TX_FIFO_OVERFLOW BIT(8) | |
82 | #define RX_PKT_LEN GENMASK(31, 16) | |
83 | ||
84 | #define MTK_REG_CTDR 0x18 | |
85 | ||
86 | #define MTK_REG_CRDR 0x1c | |
87 | ||
88 | #define MTK_SDIO_BLOCK_SIZE 256 | |
89 | ||
90 | #define BTMTKSDIO_TX_WAIT_VND_EVT 1 | |
91 | ||
92 | enum { | |
93 | MTK_WMT_PATCH_DWNLD = 0x1, | |
94 | MTK_WMT_TEST = 0x2, | |
95 | MTK_WMT_WAKEUP = 0x3, | |
96 | MTK_WMT_HIF = 0x4, | |
97 | MTK_WMT_FUNC_CTRL = 0x6, | |
98 | MTK_WMT_RST = 0x7, | |
99 | MTK_WMT_SEMAPHORE = 0x17, | |
100 | }; | |
101 | ||
102 | enum { | |
103 | BTMTK_WMT_INVALID, | |
104 | BTMTK_WMT_PATCH_UNDONE, | |
105 | BTMTK_WMT_PATCH_DONE, | |
106 | BTMTK_WMT_ON_UNDONE, | |
107 | BTMTK_WMT_ON_DONE, | |
108 | BTMTK_WMT_ON_PROGRESS, | |
109 | }; | |
110 | ||
111 | struct mtkbtsdio_hdr { | |
112 | __le16 len; | |
113 | __le16 reserved; | |
114 | u8 bt_type; | |
115 | } __packed; | |
116 | ||
117 | struct mtk_wmt_hdr { | |
118 | u8 dir; | |
119 | u8 op; | |
120 | __le16 dlen; | |
121 | u8 flag; | |
122 | } __packed; | |
123 | ||
124 | struct mtk_hci_wmt_cmd { | |
125 | struct mtk_wmt_hdr hdr; | |
126 | u8 data[256]; | |
127 | } __packed; | |
128 | ||
129 | struct btmtk_hci_wmt_evt { | |
130 | struct hci_event_hdr hhdr; | |
131 | struct mtk_wmt_hdr whdr; | |
132 | } __packed; | |
133 | ||
134 | struct btmtk_hci_wmt_evt_funcc { | |
135 | struct btmtk_hci_wmt_evt hwhdr; | |
136 | __be16 status; | |
137 | } __packed; | |
138 | ||
139 | struct btmtk_tci_sleep { | |
140 | u8 mode; | |
141 | __le16 duration; | |
142 | __le16 host_duration; | |
143 | u8 host_wakeup_pin; | |
144 | u8 time_compensation; | |
145 | } __packed; | |
146 | ||
147 | struct btmtk_hci_wmt_params { | |
148 | u8 op; | |
149 | u8 flag; | |
150 | u16 dlen; | |
151 | const void *data; | |
152 | u32 *status; | |
153 | }; | |
154 | ||
155 | struct btmtksdio_dev { | |
156 | struct hci_dev *hdev; | |
157 | struct sdio_func *func; | |
7f3c563c | 158 | struct device *dev; |
9aebfd4a SW |
159 | |
160 | struct work_struct tx_work; | |
161 | unsigned long tx_state; | |
162 | struct sk_buff_head txq; | |
163 | ||
164 | struct sk_buff *evt_skb; | |
165 | ||
166 | const struct btmtksdio_data *data; | |
167 | }; | |
168 | ||
169 | static int mtk_hci_wmt_sync(struct hci_dev *hdev, | |
170 | struct btmtk_hci_wmt_params *wmt_params) | |
171 | { | |
172 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
173 | struct btmtk_hci_wmt_evt_funcc *wmt_evt_funcc; | |
174 | u32 hlen, status = BTMTK_WMT_INVALID; | |
175 | struct btmtk_hci_wmt_evt *wmt_evt; | |
176 | struct mtk_hci_wmt_cmd wc; | |
177 | struct mtk_wmt_hdr *hdr; | |
178 | int err; | |
179 | ||
180 | hlen = sizeof(*hdr) + wmt_params->dlen; | |
181 | if (hlen > 255) | |
182 | return -EINVAL; | |
183 | ||
184 | hdr = (struct mtk_wmt_hdr *)&wc; | |
185 | hdr->dir = 1; | |
186 | hdr->op = wmt_params->op; | |
187 | hdr->dlen = cpu_to_le16(wmt_params->dlen + 1); | |
188 | hdr->flag = wmt_params->flag; | |
189 | memcpy(wc.data, wmt_params->data, wmt_params->dlen); | |
190 | ||
191 | set_bit(BTMTKSDIO_TX_WAIT_VND_EVT, &bdev->tx_state); | |
192 | ||
193 | err = __hci_cmd_send(hdev, 0xfc6f, hlen, &wc); | |
194 | if (err < 0) { | |
195 | clear_bit(BTMTKSDIO_TX_WAIT_VND_EVT, &bdev->tx_state); | |
196 | return err; | |
197 | } | |
198 | ||
199 | /* The vendor specific WMT commands are all answered by a vendor | |
200 | * specific event and will not have the Command Status or Command | |
201 | * Complete as with usual HCI command flow control. | |
202 | * | |
203 | * After sending the command, wait for BTMTKSDIO_TX_WAIT_VND_EVT | |
204 | * state to be cleared. The driver specific event receive routine | |
205 | * will clear that state and with that indicate completion of the | |
206 | * WMT command. | |
207 | */ | |
208 | err = wait_on_bit_timeout(&bdev->tx_state, BTMTKSDIO_TX_WAIT_VND_EVT, | |
209 | TASK_INTERRUPTIBLE, HCI_INIT_TIMEOUT); | |
210 | if (err == -EINTR) { | |
211 | bt_dev_err(hdev, "Execution of wmt command interrupted"); | |
212 | clear_bit(BTMTKSDIO_TX_WAIT_VND_EVT, &bdev->tx_state); | |
213 | return err; | |
214 | } | |
215 | ||
216 | if (err) { | |
217 | bt_dev_err(hdev, "Execution of wmt command timed out"); | |
218 | clear_bit(BTMTKSDIO_TX_WAIT_VND_EVT, &bdev->tx_state); | |
219 | return -ETIMEDOUT; | |
220 | } | |
221 | ||
222 | /* Parse and handle the return WMT event */ | |
223 | wmt_evt = (struct btmtk_hci_wmt_evt *)bdev->evt_skb->data; | |
224 | if (wmt_evt->whdr.op != hdr->op) { | |
225 | bt_dev_err(hdev, "Wrong op received %d expected %d", | |
226 | wmt_evt->whdr.op, hdr->op); | |
227 | err = -EIO; | |
228 | goto err_free_skb; | |
229 | } | |
230 | ||
231 | switch (wmt_evt->whdr.op) { | |
232 | case MTK_WMT_SEMAPHORE: | |
233 | if (wmt_evt->whdr.flag == 2) | |
234 | status = BTMTK_WMT_PATCH_UNDONE; | |
235 | else | |
236 | status = BTMTK_WMT_PATCH_DONE; | |
237 | break; | |
238 | case MTK_WMT_FUNC_CTRL: | |
239 | wmt_evt_funcc = (struct btmtk_hci_wmt_evt_funcc *)wmt_evt; | |
240 | if (be16_to_cpu(wmt_evt_funcc->status) == 0x404) | |
241 | status = BTMTK_WMT_ON_DONE; | |
242 | else if (be16_to_cpu(wmt_evt_funcc->status) == 0x420) | |
243 | status = BTMTK_WMT_ON_PROGRESS; | |
244 | else | |
245 | status = BTMTK_WMT_ON_UNDONE; | |
246 | break; | |
247 | } | |
248 | ||
249 | if (wmt_params->status) | |
250 | *wmt_params->status = status; | |
251 | ||
252 | err_free_skb: | |
253 | kfree_skb(bdev->evt_skb); | |
254 | bdev->evt_skb = NULL; | |
255 | ||
256 | return err; | |
257 | } | |
258 | ||
259 | static int btmtksdio_tx_packet(struct btmtksdio_dev *bdev, | |
260 | struct sk_buff *skb) | |
261 | { | |
262 | struct mtkbtsdio_hdr *sdio_hdr; | |
263 | int err; | |
264 | ||
265 | /* Make sure that there are enough rooms for SDIO header */ | |
266 | if (unlikely(skb_headroom(skb) < sizeof(*sdio_hdr))) { | |
267 | err = pskb_expand_head(skb, sizeof(*sdio_hdr), 0, | |
268 | GFP_ATOMIC); | |
269 | if (err < 0) | |
270 | return err; | |
271 | } | |
272 | ||
273 | /* Prepend MediaTek SDIO Specific Header */ | |
274 | skb_push(skb, sizeof(*sdio_hdr)); | |
275 | ||
276 | sdio_hdr = (void *)skb->data; | |
277 | sdio_hdr->len = cpu_to_le16(skb->len); | |
278 | sdio_hdr->reserved = cpu_to_le16(0); | |
279 | sdio_hdr->bt_type = hci_skb_pkt_type(skb); | |
280 | ||
281 | err = sdio_writesb(bdev->func, MTK_REG_CTDR, skb->data, | |
282 | round_up(skb->len, MTK_SDIO_BLOCK_SIZE)); | |
283 | if (err < 0) | |
284 | goto err_skb_pull; | |
285 | ||
286 | bdev->hdev->stat.byte_tx += skb->len; | |
287 | ||
288 | kfree_skb(skb); | |
289 | ||
290 | return 0; | |
291 | ||
292 | err_skb_pull: | |
293 | skb_pull(skb, sizeof(*sdio_hdr)); | |
294 | ||
295 | return err; | |
296 | } | |
297 | ||
298 | static u32 btmtksdio_drv_own_query(struct btmtksdio_dev *bdev) | |
299 | { | |
300 | return sdio_readl(bdev->func, MTK_REG_CHLPCR, NULL); | |
301 | } | |
302 | ||
303 | static void btmtksdio_tx_work(struct work_struct *work) | |
304 | { | |
305 | struct btmtksdio_dev *bdev = container_of(work, struct btmtksdio_dev, | |
306 | tx_work); | |
307 | struct sk_buff *skb; | |
308 | int err; | |
309 | ||
7f3c563c SW |
310 | pm_runtime_get_sync(bdev->dev); |
311 | ||
9aebfd4a SW |
312 | sdio_claim_host(bdev->func); |
313 | ||
314 | while ((skb = skb_dequeue(&bdev->txq))) { | |
315 | err = btmtksdio_tx_packet(bdev, skb); | |
316 | if (err < 0) { | |
317 | bdev->hdev->stat.err_tx++; | |
318 | skb_queue_head(&bdev->txq, skb); | |
319 | break; | |
320 | } | |
321 | } | |
322 | ||
323 | sdio_release_host(bdev->func); | |
7f3c563c SW |
324 | |
325 | pm_runtime_mark_last_busy(bdev->dev); | |
326 | pm_runtime_put_autosuspend(bdev->dev); | |
9aebfd4a SW |
327 | } |
328 | ||
329 | static int btmtksdio_recv_event(struct hci_dev *hdev, struct sk_buff *skb) | |
330 | { | |
331 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
332 | struct hci_event_hdr *hdr = (void *)skb->data; | |
333 | int err; | |
334 | ||
335 | /* Fix up the vendor event id with 0xff for vendor specific instead | |
336 | * of 0xe4 so that event send via monitoring socket can be parsed | |
337 | * properly. | |
338 | */ | |
339 | if (hdr->evt == 0xe4) | |
340 | hdr->evt = HCI_EV_VENDOR; | |
341 | ||
342 | /* When someone waits for the WMT event, the skb is being cloned | |
343 | * and being processed the events from there then. | |
344 | */ | |
345 | if (test_bit(BTMTKSDIO_TX_WAIT_VND_EVT, &bdev->tx_state)) { | |
346 | bdev->evt_skb = skb_clone(skb, GFP_KERNEL); | |
347 | if (!bdev->evt_skb) { | |
348 | err = -ENOMEM; | |
349 | goto err_out; | |
350 | } | |
351 | } | |
352 | ||
353 | err = hci_recv_frame(hdev, skb); | |
354 | if (err < 0) | |
355 | goto err_free_skb; | |
356 | ||
357 | if (hdr->evt == HCI_EV_VENDOR) { | |
358 | if (test_and_clear_bit(BTMTKSDIO_TX_WAIT_VND_EVT, | |
359 | &bdev->tx_state)) { | |
360 | /* Barrier to sync with other CPUs */ | |
361 | smp_mb__after_atomic(); | |
362 | wake_up_bit(&bdev->tx_state, BTMTKSDIO_TX_WAIT_VND_EVT); | |
363 | } | |
364 | } | |
365 | ||
366 | return 0; | |
367 | ||
368 | err_free_skb: | |
369 | kfree_skb(bdev->evt_skb); | |
370 | bdev->evt_skb = NULL; | |
371 | ||
372 | err_out: | |
373 | return err; | |
374 | } | |
375 | ||
376 | static const struct h4_recv_pkt mtk_recv_pkts[] = { | |
377 | { H4_RECV_ACL, .recv = hci_recv_frame }, | |
378 | { H4_RECV_SCO, .recv = hci_recv_frame }, | |
379 | { H4_RECV_EVENT, .recv = btmtksdio_recv_event }, | |
380 | }; | |
381 | ||
382 | static int btmtksdio_rx_packet(struct btmtksdio_dev *bdev, u16 rx_size) | |
383 | { | |
384 | const struct h4_recv_pkt *pkts = mtk_recv_pkts; | |
385 | int pkts_count = ARRAY_SIZE(mtk_recv_pkts); | |
386 | struct mtkbtsdio_hdr *sdio_hdr; | |
9aebfd4a SW |
387 | int err, i, pad_size; |
388 | struct sk_buff *skb; | |
389 | u16 dlen; | |
390 | ||
391 | if (rx_size < sizeof(*sdio_hdr)) | |
392 | return -EILSEQ; | |
393 | ||
394 | /* A SDIO packet is exactly containing a Bluetooth packet */ | |
395 | skb = bt_skb_alloc(rx_size, GFP_KERNEL); | |
396 | if (!skb) | |
397 | return -ENOMEM; | |
398 | ||
399 | skb_put(skb, rx_size); | |
400 | ||
401 | err = sdio_readsb(bdev->func, skb->data, MTK_REG_CRDR, rx_size); | |
402 | if (err < 0) | |
403 | goto err_kfree_skb; | |
404 | ||
9aebfd4a SW |
405 | sdio_hdr = (void *)skb->data; |
406 | ||
407 | /* We assume the default error as -EILSEQ simply to make the error path | |
408 | * be cleaner. | |
409 | */ | |
410 | err = -EILSEQ; | |
411 | ||
412 | if (rx_size != le16_to_cpu(sdio_hdr->len)) { | |
413 | bt_dev_err(bdev->hdev, "Rx size in sdio header is mismatched "); | |
414 | goto err_kfree_skb; | |
415 | } | |
416 | ||
417 | hci_skb_pkt_type(skb) = sdio_hdr->bt_type; | |
418 | ||
419 | /* Remove MediaTek SDIO header */ | |
420 | skb_pull(skb, sizeof(*sdio_hdr)); | |
421 | ||
422 | /* We have to dig into the packet to get payload size and then know how | |
423 | * many padding bytes at the tail, these padding bytes should be removed | |
424 | * before the packet is indicated to the core layer. | |
425 | */ | |
426 | for (i = 0; i < pkts_count; i++) { | |
427 | if (sdio_hdr->bt_type == (&pkts[i])->type) | |
428 | break; | |
429 | } | |
430 | ||
431 | if (i >= pkts_count) { | |
432 | bt_dev_err(bdev->hdev, "Invalid bt type 0x%02x", | |
433 | sdio_hdr->bt_type); | |
434 | goto err_kfree_skb; | |
435 | } | |
436 | ||
437 | /* Remaining bytes cannot hold a header*/ | |
438 | if (skb->len < (&pkts[i])->hlen) { | |
439 | bt_dev_err(bdev->hdev, "The size of bt header is mismatched"); | |
440 | goto err_kfree_skb; | |
441 | } | |
442 | ||
443 | switch ((&pkts[i])->lsize) { | |
444 | case 1: | |
445 | dlen = skb->data[(&pkts[i])->loff]; | |
446 | break; | |
447 | case 2: | |
448 | dlen = get_unaligned_le16(skb->data + | |
449 | (&pkts[i])->loff); | |
450 | break; | |
451 | default: | |
452 | goto err_kfree_skb; | |
453 | } | |
454 | ||
455 | pad_size = skb->len - (&pkts[i])->hlen - dlen; | |
456 | ||
457 | /* Remaining bytes cannot hold a payload */ | |
458 | if (pad_size < 0) { | |
459 | bt_dev_err(bdev->hdev, "The size of bt payload is mismatched"); | |
460 | goto err_kfree_skb; | |
461 | } | |
462 | ||
463 | /* Remove padding bytes */ | |
464 | skb_trim(skb, skb->len - pad_size); | |
465 | ||
466 | /* Complete frame */ | |
467 | (&pkts[i])->recv(bdev->hdev, skb); | |
468 | ||
bcaa7d72 SW |
469 | bdev->hdev->stat.byte_rx += rx_size; |
470 | ||
9aebfd4a SW |
471 | return 0; |
472 | ||
473 | err_kfree_skb: | |
9aebfd4a SW |
474 | kfree_skb(skb); |
475 | ||
476 | return err; | |
477 | } | |
478 | ||
479 | static void btmtksdio_interrupt(struct sdio_func *func) | |
480 | { | |
481 | struct btmtksdio_dev *bdev = sdio_get_drvdata(func); | |
482 | u32 int_status; | |
483 | u16 rx_size; | |
484 | ||
7f3c563c SW |
485 | /* It is required that the host gets ownership from the device before |
486 | * accessing any register, however, if SDIO host is not being released, | |
487 | * a potential deadlock probably happens in a circular wait between SDIO | |
488 | * IRQ work and PM runtime work. So, we have to explicitly release SDIO | |
489 | * host here and claim again after the PM runtime work is all done. | |
490 | */ | |
491 | sdio_release_host(bdev->func); | |
492 | ||
493 | pm_runtime_get_sync(bdev->dev); | |
494 | ||
495 | sdio_claim_host(bdev->func); | |
496 | ||
9aebfd4a SW |
497 | /* Disable interrupt */ |
498 | sdio_writel(func, C_INT_EN_CLR, MTK_REG_CHLPCR, 0); | |
499 | ||
500 | int_status = sdio_readl(func, MTK_REG_CHISR, NULL); | |
501 | ||
502 | /* Ack an interrupt as soon as possible before any operation on | |
503 | * hardware. | |
504 | * | |
505 | * Note that we don't ack any status during operations to avoid race | |
506 | * condition between the host and the device such as it's possible to | |
507 | * mistakenly ack RX_DONE for the next packet and then cause interrupts | |
508 | * not be raised again but there is still pending data in the hardware | |
509 | * FIFO. | |
510 | */ | |
511 | sdio_writel(func, int_status, MTK_REG_CHISR, NULL); | |
512 | ||
513 | if (unlikely(!int_status)) | |
e1052fb2 | 514 | bt_dev_err(bdev->hdev, "CHISR is 0"); |
9aebfd4a SW |
515 | |
516 | if (int_status & FW_OWN_BACK_INT) | |
e1052fb2 | 517 | bt_dev_dbg(bdev->hdev, "Get fw own back"); |
9aebfd4a SW |
518 | |
519 | if (int_status & TX_EMPTY) | |
520 | schedule_work(&bdev->tx_work); | |
521 | else if (unlikely(int_status & TX_FIFO_OVERFLOW)) | |
e1052fb2 | 522 | bt_dev_warn(bdev->hdev, "Tx fifo overflow"); |
9aebfd4a SW |
523 | |
524 | if (int_status & RX_DONE_INT) { | |
525 | rx_size = (int_status & RX_PKT_LEN) >> 16; | |
526 | ||
527 | if (btmtksdio_rx_packet(bdev, rx_size) < 0) | |
528 | bdev->hdev->stat.err_rx++; | |
529 | } | |
530 | ||
531 | /* Enable interrupt */ | |
532 | sdio_writel(func, C_INT_EN_SET, MTK_REG_CHLPCR, 0); | |
7f3c563c SW |
533 | |
534 | pm_runtime_mark_last_busy(bdev->dev); | |
535 | pm_runtime_put_autosuspend(bdev->dev); | |
9aebfd4a SW |
536 | } |
537 | ||
538 | static int btmtksdio_open(struct hci_dev *hdev) | |
539 | { | |
540 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
541 | int err; | |
542 | u32 status; | |
543 | ||
544 | sdio_claim_host(bdev->func); | |
545 | ||
546 | err = sdio_enable_func(bdev->func); | |
547 | if (err < 0) | |
548 | goto err_release_host; | |
549 | ||
550 | /* Get ownership from the device */ | |
551 | sdio_writel(bdev->func, C_FW_OWN_REQ_CLR, MTK_REG_CHLPCR, &err); | |
552 | if (err < 0) | |
553 | goto err_disable_func; | |
554 | ||
555 | err = readx_poll_timeout(btmtksdio_drv_own_query, bdev, status, | |
2e47cc2b | 556 | status & C_COM_DRV_OWN, 2000, 1000000); |
9aebfd4a SW |
557 | if (err < 0) { |
558 | bt_dev_err(bdev->hdev, "Cannot get ownership from device"); | |
559 | goto err_disable_func; | |
560 | } | |
561 | ||
562 | /* Disable interrupt & mask out all interrupt sources */ | |
563 | sdio_writel(bdev->func, C_INT_EN_CLR, MTK_REG_CHLPCR, &err); | |
564 | if (err < 0) | |
565 | goto err_disable_func; | |
566 | ||
567 | sdio_writel(bdev->func, 0, MTK_REG_CHIER, &err); | |
568 | if (err < 0) | |
569 | goto err_disable_func; | |
570 | ||
571 | err = sdio_claim_irq(bdev->func, btmtksdio_interrupt); | |
572 | if (err < 0) | |
573 | goto err_disable_func; | |
574 | ||
575 | err = sdio_set_block_size(bdev->func, MTK_SDIO_BLOCK_SIZE); | |
576 | if (err < 0) | |
577 | goto err_release_irq; | |
578 | ||
579 | /* SDIO CMD 5 allows the SDIO device back to idle state an | |
580 | * synchronous interrupt is supported in SDIO 4-bit mode | |
581 | */ | |
582 | sdio_writel(bdev->func, SDIO_INT_CTL | SDIO_RE_INIT_EN, | |
583 | MTK_REG_CSDIOCSR, &err); | |
584 | if (err < 0) | |
585 | goto err_release_irq; | |
586 | ||
587 | /* Setup write-1-clear for CHISR register */ | |
588 | sdio_writel(bdev->func, C_INT_CLR_CTRL, MTK_REG_CHCR, &err); | |
589 | if (err < 0) | |
590 | goto err_release_irq; | |
591 | ||
592 | /* Setup interrupt sources */ | |
593 | sdio_writel(bdev->func, RX_DONE_INT | TX_EMPTY | TX_FIFO_OVERFLOW, | |
594 | MTK_REG_CHIER, &err); | |
595 | if (err < 0) | |
596 | goto err_release_irq; | |
597 | ||
598 | /* Enable interrupt */ | |
599 | sdio_writel(bdev->func, C_INT_EN_SET, MTK_REG_CHLPCR, &err); | |
600 | if (err < 0) | |
601 | goto err_release_irq; | |
602 | ||
603 | sdio_release_host(bdev->func); | |
604 | ||
605 | return 0; | |
606 | ||
607 | err_release_irq: | |
608 | sdio_release_irq(bdev->func); | |
609 | ||
610 | err_disable_func: | |
611 | sdio_disable_func(bdev->func); | |
612 | ||
613 | err_release_host: | |
614 | sdio_release_host(bdev->func); | |
615 | ||
616 | return err; | |
617 | } | |
618 | ||
619 | static int btmtksdio_close(struct hci_dev *hdev) | |
620 | { | |
621 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
622 | u32 status; | |
623 | int err; | |
624 | ||
625 | sdio_claim_host(bdev->func); | |
626 | ||
627 | /* Disable interrupt */ | |
628 | sdio_writel(bdev->func, C_INT_EN_CLR, MTK_REG_CHLPCR, NULL); | |
629 | ||
630 | sdio_release_irq(bdev->func); | |
631 | ||
632 | /* Return ownership to the device */ | |
633 | sdio_writel(bdev->func, C_FW_OWN_REQ_SET, MTK_REG_CHLPCR, NULL); | |
634 | ||
635 | err = readx_poll_timeout(btmtksdio_drv_own_query, bdev, status, | |
2e47cc2b | 636 | !(status & C_COM_DRV_OWN), 2000, 1000000); |
9aebfd4a SW |
637 | if (err < 0) |
638 | bt_dev_err(bdev->hdev, "Cannot return ownership to device"); | |
639 | ||
640 | sdio_disable_func(bdev->func); | |
641 | ||
642 | sdio_release_host(bdev->func); | |
643 | ||
644 | return 0; | |
645 | } | |
646 | ||
647 | static int btmtksdio_flush(struct hci_dev *hdev) | |
648 | { | |
649 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
650 | ||
651 | skb_queue_purge(&bdev->txq); | |
652 | ||
653 | cancel_work_sync(&bdev->tx_work); | |
654 | ||
655 | return 0; | |
656 | } | |
657 | ||
658 | static int btmtksdio_func_query(struct hci_dev *hdev) | |
659 | { | |
660 | struct btmtk_hci_wmt_params wmt_params; | |
661 | int status, err; | |
662 | u8 param = 0; | |
663 | ||
664 | /* Query whether the function is enabled */ | |
665 | wmt_params.op = MTK_WMT_FUNC_CTRL; | |
666 | wmt_params.flag = 4; | |
667 | wmt_params.dlen = sizeof(param); | |
668 | wmt_params.data = ¶m; | |
669 | wmt_params.status = &status; | |
670 | ||
671 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
672 | if (err < 0) { | |
673 | bt_dev_err(hdev, "Failed to query function status (%d)", err); | |
674 | return err; | |
675 | } | |
676 | ||
677 | return status; | |
678 | } | |
679 | ||
680 | static int mtk_setup_firmware(struct hci_dev *hdev, const char *fwname) | |
681 | { | |
682 | struct btmtk_hci_wmt_params wmt_params; | |
683 | const struct firmware *fw; | |
684 | const u8 *fw_ptr; | |
685 | size_t fw_size; | |
686 | int err, dlen; | |
687 | u8 flag; | |
688 | ||
689 | err = request_firmware(&fw, fwname, &hdev->dev); | |
690 | if (err < 0) { | |
691 | bt_dev_err(hdev, "Failed to load firmware file (%d)", err); | |
692 | return err; | |
693 | } | |
694 | ||
695 | fw_ptr = fw->data; | |
696 | fw_size = fw->size; | |
697 | ||
698 | /* The size of patch header is 30 bytes, should be skip */ | |
699 | if (fw_size < 30) { | |
700 | err = -EINVAL; | |
701 | goto free_fw; | |
702 | } | |
703 | ||
704 | fw_size -= 30; | |
705 | fw_ptr += 30; | |
706 | flag = 1; | |
707 | ||
708 | wmt_params.op = MTK_WMT_PATCH_DWNLD; | |
709 | wmt_params.status = NULL; | |
710 | ||
711 | while (fw_size > 0) { | |
712 | dlen = min_t(int, 250, fw_size); | |
713 | ||
714 | /* Tell device the position in sequence */ | |
715 | if (fw_size - dlen <= 0) | |
716 | flag = 3; | |
717 | else if (fw_size < fw->size - 30) | |
718 | flag = 2; | |
719 | ||
720 | wmt_params.flag = flag; | |
721 | wmt_params.dlen = dlen; | |
722 | wmt_params.data = fw_ptr; | |
723 | ||
724 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
725 | if (err < 0) { | |
726 | bt_dev_err(hdev, "Failed to send wmt patch dwnld (%d)", | |
727 | err); | |
728 | goto free_fw; | |
729 | } | |
730 | ||
731 | fw_size -= dlen; | |
732 | fw_ptr += dlen; | |
733 | } | |
734 | ||
735 | wmt_params.op = MTK_WMT_RST; | |
736 | wmt_params.flag = 4; | |
737 | wmt_params.dlen = 0; | |
738 | wmt_params.data = NULL; | |
739 | wmt_params.status = NULL; | |
740 | ||
741 | /* Activate funciton the firmware providing to */ | |
742 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
743 | if (err < 0) { | |
744 | bt_dev_err(hdev, "Failed to send wmt rst (%d)", err); | |
745 | goto free_fw; | |
746 | } | |
747 | ||
748 | /* Wait a few moments for firmware activation done */ | |
749 | usleep_range(10000, 12000); | |
750 | ||
751 | free_fw: | |
752 | release_firmware(fw); | |
753 | return err; | |
754 | } | |
755 | ||
756 | static int btmtksdio_setup(struct hci_dev *hdev) | |
757 | { | |
758 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
759 | struct btmtk_hci_wmt_params wmt_params; | |
760 | ktime_t calltime, delta, rettime; | |
761 | struct btmtk_tci_sleep tci_sleep; | |
762 | unsigned long long duration; | |
763 | struct sk_buff *skb; | |
764 | int err, status; | |
765 | u8 param = 0x1; | |
766 | ||
767 | calltime = ktime_get(); | |
768 | ||
769 | /* Query whether the firmware is already download */ | |
770 | wmt_params.op = MTK_WMT_SEMAPHORE; | |
771 | wmt_params.flag = 1; | |
772 | wmt_params.dlen = 0; | |
773 | wmt_params.data = NULL; | |
774 | wmt_params.status = &status; | |
775 | ||
776 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
777 | if (err < 0) { | |
778 | bt_dev_err(hdev, "Failed to query firmware status (%d)", err); | |
779 | return err; | |
780 | } | |
781 | ||
782 | if (status == BTMTK_WMT_PATCH_DONE) { | |
783 | bt_dev_info(hdev, "Firmware already downloaded"); | |
784 | goto ignore_setup_fw; | |
785 | } | |
786 | ||
787 | /* Setup a firmware which the device definitely requires */ | |
788 | err = mtk_setup_firmware(hdev, bdev->data->fwname); | |
789 | if (err < 0) | |
790 | return err; | |
791 | ||
792 | ignore_setup_fw: | |
793 | /* Query whether the device is already enabled */ | |
794 | err = readx_poll_timeout(btmtksdio_func_query, hdev, status, | |
795 | status < 0 || status != BTMTK_WMT_ON_PROGRESS, | |
796 | 2000, 5000000); | |
797 | /* -ETIMEDOUT happens */ | |
798 | if (err < 0) | |
799 | return err; | |
800 | ||
801 | /* The other errors happen in btusb_mtk_func_query */ | |
802 | if (status < 0) | |
803 | return status; | |
804 | ||
805 | if (status == BTMTK_WMT_ON_DONE) { | |
806 | bt_dev_info(hdev, "function already on"); | |
807 | goto ignore_func_on; | |
808 | } | |
809 | ||
810 | /* Enable Bluetooth protocol */ | |
811 | wmt_params.op = MTK_WMT_FUNC_CTRL; | |
812 | wmt_params.flag = 0; | |
813 | wmt_params.dlen = sizeof(param); | |
814 | wmt_params.data = ¶m; | |
815 | wmt_params.status = NULL; | |
816 | ||
817 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
818 | if (err < 0) { | |
819 | bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err); | |
820 | return err; | |
821 | } | |
822 | ||
823 | ignore_func_on: | |
824 | /* Apply the low power environment setup */ | |
825 | tci_sleep.mode = 0x5; | |
826 | tci_sleep.duration = cpu_to_le16(0x640); | |
827 | tci_sleep.host_duration = cpu_to_le16(0x640); | |
828 | tci_sleep.host_wakeup_pin = 0; | |
829 | tci_sleep.time_compensation = 0; | |
830 | ||
831 | skb = __hci_cmd_sync(hdev, 0xfc7a, sizeof(tci_sleep), &tci_sleep, | |
832 | HCI_INIT_TIMEOUT); | |
833 | if (IS_ERR(skb)) { | |
834 | err = PTR_ERR(skb); | |
835 | bt_dev_err(hdev, "Failed to apply low power setting (%d)", err); | |
836 | return err; | |
837 | } | |
838 | kfree_skb(skb); | |
839 | ||
840 | rettime = ktime_get(); | |
841 | delta = ktime_sub(rettime, calltime); | |
842 | duration = (unsigned long long)ktime_to_ns(delta) >> 10; | |
843 | ||
7f3c563c SW |
844 | pm_runtime_set_autosuspend_delay(bdev->dev, |
845 | MTKBTSDIO_AUTOSUSPEND_DELAY); | |
846 | pm_runtime_use_autosuspend(bdev->dev); | |
847 | ||
848 | err = pm_runtime_set_active(bdev->dev); | |
849 | if (err < 0) | |
850 | return err; | |
851 | ||
852 | /* Default forbid runtime auto suspend, that can be allowed by | |
853 | * enable_autosuspend flag or the PM runtime entry under sysfs. | |
854 | */ | |
855 | pm_runtime_forbid(bdev->dev); | |
856 | pm_runtime_enable(bdev->dev); | |
857 | ||
858 | if (enable_autosuspend) | |
859 | pm_runtime_allow(bdev->dev); | |
860 | ||
9aebfd4a SW |
861 | bt_dev_info(hdev, "Device setup in %llu usecs", duration); |
862 | ||
863 | return 0; | |
864 | } | |
865 | ||
866 | static int btmtksdio_shutdown(struct hci_dev *hdev) | |
867 | { | |
7f3c563c | 868 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); |
9aebfd4a SW |
869 | struct btmtk_hci_wmt_params wmt_params; |
870 | u8 param = 0x0; | |
871 | int err; | |
872 | ||
7f3c563c SW |
873 | /* Get back the state to be consistent with the state |
874 | * in btmtksdio_setup. | |
875 | */ | |
876 | pm_runtime_get_sync(bdev->dev); | |
877 | ||
9aebfd4a SW |
878 | /* Disable the device */ |
879 | wmt_params.op = MTK_WMT_FUNC_CTRL; | |
880 | wmt_params.flag = 0; | |
881 | wmt_params.dlen = sizeof(param); | |
882 | wmt_params.data = ¶m; | |
883 | wmt_params.status = NULL; | |
884 | ||
885 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
886 | if (err < 0) { | |
887 | bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err); | |
888 | return err; | |
889 | } | |
890 | ||
7f3c563c SW |
891 | pm_runtime_put_noidle(bdev->dev); |
892 | pm_runtime_disable(bdev->dev); | |
893 | ||
9aebfd4a SW |
894 | return 0; |
895 | } | |
896 | ||
897 | static int btmtksdio_send_frame(struct hci_dev *hdev, struct sk_buff *skb) | |
898 | { | |
899 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
900 | ||
901 | switch (hci_skb_pkt_type(skb)) { | |
902 | case HCI_COMMAND_PKT: | |
903 | hdev->stat.cmd_tx++; | |
904 | break; | |
905 | ||
906 | case HCI_ACLDATA_PKT: | |
907 | hdev->stat.acl_tx++; | |
908 | break; | |
909 | ||
910 | case HCI_SCODATA_PKT: | |
911 | hdev->stat.sco_tx++; | |
912 | break; | |
913 | ||
914 | default: | |
915 | return -EILSEQ; | |
916 | } | |
917 | ||
918 | skb_queue_tail(&bdev->txq, skb); | |
919 | ||
920 | schedule_work(&bdev->tx_work); | |
921 | ||
922 | return 0; | |
923 | } | |
924 | ||
925 | static int btmtksdio_probe(struct sdio_func *func, | |
926 | const struct sdio_device_id *id) | |
927 | { | |
928 | struct btmtksdio_dev *bdev; | |
929 | struct hci_dev *hdev; | |
930 | int err; | |
931 | ||
932 | bdev = devm_kzalloc(&func->dev, sizeof(*bdev), GFP_KERNEL); | |
933 | if (!bdev) | |
934 | return -ENOMEM; | |
935 | ||
936 | bdev->data = (void *)id->driver_data; | |
937 | if (!bdev->data) | |
938 | return -ENODEV; | |
939 | ||
7f3c563c | 940 | bdev->dev = &func->dev; |
9aebfd4a SW |
941 | bdev->func = func; |
942 | ||
943 | INIT_WORK(&bdev->tx_work, btmtksdio_tx_work); | |
944 | skb_queue_head_init(&bdev->txq); | |
945 | ||
946 | /* Initialize and register HCI device */ | |
947 | hdev = hci_alloc_dev(); | |
948 | if (!hdev) { | |
949 | dev_err(&func->dev, "Can't allocate HCI device\n"); | |
950 | return -ENOMEM; | |
951 | } | |
952 | ||
953 | bdev->hdev = hdev; | |
954 | ||
955 | hdev->bus = HCI_SDIO; | |
956 | hci_set_drvdata(hdev, bdev); | |
957 | ||
958 | hdev->open = btmtksdio_open; | |
959 | hdev->close = btmtksdio_close; | |
960 | hdev->flush = btmtksdio_flush; | |
961 | hdev->setup = btmtksdio_setup; | |
962 | hdev->shutdown = btmtksdio_shutdown; | |
963 | hdev->send = btmtksdio_send_frame; | |
964 | SET_HCIDEV_DEV(hdev, &func->dev); | |
965 | ||
966 | hdev->manufacturer = 70; | |
967 | set_bit(HCI_QUIRK_NON_PERSISTENT_SETUP, &hdev->quirks); | |
968 | ||
969 | err = hci_register_dev(hdev); | |
970 | if (err < 0) { | |
971 | dev_err(&func->dev, "Can't register HCI device\n"); | |
972 | hci_free_dev(hdev); | |
973 | return err; | |
974 | } | |
975 | ||
976 | sdio_set_drvdata(func, bdev); | |
977 | ||
7f3c563c SW |
978 | /* pm_runtime_enable would be done after the firmware is being |
979 | * downloaded because the core layer probably already enables | |
980 | * runtime PM for this func such as the case host->caps & | |
981 | * MMC_CAP_POWER_OFF_CARD. | |
982 | */ | |
983 | if (pm_runtime_enabled(bdev->dev)) | |
984 | pm_runtime_disable(bdev->dev); | |
985 | ||
986 | /* As explaination in drivers/mmc/core/sdio_bus.c tells us: | |
987 | * Unbound SDIO functions are always suspended. | |
988 | * During probe, the function is set active and the usage count | |
989 | * is incremented. If the driver supports runtime PM, | |
990 | * it should call pm_runtime_put_noidle() in its probe routine and | |
991 | * pm_runtime_get_noresume() in its remove routine. | |
992 | * | |
993 | * So, put a pm_runtime_put_noidle here ! | |
994 | */ | |
995 | pm_runtime_put_noidle(bdev->dev); | |
996 | ||
9aebfd4a SW |
997 | return 0; |
998 | } | |
999 | ||
1000 | static void btmtksdio_remove(struct sdio_func *func) | |
1001 | { | |
1002 | struct btmtksdio_dev *bdev = sdio_get_drvdata(func); | |
1003 | struct hci_dev *hdev; | |
1004 | ||
1005 | if (!bdev) | |
1006 | return; | |
1007 | ||
7f3c563c SW |
1008 | /* Be consistent the state in btmtksdio_probe */ |
1009 | pm_runtime_get_noresume(bdev->dev); | |
1010 | ||
9aebfd4a SW |
1011 | hdev = bdev->hdev; |
1012 | ||
1013 | sdio_set_drvdata(func, NULL); | |
1014 | hci_unregister_dev(hdev); | |
1015 | hci_free_dev(hdev); | |
1016 | } | |
1017 | ||
7f3c563c SW |
1018 | #ifdef CONFIG_PM |
1019 | static int btmtksdio_runtime_suspend(struct device *dev) | |
1020 | { | |
1021 | struct sdio_func *func = dev_to_sdio_func(dev); | |
1022 | struct btmtksdio_dev *bdev; | |
1023 | u32 status; | |
1024 | int err; | |
1025 | ||
1026 | bdev = sdio_get_drvdata(func); | |
1027 | if (!bdev) | |
1028 | return 0; | |
1029 | ||
1030 | sdio_claim_host(bdev->func); | |
1031 | ||
1032 | sdio_writel(bdev->func, C_FW_OWN_REQ_SET, MTK_REG_CHLPCR, &err); | |
1033 | if (err < 0) | |
1034 | goto out; | |
1035 | ||
1036 | err = readx_poll_timeout(btmtksdio_drv_own_query, bdev, status, | |
1037 | !(status & C_COM_DRV_OWN), 2000, 1000000); | |
1038 | out: | |
1039 | bt_dev_info(bdev->hdev, "status (%d) return ownership to device", err); | |
1040 | ||
1041 | sdio_release_host(bdev->func); | |
1042 | ||
1043 | return err; | |
1044 | } | |
1045 | ||
1046 | static int btmtksdio_runtime_resume(struct device *dev) | |
1047 | { | |
1048 | struct sdio_func *func = dev_to_sdio_func(dev); | |
1049 | struct btmtksdio_dev *bdev; | |
1050 | u32 status; | |
1051 | int err; | |
1052 | ||
1053 | bdev = sdio_get_drvdata(func); | |
1054 | if (!bdev) | |
1055 | return 0; | |
1056 | ||
1057 | sdio_claim_host(bdev->func); | |
1058 | ||
1059 | sdio_writel(bdev->func, C_FW_OWN_REQ_CLR, MTK_REG_CHLPCR, &err); | |
1060 | if (err < 0) | |
1061 | goto out; | |
1062 | ||
1063 | err = readx_poll_timeout(btmtksdio_drv_own_query, bdev, status, | |
1064 | status & C_COM_DRV_OWN, 2000, 1000000); | |
1065 | out: | |
1066 | bt_dev_info(bdev->hdev, "status (%d) get ownership from device", err); | |
1067 | ||
1068 | sdio_release_host(bdev->func); | |
1069 | ||
1070 | return err; | |
1071 | } | |
1072 | ||
1073 | static UNIVERSAL_DEV_PM_OPS(btmtksdio_pm_ops, btmtksdio_runtime_suspend, | |
1074 | btmtksdio_runtime_resume, NULL); | |
1075 | #define BTMTKSDIO_PM_OPS (&btmtksdio_pm_ops) | |
1076 | #else /* CONFIG_PM */ | |
1077 | #define BTMTKSDIO_PM_OPS NULL | |
1078 | #endif /* CONFIG_PM */ | |
1079 | ||
9aebfd4a SW |
1080 | static struct sdio_driver btmtksdio_driver = { |
1081 | .name = "btmtksdio", | |
1082 | .probe = btmtksdio_probe, | |
1083 | .remove = btmtksdio_remove, | |
1084 | .id_table = btmtksdio_table, | |
7f3c563c SW |
1085 | .drv = { |
1086 | .owner = THIS_MODULE, | |
1087 | .pm = BTMTKSDIO_PM_OPS, | |
1088 | } | |
9aebfd4a SW |
1089 | }; |
1090 | ||
a6094a46 | 1091 | module_sdio_driver(btmtksdio_driver); |
9aebfd4a | 1092 | |
7f3c563c SW |
1093 | module_param(enable_autosuspend, bool, 0644); |
1094 | MODULE_PARM_DESC(enable_autosuspend, "Enable autosuspend by default"); | |
1095 | ||
9aebfd4a SW |
1096 | MODULE_AUTHOR("Sean Wang <sean.wang@mediatek.com>"); |
1097 | MODULE_DESCRIPTION("MediaTek Bluetooth SDIO driver ver " VERSION); | |
1098 | MODULE_VERSION(VERSION); | |
1099 | MODULE_LICENSE("GPL"); | |
1100 | MODULE_FIRMWARE(FIRMWARE_MT7663); | |
1101 | MODULE_FIRMWARE(FIRMWARE_MT7668); |