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> | |
8fafe702 | 15 | #include <linux/gpio/consumer.h> |
9aebfd4a SW |
16 | #include <linux/init.h> |
17 | #include <linux/iopoll.h> | |
18 | #include <linux/kernel.h> | |
19 | #include <linux/module.h> | |
8fafe702 | 20 | #include <linux/of.h> |
7f3c563c | 21 | #include <linux/pm_runtime.h> |
9aebfd4a SW |
22 | #include <linux/skbuff.h> |
23 | ||
24 | #include <linux/mmc/host.h> | |
25 | #include <linux/mmc/sdio_ids.h> | |
26 | #include <linux/mmc/sdio_func.h> | |
27 | ||
28 | #include <net/bluetooth/bluetooth.h> | |
29 | #include <net/bluetooth/hci_core.h> | |
30 | ||
31 | #include "h4_recv.h" | |
3a722044 | 32 | #include "btmtk.h" |
9aebfd4a SW |
33 | |
34 | #define VERSION "0.1" | |
35 | ||
e98aa38c | 36 | #define MTKBTSDIO_AUTOSUSPEND_DELAY 1000 |
7f3c563c | 37 | |
e98aa38c | 38 | static bool enable_autosuspend = true; |
7f3c563c | 39 | |
9aebfd4a SW |
40 | struct btmtksdio_data { |
41 | const char *fwname; | |
c603bf1f | 42 | u16 chipid; |
01ecc177 | 43 | bool lp_mbox_supported; |
9aebfd4a SW |
44 | }; |
45 | ||
46 | static const struct btmtksdio_data mt7663_data = { | |
47 | .fwname = FIRMWARE_MT7663, | |
c603bf1f | 48 | .chipid = 0x7663, |
01ecc177 | 49 | .lp_mbox_supported = false, |
9aebfd4a SW |
50 | }; |
51 | ||
52 | static const struct btmtksdio_data mt7668_data = { | |
53 | .fwname = FIRMWARE_MT7668, | |
c603bf1f | 54 | .chipid = 0x7668, |
01ecc177 | 55 | .lp_mbox_supported = false, |
c603bf1f SW |
56 | }; |
57 | ||
58 | static const struct btmtksdio_data mt7921_data = { | |
59 | .fwname = FIRMWARE_MT7961, | |
60 | .chipid = 0x7921, | |
01ecc177 | 61 | .lp_mbox_supported = true, |
9aebfd4a SW |
62 | }; |
63 | ||
64 | static const struct sdio_device_id btmtksdio_table[] = { | |
baaa110d | 65 | {SDIO_DEVICE(SDIO_VENDOR_ID_MEDIATEK, SDIO_DEVICE_ID_MEDIATEK_MT7663), |
9aebfd4a | 66 | .driver_data = (kernel_ulong_t)&mt7663_data }, |
baaa110d | 67 | {SDIO_DEVICE(SDIO_VENDOR_ID_MEDIATEK, SDIO_DEVICE_ID_MEDIATEK_MT7668), |
9aebfd4a | 68 | .driver_data = (kernel_ulong_t)&mt7668_data }, |
c603bf1f SW |
69 | {SDIO_DEVICE(SDIO_VENDOR_ID_MEDIATEK, SDIO_DEVICE_ID_MEDIATEK_MT7961), |
70 | .driver_data = (kernel_ulong_t)&mt7921_data }, | |
9aebfd4a SW |
71 | { } /* Terminating entry */ |
72 | }; | |
53121a7c | 73 | MODULE_DEVICE_TABLE(sdio, btmtksdio_table); |
9aebfd4a SW |
74 | |
75 | #define MTK_REG_CHLPCR 0x4 /* W1S */ | |
76 | #define C_INT_EN_SET BIT(0) | |
77 | #define C_INT_EN_CLR BIT(1) | |
2e47cc2b SW |
78 | #define C_FW_OWN_REQ_SET BIT(8) /* For write */ |
79 | #define C_COM_DRV_OWN BIT(8) /* For read */ | |
9aebfd4a SW |
80 | #define C_FW_OWN_REQ_CLR BIT(9) |
81 | ||
82 | #define MTK_REG_CSDIOCSR 0x8 | |
83 | #define SDIO_RE_INIT_EN BIT(0) | |
84 | #define SDIO_INT_CTL BIT(2) | |
85 | ||
86 | #define MTK_REG_CHCR 0xc | |
87 | #define C_INT_CLR_CTRL BIT(1) | |
8fafe702 | 88 | #define BT_RST_DONE BIT(8) |
9aebfd4a SW |
89 | |
90 | /* CHISR have the same bits field definition with CHIER */ | |
91 | #define MTK_REG_CHISR 0x10 | |
92 | #define MTK_REG_CHIER 0x14 | |
93 | #define FW_OWN_BACK_INT BIT(0) | |
94 | #define RX_DONE_INT BIT(1) | |
95 | #define TX_EMPTY BIT(2) | |
96 | #define TX_FIFO_OVERFLOW BIT(8) | |
2fc967cc | 97 | #define FW_MAILBOX_INT BIT(15) |
db3f1f9b | 98 | #define INT_MASK GENMASK(15, 0) |
9aebfd4a SW |
99 | #define RX_PKT_LEN GENMASK(31, 16) |
100 | ||
01ecc177 MC |
101 | #define MTK_REG_CSICR 0xc0 |
102 | #define CSICR_CLR_MBOX_ACK BIT(0) | |
2fc967cc MC |
103 | #define MTK_REG_PH2DSM0R 0xc4 |
104 | #define PH2DSM0R_DRIVER_OWN BIT(0) | |
01ecc177 MC |
105 | #define MTK_REG_PD2HRM0R 0xdc |
106 | #define PD2HRM0R_DRV_OWN BIT(0) | |
2fc967cc | 107 | |
9aebfd4a SW |
108 | #define MTK_REG_CTDR 0x18 |
109 | ||
110 | #define MTK_REG_CRDR 0x1c | |
111 | ||
184ea403 SW |
112 | #define MTK_REG_CRPLR 0x24 |
113 | ||
9aebfd4a SW |
114 | #define MTK_SDIO_BLOCK_SIZE 256 |
115 | ||
116 | #define BTMTKSDIO_TX_WAIT_VND_EVT 1 | |
d555b1f2 | 117 | #define BTMTKSDIO_HW_TX_READY 2 |
4b4b2228 | 118 | #define BTMTKSDIO_FUNC_ENABLED 3 |
01ecc177 | 119 | #define BTMTKSDIO_PATCH_ENABLED 4 |
8fafe702 | 120 | #define BTMTKSDIO_HW_RESET_ACTIVE 5 |
9aebfd4a | 121 | |
9aebfd4a SW |
122 | struct mtkbtsdio_hdr { |
123 | __le16 len; | |
124 | __le16 reserved; | |
125 | u8 bt_type; | |
126 | } __packed; | |
127 | ||
9aebfd4a SW |
128 | struct btmtksdio_dev { |
129 | struct hci_dev *hdev; | |
130 | struct sdio_func *func; | |
7f3c563c | 131 | struct device *dev; |
9aebfd4a | 132 | |
26270bc1 | 133 | struct work_struct txrx_work; |
9aebfd4a SW |
134 | unsigned long tx_state; |
135 | struct sk_buff_head txq; | |
136 | ||
137 | struct sk_buff *evt_skb; | |
138 | ||
139 | const struct btmtksdio_data *data; | |
8fafe702 CYC |
140 | |
141 | struct gpio_desc *reset; | |
9aebfd4a SW |
142 | }; |
143 | ||
144 | static int mtk_hci_wmt_sync(struct hci_dev *hdev, | |
145 | struct btmtk_hci_wmt_params *wmt_params) | |
146 | { | |
147 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
148 | struct btmtk_hci_wmt_evt_funcc *wmt_evt_funcc; | |
c603bf1f | 149 | struct btmtk_hci_wmt_evt_reg *wmt_evt_reg; |
9aebfd4a SW |
150 | u32 hlen, status = BTMTK_WMT_INVALID; |
151 | struct btmtk_hci_wmt_evt *wmt_evt; | |
3a722044 SW |
152 | struct btmtk_hci_wmt_cmd *wc; |
153 | struct btmtk_wmt_hdr *hdr; | |
9aebfd4a SW |
154 | int err; |
155 | ||
3a722044 | 156 | /* Send the WMT command and wait until the WMT event returns */ |
9aebfd4a SW |
157 | hlen = sizeof(*hdr) + wmt_params->dlen; |
158 | if (hlen > 255) | |
159 | return -EINVAL; | |
160 | ||
3a722044 SW |
161 | wc = kzalloc(hlen, GFP_KERNEL); |
162 | if (!wc) | |
163 | return -ENOMEM; | |
164 | ||
165 | hdr = &wc->hdr; | |
9aebfd4a SW |
166 | hdr->dir = 1; |
167 | hdr->op = wmt_params->op; | |
168 | hdr->dlen = cpu_to_le16(wmt_params->dlen + 1); | |
169 | hdr->flag = wmt_params->flag; | |
3a722044 | 170 | memcpy(wc->data, wmt_params->data, wmt_params->dlen); |
9aebfd4a SW |
171 | |
172 | set_bit(BTMTKSDIO_TX_WAIT_VND_EVT, &bdev->tx_state); | |
173 | ||
3a722044 | 174 | err = __hci_cmd_send(hdev, 0xfc6f, hlen, wc); |
9aebfd4a SW |
175 | if (err < 0) { |
176 | clear_bit(BTMTKSDIO_TX_WAIT_VND_EVT, &bdev->tx_state); | |
3a722044 | 177 | goto err_free_wc; |
9aebfd4a SW |
178 | } |
179 | ||
180 | /* The vendor specific WMT commands are all answered by a vendor | |
181 | * specific event and will not have the Command Status or Command | |
182 | * Complete as with usual HCI command flow control. | |
183 | * | |
184 | * After sending the command, wait for BTMTKSDIO_TX_WAIT_VND_EVT | |
185 | * state to be cleared. The driver specific event receive routine | |
186 | * will clear that state and with that indicate completion of the | |
187 | * WMT command. | |
188 | */ | |
189 | err = wait_on_bit_timeout(&bdev->tx_state, BTMTKSDIO_TX_WAIT_VND_EVT, | |
190 | TASK_INTERRUPTIBLE, HCI_INIT_TIMEOUT); | |
191 | if (err == -EINTR) { | |
192 | bt_dev_err(hdev, "Execution of wmt command interrupted"); | |
193 | clear_bit(BTMTKSDIO_TX_WAIT_VND_EVT, &bdev->tx_state); | |
3a722044 | 194 | goto err_free_wc; |
9aebfd4a SW |
195 | } |
196 | ||
197 | if (err) { | |
198 | bt_dev_err(hdev, "Execution of wmt command timed out"); | |
199 | clear_bit(BTMTKSDIO_TX_WAIT_VND_EVT, &bdev->tx_state); | |
3a722044 SW |
200 | err = -ETIMEDOUT; |
201 | goto err_free_wc; | |
9aebfd4a SW |
202 | } |
203 | ||
204 | /* Parse and handle the return WMT event */ | |
205 | wmt_evt = (struct btmtk_hci_wmt_evt *)bdev->evt_skb->data; | |
206 | if (wmt_evt->whdr.op != hdr->op) { | |
207 | bt_dev_err(hdev, "Wrong op received %d expected %d", | |
208 | wmt_evt->whdr.op, hdr->op); | |
209 | err = -EIO; | |
210 | goto err_free_skb; | |
211 | } | |
212 | ||
213 | switch (wmt_evt->whdr.op) { | |
3a722044 | 214 | case BTMTK_WMT_SEMAPHORE: |
9aebfd4a SW |
215 | if (wmt_evt->whdr.flag == 2) |
216 | status = BTMTK_WMT_PATCH_UNDONE; | |
217 | else | |
218 | status = BTMTK_WMT_PATCH_DONE; | |
219 | break; | |
3a722044 | 220 | case BTMTK_WMT_FUNC_CTRL: |
9aebfd4a SW |
221 | wmt_evt_funcc = (struct btmtk_hci_wmt_evt_funcc *)wmt_evt; |
222 | if (be16_to_cpu(wmt_evt_funcc->status) == 0x404) | |
223 | status = BTMTK_WMT_ON_DONE; | |
224 | else if (be16_to_cpu(wmt_evt_funcc->status) == 0x420) | |
225 | status = BTMTK_WMT_ON_PROGRESS; | |
226 | else | |
227 | status = BTMTK_WMT_ON_UNDONE; | |
228 | break; | |
c603bf1f SW |
229 | case BTMTK_WMT_PATCH_DWNLD: |
230 | if (wmt_evt->whdr.flag == 2) | |
231 | status = BTMTK_WMT_PATCH_DONE; | |
232 | else if (wmt_evt->whdr.flag == 1) | |
233 | status = BTMTK_WMT_PATCH_PROGRESS; | |
234 | else | |
235 | status = BTMTK_WMT_PATCH_UNDONE; | |
236 | break; | |
237 | case BTMTK_WMT_REGISTER: | |
238 | wmt_evt_reg = (struct btmtk_hci_wmt_evt_reg *)wmt_evt; | |
239 | if (le16_to_cpu(wmt_evt->whdr.dlen) == 12) | |
240 | status = le32_to_cpu(wmt_evt_reg->val); | |
241 | break; | |
9aebfd4a SW |
242 | } |
243 | ||
244 | if (wmt_params->status) | |
245 | *wmt_params->status = status; | |
246 | ||
247 | err_free_skb: | |
248 | kfree_skb(bdev->evt_skb); | |
249 | bdev->evt_skb = NULL; | |
3a722044 SW |
250 | err_free_wc: |
251 | kfree(wc); | |
9aebfd4a SW |
252 | |
253 | return err; | |
254 | } | |
255 | ||
256 | static int btmtksdio_tx_packet(struct btmtksdio_dev *bdev, | |
257 | struct sk_buff *skb) | |
258 | { | |
259 | struct mtkbtsdio_hdr *sdio_hdr; | |
260 | int err; | |
261 | ||
262 | /* Make sure that there are enough rooms for SDIO header */ | |
263 | if (unlikely(skb_headroom(skb) < sizeof(*sdio_hdr))) { | |
264 | err = pskb_expand_head(skb, sizeof(*sdio_hdr), 0, | |
265 | GFP_ATOMIC); | |
266 | if (err < 0) | |
267 | return err; | |
268 | } | |
269 | ||
270 | /* Prepend MediaTek SDIO Specific Header */ | |
271 | skb_push(skb, sizeof(*sdio_hdr)); | |
272 | ||
273 | sdio_hdr = (void *)skb->data; | |
274 | sdio_hdr->len = cpu_to_le16(skb->len); | |
275 | sdio_hdr->reserved = cpu_to_le16(0); | |
276 | sdio_hdr->bt_type = hci_skb_pkt_type(skb); | |
277 | ||
d555b1f2 | 278 | clear_bit(BTMTKSDIO_HW_TX_READY, &bdev->tx_state); |
9aebfd4a SW |
279 | err = sdio_writesb(bdev->func, MTK_REG_CTDR, skb->data, |
280 | round_up(skb->len, MTK_SDIO_BLOCK_SIZE)); | |
281 | if (err < 0) | |
282 | goto err_skb_pull; | |
283 | ||
284 | bdev->hdev->stat.byte_tx += skb->len; | |
285 | ||
286 | kfree_skb(skb); | |
287 | ||
288 | return 0; | |
289 | ||
290 | err_skb_pull: | |
291 | skb_pull(skb, sizeof(*sdio_hdr)); | |
292 | ||
293 | return err; | |
294 | } | |
295 | ||
296 | static u32 btmtksdio_drv_own_query(struct btmtksdio_dev *bdev) | |
297 | { | |
298 | return sdio_readl(bdev->func, MTK_REG_CHLPCR, NULL); | |
299 | } | |
300 | ||
01ecc177 MC |
301 | static u32 btmtksdio_drv_own_query_79xx(struct btmtksdio_dev *bdev) |
302 | { | |
303 | return sdio_readl(bdev->func, MTK_REG_PD2HRM0R, NULL); | |
304 | } | |
305 | ||
8fafe702 CYC |
306 | static u32 btmtksdio_chcr_query(struct btmtksdio_dev *bdev) |
307 | { | |
308 | return sdio_readl(bdev->func, MTK_REG_CHCR, NULL); | |
309 | } | |
310 | ||
c7e301d7 MC |
311 | static int btmtksdio_fw_pmctrl(struct btmtksdio_dev *bdev) |
312 | { | |
313 | u32 status; | |
314 | int err; | |
315 | ||
316 | sdio_claim_host(bdev->func); | |
317 | ||
01ecc177 MC |
318 | if (bdev->data->lp_mbox_supported && |
319 | test_bit(BTMTKSDIO_PATCH_ENABLED, &bdev->tx_state)) { | |
320 | sdio_writel(bdev->func, CSICR_CLR_MBOX_ACK, MTK_REG_CSICR, | |
321 | &err); | |
322 | err = readx_poll_timeout(btmtksdio_drv_own_query_79xx, bdev, | |
323 | status, !(status & PD2HRM0R_DRV_OWN), | |
324 | 2000, 1000000); | |
325 | if (err < 0) { | |
326 | bt_dev_err(bdev->hdev, "mailbox ACK not cleared"); | |
327 | goto out; | |
328 | } | |
329 | } | |
330 | ||
c7e301d7 MC |
331 | /* Return ownership to the device */ |
332 | sdio_writel(bdev->func, C_FW_OWN_REQ_SET, MTK_REG_CHLPCR, &err); | |
333 | if (err < 0) | |
334 | goto out; | |
335 | ||
336 | err = readx_poll_timeout(btmtksdio_drv_own_query, bdev, status, | |
337 | !(status & C_COM_DRV_OWN), 2000, 1000000); | |
338 | ||
339 | out: | |
340 | sdio_release_host(bdev->func); | |
341 | ||
342 | if (err < 0) | |
343 | bt_dev_err(bdev->hdev, "Cannot return ownership to device"); | |
344 | ||
345 | return err; | |
346 | } | |
347 | ||
348 | static int btmtksdio_drv_pmctrl(struct btmtksdio_dev *bdev) | |
349 | { | |
350 | u32 status; | |
351 | int err; | |
352 | ||
353 | sdio_claim_host(bdev->func); | |
354 | ||
355 | /* Get ownership from the device */ | |
356 | sdio_writel(bdev->func, C_FW_OWN_REQ_CLR, MTK_REG_CHLPCR, &err); | |
357 | if (err < 0) | |
358 | goto out; | |
359 | ||
360 | err = readx_poll_timeout(btmtksdio_drv_own_query, bdev, status, | |
361 | status & C_COM_DRV_OWN, 2000, 1000000); | |
362 | ||
01ecc177 MC |
363 | if (!err && bdev->data->lp_mbox_supported && |
364 | test_bit(BTMTKSDIO_PATCH_ENABLED, &bdev->tx_state)) | |
365 | err = readx_poll_timeout(btmtksdio_drv_own_query_79xx, bdev, | |
366 | status, status & PD2HRM0R_DRV_OWN, | |
367 | 2000, 1000000); | |
368 | ||
c7e301d7 MC |
369 | out: |
370 | sdio_release_host(bdev->func); | |
371 | ||
372 | if (err < 0) | |
373 | bt_dev_err(bdev->hdev, "Cannot get ownership from device"); | |
374 | ||
375 | return err; | |
376 | } | |
377 | ||
9aebfd4a SW |
378 | static int btmtksdio_recv_event(struct hci_dev *hdev, struct sk_buff *skb) |
379 | { | |
380 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
381 | struct hci_event_hdr *hdr = (void *)skb->data; | |
0fab6361 | 382 | u8 evt = hdr->evt; |
9aebfd4a SW |
383 | int err; |
384 | ||
9aebfd4a SW |
385 | /* When someone waits for the WMT event, the skb is being cloned |
386 | * and being processed the events from there then. | |
387 | */ | |
388 | if (test_bit(BTMTKSDIO_TX_WAIT_VND_EVT, &bdev->tx_state)) { | |
389 | bdev->evt_skb = skb_clone(skb, GFP_KERNEL); | |
390 | if (!bdev->evt_skb) { | |
391 | err = -ENOMEM; | |
392 | goto err_out; | |
393 | } | |
394 | } | |
395 | ||
396 | err = hci_recv_frame(hdev, skb); | |
397 | if (err < 0) | |
398 | goto err_free_skb; | |
399 | ||
0fab6361 | 400 | if (evt == HCI_EV_WMT) { |
9aebfd4a SW |
401 | if (test_and_clear_bit(BTMTKSDIO_TX_WAIT_VND_EVT, |
402 | &bdev->tx_state)) { | |
403 | /* Barrier to sync with other CPUs */ | |
404 | smp_mb__after_atomic(); | |
405 | wake_up_bit(&bdev->tx_state, BTMTKSDIO_TX_WAIT_VND_EVT); | |
406 | } | |
407 | } | |
408 | ||
409 | return 0; | |
410 | ||
411 | err_free_skb: | |
412 | kfree_skb(bdev->evt_skb); | |
413 | bdev->evt_skb = NULL; | |
414 | ||
415 | err_out: | |
416 | return err; | |
417 | } | |
418 | ||
db57b625 SW |
419 | static int btmtksdio_recv_acl(struct hci_dev *hdev, struct sk_buff *skb) |
420 | { | |
421 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
422 | u16 handle = le16_to_cpu(hci_acl_hdr(skb)->handle); | |
423 | ||
424 | switch (handle) { | |
425 | case 0xfc6f: | |
426 | /* Firmware dump from device: when the firmware hangs, the | |
427 | * device can no longer suspend and thus disable auto-suspend. | |
428 | */ | |
429 | pm_runtime_forbid(bdev->dev); | |
430 | fallthrough; | |
431 | case 0x05ff: | |
432 | case 0x05fe: | |
433 | /* Firmware debug logging */ | |
434 | return hci_recv_diag(hdev, skb); | |
435 | } | |
436 | ||
437 | return hci_recv_frame(hdev, skb); | |
438 | } | |
439 | ||
9aebfd4a | 440 | static const struct h4_recv_pkt mtk_recv_pkts[] = { |
db57b625 | 441 | { H4_RECV_ACL, .recv = btmtksdio_recv_acl }, |
9aebfd4a SW |
442 | { H4_RECV_SCO, .recv = hci_recv_frame }, |
443 | { H4_RECV_EVENT, .recv = btmtksdio_recv_event }, | |
444 | }; | |
445 | ||
446 | static int btmtksdio_rx_packet(struct btmtksdio_dev *bdev, u16 rx_size) | |
447 | { | |
448 | const struct h4_recv_pkt *pkts = mtk_recv_pkts; | |
449 | int pkts_count = ARRAY_SIZE(mtk_recv_pkts); | |
450 | struct mtkbtsdio_hdr *sdio_hdr; | |
9aebfd4a SW |
451 | int err, i, pad_size; |
452 | struct sk_buff *skb; | |
453 | u16 dlen; | |
454 | ||
455 | if (rx_size < sizeof(*sdio_hdr)) | |
456 | return -EILSEQ; | |
457 | ||
458 | /* A SDIO packet is exactly containing a Bluetooth packet */ | |
459 | skb = bt_skb_alloc(rx_size, GFP_KERNEL); | |
460 | if (!skb) | |
461 | return -ENOMEM; | |
462 | ||
463 | skb_put(skb, rx_size); | |
464 | ||
465 | err = sdio_readsb(bdev->func, skb->data, MTK_REG_CRDR, rx_size); | |
466 | if (err < 0) | |
467 | goto err_kfree_skb; | |
468 | ||
9aebfd4a SW |
469 | sdio_hdr = (void *)skb->data; |
470 | ||
471 | /* We assume the default error as -EILSEQ simply to make the error path | |
472 | * be cleaner. | |
473 | */ | |
474 | err = -EILSEQ; | |
475 | ||
476 | if (rx_size != le16_to_cpu(sdio_hdr->len)) { | |
477 | bt_dev_err(bdev->hdev, "Rx size in sdio header is mismatched "); | |
478 | goto err_kfree_skb; | |
479 | } | |
480 | ||
481 | hci_skb_pkt_type(skb) = sdio_hdr->bt_type; | |
482 | ||
483 | /* Remove MediaTek SDIO header */ | |
484 | skb_pull(skb, sizeof(*sdio_hdr)); | |
485 | ||
486 | /* We have to dig into the packet to get payload size and then know how | |
487 | * many padding bytes at the tail, these padding bytes should be removed | |
488 | * before the packet is indicated to the core layer. | |
489 | */ | |
490 | for (i = 0; i < pkts_count; i++) { | |
491 | if (sdio_hdr->bt_type == (&pkts[i])->type) | |
492 | break; | |
493 | } | |
494 | ||
495 | if (i >= pkts_count) { | |
496 | bt_dev_err(bdev->hdev, "Invalid bt type 0x%02x", | |
497 | sdio_hdr->bt_type); | |
498 | goto err_kfree_skb; | |
499 | } | |
500 | ||
501 | /* Remaining bytes cannot hold a header*/ | |
502 | if (skb->len < (&pkts[i])->hlen) { | |
503 | bt_dev_err(bdev->hdev, "The size of bt header is mismatched"); | |
504 | goto err_kfree_skb; | |
505 | } | |
506 | ||
507 | switch ((&pkts[i])->lsize) { | |
1ca2a394 JT |
508 | case 1: |
509 | dlen = skb->data[(&pkts[i])->loff]; | |
510 | break; | |
511 | case 2: | |
512 | dlen = get_unaligned_le16(skb->data + | |
9aebfd4a | 513 | (&pkts[i])->loff); |
1ca2a394 JT |
514 | break; |
515 | default: | |
516 | goto err_kfree_skb; | |
9aebfd4a SW |
517 | } |
518 | ||
519 | pad_size = skb->len - (&pkts[i])->hlen - dlen; | |
520 | ||
521 | /* Remaining bytes cannot hold a payload */ | |
522 | if (pad_size < 0) { | |
523 | bt_dev_err(bdev->hdev, "The size of bt payload is mismatched"); | |
524 | goto err_kfree_skb; | |
525 | } | |
526 | ||
527 | /* Remove padding bytes */ | |
528 | skb_trim(skb, skb->len - pad_size); | |
529 | ||
530 | /* Complete frame */ | |
531 | (&pkts[i])->recv(bdev->hdev, skb); | |
532 | ||
bcaa7d72 SW |
533 | bdev->hdev->stat.byte_rx += rx_size; |
534 | ||
9aebfd4a SW |
535 | return 0; |
536 | ||
537 | err_kfree_skb: | |
9aebfd4a SW |
538 | kfree_skb(skb); |
539 | ||
540 | return err; | |
541 | } | |
542 | ||
26270bc1 | 543 | static void btmtksdio_txrx_work(struct work_struct *work) |
9aebfd4a | 544 | { |
26270bc1 SW |
545 | struct btmtksdio_dev *bdev = container_of(work, struct btmtksdio_dev, |
546 | txrx_work); | |
547 | unsigned long txrx_timeout; | |
184ea403 | 548 | u32 int_status, rx_size; |
26270bc1 | 549 | struct sk_buff *skb; |
26270bc1 | 550 | int err; |
7f3c563c SW |
551 | |
552 | pm_runtime_get_sync(bdev->dev); | |
553 | ||
554 | sdio_claim_host(bdev->func); | |
555 | ||
9aebfd4a | 556 | /* Disable interrupt */ |
26270bc1 | 557 | sdio_writel(bdev->func, C_INT_EN_CLR, MTK_REG_CHLPCR, 0); |
9aebfd4a | 558 | |
26270bc1 SW |
559 | txrx_timeout = jiffies + 5 * HZ; |
560 | ||
561 | do { | |
562 | int_status = sdio_readl(bdev->func, MTK_REG_CHISR, NULL); | |
563 | ||
564 | /* Ack an interrupt as soon as possible before any operation on | |
565 | * hardware. | |
566 | * | |
567 | * Note that we don't ack any status during operations to avoid race | |
568 | * condition between the host and the device such as it's possible to | |
569 | * mistakenly ack RX_DONE for the next packet and then cause interrupts | |
570 | * not be raised again but there is still pending data in the hardware | |
571 | * FIFO. | |
572 | */ | |
573 | sdio_writel(bdev->func, int_status, MTK_REG_CHISR, NULL); | |
db3f1f9b | 574 | int_status &= INT_MASK; |
26270bc1 | 575 | |
2fc967cc MC |
576 | if ((int_status & FW_MAILBOX_INT) && |
577 | bdev->data->chipid == 0x7921) { | |
578 | sdio_writel(bdev->func, PH2DSM0R_DRIVER_OWN, | |
579 | MTK_REG_PH2DSM0R, 0); | |
580 | } | |
581 | ||
26270bc1 SW |
582 | if (int_status & FW_OWN_BACK_INT) |
583 | bt_dev_dbg(bdev->hdev, "Get fw own back"); | |
584 | ||
585 | if (int_status & TX_EMPTY) | |
d555b1f2 SW |
586 | set_bit(BTMTKSDIO_HW_TX_READY, &bdev->tx_state); |
587 | ||
26270bc1 SW |
588 | else if (unlikely(int_status & TX_FIFO_OVERFLOW)) |
589 | bt_dev_warn(bdev->hdev, "Tx fifo overflow"); | |
590 | ||
d555b1f2 | 591 | if (test_bit(BTMTKSDIO_HW_TX_READY, &bdev->tx_state)) { |
10fe40e1 MC |
592 | skb = skb_dequeue(&bdev->txq); |
593 | if (skb) { | |
594 | err = btmtksdio_tx_packet(bdev, skb); | |
595 | if (err < 0) { | |
596 | bdev->hdev->stat.err_tx++; | |
597 | skb_queue_head(&bdev->txq, skb); | |
598 | } | |
599 | } | |
600 | } | |
601 | ||
26270bc1 | 602 | if (int_status & RX_DONE_INT) { |
184ea403 SW |
603 | rx_size = sdio_readl(bdev->func, MTK_REG_CRPLR, NULL); |
604 | rx_size = (rx_size & RX_PKT_LEN) >> 16; | |
26270bc1 SW |
605 | if (btmtksdio_rx_packet(bdev, rx_size) < 0) |
606 | bdev->hdev->stat.err_rx++; | |
607 | } | |
26270bc1 | 608 | } while (int_status || time_is_before_jiffies(txrx_timeout)); |
9aebfd4a | 609 | |
26270bc1 SW |
610 | /* Enable interrupt */ |
611 | sdio_writel(bdev->func, C_INT_EN_SET, MTK_REG_CHLPCR, 0); | |
9aebfd4a | 612 | |
26270bc1 | 613 | sdio_release_host(bdev->func); |
9aebfd4a | 614 | |
26270bc1 SW |
615 | pm_runtime_mark_last_busy(bdev->dev); |
616 | pm_runtime_put_autosuspend(bdev->dev); | |
617 | } | |
9aebfd4a | 618 | |
26270bc1 SW |
619 | static void btmtksdio_interrupt(struct sdio_func *func) |
620 | { | |
621 | struct btmtksdio_dev *bdev = sdio_get_drvdata(func); | |
9aebfd4a | 622 | |
26270bc1 SW |
623 | /* Disable interrupt */ |
624 | sdio_writel(bdev->func, C_INT_EN_CLR, MTK_REG_CHLPCR, 0); | |
7f3c563c | 625 | |
26270bc1 | 626 | schedule_work(&bdev->txrx_work); |
9aebfd4a SW |
627 | } |
628 | ||
629 | static int btmtksdio_open(struct hci_dev *hdev) | |
630 | { | |
631 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
c7e301d7 | 632 | u32 val; |
9aebfd4a | 633 | int err; |
9aebfd4a SW |
634 | |
635 | sdio_claim_host(bdev->func); | |
636 | ||
637 | err = sdio_enable_func(bdev->func); | |
638 | if (err < 0) | |
639 | goto err_release_host; | |
640 | ||
4b4b2228 SW |
641 | set_bit(BTMTKSDIO_FUNC_ENABLED, &bdev->tx_state); |
642 | ||
c7e301d7 | 643 | err = btmtksdio_drv_pmctrl(bdev); |
9aebfd4a SW |
644 | if (err < 0) |
645 | goto err_disable_func; | |
646 | ||
9aebfd4a SW |
647 | /* Disable interrupt & mask out all interrupt sources */ |
648 | sdio_writel(bdev->func, C_INT_EN_CLR, MTK_REG_CHLPCR, &err); | |
649 | if (err < 0) | |
650 | goto err_disable_func; | |
651 | ||
652 | sdio_writel(bdev->func, 0, MTK_REG_CHIER, &err); | |
653 | if (err < 0) | |
654 | goto err_disable_func; | |
655 | ||
656 | err = sdio_claim_irq(bdev->func, btmtksdio_interrupt); | |
657 | if (err < 0) | |
658 | goto err_disable_func; | |
659 | ||
660 | err = sdio_set_block_size(bdev->func, MTK_SDIO_BLOCK_SIZE); | |
661 | if (err < 0) | |
662 | goto err_release_irq; | |
663 | ||
664 | /* SDIO CMD 5 allows the SDIO device back to idle state an | |
665 | * synchronous interrupt is supported in SDIO 4-bit mode | |
666 | */ | |
5b23ac1a SW |
667 | val = sdio_readl(bdev->func, MTK_REG_CSDIOCSR, &err); |
668 | if (err < 0) | |
669 | goto err_release_irq; | |
670 | ||
671 | val |= SDIO_INT_CTL; | |
672 | sdio_writel(bdev->func, val, MTK_REG_CSDIOCSR, &err); | |
9aebfd4a SW |
673 | if (err < 0) |
674 | goto err_release_irq; | |
675 | ||
77b210d1 SW |
676 | /* Explitly set write-1-clear method */ |
677 | val = sdio_readl(bdev->func, MTK_REG_CHCR, &err); | |
678 | if (err < 0) | |
679 | goto err_release_irq; | |
680 | ||
681 | val |= C_INT_CLR_CTRL; | |
682 | sdio_writel(bdev->func, val, MTK_REG_CHCR, &err); | |
9aebfd4a SW |
683 | if (err < 0) |
684 | goto err_release_irq; | |
685 | ||
686 | /* Setup interrupt sources */ | |
687 | sdio_writel(bdev->func, RX_DONE_INT | TX_EMPTY | TX_FIFO_OVERFLOW, | |
688 | MTK_REG_CHIER, &err); | |
689 | if (err < 0) | |
690 | goto err_release_irq; | |
691 | ||
692 | /* Enable interrupt */ | |
693 | sdio_writel(bdev->func, C_INT_EN_SET, MTK_REG_CHLPCR, &err); | |
694 | if (err < 0) | |
695 | goto err_release_irq; | |
696 | ||
697 | sdio_release_host(bdev->func); | |
698 | ||
699 | return 0; | |
700 | ||
701 | err_release_irq: | |
702 | sdio_release_irq(bdev->func); | |
703 | ||
704 | err_disable_func: | |
705 | sdio_disable_func(bdev->func); | |
706 | ||
707 | err_release_host: | |
708 | sdio_release_host(bdev->func); | |
709 | ||
710 | return err; | |
711 | } | |
712 | ||
713 | static int btmtksdio_close(struct hci_dev *hdev) | |
714 | { | |
715 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
9aebfd4a SW |
716 | |
717 | sdio_claim_host(bdev->func); | |
718 | ||
719 | /* Disable interrupt */ | |
720 | sdio_writel(bdev->func, C_INT_EN_CLR, MTK_REG_CHLPCR, NULL); | |
721 | ||
722 | sdio_release_irq(bdev->func); | |
723 | ||
26270bc1 SW |
724 | cancel_work_sync(&bdev->txrx_work); |
725 | ||
c7e301d7 | 726 | btmtksdio_fw_pmctrl(bdev); |
9aebfd4a | 727 | |
4b4b2228 | 728 | clear_bit(BTMTKSDIO_FUNC_ENABLED, &bdev->tx_state); |
9aebfd4a SW |
729 | sdio_disable_func(bdev->func); |
730 | ||
731 | sdio_release_host(bdev->func); | |
732 | ||
733 | return 0; | |
734 | } | |
735 | ||
736 | static int btmtksdio_flush(struct hci_dev *hdev) | |
737 | { | |
738 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
739 | ||
740 | skb_queue_purge(&bdev->txq); | |
741 | ||
26270bc1 | 742 | cancel_work_sync(&bdev->txrx_work); |
9aebfd4a SW |
743 | |
744 | return 0; | |
745 | } | |
746 | ||
747 | static int btmtksdio_func_query(struct hci_dev *hdev) | |
748 | { | |
749 | struct btmtk_hci_wmt_params wmt_params; | |
750 | int status, err; | |
751 | u8 param = 0; | |
752 | ||
753 | /* Query whether the function is enabled */ | |
3a722044 | 754 | wmt_params.op = BTMTK_WMT_FUNC_CTRL; |
9aebfd4a SW |
755 | wmt_params.flag = 4; |
756 | wmt_params.dlen = sizeof(param); | |
757 | wmt_params.data = ¶m; | |
758 | wmt_params.status = &status; | |
759 | ||
760 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
761 | if (err < 0) { | |
762 | bt_dev_err(hdev, "Failed to query function status (%d)", err); | |
763 | return err; | |
764 | } | |
765 | ||
766 | return status; | |
767 | } | |
768 | ||
c603bf1f | 769 | static int mt76xx_setup(struct hci_dev *hdev, const char *fwname) |
9aebfd4a | 770 | { |
01ecc177 | 771 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); |
9aebfd4a | 772 | struct btmtk_hci_wmt_params wmt_params; |
9aebfd4a | 773 | struct btmtk_tci_sleep tci_sleep; |
9aebfd4a SW |
774 | struct sk_buff *skb; |
775 | int err, status; | |
776 | u8 param = 0x1; | |
777 | ||
9aebfd4a | 778 | /* Query whether the firmware is already download */ |
3a722044 | 779 | wmt_params.op = BTMTK_WMT_SEMAPHORE; |
9aebfd4a SW |
780 | wmt_params.flag = 1; |
781 | wmt_params.dlen = 0; | |
782 | wmt_params.data = NULL; | |
783 | wmt_params.status = &status; | |
784 | ||
785 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
786 | if (err < 0) { | |
787 | bt_dev_err(hdev, "Failed to query firmware status (%d)", err); | |
788 | return err; | |
789 | } | |
790 | ||
791 | if (status == BTMTK_WMT_PATCH_DONE) { | |
792 | bt_dev_info(hdev, "Firmware already downloaded"); | |
793 | goto ignore_setup_fw; | |
794 | } | |
795 | ||
796 | /* Setup a firmware which the device definitely requires */ | |
c603bf1f | 797 | err = btmtk_setup_firmware(hdev, fwname, mtk_hci_wmt_sync); |
9aebfd4a SW |
798 | if (err < 0) |
799 | return err; | |
800 | ||
801 | ignore_setup_fw: | |
802 | /* Query whether the device is already enabled */ | |
803 | err = readx_poll_timeout(btmtksdio_func_query, hdev, status, | |
804 | status < 0 || status != BTMTK_WMT_ON_PROGRESS, | |
805 | 2000, 5000000); | |
806 | /* -ETIMEDOUT happens */ | |
807 | if (err < 0) | |
808 | return err; | |
809 | ||
810 | /* The other errors happen in btusb_mtk_func_query */ | |
811 | if (status < 0) | |
812 | return status; | |
813 | ||
814 | if (status == BTMTK_WMT_ON_DONE) { | |
815 | bt_dev_info(hdev, "function already on"); | |
816 | goto ignore_func_on; | |
817 | } | |
818 | ||
819 | /* Enable Bluetooth protocol */ | |
3a722044 | 820 | wmt_params.op = BTMTK_WMT_FUNC_CTRL; |
9aebfd4a SW |
821 | wmt_params.flag = 0; |
822 | wmt_params.dlen = sizeof(param); | |
823 | wmt_params.data = ¶m; | |
824 | wmt_params.status = NULL; | |
825 | ||
826 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
827 | if (err < 0) { | |
828 | bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err); | |
829 | return err; | |
830 | } | |
831 | ||
01ecc177 MC |
832 | set_bit(BTMTKSDIO_PATCH_ENABLED, &bdev->tx_state); |
833 | ||
9aebfd4a SW |
834 | ignore_func_on: |
835 | /* Apply the low power environment setup */ | |
836 | tci_sleep.mode = 0x5; | |
837 | tci_sleep.duration = cpu_to_le16(0x640); | |
838 | tci_sleep.host_duration = cpu_to_le16(0x640); | |
839 | tci_sleep.host_wakeup_pin = 0; | |
840 | tci_sleep.time_compensation = 0; | |
841 | ||
842 | skb = __hci_cmd_sync(hdev, 0xfc7a, sizeof(tci_sleep), &tci_sleep, | |
843 | HCI_INIT_TIMEOUT); | |
844 | if (IS_ERR(skb)) { | |
845 | err = PTR_ERR(skb); | |
846 | bt_dev_err(hdev, "Failed to apply low power setting (%d)", err); | |
847 | return err; | |
848 | } | |
849 | kfree_skb(skb); | |
850 | ||
c603bf1f SW |
851 | return 0; |
852 | } | |
853 | ||
854 | static int mt79xx_setup(struct hci_dev *hdev, const char *fwname) | |
855 | { | |
01ecc177 | 856 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); |
c603bf1f SW |
857 | struct btmtk_hci_wmt_params wmt_params; |
858 | u8 param = 0x1; | |
859 | int err; | |
860 | ||
861 | err = btmtk_setup_firmware_79xx(hdev, fwname, mtk_hci_wmt_sync); | |
862 | if (err < 0) { | |
863 | bt_dev_err(hdev, "Failed to setup 79xx firmware (%d)", err); | |
864 | return err; | |
865 | } | |
866 | ||
74697205 SW |
867 | err = btmtksdio_fw_pmctrl(bdev); |
868 | if (err < 0) | |
869 | return err; | |
870 | ||
871 | err = btmtksdio_drv_pmctrl(bdev); | |
872 | if (err < 0) | |
873 | return err; | |
874 | ||
c603bf1f SW |
875 | /* Enable Bluetooth protocol */ |
876 | wmt_params.op = BTMTK_WMT_FUNC_CTRL; | |
877 | wmt_params.flag = 0; | |
878 | wmt_params.dlen = sizeof(param); | |
879 | wmt_params.data = ¶m; | |
880 | wmt_params.status = NULL; | |
881 | ||
882 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
883 | if (err < 0) { | |
884 | bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err); | |
885 | return err; | |
886 | } | |
887 | ||
630491ff | 888 | hci_set_msft_opcode(hdev, 0xFD30); |
16ada83b | 889 | hci_set_aosp_capable(hdev); |
01ecc177 | 890 | set_bit(BTMTKSDIO_PATCH_ENABLED, &bdev->tx_state); |
630491ff | 891 | |
c603bf1f SW |
892 | return err; |
893 | } | |
894 | ||
4b685879 | 895 | static int btmtksdio_mtk_reg_read(struct hci_dev *hdev, u32 reg, u32 *val) |
c603bf1f SW |
896 | { |
897 | struct btmtk_hci_wmt_params wmt_params; | |
5677bcf6 | 898 | struct reg_read_cmd reg_read = { |
c603bf1f SW |
899 | .type = 1, |
900 | .num = 1, | |
901 | }; | |
902 | u32 status; | |
903 | int err; | |
904 | ||
905 | reg_read.addr = cpu_to_le32(reg); | |
906 | wmt_params.op = BTMTK_WMT_REGISTER; | |
907 | wmt_params.flag = BTMTK_WMT_REG_READ; | |
908 | wmt_params.dlen = sizeof(reg_read); | |
909 | wmt_params.data = ®_read; | |
910 | wmt_params.status = &status; | |
911 | ||
912 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
913 | if (err < 0) { | |
386f626a | 914 | bt_dev_err(hdev, "Failed to read reg (%d)", err); |
c603bf1f SW |
915 | return err; |
916 | } | |
917 | ||
918 | *val = status; | |
919 | ||
920 | return err; | |
921 | } | |
922 | ||
191c8723 MC |
923 | static int btmtksdio_mtk_reg_write(struct hci_dev *hdev, u32 reg, u32 val, u32 mask) |
924 | { | |
925 | struct btmtk_hci_wmt_params wmt_params; | |
926 | const struct reg_write_cmd reg_write = { | |
927 | .type = 1, | |
928 | .num = 1, | |
929 | .addr = cpu_to_le32(reg), | |
930 | .data = cpu_to_le32(val), | |
931 | .mask = cpu_to_le32(mask), | |
932 | }; | |
933 | int err, status; | |
934 | ||
935 | wmt_params.op = BTMTK_WMT_REGISTER; | |
936 | wmt_params.flag = BTMTK_WMT_REG_WRITE; | |
937 | wmt_params.dlen = sizeof(reg_write); | |
938 | wmt_params.data = ®_write; | |
939 | wmt_params.status = &status; | |
940 | ||
941 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
942 | if (err < 0) | |
943 | bt_dev_err(hdev, "Failed to write reg (%d)", err); | |
944 | ||
945 | return err; | |
946 | } | |
947 | ||
d786105e YY |
948 | static int btmtksdio_get_data_path_id(struct hci_dev *hdev, __u8 *data_path_id) |
949 | { | |
950 | /* uses 1 as data path id for all the usecases */ | |
951 | *data_path_id = 1; | |
952 | return 0; | |
953 | } | |
954 | ||
f41b91fa YY |
955 | static int btmtksdio_get_codec_config_data(struct hci_dev *hdev, |
956 | __u8 link, struct bt_codec *codec, | |
957 | __u8 *ven_len, __u8 **ven_data) | |
958 | { | |
959 | int err = 0; | |
960 | ||
961 | if (!ven_data || !ven_len) | |
962 | return -EINVAL; | |
963 | ||
964 | *ven_len = 0; | |
965 | *ven_data = NULL; | |
966 | ||
967 | if (link != ESCO_LINK) { | |
968 | bt_dev_err(hdev, "Invalid link type(%u)", link); | |
969 | return -EINVAL; | |
970 | } | |
971 | ||
972 | *ven_data = kmalloc(sizeof(__u8), GFP_KERNEL); | |
789f6b8a | 973 | if (!*ven_data) { |
f41b91fa YY |
974 | err = -ENOMEM; |
975 | goto error; | |
976 | } | |
977 | ||
978 | /* supports only CVSD and mSBC offload codecs */ | |
979 | switch (codec->id) { | |
980 | case 0x02: | |
981 | **ven_data = 0x00; | |
982 | break; | |
983 | case 0x05: | |
984 | **ven_data = 0x01; | |
985 | break; | |
986 | default: | |
987 | err = -EINVAL; | |
988 | bt_dev_err(hdev, "Invalid codec id(%u)", codec->id); | |
989 | goto error; | |
990 | } | |
991 | /* codec and its capabilities are pre-defined to ids | |
992 | * preset id = 0x00 represents CVSD codec with sampling rate 8K | |
993 | * preset id = 0x01 represents mSBC codec with sampling rate 16K | |
994 | */ | |
995 | *ven_len = sizeof(__u8); | |
996 | return err; | |
997 | ||
998 | error: | |
999 | kfree(*ven_data); | |
1000 | *ven_data = NULL; | |
1001 | return err; | |
1002 | } | |
1003 | ||
191c8723 MC |
1004 | static int btmtksdio_sco_setting(struct hci_dev *hdev) |
1005 | { | |
1006 | const struct btmtk_sco sco_setting = { | |
1007 | .clock_config = 0x49, | |
1008 | .channel_format_config = 0x80, | |
1009 | }; | |
1010 | struct sk_buff *skb; | |
1011 | u32 val; | |
1012 | int err; | |
1013 | ||
1014 | /* Enable SCO over I2S/PCM for MediaTek chipset */ | |
1015 | skb = __hci_cmd_sync(hdev, 0xfc72, sizeof(sco_setting), | |
1016 | &sco_setting, HCI_CMD_TIMEOUT); | |
1017 | if (IS_ERR(skb)) | |
1018 | return PTR_ERR(skb); | |
1019 | ||
1020 | kfree_skb(skb); | |
1021 | ||
1022 | err = btmtksdio_mtk_reg_read(hdev, MT7921_PINMUX_0, &val); | |
1023 | if (err < 0) | |
1024 | return err; | |
1025 | ||
1026 | val |= 0x11000000; | |
1027 | err = btmtksdio_mtk_reg_write(hdev, MT7921_PINMUX_0, val, ~0); | |
1028 | if (err < 0) | |
1029 | return err; | |
1030 | ||
1031 | err = btmtksdio_mtk_reg_read(hdev, MT7921_PINMUX_1, &val); | |
1032 | if (err < 0) | |
1033 | return err; | |
1034 | ||
1035 | val |= 0x00000101; | |
d786105e YY |
1036 | err = btmtksdio_mtk_reg_write(hdev, MT7921_PINMUX_1, val, ~0); |
1037 | if (err < 0) | |
1038 | return err; | |
1039 | ||
1040 | hdev->get_data_path_id = btmtksdio_get_data_path_id; | |
f41b91fa | 1041 | hdev->get_codec_config_data = btmtksdio_get_codec_config_data; |
d786105e YY |
1042 | |
1043 | return err; | |
191c8723 MC |
1044 | } |
1045 | ||
8fafe702 CYC |
1046 | static int btmtksdio_reset_setting(struct hci_dev *hdev) |
1047 | { | |
1048 | int err; | |
1049 | u32 val; | |
1050 | ||
1051 | err = btmtksdio_mtk_reg_read(hdev, MT7921_PINMUX_1, &val); | |
1052 | if (err < 0) | |
1053 | return err; | |
1054 | ||
1055 | val |= 0x20; /* set the pin (bit field 11:8) work as GPIO mode */ | |
1056 | err = btmtksdio_mtk_reg_write(hdev, MT7921_PINMUX_1, val, ~0); | |
1057 | if (err < 0) | |
1058 | return err; | |
1059 | ||
1060 | err = btmtksdio_mtk_reg_read(hdev, MT7921_BTSYS_RST, &val); | |
1061 | if (err < 0) | |
1062 | return err; | |
1063 | ||
1064 | val |= MT7921_BTSYS_RST_WITH_GPIO; | |
1065 | return btmtksdio_mtk_reg_write(hdev, MT7921_BTSYS_RST, val, ~0); | |
1066 | } | |
1067 | ||
c603bf1f SW |
1068 | static int btmtksdio_setup(struct hci_dev *hdev) |
1069 | { | |
1070 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
1071 | ktime_t calltime, delta, rettime; | |
1072 | unsigned long long duration; | |
1073 | char fwname[64]; | |
1074 | int err, dev_id; | |
8fafe702 | 1075 | u32 fw_version = 0, val; |
c603bf1f SW |
1076 | |
1077 | calltime = ktime_get(); | |
d555b1f2 | 1078 | set_bit(BTMTKSDIO_HW_TX_READY, &bdev->tx_state); |
c603bf1f SW |
1079 | |
1080 | switch (bdev->data->chipid) { | |
1081 | case 0x7921: | |
8fafe702 CYC |
1082 | if (test_bit(BTMTKSDIO_HW_RESET_ACTIVE, &bdev->tx_state)) { |
1083 | err = btmtksdio_mtk_reg_read(hdev, MT7921_DLSTATUS, | |
1084 | &val); | |
1085 | if (err < 0) | |
1086 | return err; | |
1087 | ||
1088 | val &= ~BT_DL_STATE; | |
1089 | err = btmtksdio_mtk_reg_write(hdev, MT7921_DLSTATUS, | |
1090 | val, ~0); | |
1091 | if (err < 0) | |
1092 | return err; | |
1093 | ||
1094 | btmtksdio_fw_pmctrl(bdev); | |
1095 | msleep(20); | |
1096 | btmtksdio_drv_pmctrl(bdev); | |
1097 | ||
1098 | clear_bit(BTMTKSDIO_HW_RESET_ACTIVE, &bdev->tx_state); | |
1099 | } | |
1100 | ||
4b685879 | 1101 | err = btmtksdio_mtk_reg_read(hdev, 0x70010200, &dev_id); |
c603bf1f SW |
1102 | if (err < 0) { |
1103 | bt_dev_err(hdev, "Failed to get device id (%d)", err); | |
1104 | return err; | |
1105 | } | |
1106 | ||
4b685879 | 1107 | err = btmtksdio_mtk_reg_read(hdev, 0x80021004, &fw_version); |
c603bf1f SW |
1108 | if (err < 0) { |
1109 | bt_dev_err(hdev, "Failed to get fw version (%d)", err); | |
1110 | return err; | |
1111 | } | |
1112 | ||
1113 | snprintf(fwname, sizeof(fwname), | |
1114 | "mediatek/BT_RAM_CODE_MT%04x_1_%x_hdr.bin", | |
1115 | dev_id & 0xffff, (fw_version & 0xff) + 1); | |
1116 | err = mt79xx_setup(hdev, fwname); | |
1117 | if (err < 0) | |
1118 | return err; | |
191c8723 MC |
1119 | |
1120 | /* Enable SCO over I2S/PCM */ | |
1121 | err = btmtksdio_sco_setting(hdev); | |
1122 | if (err < 0) { | |
1123 | bt_dev_err(hdev, "Failed to enable SCO setting (%d)", err); | |
1124 | return err; | |
1125 | } | |
1126 | ||
5ad80cfc YY |
1127 | /* Enable WBS with mSBC codec */ |
1128 | set_bit(HCI_QUIRK_WIDEBAND_SPEECH_SUPPORTED, &hdev->quirks); | |
1129 | ||
8fafe702 CYC |
1130 | /* Enable GPIO reset mechanism */ |
1131 | if (bdev->reset) { | |
1132 | err = btmtksdio_reset_setting(hdev); | |
1133 | if (err < 0) { | |
1134 | bt_dev_err(hdev, "Failed to enable Reset setting (%d)", err); | |
1135 | devm_gpiod_put(bdev->dev, bdev->reset); | |
1136 | bdev->reset = NULL; | |
1137 | } | |
1138 | } | |
1139 | ||
546ff98e YY |
1140 | /* Valid LE States quirk for MediaTek 7921 */ |
1141 | set_bit(HCI_QUIRK_VALID_LE_STATES, &hdev->quirks); | |
1142 | ||
c603bf1f SW |
1143 | break; |
1144 | case 0x7663: | |
1145 | case 0x7668: | |
1146 | err = mt76xx_setup(hdev, bdev->data->fwname); | |
1147 | if (err < 0) | |
1148 | return err; | |
1149 | break; | |
1150 | default: | |
1151 | return -ENODEV; | |
1152 | } | |
1153 | ||
9aebfd4a SW |
1154 | rettime = ktime_get(); |
1155 | delta = ktime_sub(rettime, calltime); | |
1156 | duration = (unsigned long long)ktime_to_ns(delta) >> 10; | |
1157 | ||
7f3c563c SW |
1158 | pm_runtime_set_autosuspend_delay(bdev->dev, |
1159 | MTKBTSDIO_AUTOSUSPEND_DELAY); | |
1160 | pm_runtime_use_autosuspend(bdev->dev); | |
1161 | ||
1162 | err = pm_runtime_set_active(bdev->dev); | |
1163 | if (err < 0) | |
1164 | return err; | |
1165 | ||
1166 | /* Default forbid runtime auto suspend, that can be allowed by | |
1167 | * enable_autosuspend flag or the PM runtime entry under sysfs. | |
1168 | */ | |
1169 | pm_runtime_forbid(bdev->dev); | |
1170 | pm_runtime_enable(bdev->dev); | |
1171 | ||
1172 | if (enable_autosuspend) | |
1173 | pm_runtime_allow(bdev->dev); | |
1174 | ||
9aebfd4a SW |
1175 | bt_dev_info(hdev, "Device setup in %llu usecs", duration); |
1176 | ||
1177 | return 0; | |
1178 | } | |
1179 | ||
1180 | static int btmtksdio_shutdown(struct hci_dev *hdev) | |
1181 | { | |
7f3c563c | 1182 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); |
9aebfd4a SW |
1183 | struct btmtk_hci_wmt_params wmt_params; |
1184 | u8 param = 0x0; | |
1185 | int err; | |
1186 | ||
7f3c563c SW |
1187 | /* Get back the state to be consistent with the state |
1188 | * in btmtksdio_setup. | |
1189 | */ | |
1190 | pm_runtime_get_sync(bdev->dev); | |
1191 | ||
baabb7f5 SW |
1192 | /* wmt command only works until the reset is complete */ |
1193 | if (test_bit(BTMTKSDIO_HW_RESET_ACTIVE, &bdev->tx_state)) | |
1194 | goto ignore_wmt_cmd; | |
1195 | ||
9aebfd4a | 1196 | /* Disable the device */ |
3a722044 | 1197 | wmt_params.op = BTMTK_WMT_FUNC_CTRL; |
9aebfd4a SW |
1198 | wmt_params.flag = 0; |
1199 | wmt_params.dlen = sizeof(param); | |
1200 | wmt_params.data = ¶m; | |
1201 | wmt_params.status = NULL; | |
1202 | ||
1203 | err = mtk_hci_wmt_sync(hdev, &wmt_params); | |
1204 | if (err < 0) { | |
1205 | bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err); | |
1206 | return err; | |
1207 | } | |
1208 | ||
baabb7f5 | 1209 | ignore_wmt_cmd: |
7f3c563c SW |
1210 | pm_runtime_put_noidle(bdev->dev); |
1211 | pm_runtime_disable(bdev->dev); | |
1212 | ||
9aebfd4a SW |
1213 | return 0; |
1214 | } | |
1215 | ||
1216 | static int btmtksdio_send_frame(struct hci_dev *hdev, struct sk_buff *skb) | |
1217 | { | |
1218 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
1219 | ||
1220 | switch (hci_skb_pkt_type(skb)) { | |
1221 | case HCI_COMMAND_PKT: | |
1222 | hdev->stat.cmd_tx++; | |
1223 | break; | |
1224 | ||
1225 | case HCI_ACLDATA_PKT: | |
1226 | hdev->stat.acl_tx++; | |
1227 | break; | |
1228 | ||
1229 | case HCI_SCODATA_PKT: | |
1230 | hdev->stat.sco_tx++; | |
1231 | break; | |
1232 | ||
1233 | default: | |
1234 | return -EILSEQ; | |
1235 | } | |
1236 | ||
1237 | skb_queue_tail(&bdev->txq, skb); | |
1238 | ||
26270bc1 | 1239 | schedule_work(&bdev->txrx_work); |
9aebfd4a SW |
1240 | |
1241 | return 0; | |
1242 | } | |
1243 | ||
8fafe702 CYC |
1244 | static void btmtksdio_cmd_timeout(struct hci_dev *hdev) |
1245 | { | |
1246 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
1247 | u32 status; | |
1248 | int err; | |
1249 | ||
1250 | if (!bdev->reset || bdev->data->chipid != 0x7921) | |
1251 | return; | |
1252 | ||
1253 | pm_runtime_get_sync(bdev->dev); | |
1254 | ||
1255 | if (test_and_set_bit(BTMTKSDIO_HW_RESET_ACTIVE, &bdev->tx_state)) | |
1256 | return; | |
1257 | ||
1258 | sdio_claim_host(bdev->func); | |
1259 | ||
1260 | sdio_writel(bdev->func, C_INT_EN_CLR, MTK_REG_CHLPCR, NULL); | |
1261 | skb_queue_purge(&bdev->txq); | |
1262 | cancel_work_sync(&bdev->txrx_work); | |
1263 | ||
1264 | gpiod_set_value_cansleep(bdev->reset, 1); | |
1265 | msleep(100); | |
1266 | gpiod_set_value_cansleep(bdev->reset, 0); | |
1267 | ||
1268 | err = readx_poll_timeout(btmtksdio_chcr_query, bdev, status, | |
1269 | status & BT_RST_DONE, 100000, 2000000); | |
1270 | if (err < 0) { | |
1271 | bt_dev_err(hdev, "Failed to reset (%d)", err); | |
1272 | goto err; | |
1273 | } | |
1274 | ||
1275 | clear_bit(BTMTKSDIO_PATCH_ENABLED, &bdev->tx_state); | |
1276 | err: | |
1277 | sdio_release_host(bdev->func); | |
1278 | ||
1279 | pm_runtime_put_noidle(bdev->dev); | |
1280 | pm_runtime_disable(bdev->dev); | |
1281 | ||
1282 | hci_reset_dev(hdev); | |
1283 | } | |
1284 | ||
df332800 SW |
1285 | static bool btmtksdio_sdio_inband_wakeup(struct hci_dev *hdev) |
1286 | { | |
1287 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
1288 | ||
1289 | return device_may_wakeup(bdev->dev); | |
1290 | } | |
1291 | ||
ce64b3e9 MC |
1292 | static bool btmtksdio_sdio_wakeup(struct hci_dev *hdev) |
1293 | { | |
1294 | struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); | |
1295 | bool may_wakeup = device_may_wakeup(bdev->dev); | |
1296 | const struct btmtk_wakeon bt_awake = { | |
1297 | .mode = 0x1, | |
1298 | .gpo = 0, | |
1299 | .active_high = 0x1, | |
1300 | .enable_delay = cpu_to_le16(0xc80), | |
1301 | .wakeup_delay = cpu_to_le16(0x20), | |
1302 | }; | |
1303 | ||
1304 | if (may_wakeup && bdev->data->chipid == 0x7921) { | |
1305 | struct sk_buff *skb; | |
1306 | ||
1307 | skb = __hci_cmd_sync(hdev, 0xfc27, sizeof(bt_awake), | |
1308 | &bt_awake, HCI_CMD_TIMEOUT); | |
1309 | if (IS_ERR(skb)) | |
1310 | may_wakeup = false; | |
eb3f0517 YY |
1311 | else |
1312 | kfree_skb(skb); | |
ce64b3e9 MC |
1313 | } |
1314 | ||
1315 | return may_wakeup; | |
1316 | } | |
1317 | ||
9aebfd4a SW |
1318 | static int btmtksdio_probe(struct sdio_func *func, |
1319 | const struct sdio_device_id *id) | |
1320 | { | |
1321 | struct btmtksdio_dev *bdev; | |
1322 | struct hci_dev *hdev; | |
1323 | int err; | |
1324 | ||
1325 | bdev = devm_kzalloc(&func->dev, sizeof(*bdev), GFP_KERNEL); | |
1326 | if (!bdev) | |
1327 | return -ENOMEM; | |
1328 | ||
1329 | bdev->data = (void *)id->driver_data; | |
1330 | if (!bdev->data) | |
1331 | return -ENODEV; | |
1332 | ||
7f3c563c | 1333 | bdev->dev = &func->dev; |
9aebfd4a SW |
1334 | bdev->func = func; |
1335 | ||
26270bc1 | 1336 | INIT_WORK(&bdev->txrx_work, btmtksdio_txrx_work); |
9aebfd4a SW |
1337 | skb_queue_head_init(&bdev->txq); |
1338 | ||
1339 | /* Initialize and register HCI device */ | |
1340 | hdev = hci_alloc_dev(); | |
1341 | if (!hdev) { | |
1342 | dev_err(&func->dev, "Can't allocate HCI device\n"); | |
1343 | return -ENOMEM; | |
1344 | } | |
1345 | ||
1346 | bdev->hdev = hdev; | |
1347 | ||
1348 | hdev->bus = HCI_SDIO; | |
1349 | hci_set_drvdata(hdev, bdev); | |
1350 | ||
1351 | hdev->open = btmtksdio_open; | |
1352 | hdev->close = btmtksdio_close; | |
8fafe702 | 1353 | hdev->cmd_timeout = btmtksdio_cmd_timeout; |
9aebfd4a SW |
1354 | hdev->flush = btmtksdio_flush; |
1355 | hdev->setup = btmtksdio_setup; | |
1356 | hdev->shutdown = btmtksdio_shutdown; | |
1357 | hdev->send = btmtksdio_send_frame; | |
ce64b3e9 | 1358 | hdev->wakeup = btmtksdio_sdio_wakeup; |
df332800 SW |
1359 | /* |
1360 | * If SDIO controller supports wake on Bluetooth, sending a wakeon | |
1361 | * command is not necessary. | |
1362 | */ | |
1363 | if (device_can_wakeup(func->card->host->parent)) | |
1364 | hdev->wakeup = btmtksdio_sdio_inband_wakeup; | |
1365 | else | |
1366 | hdev->wakeup = btmtksdio_sdio_wakeup; | |
877ec9e1 SW |
1367 | hdev->set_bdaddr = btmtk_set_bdaddr; |
1368 | ||
9aebfd4a SW |
1369 | SET_HCIDEV_DEV(hdev, &func->dev); |
1370 | ||
1371 | hdev->manufacturer = 70; | |
1372 | set_bit(HCI_QUIRK_NON_PERSISTENT_SETUP, &hdev->quirks); | |
1373 | ||
b062a0b9 YY |
1374 | sdio_set_drvdata(func, bdev); |
1375 | ||
9aebfd4a SW |
1376 | err = hci_register_dev(hdev); |
1377 | if (err < 0) { | |
1378 | dev_err(&func->dev, "Can't register HCI device\n"); | |
1379 | hci_free_dev(hdev); | |
1380 | return err; | |
1381 | } | |
1382 | ||
7f3c563c SW |
1383 | /* pm_runtime_enable would be done after the firmware is being |
1384 | * downloaded because the core layer probably already enables | |
1385 | * runtime PM for this func such as the case host->caps & | |
1386 | * MMC_CAP_POWER_OFF_CARD. | |
1387 | */ | |
1388 | if (pm_runtime_enabled(bdev->dev)) | |
1389 | pm_runtime_disable(bdev->dev); | |
1390 | ||
1391 | /* As explaination in drivers/mmc/core/sdio_bus.c tells us: | |
1392 | * Unbound SDIO functions are always suspended. | |
1393 | * During probe, the function is set active and the usage count | |
1394 | * is incremented. If the driver supports runtime PM, | |
1395 | * it should call pm_runtime_put_noidle() in its probe routine and | |
1396 | * pm_runtime_get_noresume() in its remove routine. | |
1397 | * | |
1398 | * So, put a pm_runtime_put_noidle here ! | |
1399 | */ | |
1400 | pm_runtime_put_noidle(bdev->dev); | |
1401 | ||
ce64b3e9 MC |
1402 | err = device_init_wakeup(bdev->dev, true); |
1403 | if (err) | |
1404 | bt_dev_err(hdev, "failed to initialize device wakeup"); | |
1405 | ||
8fafe702 CYC |
1406 | bdev->dev->of_node = of_find_compatible_node(NULL, NULL, |
1407 | "mediatek,mt7921s-bluetooth"); | |
1408 | bdev->reset = devm_gpiod_get_optional(bdev->dev, "reset", | |
1409 | GPIOD_OUT_LOW); | |
1410 | if (IS_ERR(bdev->reset)) | |
1411 | err = PTR_ERR(bdev->reset); | |
1412 | ||
ce64b3e9 | 1413 | return err; |
9aebfd4a SW |
1414 | } |
1415 | ||
1416 | static void btmtksdio_remove(struct sdio_func *func) | |
1417 | { | |
1418 | struct btmtksdio_dev *bdev = sdio_get_drvdata(func); | |
1419 | struct hci_dev *hdev; | |
1420 | ||
1421 | if (!bdev) | |
1422 | return; | |
1423 | ||
7f3c563c SW |
1424 | /* Be consistent the state in btmtksdio_probe */ |
1425 | pm_runtime_get_noresume(bdev->dev); | |
1426 | ||
9aebfd4a SW |
1427 | hdev = bdev->hdev; |
1428 | ||
1429 | sdio_set_drvdata(func, NULL); | |
1430 | hci_unregister_dev(hdev); | |
1431 | hci_free_dev(hdev); | |
1432 | } | |
1433 | ||
7f3c563c SW |
1434 | #ifdef CONFIG_PM |
1435 | static int btmtksdio_runtime_suspend(struct device *dev) | |
1436 | { | |
1437 | struct sdio_func *func = dev_to_sdio_func(dev); | |
1438 | struct btmtksdio_dev *bdev; | |
7f3c563c SW |
1439 | int err; |
1440 | ||
1441 | bdev = sdio_get_drvdata(func); | |
1442 | if (!bdev) | |
1443 | return 0; | |
1444 | ||
4b4b2228 SW |
1445 | if (!test_bit(BTMTKSDIO_FUNC_ENABLED, &bdev->tx_state)) |
1446 | return 0; | |
1447 | ||
561ae1d4 SW |
1448 | sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER); |
1449 | ||
c7e301d7 | 1450 | err = btmtksdio_fw_pmctrl(bdev); |
7f3c563c | 1451 | |
095519de | 1452 | bt_dev_dbg(bdev->hdev, "status (%d) return ownership to device", err); |
7f3c563c | 1453 | |
7f3c563c SW |
1454 | return err; |
1455 | } | |
1456 | ||
1457 | static int btmtksdio_runtime_resume(struct device *dev) | |
1458 | { | |
1459 | struct sdio_func *func = dev_to_sdio_func(dev); | |
1460 | struct btmtksdio_dev *bdev; | |
7f3c563c SW |
1461 | int err; |
1462 | ||
1463 | bdev = sdio_get_drvdata(func); | |
1464 | if (!bdev) | |
1465 | return 0; | |
1466 | ||
4b4b2228 SW |
1467 | if (!test_bit(BTMTKSDIO_FUNC_ENABLED, &bdev->tx_state)) |
1468 | return 0; | |
1469 | ||
c7e301d7 | 1470 | err = btmtksdio_drv_pmctrl(bdev); |
7f3c563c | 1471 | |
095519de | 1472 | bt_dev_dbg(bdev->hdev, "status (%d) get ownership from device", err); |
7f3c563c | 1473 | |
7f3c563c SW |
1474 | return err; |
1475 | } | |
1476 | ||
1477 | static UNIVERSAL_DEV_PM_OPS(btmtksdio_pm_ops, btmtksdio_runtime_suspend, | |
1478 | btmtksdio_runtime_resume, NULL); | |
1479 | #define BTMTKSDIO_PM_OPS (&btmtksdio_pm_ops) | |
1480 | #else /* CONFIG_PM */ | |
1481 | #define BTMTKSDIO_PM_OPS NULL | |
1482 | #endif /* CONFIG_PM */ | |
1483 | ||
9aebfd4a SW |
1484 | static struct sdio_driver btmtksdio_driver = { |
1485 | .name = "btmtksdio", | |
1486 | .probe = btmtksdio_probe, | |
1487 | .remove = btmtksdio_remove, | |
1488 | .id_table = btmtksdio_table, | |
7f3c563c SW |
1489 | .drv = { |
1490 | .owner = THIS_MODULE, | |
1491 | .pm = BTMTKSDIO_PM_OPS, | |
1492 | } | |
9aebfd4a SW |
1493 | }; |
1494 | ||
a6094a46 | 1495 | module_sdio_driver(btmtksdio_driver); |
9aebfd4a | 1496 | |
7f3c563c SW |
1497 | module_param(enable_autosuspend, bool, 0644); |
1498 | MODULE_PARM_DESC(enable_autosuspend, "Enable autosuspend by default"); | |
1499 | ||
9aebfd4a SW |
1500 | MODULE_AUTHOR("Sean Wang <sean.wang@mediatek.com>"); |
1501 | MODULE_DESCRIPTION("MediaTek Bluetooth SDIO driver ver " VERSION); | |
1502 | MODULE_VERSION(VERSION); | |
1503 | MODULE_LICENSE("GPL"); |