Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Marvell BT-over-SDIO driver: SDIO interface related functions.
4 *
5 * Copyright (C) 2009, Marvell International Ltd.
6 **/
7
8#include <linux/firmware.h>
9#include <linux/slab.h>
10#include <linux/suspend.h>
11
12#include <linux/mmc/sdio_ids.h>
13#include <linux/mmc/sdio_func.h>
14#include <linux/module.h>
15#include <linux/devcoredump.h>
16
17#include <net/bluetooth/bluetooth.h>
18#include <net/bluetooth/hci_core.h>
19
20#include "btmrvl_drv.h"
21#include "btmrvl_sdio.h"
22
23#define VERSION "1.0"
24
25static struct memory_type_mapping mem_type_mapping_tbl[] = {
26 {"ITCM", NULL, 0, 0xF0},
27 {"DTCM", NULL, 0, 0xF1},
28 {"SQRAM", NULL, 0, 0xF2},
29 {"APU", NULL, 0, 0xF3},
30 {"CIU", NULL, 0, 0xF4},
31 {"ICU", NULL, 0, 0xF5},
32 {"MAC", NULL, 0, 0xF6},
33 {"EXT7", NULL, 0, 0xF7},
34 {"EXT8", NULL, 0, 0xF8},
35 {"EXT9", NULL, 0, 0xF9},
36 {"EXT10", NULL, 0, 0xFA},
37 {"EXT11", NULL, 0, 0xFB},
38 {"EXT12", NULL, 0, 0xFC},
39 {"EXT13", NULL, 0, 0xFD},
40 {"EXTLAST", NULL, 0, 0xFE},
41};
42
43static const struct of_device_id btmrvl_sdio_of_match_table[] __maybe_unused = {
44 { .compatible = "marvell,sd8897-bt" },
45 { .compatible = "marvell,sd8997-bt" },
46 { }
47};
48
49static irqreturn_t btmrvl_wake_irq_bt(int irq, void *priv)
50{
51 struct btmrvl_sdio_card *card = priv;
52 struct device *dev = &card->func->dev;
53 struct btmrvl_plt_wake_cfg *cfg = card->plt_wake_cfg;
54
55 dev_info(dev, "wake by bt\n");
56 cfg->wake_by_bt = true;
57 disable_irq_nosync(irq);
58
59 pm_wakeup_event(dev, 0);
60 pm_system_wakeup();
61
62 return IRQ_HANDLED;
63}
64
65/* This function parses device tree node using mmc subnode devicetree API.
66 * The device node is saved in card->plt_of_node.
67 * If the device tree node exists and includes interrupts attributes, this
68 * function will request platform specific wakeup interrupt.
69 */
70static int btmrvl_sdio_probe_of(struct device *dev,
71 struct btmrvl_sdio_card *card)
72{
73 struct btmrvl_plt_wake_cfg *cfg;
74 int ret;
75
76 if (!dev->of_node ||
77 !of_match_node(btmrvl_sdio_of_match_table, dev->of_node)) {
78 dev_info(dev, "sdio device tree data not available\n");
79 return -1;
80 }
81
82 card->plt_of_node = dev->of_node;
83
84 card->plt_wake_cfg = devm_kzalloc(dev, sizeof(*card->plt_wake_cfg),
85 GFP_KERNEL);
86 cfg = card->plt_wake_cfg;
87 if (cfg && card->plt_of_node) {
88 cfg->irq_bt = irq_of_parse_and_map(card->plt_of_node, 0);
89 if (!cfg->irq_bt) {
90 dev_err(dev, "fail to parse irq_bt from device tree\n");
91 cfg->irq_bt = -1;
92 } else {
93 ret = devm_request_irq(dev, cfg->irq_bt,
94 btmrvl_wake_irq_bt,
95 IRQF_NO_AUTOEN, "bt_wake", card);
96 if (ret) {
97 dev_err(dev,
98 "Failed to request irq_bt %d (%d)\n",
99 cfg->irq_bt, ret);
100 }
101
102 /* Configure wakeup (enabled by default) */
103 device_init_wakeup(dev, true);
104 }
105 }
106
107 return 0;
108}
109
110/* The btmrvl_sdio_remove() callback function is called
111 * when user removes this module from kernel space or ejects
112 * the card from the slot. The driver handles these 2 cases
113 * differently.
114 * If the user is removing the module, a MODULE_SHUTDOWN_REQ
115 * command is sent to firmware and interrupt will be disabled.
116 * If the card is removed, there is no need to send command
117 * or disable interrupt.
118 *
119 * The variable 'user_rmmod' is used to distinguish these two
120 * scenarios. This flag is initialized as FALSE in case the card
121 * is removed, and will be set to TRUE for module removal when
122 * module_exit function is called.
123 */
124static u8 user_rmmod;
125static u8 sdio_ireg;
126
127static const struct btmrvl_sdio_card_reg btmrvl_reg_8688 = {
128 .cfg = 0x03,
129 .host_int_mask = 0x04,
130 .host_intstatus = 0x05,
131 .card_status = 0x20,
132 .sq_read_base_addr_a0 = 0x10,
133 .sq_read_base_addr_a1 = 0x11,
134 .card_fw_status0 = 0x40,
135 .card_fw_status1 = 0x41,
136 .card_rx_len = 0x42,
137 .card_rx_unit = 0x43,
138 .io_port_0 = 0x00,
139 .io_port_1 = 0x01,
140 .io_port_2 = 0x02,
141 .int_read_to_clear = false,
142};
143static const struct btmrvl_sdio_card_reg btmrvl_reg_87xx = {
144 .cfg = 0x00,
145 .host_int_mask = 0x02,
146 .host_intstatus = 0x03,
147 .card_status = 0x30,
148 .sq_read_base_addr_a0 = 0x40,
149 .sq_read_base_addr_a1 = 0x41,
150 .card_revision = 0x5c,
151 .card_fw_status0 = 0x60,
152 .card_fw_status1 = 0x61,
153 .card_rx_len = 0x62,
154 .card_rx_unit = 0x63,
155 .io_port_0 = 0x78,
156 .io_port_1 = 0x79,
157 .io_port_2 = 0x7a,
158 .int_read_to_clear = false,
159};
160
161static const struct btmrvl_sdio_card_reg btmrvl_reg_8887 = {
162 .cfg = 0x00,
163 .host_int_mask = 0x08,
164 .host_intstatus = 0x0C,
165 .card_status = 0x5C,
166 .sq_read_base_addr_a0 = 0x6C,
167 .sq_read_base_addr_a1 = 0x6D,
168 .card_revision = 0xC8,
169 .card_fw_status0 = 0x88,
170 .card_fw_status1 = 0x89,
171 .card_rx_len = 0x8A,
172 .card_rx_unit = 0x8B,
173 .io_port_0 = 0xE4,
174 .io_port_1 = 0xE5,
175 .io_port_2 = 0xE6,
176 .int_read_to_clear = true,
177 .host_int_rsr = 0x04,
178 .card_misc_cfg = 0xD8,
179};
180
181static const struct btmrvl_sdio_card_reg btmrvl_reg_8897 = {
182 .cfg = 0x00,
183 .host_int_mask = 0x02,
184 .host_intstatus = 0x03,
185 .card_status = 0x50,
186 .sq_read_base_addr_a0 = 0x60,
187 .sq_read_base_addr_a1 = 0x61,
188 .card_revision = 0xbc,
189 .card_fw_status0 = 0xc0,
190 .card_fw_status1 = 0xc1,
191 .card_rx_len = 0xc2,
192 .card_rx_unit = 0xc3,
193 .io_port_0 = 0xd8,
194 .io_port_1 = 0xd9,
195 .io_port_2 = 0xda,
196 .int_read_to_clear = true,
197 .host_int_rsr = 0x01,
198 .card_misc_cfg = 0xcc,
199 .fw_dump_ctrl = 0xe2,
200 .fw_dump_start = 0xe3,
201 .fw_dump_end = 0xea,
202};
203
204static const struct btmrvl_sdio_card_reg btmrvl_reg_89xx = {
205 .cfg = 0x00,
206 .host_int_mask = 0x08,
207 .host_intstatus = 0x0c,
208 .card_status = 0x5c,
209 .sq_read_base_addr_a0 = 0xf8,
210 .sq_read_base_addr_a1 = 0xf9,
211 .card_revision = 0xc8,
212 .card_fw_status0 = 0xe8,
213 .card_fw_status1 = 0xe9,
214 .card_rx_len = 0xea,
215 .card_rx_unit = 0xeb,
216 .io_port_0 = 0xe4,
217 .io_port_1 = 0xe5,
218 .io_port_2 = 0xe6,
219 .int_read_to_clear = true,
220 .host_int_rsr = 0x04,
221 .card_misc_cfg = 0xd8,
222 .fw_dump_ctrl = 0xf0,
223 .fw_dump_start = 0xf1,
224 .fw_dump_end = 0xf8,
225};
226
227static const struct btmrvl_sdio_device btmrvl_sdio_sd8688 = {
228 .helper = "mrvl/sd8688_helper.bin",
229 .firmware = "mrvl/sd8688.bin",
230 .reg = &btmrvl_reg_8688,
231 .support_pscan_win_report = false,
232 .sd_blksz_fw_dl = 64,
233 .supports_fw_dump = false,
234};
235
236static const struct btmrvl_sdio_device btmrvl_sdio_sd8787 = {
237 .helper = NULL,
238 .firmware = "mrvl/sd8787_uapsta.bin",
239 .reg = &btmrvl_reg_87xx,
240 .support_pscan_win_report = false,
241 .sd_blksz_fw_dl = 256,
242 .supports_fw_dump = false,
243};
244
245static const struct btmrvl_sdio_device btmrvl_sdio_sd8797 = {
246 .helper = NULL,
247 .firmware = "mrvl/sd8797_uapsta.bin",
248 .reg = &btmrvl_reg_87xx,
249 .support_pscan_win_report = false,
250 .sd_blksz_fw_dl = 256,
251 .supports_fw_dump = false,
252};
253
254static const struct btmrvl_sdio_device btmrvl_sdio_sd8887 = {
255 .helper = NULL,
256 .firmware = "mrvl/sd8887_uapsta.bin",
257 .reg = &btmrvl_reg_8887,
258 .support_pscan_win_report = true,
259 .sd_blksz_fw_dl = 256,
260 .supports_fw_dump = false,
261};
262
263static const struct btmrvl_sdio_device btmrvl_sdio_sd8897 = {
264 .helper = NULL,
265 .firmware = "mrvl/sd8897_uapsta.bin",
266 .reg = &btmrvl_reg_8897,
267 .support_pscan_win_report = true,
268 .sd_blksz_fw_dl = 256,
269 .supports_fw_dump = true,
270};
271
272static const struct btmrvl_sdio_device btmrvl_sdio_sd8977 = {
273 .helper = NULL,
274 .firmware = "mrvl/sdsd8977_combo_v2.bin",
275 .reg = &btmrvl_reg_89xx,
276 .support_pscan_win_report = true,
277 .sd_blksz_fw_dl = 256,
278 .supports_fw_dump = true,
279};
280
281static const struct btmrvl_sdio_device btmrvl_sdio_sd8987 = {
282 .helper = NULL,
283 .firmware = "mrvl/sd8987_uapsta.bin",
284 .reg = &btmrvl_reg_89xx,
285 .support_pscan_win_report = true,
286 .sd_blksz_fw_dl = 256,
287 .supports_fw_dump = true,
288};
289
290static const struct btmrvl_sdio_device btmrvl_sdio_sd8997 = {
291 .helper = NULL,
292 .firmware = "mrvl/sdsd8997_combo_v4.bin",
293 .reg = &btmrvl_reg_89xx,
294 .support_pscan_win_report = true,
295 .sd_blksz_fw_dl = 256,
296 .supports_fw_dump = true,
297};
298
299static const struct sdio_device_id btmrvl_sdio_ids[] = {
300 /* Marvell SD8688 Bluetooth device */
301 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8688_BT),
302 .driver_data = (unsigned long)&btmrvl_sdio_sd8688 },
303 /* Marvell SD8787 Bluetooth device */
304 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8787_BT),
305 .driver_data = (unsigned long)&btmrvl_sdio_sd8787 },
306 /* Marvell SD8787 Bluetooth AMP device */
307 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8787_BT_AMP),
308 .driver_data = (unsigned long)&btmrvl_sdio_sd8787 },
309 /* Marvell SD8797 Bluetooth device */
310 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8797_BT),
311 .driver_data = (unsigned long)&btmrvl_sdio_sd8797 },
312 /* Marvell SD8887 Bluetooth device */
313 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8887_BT),
314 .driver_data = (unsigned long)&btmrvl_sdio_sd8887 },
315 /* Marvell SD8897 Bluetooth device */
316 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8897_BT),
317 .driver_data = (unsigned long)&btmrvl_sdio_sd8897 },
318 /* Marvell SD8977 Bluetooth device */
319 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8977_BT),
320 .driver_data = (unsigned long)&btmrvl_sdio_sd8977 },
321 /* Marvell SD8987 Bluetooth device */
322 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8987_BT),
323 .driver_data = (unsigned long)&btmrvl_sdio_sd8987 },
324 /* Marvell SD8997 Bluetooth device */
325 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8997_BT),
326 .driver_data = (unsigned long)&btmrvl_sdio_sd8997 },
327
328 { } /* Terminating entry */
329};
330
331MODULE_DEVICE_TABLE(sdio, btmrvl_sdio_ids);
332
333static int btmrvl_sdio_get_rx_unit(struct btmrvl_sdio_card *card)
334{
335 u8 reg;
336 int ret;
337
338 reg = sdio_readb(card->func, card->reg->card_rx_unit, &ret);
339 if (!ret)
340 card->rx_unit = reg;
341
342 return ret;
343}
344
345static int btmrvl_sdio_read_fw_status(struct btmrvl_sdio_card *card, u16 *dat)
346{
347 u8 fws0, fws1;
348 int ret;
349
350 *dat = 0;
351
352 fws0 = sdio_readb(card->func, card->reg->card_fw_status0, &ret);
353 if (ret)
354 return -EIO;
355
356 fws1 = sdio_readb(card->func, card->reg->card_fw_status1, &ret);
357 if (ret)
358 return -EIO;
359
360 *dat = (((u16) fws1) << 8) | fws0;
361
362 return 0;
363}
364
365static int btmrvl_sdio_read_rx_len(struct btmrvl_sdio_card *card, u16 *dat)
366{
367 u8 reg;
368 int ret;
369
370 reg = sdio_readb(card->func, card->reg->card_rx_len, &ret);
371 if (!ret)
372 *dat = (u16) reg << card->rx_unit;
373
374 return ret;
375}
376
377static int btmrvl_sdio_enable_host_int_mask(struct btmrvl_sdio_card *card,
378 u8 mask)
379{
380 int ret;
381
382 sdio_writeb(card->func, mask, card->reg->host_int_mask, &ret);
383 if (ret) {
384 BT_ERR("Unable to enable the host interrupt!");
385 ret = -EIO;
386 }
387
388 return ret;
389}
390
391static int btmrvl_sdio_disable_host_int_mask(struct btmrvl_sdio_card *card,
392 u8 mask)
393{
394 u8 host_int_mask;
395 int ret;
396
397 host_int_mask = sdio_readb(card->func, card->reg->host_int_mask, &ret);
398 if (ret)
399 return -EIO;
400
401 host_int_mask &= ~mask;
402
403 sdio_writeb(card->func, host_int_mask, card->reg->host_int_mask, &ret);
404 if (ret < 0) {
405 BT_ERR("Unable to disable the host interrupt!");
406 return -EIO;
407 }
408
409 return 0;
410}
411
412static int btmrvl_sdio_poll_card_status(struct btmrvl_sdio_card *card, u8 bits)
413{
414 unsigned int tries;
415 u8 status;
416 int ret;
417
418 for (tries = 0; tries < MAX_POLL_TRIES * 1000; tries++) {
419 status = sdio_readb(card->func, card->reg->card_status, &ret);
420 if (ret)
421 goto failed;
422 if ((status & bits) == bits)
423 return ret;
424
425 udelay(1);
426 }
427
428 ret = -ETIMEDOUT;
429
430failed:
431 BT_ERR("FAILED! ret=%d", ret);
432
433 return ret;
434}
435
436static int btmrvl_sdio_verify_fw_download(struct btmrvl_sdio_card *card,
437 int pollnum)
438{
439 u16 firmwarestat;
440 int tries, ret;
441
442 /* Wait for firmware to become ready */
443 for (tries = 0; tries < pollnum; tries++) {
444 sdio_claim_host(card->func);
445 ret = btmrvl_sdio_read_fw_status(card, &firmwarestat);
446 sdio_release_host(card->func);
447 if (ret < 0)
448 continue;
449
450 if (firmwarestat == FIRMWARE_READY)
451 return 0;
452
453 msleep(100);
454 }
455
456 return -ETIMEDOUT;
457}
458
459static int btmrvl_sdio_download_helper(struct btmrvl_sdio_card *card)
460{
461 const struct firmware *fw_helper = NULL;
462 const u8 *helper = NULL;
463 int ret;
464 void *tmphlprbuf = NULL;
465 int tmphlprbufsz, hlprblknow, helperlen;
466 u8 *helperbuf;
467 u32 tx_len;
468
469 ret = request_firmware(&fw_helper, card->helper,
470 &card->func->dev);
471 if ((ret < 0) || !fw_helper) {
472 BT_ERR("request_firmware(helper) failed, error code = %d",
473 ret);
474 ret = -ENOENT;
475 goto done;
476 }
477
478 helper = fw_helper->data;
479 helperlen = fw_helper->size;
480
481 BT_DBG("Downloading helper image (%d bytes), block size %d bytes",
482 helperlen, SDIO_BLOCK_SIZE);
483
484 tmphlprbufsz = ALIGN_SZ(BTM_UPLD_SIZE, BTSDIO_DMA_ALIGN);
485
486 tmphlprbuf = kzalloc(tmphlprbufsz, GFP_KERNEL);
487 if (!tmphlprbuf) {
488 BT_ERR("Unable to allocate buffer for helper."
489 " Terminating download");
490 ret = -ENOMEM;
491 goto done;
492 }
493
494 helperbuf = (u8 *) ALIGN_ADDR(tmphlprbuf, BTSDIO_DMA_ALIGN);
495
496 /* Perform helper data transfer */
497 tx_len = (FIRMWARE_TRANSFER_NBLOCK * SDIO_BLOCK_SIZE)
498 - SDIO_HEADER_LEN;
499 hlprblknow = 0;
500
501 do {
502 ret = btmrvl_sdio_poll_card_status(card,
503 CARD_IO_READY | DN_LD_CARD_RDY);
504 if (ret < 0) {
505 BT_ERR("Helper download poll status timeout @ %d",
506 hlprblknow);
507 goto done;
508 }
509
510 /* Check if there is more data? */
511 if (hlprblknow >= helperlen)
512 break;
513
514 if (helperlen - hlprblknow < tx_len)
515 tx_len = helperlen - hlprblknow;
516
517 /* Little-endian */
518 helperbuf[0] = ((tx_len & 0x000000ff) >> 0);
519 helperbuf[1] = ((tx_len & 0x0000ff00) >> 8);
520 helperbuf[2] = ((tx_len & 0x00ff0000) >> 16);
521 helperbuf[3] = ((tx_len & 0xff000000) >> 24);
522
523 memcpy(&helperbuf[SDIO_HEADER_LEN], &helper[hlprblknow],
524 tx_len);
525
526 /* Now send the data */
527 ret = sdio_writesb(card->func, card->ioport, helperbuf,
528 FIRMWARE_TRANSFER_NBLOCK * SDIO_BLOCK_SIZE);
529 if (ret < 0) {
530 BT_ERR("IO error during helper download @ %d",
531 hlprblknow);
532 goto done;
533 }
534
535 hlprblknow += tx_len;
536 } while (true);
537
538 BT_DBG("Transferring helper image EOF block");
539
540 memset(helperbuf, 0x0, SDIO_BLOCK_SIZE);
541
542 ret = sdio_writesb(card->func, card->ioport, helperbuf,
543 SDIO_BLOCK_SIZE);
544 if (ret < 0) {
545 BT_ERR("IO error in writing helper image EOF block");
546 goto done;
547 }
548
549 ret = 0;
550
551done:
552 kfree(tmphlprbuf);
553 release_firmware(fw_helper);
554 return ret;
555}
556
557static int btmrvl_sdio_download_fw_w_helper(struct btmrvl_sdio_card *card)
558{
559 const struct firmware *fw_firmware = NULL;
560 const u8 *firmware = NULL;
561 int firmwarelen, tmpfwbufsz, ret;
562 unsigned int tries, offset;
563 u8 base0, base1;
564 void *tmpfwbuf = NULL;
565 u8 *fwbuf;
566 u16 len, blksz_dl = card->sd_blksz_fw_dl;
567 int txlen = 0, tx_blocks = 0, count = 0;
568
569 ret = request_firmware(&fw_firmware, card->firmware,
570 &card->func->dev);
571 if ((ret < 0) || !fw_firmware) {
572 BT_ERR("request_firmware(firmware) failed, error code = %d",
573 ret);
574 ret = -ENOENT;
575 goto done;
576 }
577
578 firmware = fw_firmware->data;
579 firmwarelen = fw_firmware->size;
580
581 BT_DBG("Downloading FW image (%d bytes)", firmwarelen);
582
583 tmpfwbufsz = ALIGN_SZ(BTM_UPLD_SIZE, BTSDIO_DMA_ALIGN);
584 tmpfwbuf = kzalloc(tmpfwbufsz, GFP_KERNEL);
585 if (!tmpfwbuf) {
586 BT_ERR("Unable to allocate buffer for firmware."
587 " Terminating download");
588 ret = -ENOMEM;
589 goto done;
590 }
591
592 /* Ensure aligned firmware buffer */
593 fwbuf = (u8 *) ALIGN_ADDR(tmpfwbuf, BTSDIO_DMA_ALIGN);
594
595 /* Perform firmware data transfer */
596 offset = 0;
597 do {
598 ret = btmrvl_sdio_poll_card_status(card,
599 CARD_IO_READY | DN_LD_CARD_RDY);
600 if (ret < 0) {
601 BT_ERR("FW download with helper poll status"
602 " timeout @ %d", offset);
603 goto done;
604 }
605
606 /* Check if there is more data ? */
607 if (offset >= firmwarelen)
608 break;
609
610 for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
611 base0 = sdio_readb(card->func,
612 card->reg->sq_read_base_addr_a0, &ret);
613 if (ret) {
614 BT_ERR("BASE0 register read failed:"
615 " base0 = 0x%04X(%d)."
616 " Terminating download",
617 base0, base0);
618 ret = -EIO;
619 goto done;
620 }
621 base1 = sdio_readb(card->func,
622 card->reg->sq_read_base_addr_a1, &ret);
623 if (ret) {
624 BT_ERR("BASE1 register read failed:"
625 " base1 = 0x%04X(%d)."
626 " Terminating download",
627 base1, base1);
628 ret = -EIO;
629 goto done;
630 }
631
632 len = (((u16) base1) << 8) | base0;
633 if (len)
634 break;
635
636 udelay(10);
637 }
638
639 if (!len)
640 break;
641 else if (len > BTM_UPLD_SIZE) {
642 BT_ERR("FW download failure @%d, invalid length %d",
643 offset, len);
644 ret = -EINVAL;
645 goto done;
646 }
647
648 txlen = len;
649
650 if (len & BIT(0)) {
651 count++;
652 if (count > MAX_WRITE_IOMEM_RETRY) {
653 BT_ERR("FW download failure @%d, "
654 "over max retry count", offset);
655 ret = -EIO;
656 goto done;
657 }
658 BT_ERR("FW CRC error indicated by the helper: "
659 "len = 0x%04X, txlen = %d", len, txlen);
660 len &= ~BIT(0);
661 /* Set txlen to 0 so as to resend from same offset */
662 txlen = 0;
663 } else {
664 count = 0;
665
666 /* Last block ? */
667 if (firmwarelen - offset < txlen)
668 txlen = firmwarelen - offset;
669
670 tx_blocks = DIV_ROUND_UP(txlen, blksz_dl);
671
672 memcpy(fwbuf, &firmware[offset], txlen);
673 }
674
675 ret = sdio_writesb(card->func, card->ioport, fwbuf,
676 tx_blocks * blksz_dl);
677
678 if (ret < 0) {
679 BT_ERR("FW download, writesb(%d) failed @%d",
680 count, offset);
681 sdio_writeb(card->func, HOST_CMD53_FIN,
682 card->reg->cfg, &ret);
683 if (ret)
684 BT_ERR("writeb failed (CFG)");
685 }
686
687 offset += txlen;
688 } while (true);
689
690 BT_INFO("FW download over, size %d bytes", offset);
691
692 ret = 0;
693
694done:
695 kfree(tmpfwbuf);
696 release_firmware(fw_firmware);
697 return ret;
698}
699
700static int btmrvl_sdio_card_to_host(struct btmrvl_private *priv)
701{
702 u16 buf_len = 0;
703 int ret, num_blocks, blksz;
704 struct sk_buff *skb = NULL;
705 u32 type;
706 u8 *payload;
707 struct hci_dev *hdev = priv->btmrvl_dev.hcidev;
708 struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
709
710 if (!card || !card->func) {
711 BT_ERR("card or function is NULL!");
712 ret = -EINVAL;
713 goto exit;
714 }
715
716 /* Read the length of data to be transferred */
717 ret = btmrvl_sdio_read_rx_len(card, &buf_len);
718 if (ret < 0) {
719 BT_ERR("read rx_len failed");
720 ret = -EIO;
721 goto exit;
722 }
723
724 blksz = SDIO_BLOCK_SIZE;
725 num_blocks = DIV_ROUND_UP(buf_len, blksz);
726
727 if (buf_len <= SDIO_HEADER_LEN
728 || (num_blocks * blksz) > ALLOC_BUF_SIZE) {
729 BT_ERR("invalid packet length: %d", buf_len);
730 ret = -EINVAL;
731 goto exit;
732 }
733
734 /* Allocate buffer */
735 skb = bt_skb_alloc(num_blocks * blksz + BTSDIO_DMA_ALIGN, GFP_KERNEL);
736 if (!skb) {
737 BT_ERR("No free skb");
738 ret = -ENOMEM;
739 goto exit;
740 }
741
742 if ((unsigned long) skb->data & (BTSDIO_DMA_ALIGN - 1)) {
743 skb_put(skb, (unsigned long) skb->data &
744 (BTSDIO_DMA_ALIGN - 1));
745 skb_pull(skb, (unsigned long) skb->data &
746 (BTSDIO_DMA_ALIGN - 1));
747 }
748
749 payload = skb->data;
750
751 ret = sdio_readsb(card->func, payload, card->ioport,
752 num_blocks * blksz);
753 if (ret < 0) {
754 BT_ERR("readsb failed: %d", ret);
755 ret = -EIO;
756 goto exit;
757 }
758
759 /* This is SDIO specific header length: byte[2][1][0], type: byte[3]
760 * (HCI_COMMAND = 1, ACL_DATA = 2, SCO_DATA = 3, 0xFE = Vendor)
761 */
762
763 buf_len = payload[0];
764 buf_len |= payload[1] << 8;
765 buf_len |= payload[2] << 16;
766
767 if (buf_len > blksz * num_blocks) {
768 BT_ERR("Skip incorrect packet: hdrlen %d buffer %d",
769 buf_len, blksz * num_blocks);
770 ret = -EIO;
771 goto exit;
772 }
773
774 type = payload[3];
775
776 switch (type) {
777 case HCI_ACLDATA_PKT:
778 case HCI_SCODATA_PKT:
779 case HCI_EVENT_PKT:
780 hci_skb_pkt_type(skb) = type;
781 skb_put(skb, buf_len);
782 skb_pull(skb, SDIO_HEADER_LEN);
783
784 if (type == HCI_EVENT_PKT) {
785 if (btmrvl_check_evtpkt(priv, skb))
786 hci_recv_frame(hdev, skb);
787 } else {
788 hci_recv_frame(hdev, skb);
789 }
790
791 hdev->stat.byte_rx += buf_len;
792 break;
793
794 case MRVL_VENDOR_PKT:
795 hci_skb_pkt_type(skb) = HCI_VENDOR_PKT;
796 skb_put(skb, buf_len);
797 skb_pull(skb, SDIO_HEADER_LEN);
798
799 if (btmrvl_process_event(priv, skb))
800 hci_recv_frame(hdev, skb);
801
802 hdev->stat.byte_rx += buf_len;
803 break;
804
805 default:
806 BT_ERR("Unknown packet type:%d", type);
807 BT_ERR("hex: %*ph", blksz * num_blocks, payload);
808
809 kfree_skb(skb);
810 skb = NULL;
811 break;
812 }
813
814exit:
815 if (ret) {
816 hdev->stat.err_rx++;
817 kfree_skb(skb);
818 }
819
820 return ret;
821}
822
823static int btmrvl_sdio_process_int_status(struct btmrvl_private *priv)
824{
825 ulong flags;
826 u8 ireg;
827 struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
828
829 spin_lock_irqsave(&priv->driver_lock, flags);
830 ireg = sdio_ireg;
831 sdio_ireg = 0;
832 spin_unlock_irqrestore(&priv->driver_lock, flags);
833
834 sdio_claim_host(card->func);
835 if (ireg & DN_LD_HOST_INT_STATUS) {
836 if (priv->btmrvl_dev.tx_dnld_rdy)
837 BT_DBG("tx_done already received: "
838 " int_status=0x%x", ireg);
839 else
840 priv->btmrvl_dev.tx_dnld_rdy = true;
841 }
842
843 if (ireg & UP_LD_HOST_INT_STATUS)
844 btmrvl_sdio_card_to_host(priv);
845
846 sdio_release_host(card->func);
847
848 return 0;
849}
850
851static int btmrvl_sdio_read_to_clear(struct btmrvl_sdio_card *card, u8 *ireg)
852{
853 struct btmrvl_adapter *adapter = card->priv->adapter;
854 int ret;
855
856 ret = sdio_readsb(card->func, adapter->hw_regs, 0, SDIO_BLOCK_SIZE);
857 if (ret) {
858 BT_ERR("sdio_readsb: read int hw_regs failed: %d", ret);
859 return ret;
860 }
861
862 *ireg = adapter->hw_regs[card->reg->host_intstatus];
863 BT_DBG("hw_regs[%#x]=%#x", card->reg->host_intstatus, *ireg);
864
865 return 0;
866}
867
868static int btmrvl_sdio_write_to_clear(struct btmrvl_sdio_card *card, u8 *ireg)
869{
870 int ret;
871
872 *ireg = sdio_readb(card->func, card->reg->host_intstatus, &ret);
873 if (ret) {
874 BT_ERR("sdio_readb: read int status failed: %d", ret);
875 return ret;
876 }
877
878 if (*ireg) {
879 /*
880 * DN_LD_HOST_INT_STATUS and/or UP_LD_HOST_INT_STATUS
881 * Clear the interrupt status register and re-enable the
882 * interrupt.
883 */
884 BT_DBG("int_status = 0x%x", *ireg);
885
886 sdio_writeb(card->func, ~(*ireg) & (DN_LD_HOST_INT_STATUS |
887 UP_LD_HOST_INT_STATUS),
888 card->reg->host_intstatus, &ret);
889 if (ret) {
890 BT_ERR("sdio_writeb: clear int status failed: %d", ret);
891 return ret;
892 }
893 }
894
895 return 0;
896}
897
898static void btmrvl_sdio_interrupt(struct sdio_func *func)
899{
900 struct btmrvl_private *priv;
901 struct btmrvl_sdio_card *card;
902 ulong flags;
903 u8 ireg = 0;
904 int ret;
905
906 card = sdio_get_drvdata(func);
907 if (!card || !card->priv) {
908 BT_ERR("sbi_interrupt(%p) card or priv is NULL, card=%p",
909 func, card);
910 return;
911 }
912
913 priv = card->priv;
914
915 if (priv->surprise_removed)
916 return;
917
918 if (card->reg->int_read_to_clear)
919 ret = btmrvl_sdio_read_to_clear(card, &ireg);
920 else
921 ret = btmrvl_sdio_write_to_clear(card, &ireg);
922
923 if (ret)
924 return;
925
926 spin_lock_irqsave(&priv->driver_lock, flags);
927 sdio_ireg |= ireg;
928 spin_unlock_irqrestore(&priv->driver_lock, flags);
929
930 btmrvl_interrupt(priv);
931}
932
933static int btmrvl_sdio_register_dev(struct btmrvl_sdio_card *card)
934{
935 struct sdio_func *func;
936 u8 reg;
937 int ret;
938
939 if (!card || !card->func) {
940 BT_ERR("Error: card or function is NULL!");
941 ret = -EINVAL;
942 goto failed;
943 }
944
945 func = card->func;
946
947 sdio_claim_host(func);
948
949 ret = sdio_enable_func(func);
950 if (ret) {
951 BT_ERR("sdio_enable_func() failed: ret=%d", ret);
952 ret = -EIO;
953 goto release_host;
954 }
955
956 ret = sdio_claim_irq(func, btmrvl_sdio_interrupt);
957 if (ret) {
958 BT_ERR("sdio_claim_irq failed: ret=%d", ret);
959 ret = -EIO;
960 goto disable_func;
961 }
962
963 ret = sdio_set_block_size(card->func, SDIO_BLOCK_SIZE);
964 if (ret) {
965 BT_ERR("cannot set SDIO block size");
966 ret = -EIO;
967 goto release_irq;
968 }
969
970 reg = sdio_readb(func, card->reg->io_port_0, &ret);
971 if (ret < 0) {
972 ret = -EIO;
973 goto release_irq;
974 }
975
976 card->ioport = reg;
977
978 reg = sdio_readb(func, card->reg->io_port_1, &ret);
979 if (ret < 0) {
980 ret = -EIO;
981 goto release_irq;
982 }
983
984 card->ioport |= (reg << 8);
985
986 reg = sdio_readb(func, card->reg->io_port_2, &ret);
987 if (ret < 0) {
988 ret = -EIO;
989 goto release_irq;
990 }
991
992 card->ioport |= (reg << 16);
993
994 BT_DBG("SDIO FUNC%d IO port: 0x%x", func->num, card->ioport);
995
996 if (card->reg->int_read_to_clear) {
997 reg = sdio_readb(func, card->reg->host_int_rsr, &ret);
998 if (ret < 0) {
999 ret = -EIO;
1000 goto release_irq;
1001 }
1002 sdio_writeb(func, reg | 0x3f, card->reg->host_int_rsr, &ret);
1003 if (ret < 0) {
1004 ret = -EIO;
1005 goto release_irq;
1006 }
1007
1008 reg = sdio_readb(func, card->reg->card_misc_cfg, &ret);
1009 if (ret < 0) {
1010 ret = -EIO;
1011 goto release_irq;
1012 }
1013 sdio_writeb(func, reg | 0x10, card->reg->card_misc_cfg, &ret);
1014 if (ret < 0) {
1015 ret = -EIO;
1016 goto release_irq;
1017 }
1018 }
1019
1020 sdio_set_drvdata(func, card);
1021
1022 sdio_release_host(func);
1023
1024 return 0;
1025
1026release_irq:
1027 sdio_release_irq(func);
1028
1029disable_func:
1030 sdio_disable_func(func);
1031
1032release_host:
1033 sdio_release_host(func);
1034
1035failed:
1036 return ret;
1037}
1038
1039static int btmrvl_sdio_unregister_dev(struct btmrvl_sdio_card *card)
1040{
1041 if (card && card->func) {
1042 sdio_claim_host(card->func);
1043 sdio_release_irq(card->func);
1044 sdio_disable_func(card->func);
1045 sdio_release_host(card->func);
1046 sdio_set_drvdata(card->func, NULL);
1047 }
1048
1049 return 0;
1050}
1051
1052static int btmrvl_sdio_enable_host_int(struct btmrvl_sdio_card *card)
1053{
1054 int ret;
1055
1056 if (!card || !card->func)
1057 return -EINVAL;
1058
1059 sdio_claim_host(card->func);
1060
1061 ret = btmrvl_sdio_enable_host_int_mask(card, HIM_ENABLE);
1062
1063 btmrvl_sdio_get_rx_unit(card);
1064
1065 sdio_release_host(card->func);
1066
1067 return ret;
1068}
1069
1070static int btmrvl_sdio_disable_host_int(struct btmrvl_sdio_card *card)
1071{
1072 int ret;
1073
1074 if (!card || !card->func)
1075 return -EINVAL;
1076
1077 sdio_claim_host(card->func);
1078
1079 ret = btmrvl_sdio_disable_host_int_mask(card, HIM_DISABLE);
1080
1081 sdio_release_host(card->func);
1082
1083 return ret;
1084}
1085
1086static int btmrvl_sdio_host_to_card(struct btmrvl_private *priv,
1087 u8 *payload, u16 nb)
1088{
1089 struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
1090 int ret = 0;
1091 int blksz;
1092 int i = 0;
1093 u8 *buf = NULL;
1094 void *tmpbuf = NULL;
1095 int tmpbufsz;
1096
1097 if (!card || !card->func) {
1098 BT_ERR("card or function is NULL!");
1099 return -EINVAL;
1100 }
1101
1102 blksz = DIV_ROUND_UP(nb, SDIO_BLOCK_SIZE) * SDIO_BLOCK_SIZE;
1103
1104 buf = payload;
1105 if ((unsigned long) payload & (BTSDIO_DMA_ALIGN - 1) ||
1106 nb < blksz) {
1107 tmpbufsz = ALIGN_SZ(blksz, BTSDIO_DMA_ALIGN) +
1108 BTSDIO_DMA_ALIGN;
1109 tmpbuf = kzalloc(tmpbufsz, GFP_KERNEL);
1110 if (!tmpbuf)
1111 return -ENOMEM;
1112 buf = (u8 *) ALIGN_ADDR(tmpbuf, BTSDIO_DMA_ALIGN);
1113 memcpy(buf, payload, nb);
1114 }
1115
1116 sdio_claim_host(card->func);
1117
1118 do {
1119 /* Transfer data to card */
1120 ret = sdio_writesb(card->func, card->ioport, buf,
1121 blksz);
1122 if (ret < 0) {
1123 i++;
1124 BT_ERR("i=%d writesb failed: %d", i, ret);
1125 BT_ERR("hex: %*ph", nb, payload);
1126 ret = -EIO;
1127 if (i > MAX_WRITE_IOMEM_RETRY)
1128 goto exit;
1129 }
1130 } while (ret);
1131
1132 priv->btmrvl_dev.tx_dnld_rdy = false;
1133
1134exit:
1135 sdio_release_host(card->func);
1136 kfree(tmpbuf);
1137
1138 return ret;
1139}
1140
1141static int btmrvl_sdio_download_fw(struct btmrvl_sdio_card *card)
1142{
1143 int ret;
1144 u8 fws0;
1145 int pollnum = MAX_POLL_TRIES;
1146
1147 if (!card || !card->func) {
1148 BT_ERR("card or function is NULL!");
1149 return -EINVAL;
1150 }
1151
1152 if (!btmrvl_sdio_verify_fw_download(card, 1)) {
1153 BT_DBG("Firmware already downloaded!");
1154 return 0;
1155 }
1156
1157 sdio_claim_host(card->func);
1158
1159 /* Check if other function driver is downloading the firmware */
1160 fws0 = sdio_readb(card->func, card->reg->card_fw_status0, &ret);
1161 if (ret) {
1162 BT_ERR("Failed to read FW downloading status!");
1163 ret = -EIO;
1164 goto done;
1165 }
1166 if (fws0) {
1167 BT_DBG("BT not the winner (%#x). Skip FW downloading", fws0);
1168
1169 /* Give other function more time to download the firmware */
1170 pollnum *= 10;
1171 } else {
1172 if (card->helper) {
1173 ret = btmrvl_sdio_download_helper(card);
1174 if (ret) {
1175 BT_ERR("Failed to download helper!");
1176 ret = -EIO;
1177 goto done;
1178 }
1179 }
1180
1181 if (btmrvl_sdio_download_fw_w_helper(card)) {
1182 BT_ERR("Failed to download firmware!");
1183 ret = -EIO;
1184 goto done;
1185 }
1186 }
1187
1188 /*
1189 * winner or not, with this test the FW synchronizes when the
1190 * module can continue its initialization
1191 */
1192 if (btmrvl_sdio_verify_fw_download(card, pollnum)) {
1193 BT_ERR("FW failed to be active in time!");
1194 ret = -ETIMEDOUT;
1195 goto done;
1196 }
1197
1198 sdio_release_host(card->func);
1199
1200 return 0;
1201
1202done:
1203 sdio_release_host(card->func);
1204 return ret;
1205}
1206
1207static int btmrvl_sdio_wakeup_fw(struct btmrvl_private *priv)
1208{
1209 struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
1210 int ret = 0;
1211
1212 if (!card || !card->func) {
1213 BT_ERR("card or function is NULL!");
1214 return -EINVAL;
1215 }
1216
1217 sdio_claim_host(card->func);
1218
1219 sdio_writeb(card->func, HOST_POWER_UP, card->reg->cfg, &ret);
1220
1221 sdio_release_host(card->func);
1222
1223 BT_DBG("wake up firmware");
1224
1225 return ret;
1226}
1227
1228static void btmrvl_sdio_dump_regs(struct btmrvl_private *priv)
1229{
1230 struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
1231 int ret = 0;
1232 unsigned int reg, reg_start, reg_end;
1233 char buf[256], *ptr;
1234 u8 loop, func, data;
1235 int MAX_LOOP = 2;
1236
1237 btmrvl_sdio_wakeup_fw(priv);
1238 sdio_claim_host(card->func);
1239
1240 for (loop = 0; loop < MAX_LOOP; loop++) {
1241 memset(buf, 0, sizeof(buf));
1242 ptr = buf;
1243
1244 if (loop == 0) {
1245 /* Read the registers of SDIO function0 */
1246 func = loop;
1247 reg_start = 0;
1248 reg_end = 9;
1249 } else {
1250 func = 2;
1251 reg_start = 0;
1252 reg_end = 0x09;
1253 }
1254
1255 ptr += sprintf(ptr, "SDIO Func%d (%#x-%#x): ",
1256 func, reg_start, reg_end);
1257 for (reg = reg_start; reg <= reg_end; reg++) {
1258 if (func == 0)
1259 data = sdio_f0_readb(card->func, reg, &ret);
1260 else
1261 data = sdio_readb(card->func, reg, &ret);
1262
1263 if (!ret) {
1264 ptr += sprintf(ptr, "%02x ", data);
1265 } else {
1266 ptr += sprintf(ptr, "ERR");
1267 break;
1268 }
1269 }
1270
1271 BT_INFO("%s", buf);
1272 }
1273
1274 sdio_release_host(card->func);
1275}
1276
1277/* This function read/write firmware */
1278static enum
1279rdwr_status btmrvl_sdio_rdwr_firmware(struct btmrvl_private *priv,
1280 u8 doneflag)
1281{
1282 struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
1283 int ret, tries;
1284 u8 ctrl_data = 0;
1285
1286 sdio_writeb(card->func, FW_DUMP_HOST_READY, card->reg->fw_dump_ctrl,
1287 &ret);
1288
1289 if (ret) {
1290 BT_ERR("SDIO write err");
1291 return RDWR_STATUS_FAILURE;
1292 }
1293
1294 for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
1295 ctrl_data = sdio_readb(card->func, card->reg->fw_dump_ctrl,
1296 &ret);
1297
1298 if (ret) {
1299 BT_ERR("SDIO read err");
1300 return RDWR_STATUS_FAILURE;
1301 }
1302
1303 if (ctrl_data == FW_DUMP_DONE)
1304 break;
1305 if (doneflag && ctrl_data == doneflag)
1306 return RDWR_STATUS_DONE;
1307 if (ctrl_data != FW_DUMP_HOST_READY) {
1308 BT_INFO("The ctrl reg was changed, re-try again!");
1309 sdio_writeb(card->func, FW_DUMP_HOST_READY,
1310 card->reg->fw_dump_ctrl, &ret);
1311 if (ret) {
1312 BT_ERR("SDIO write err");
1313 return RDWR_STATUS_FAILURE;
1314 }
1315 }
1316 usleep_range(100, 200);
1317 }
1318
1319 if (ctrl_data == FW_DUMP_HOST_READY) {
1320 BT_ERR("Fail to pull ctrl_data");
1321 return RDWR_STATUS_FAILURE;
1322 }
1323
1324 return RDWR_STATUS_SUCCESS;
1325}
1326
1327/* This function dump sdio register and memory data */
1328static void btmrvl_sdio_coredump(struct device *dev)
1329{
1330 struct sdio_func *func = dev_to_sdio_func(dev);
1331 struct btmrvl_sdio_card *card;
1332 struct btmrvl_private *priv;
1333 int ret = 0;
1334 unsigned int reg, reg_start, reg_end;
1335 enum rdwr_status stat;
1336 u8 *dbg_ptr, *end_ptr, *fw_dump_data, *fw_dump_ptr;
1337 u8 dump_num = 0, idx, i, read_reg, doneflag = 0;
1338 u32 memory_size, fw_dump_len = 0;
1339 int size = 0;
1340
1341 card = sdio_get_drvdata(func);
1342 priv = card->priv;
1343
1344 /* dump sdio register first */
1345 btmrvl_sdio_dump_regs(priv);
1346
1347 if (!card->supports_fw_dump) {
1348 BT_ERR("Firmware dump not supported for this card!");
1349 return;
1350 }
1351
1352 for (idx = 0; idx < ARRAY_SIZE(mem_type_mapping_tbl); idx++) {
1353 struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx];
1354
1355 if (entry->mem_ptr) {
1356 vfree(entry->mem_ptr);
1357 entry->mem_ptr = NULL;
1358 }
1359 entry->mem_size = 0;
1360 }
1361
1362 btmrvl_sdio_wakeup_fw(priv);
1363 sdio_claim_host(card->func);
1364
1365 BT_INFO("== btmrvl firmware dump start ==");
1366
1367 stat = btmrvl_sdio_rdwr_firmware(priv, doneflag);
1368 if (stat == RDWR_STATUS_FAILURE)
1369 goto done;
1370
1371 reg = card->reg->fw_dump_start;
1372 /* Read the number of the memories which will dump */
1373 dump_num = sdio_readb(card->func, reg, &ret);
1374
1375 if (ret) {
1376 BT_ERR("SDIO read memory length err");
1377 goto done;
1378 }
1379
1380 /* Read the length of every memory which will dump */
1381 for (idx = 0; idx < dump_num; idx++) {
1382 struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx];
1383
1384 stat = btmrvl_sdio_rdwr_firmware(priv, doneflag);
1385 if (stat == RDWR_STATUS_FAILURE)
1386 goto done;
1387
1388 memory_size = 0;
1389 reg = card->reg->fw_dump_start;
1390 for (i = 0; i < 4; i++) {
1391 read_reg = sdio_readb(card->func, reg, &ret);
1392 if (ret) {
1393 BT_ERR("SDIO read err");
1394 goto done;
1395 }
1396 memory_size |= (read_reg << i*8);
1397 reg++;
1398 }
1399
1400 if (memory_size == 0) {
1401 BT_INFO("Firmware dump finished!");
1402 sdio_writeb(card->func, FW_DUMP_READ_DONE,
1403 card->reg->fw_dump_ctrl, &ret);
1404 if (ret) {
1405 BT_ERR("SDIO Write MEMDUMP_FINISH ERR");
1406 goto done;
1407 }
1408 break;
1409 }
1410
1411 BT_INFO("%s_SIZE=0x%x", entry->mem_name, memory_size);
1412 entry->mem_ptr = vzalloc(memory_size + 1);
1413 entry->mem_size = memory_size;
1414 if (!entry->mem_ptr) {
1415 BT_ERR("Vzalloc %s failed", entry->mem_name);
1416 goto done;
1417 }
1418
1419 fw_dump_len += (strlen("========Start dump ") +
1420 strlen(entry->mem_name) +
1421 strlen("========\n") +
1422 (memory_size + 1) +
1423 strlen("\n========End dump========\n"));
1424
1425 dbg_ptr = entry->mem_ptr;
1426 end_ptr = dbg_ptr + memory_size;
1427
1428 doneflag = entry->done_flag;
1429 BT_INFO("Start %s output, please wait...",
1430 entry->mem_name);
1431
1432 do {
1433 stat = btmrvl_sdio_rdwr_firmware(priv, doneflag);
1434 if (stat == RDWR_STATUS_FAILURE)
1435 goto done;
1436
1437 reg_start = card->reg->fw_dump_start;
1438 reg_end = card->reg->fw_dump_end;
1439 for (reg = reg_start; reg <= reg_end; reg++) {
1440 *dbg_ptr = sdio_readb(card->func, reg, &ret);
1441 if (ret) {
1442 BT_ERR("SDIO read err");
1443 goto done;
1444 }
1445 if (dbg_ptr < end_ptr)
1446 dbg_ptr++;
1447 else
1448 BT_ERR("Allocated buffer not enough");
1449 }
1450
1451 if (stat == RDWR_STATUS_DONE) {
1452 BT_INFO("%s done: size=0x%tx",
1453 entry->mem_name,
1454 dbg_ptr - entry->mem_ptr);
1455 break;
1456 }
1457 } while (1);
1458 }
1459
1460 BT_INFO("== btmrvl firmware dump end ==");
1461
1462done:
1463 sdio_release_host(card->func);
1464
1465 if (fw_dump_len == 0)
1466 return;
1467
1468 fw_dump_data = vzalloc(fw_dump_len + 1);
1469 if (!fw_dump_data) {
1470 BT_ERR("Vzalloc fw_dump_data fail!");
1471 return;
1472 }
1473 fw_dump_ptr = fw_dump_data;
1474
1475 /* Dump all the memory data into single file, a userspace script will
1476 * be used to split all the memory data to multiple files
1477 */
1478 BT_INFO("== btmrvl firmware dump to /sys/class/devcoredump start");
1479 for (idx = 0; idx < dump_num; idx++) {
1480 struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx];
1481
1482 if (entry->mem_ptr) {
1483 size += scnprintf(fw_dump_ptr + size,
1484 fw_dump_len + 1 - size,
1485 "========Start dump %s========\n",
1486 entry->mem_name);
1487
1488 memcpy(fw_dump_ptr + size, entry->mem_ptr,
1489 entry->mem_size);
1490 size += entry->mem_size;
1491
1492 size += scnprintf(fw_dump_ptr + size,
1493 fw_dump_len + 1 - size,
1494 "\n========End dump========\n");
1495
1496 vfree(mem_type_mapping_tbl[idx].mem_ptr);
1497 mem_type_mapping_tbl[idx].mem_ptr = NULL;
1498 }
1499 }
1500
1501 /* fw_dump_data will be free in device coredump release function
1502 * after 5 min
1503 */
1504 dev_coredumpv(&card->func->dev, fw_dump_data, fw_dump_len, GFP_KERNEL);
1505 BT_INFO("== btmrvl firmware dump to /sys/class/devcoredump end");
1506}
1507
1508static int btmrvl_sdio_probe(struct sdio_func *func,
1509 const struct sdio_device_id *id)
1510{
1511 int ret = 0;
1512 struct btmrvl_private *priv = NULL;
1513 struct btmrvl_sdio_card *card = NULL;
1514
1515 BT_INFO("vendor=0x%x, device=0x%x, class=%d, fn=%d",
1516 id->vendor, id->device, id->class, func->num);
1517
1518 card = devm_kzalloc(&func->dev, sizeof(*card), GFP_KERNEL);
1519 if (!card)
1520 return -ENOMEM;
1521
1522 card->func = func;
1523
1524 if (id->driver_data) {
1525 struct btmrvl_sdio_device *data = (void *) id->driver_data;
1526 card->helper = data->helper;
1527 card->firmware = data->firmware;
1528 card->reg = data->reg;
1529 card->sd_blksz_fw_dl = data->sd_blksz_fw_dl;
1530 card->support_pscan_win_report = data->support_pscan_win_report;
1531 card->supports_fw_dump = data->supports_fw_dump;
1532 }
1533
1534 if (btmrvl_sdio_register_dev(card) < 0) {
1535 BT_ERR("Failed to register BT device!");
1536 return -ENODEV;
1537 }
1538
1539 /* Disable the interrupts on the card */
1540 btmrvl_sdio_disable_host_int(card);
1541
1542 if (btmrvl_sdio_download_fw(card)) {
1543 BT_ERR("Downloading firmware failed!");
1544 ret = -ENODEV;
1545 goto unreg_dev;
1546 }
1547
1548 btmrvl_sdio_enable_host_int(card);
1549
1550 /* Device tree node parsing and platform specific configuration*/
1551 btmrvl_sdio_probe_of(&func->dev, card);
1552
1553 priv = btmrvl_add_card(card);
1554 if (!priv) {
1555 BT_ERR("Initializing card failed!");
1556 ret = -ENODEV;
1557 goto disable_host_int;
1558 }
1559
1560 card->priv = priv;
1561
1562 /* Initialize the interface specific function pointers */
1563 priv->hw_host_to_card = btmrvl_sdio_host_to_card;
1564 priv->hw_wakeup_firmware = btmrvl_sdio_wakeup_fw;
1565 priv->hw_process_int_status = btmrvl_sdio_process_int_status;
1566
1567 if (btmrvl_register_hdev(priv)) {
1568 BT_ERR("Register hdev failed!");
1569 ret = -ENODEV;
1570 goto disable_host_int;
1571 }
1572
1573 return 0;
1574
1575disable_host_int:
1576 btmrvl_sdio_disable_host_int(card);
1577unreg_dev:
1578 btmrvl_sdio_unregister_dev(card);
1579 return ret;
1580}
1581
1582static void btmrvl_sdio_remove(struct sdio_func *func)
1583{
1584 struct btmrvl_sdio_card *card;
1585
1586 if (func) {
1587 card = sdio_get_drvdata(func);
1588 if (card) {
1589 /* Send SHUTDOWN command & disable interrupt
1590 * if user removes the module.
1591 */
1592 if (user_rmmod) {
1593 btmrvl_send_module_cfg_cmd(card->priv,
1594 MODULE_SHUTDOWN_REQ);
1595 btmrvl_sdio_disable_host_int(card);
1596 }
1597
1598 BT_DBG("unregister dev");
1599 card->priv->surprise_removed = true;
1600 btmrvl_sdio_unregister_dev(card);
1601 btmrvl_remove_card(card->priv);
1602 }
1603 }
1604}
1605
1606static int btmrvl_sdio_suspend(struct device *dev)
1607{
1608 struct sdio_func *func = dev_to_sdio_func(dev);
1609 struct btmrvl_sdio_card *card;
1610 struct btmrvl_private *priv;
1611 mmc_pm_flag_t pm_flags;
1612 struct hci_dev *hcidev;
1613
1614 if (func) {
1615 pm_flags = sdio_get_host_pm_caps(func);
1616 BT_DBG("%s: suspend: PM flags = 0x%x", sdio_func_id(func),
1617 pm_flags);
1618 if (!(pm_flags & MMC_PM_KEEP_POWER)) {
1619 BT_ERR("%s: cannot remain alive while suspended",
1620 sdio_func_id(func));
1621 return -ENOSYS;
1622 }
1623 card = sdio_get_drvdata(func);
1624 if (!card || !card->priv) {
1625 BT_ERR("card or priv structure is not valid");
1626 return 0;
1627 }
1628 } else {
1629 BT_ERR("sdio_func is not specified");
1630 return 0;
1631 }
1632
1633 /* Enable platform specific wakeup interrupt */
1634 if (card->plt_wake_cfg && card->plt_wake_cfg->irq_bt >= 0 &&
1635 device_may_wakeup(dev)) {
1636 card->plt_wake_cfg->wake_by_bt = false;
1637 enable_irq(card->plt_wake_cfg->irq_bt);
1638 enable_irq_wake(card->plt_wake_cfg->irq_bt);
1639 }
1640
1641 priv = card->priv;
1642 priv->adapter->is_suspending = true;
1643 hcidev = priv->btmrvl_dev.hcidev;
1644 BT_DBG("%s: SDIO suspend", hcidev->name);
1645 hci_suspend_dev(hcidev);
1646
1647 if (priv->adapter->hs_state != HS_ACTIVATED) {
1648 if (btmrvl_enable_hs(priv)) {
1649 BT_ERR("HS not activated, suspend failed!");
1650 /* Disable platform specific wakeup interrupt */
1651 if (card->plt_wake_cfg &&
1652 card->plt_wake_cfg->irq_bt >= 0 &&
1653 device_may_wakeup(dev)) {
1654 disable_irq_wake(card->plt_wake_cfg->irq_bt);
1655 disable_irq(card->plt_wake_cfg->irq_bt);
1656 }
1657
1658 priv->adapter->is_suspending = false;
1659 return -EBUSY;
1660 }
1661 }
1662
1663 priv->adapter->is_suspending = false;
1664 priv->adapter->is_suspended = true;
1665
1666 /* We will keep the power when hs enabled successfully */
1667 if (priv->adapter->hs_state == HS_ACTIVATED) {
1668 BT_DBG("suspend with MMC_PM_KEEP_POWER");
1669 return sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER);
1670 }
1671
1672 BT_DBG("suspend without MMC_PM_KEEP_POWER");
1673 return 0;
1674}
1675
1676static int btmrvl_sdio_resume(struct device *dev)
1677{
1678 struct sdio_func *func = dev_to_sdio_func(dev);
1679 struct btmrvl_sdio_card *card;
1680 struct btmrvl_private *priv;
1681 mmc_pm_flag_t pm_flags;
1682 struct hci_dev *hcidev;
1683
1684 if (func) {
1685 pm_flags = sdio_get_host_pm_caps(func);
1686 BT_DBG("%s: resume: PM flags = 0x%x", sdio_func_id(func),
1687 pm_flags);
1688 card = sdio_get_drvdata(func);
1689 if (!card || !card->priv) {
1690 BT_ERR("card or priv structure is not valid");
1691 return 0;
1692 }
1693 } else {
1694 BT_ERR("sdio_func is not specified");
1695 return 0;
1696 }
1697 priv = card->priv;
1698
1699 if (!priv->adapter->is_suspended) {
1700 BT_DBG("device already resumed");
1701 return 0;
1702 }
1703
1704 priv->hw_wakeup_firmware(priv);
1705 priv->adapter->hs_state = HS_DEACTIVATED;
1706 hcidev = priv->btmrvl_dev.hcidev;
1707 BT_DBG("%s: HS DEACTIVATED in resume!", hcidev->name);
1708 priv->adapter->is_suspended = false;
1709 BT_DBG("%s: SDIO resume", hcidev->name);
1710 hci_resume_dev(hcidev);
1711
1712 /* Disable platform specific wakeup interrupt */
1713 if (card->plt_wake_cfg && card->plt_wake_cfg->irq_bt >= 0 &&
1714 device_may_wakeup(dev)) {
1715 disable_irq_wake(card->plt_wake_cfg->irq_bt);
1716 disable_irq(card->plt_wake_cfg->irq_bt);
1717 if (card->plt_wake_cfg->wake_by_bt)
1718 /* Undo our disable, since interrupt handler already
1719 * did this.
1720 */
1721 enable_irq(card->plt_wake_cfg->irq_bt);
1722 }
1723
1724 return 0;
1725}
1726
1727static const struct dev_pm_ops btmrvl_sdio_pm_ops = {
1728 .suspend = btmrvl_sdio_suspend,
1729 .resume = btmrvl_sdio_resume,
1730};
1731
1732static struct sdio_driver bt_mrvl_sdio = {
1733 .name = "btmrvl_sdio",
1734 .id_table = btmrvl_sdio_ids,
1735 .probe = btmrvl_sdio_probe,
1736 .remove = btmrvl_sdio_remove,
1737 .drv = {
1738 .coredump = btmrvl_sdio_coredump,
1739 .pm = &btmrvl_sdio_pm_ops,
1740 }
1741};
1742
1743static int __init btmrvl_sdio_init_module(void)
1744{
1745 if (sdio_register_driver(&bt_mrvl_sdio) != 0) {
1746 BT_ERR("SDIO Driver Registration Failed");
1747 return -ENODEV;
1748 }
1749
1750 /* Clear the flag in case user removes the card. */
1751 user_rmmod = 0;
1752
1753 return 0;
1754}
1755
1756static void __exit btmrvl_sdio_exit_module(void)
1757{
1758 /* Set the flag as user is removing this module. */
1759 user_rmmod = 1;
1760
1761 sdio_unregister_driver(&bt_mrvl_sdio);
1762}
1763
1764module_init(btmrvl_sdio_init_module);
1765module_exit(btmrvl_sdio_exit_module);
1766
1767MODULE_AUTHOR("Marvell International Ltd.");
1768MODULE_DESCRIPTION("Marvell BT-over-SDIO driver ver " VERSION);
1769MODULE_VERSION(VERSION);
1770MODULE_LICENSE("GPL v2");
1771MODULE_FIRMWARE("mrvl/sd8688_helper.bin");
1772MODULE_FIRMWARE("mrvl/sd8688.bin");
1773MODULE_FIRMWARE("mrvl/sd8787_uapsta.bin");
1774MODULE_FIRMWARE("mrvl/sd8797_uapsta.bin");
1775MODULE_FIRMWARE("mrvl/sd8887_uapsta.bin");
1776MODULE_FIRMWARE("mrvl/sd8897_uapsta.bin");
1777MODULE_FIRMWARE("mrvl/sdsd8977_combo_v2.bin");
1778MODULE_FIRMWARE("mrvl/sd8987_uapsta.bin");
1779MODULE_FIRMWARE("mrvl/sdsd8997_combo_v4.bin");
1/**
2 * Marvell BT-over-SDIO driver: SDIO interface related functions.
3 *
4 * Copyright (C) 2009, Marvell International Ltd.
5 *
6 * This software file (the "File") is distributed by Marvell International
7 * Ltd. under the terms of the GNU General Public License Version 2, June 1991
8 * (the "License"). You may use, redistribute and/or modify this File in
9 * accordance with the terms and conditions of the License, a copy of which
10 * is available by writing to the Free Software Foundation, Inc.,
11 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
12 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
13 *
14 *
15 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
17 * ARE EXPRESSLY DISCLAIMED. The License provides additional details about
18 * this warranty disclaimer.
19 **/
20
21#include <linux/firmware.h>
22#include <linux/slab.h>
23
24#include <linux/mmc/sdio_ids.h>
25#include <linux/mmc/sdio_func.h>
26#include <linux/module.h>
27
28#include <net/bluetooth/bluetooth.h>
29#include <net/bluetooth/hci_core.h>
30
31#include "btmrvl_drv.h"
32#include "btmrvl_sdio.h"
33
34#define VERSION "1.0"
35
36/* The btmrvl_sdio_remove() callback function is called
37 * when user removes this module from kernel space or ejects
38 * the card from the slot. The driver handles these 2 cases
39 * differently.
40 * If the user is removing the module, a MODULE_SHUTDOWN_REQ
41 * command is sent to firmware and interrupt will be disabled.
42 * If the card is removed, there is no need to send command
43 * or disable interrupt.
44 *
45 * The variable 'user_rmmod' is used to distinguish these two
46 * scenarios. This flag is initialized as FALSE in case the card
47 * is removed, and will be set to TRUE for module removal when
48 * module_exit function is called.
49 */
50static u8 user_rmmod;
51static u8 sdio_ireg;
52
53static const struct btmrvl_sdio_card_reg btmrvl_reg_8688 = {
54 .cfg = 0x03,
55 .host_int_mask = 0x04,
56 .host_intstatus = 0x05,
57 .card_status = 0x20,
58 .sq_read_base_addr_a0 = 0x10,
59 .sq_read_base_addr_a1 = 0x11,
60 .card_fw_status0 = 0x40,
61 .card_fw_status1 = 0x41,
62 .card_rx_len = 0x42,
63 .card_rx_unit = 0x43,
64 .io_port_0 = 0x00,
65 .io_port_1 = 0x01,
66 .io_port_2 = 0x02,
67};
68static const struct btmrvl_sdio_card_reg btmrvl_reg_87xx = {
69 .cfg = 0x00,
70 .host_int_mask = 0x02,
71 .host_intstatus = 0x03,
72 .card_status = 0x30,
73 .sq_read_base_addr_a0 = 0x40,
74 .sq_read_base_addr_a1 = 0x41,
75 .card_revision = 0x5c,
76 .card_fw_status0 = 0x60,
77 .card_fw_status1 = 0x61,
78 .card_rx_len = 0x62,
79 .card_rx_unit = 0x63,
80 .io_port_0 = 0x78,
81 .io_port_1 = 0x79,
82 .io_port_2 = 0x7a,
83};
84
85static const struct btmrvl_sdio_card_reg btmrvl_reg_88xx = {
86 .cfg = 0x00,
87 .host_int_mask = 0x02,
88 .host_intstatus = 0x03,
89 .card_status = 0x50,
90 .sq_read_base_addr_a0 = 0x60,
91 .sq_read_base_addr_a1 = 0x61,
92 .card_revision = 0xbc,
93 .card_fw_status0 = 0xc0,
94 .card_fw_status1 = 0xc1,
95 .card_rx_len = 0xc2,
96 .card_rx_unit = 0xc3,
97 .io_port_0 = 0xd8,
98 .io_port_1 = 0xd9,
99 .io_port_2 = 0xda,
100};
101
102static const struct btmrvl_sdio_device btmrvl_sdio_sd8688 = {
103 .helper = "mrvl/sd8688_helper.bin",
104 .firmware = "mrvl/sd8688.bin",
105 .reg = &btmrvl_reg_8688,
106 .sd_blksz_fw_dl = 64,
107};
108
109static const struct btmrvl_sdio_device btmrvl_sdio_sd8787 = {
110 .helper = NULL,
111 .firmware = "mrvl/sd8787_uapsta.bin",
112 .reg = &btmrvl_reg_87xx,
113 .sd_blksz_fw_dl = 256,
114};
115
116static const struct btmrvl_sdio_device btmrvl_sdio_sd8797 = {
117 .helper = NULL,
118 .firmware = "mrvl/sd8797_uapsta.bin",
119 .reg = &btmrvl_reg_87xx,
120 .sd_blksz_fw_dl = 256,
121};
122
123static const struct btmrvl_sdio_device btmrvl_sdio_sd8897 = {
124 .helper = NULL,
125 .firmware = "mrvl/sd8897_uapsta.bin",
126 .reg = &btmrvl_reg_88xx,
127 .sd_blksz_fw_dl = 256,
128};
129
130static const struct sdio_device_id btmrvl_sdio_ids[] = {
131 /* Marvell SD8688 Bluetooth device */
132 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x9105),
133 .driver_data = (unsigned long) &btmrvl_sdio_sd8688 },
134 /* Marvell SD8787 Bluetooth device */
135 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x911A),
136 .driver_data = (unsigned long) &btmrvl_sdio_sd8787 },
137 /* Marvell SD8787 Bluetooth AMP device */
138 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x911B),
139 .driver_data = (unsigned long) &btmrvl_sdio_sd8787 },
140 /* Marvell SD8797 Bluetooth device */
141 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x912A),
142 .driver_data = (unsigned long) &btmrvl_sdio_sd8797 },
143 /* Marvell SD8897 Bluetooth device */
144 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x912E),
145 .driver_data = (unsigned long) &btmrvl_sdio_sd8897 },
146
147 { } /* Terminating entry */
148};
149
150MODULE_DEVICE_TABLE(sdio, btmrvl_sdio_ids);
151
152static int btmrvl_sdio_get_rx_unit(struct btmrvl_sdio_card *card)
153{
154 u8 reg;
155 int ret;
156
157 reg = sdio_readb(card->func, card->reg->card_rx_unit, &ret);
158 if (!ret)
159 card->rx_unit = reg;
160
161 return ret;
162}
163
164static int btmrvl_sdio_read_fw_status(struct btmrvl_sdio_card *card, u16 *dat)
165{
166 u8 fws0, fws1;
167 int ret;
168
169 *dat = 0;
170
171 fws0 = sdio_readb(card->func, card->reg->card_fw_status0, &ret);
172 if (ret)
173 return -EIO;
174
175 fws1 = sdio_readb(card->func, card->reg->card_fw_status1, &ret);
176 if (ret)
177 return -EIO;
178
179 *dat = (((u16) fws1) << 8) | fws0;
180
181 return 0;
182}
183
184static int btmrvl_sdio_read_rx_len(struct btmrvl_sdio_card *card, u16 *dat)
185{
186 u8 reg;
187 int ret;
188
189 reg = sdio_readb(card->func, card->reg->card_rx_len, &ret);
190 if (!ret)
191 *dat = (u16) reg << card->rx_unit;
192
193 return ret;
194}
195
196static int btmrvl_sdio_enable_host_int_mask(struct btmrvl_sdio_card *card,
197 u8 mask)
198{
199 int ret;
200
201 sdio_writeb(card->func, mask, card->reg->host_int_mask, &ret);
202 if (ret) {
203 BT_ERR("Unable to enable the host interrupt!");
204 ret = -EIO;
205 }
206
207 return ret;
208}
209
210static int btmrvl_sdio_disable_host_int_mask(struct btmrvl_sdio_card *card,
211 u8 mask)
212{
213 u8 host_int_mask;
214 int ret;
215
216 host_int_mask = sdio_readb(card->func, card->reg->host_int_mask, &ret);
217 if (ret)
218 return -EIO;
219
220 host_int_mask &= ~mask;
221
222 sdio_writeb(card->func, host_int_mask, card->reg->host_int_mask, &ret);
223 if (ret < 0) {
224 BT_ERR("Unable to disable the host interrupt!");
225 return -EIO;
226 }
227
228 return 0;
229}
230
231static int btmrvl_sdio_poll_card_status(struct btmrvl_sdio_card *card, u8 bits)
232{
233 unsigned int tries;
234 u8 status;
235 int ret;
236
237 for (tries = 0; tries < MAX_POLL_TRIES * 1000; tries++) {
238 status = sdio_readb(card->func, card->reg->card_status, &ret);
239 if (ret)
240 goto failed;
241 if ((status & bits) == bits)
242 return ret;
243
244 udelay(1);
245 }
246
247 ret = -ETIMEDOUT;
248
249failed:
250 BT_ERR("FAILED! ret=%d", ret);
251
252 return ret;
253}
254
255static int btmrvl_sdio_verify_fw_download(struct btmrvl_sdio_card *card,
256 int pollnum)
257{
258 u16 firmwarestat;
259 int tries, ret;
260
261 /* Wait for firmware to become ready */
262 for (tries = 0; tries < pollnum; tries++) {
263 sdio_claim_host(card->func);
264 ret = btmrvl_sdio_read_fw_status(card, &firmwarestat);
265 sdio_release_host(card->func);
266 if (ret < 0)
267 continue;
268
269 if (firmwarestat == FIRMWARE_READY)
270 return 0;
271
272 msleep(10);
273 }
274
275 return -ETIMEDOUT;
276}
277
278static int btmrvl_sdio_download_helper(struct btmrvl_sdio_card *card)
279{
280 const struct firmware *fw_helper = NULL;
281 const u8 *helper = NULL;
282 int ret;
283 void *tmphlprbuf = NULL;
284 int tmphlprbufsz, hlprblknow, helperlen;
285 u8 *helperbuf;
286 u32 tx_len;
287
288 ret = request_firmware(&fw_helper, card->helper,
289 &card->func->dev);
290 if ((ret < 0) || !fw_helper) {
291 BT_ERR("request_firmware(helper) failed, error code = %d",
292 ret);
293 ret = -ENOENT;
294 goto done;
295 }
296
297 helper = fw_helper->data;
298 helperlen = fw_helper->size;
299
300 BT_DBG("Downloading helper image (%d bytes), block size %d bytes",
301 helperlen, SDIO_BLOCK_SIZE);
302
303 tmphlprbufsz = ALIGN_SZ(BTM_UPLD_SIZE, BTSDIO_DMA_ALIGN);
304
305 tmphlprbuf = kzalloc(tmphlprbufsz, GFP_KERNEL);
306 if (!tmphlprbuf) {
307 BT_ERR("Unable to allocate buffer for helper."
308 " Terminating download");
309 ret = -ENOMEM;
310 goto done;
311 }
312
313 helperbuf = (u8 *) ALIGN_ADDR(tmphlprbuf, BTSDIO_DMA_ALIGN);
314
315 /* Perform helper data transfer */
316 tx_len = (FIRMWARE_TRANSFER_NBLOCK * SDIO_BLOCK_SIZE)
317 - SDIO_HEADER_LEN;
318 hlprblknow = 0;
319
320 do {
321 ret = btmrvl_sdio_poll_card_status(card,
322 CARD_IO_READY | DN_LD_CARD_RDY);
323 if (ret < 0) {
324 BT_ERR("Helper download poll status timeout @ %d",
325 hlprblknow);
326 goto done;
327 }
328
329 /* Check if there is more data? */
330 if (hlprblknow >= helperlen)
331 break;
332
333 if (helperlen - hlprblknow < tx_len)
334 tx_len = helperlen - hlprblknow;
335
336 /* Little-endian */
337 helperbuf[0] = ((tx_len & 0x000000ff) >> 0);
338 helperbuf[1] = ((tx_len & 0x0000ff00) >> 8);
339 helperbuf[2] = ((tx_len & 0x00ff0000) >> 16);
340 helperbuf[3] = ((tx_len & 0xff000000) >> 24);
341
342 memcpy(&helperbuf[SDIO_HEADER_LEN], &helper[hlprblknow],
343 tx_len);
344
345 /* Now send the data */
346 ret = sdio_writesb(card->func, card->ioport, helperbuf,
347 FIRMWARE_TRANSFER_NBLOCK * SDIO_BLOCK_SIZE);
348 if (ret < 0) {
349 BT_ERR("IO error during helper download @ %d",
350 hlprblknow);
351 goto done;
352 }
353
354 hlprblknow += tx_len;
355 } while (true);
356
357 BT_DBG("Transferring helper image EOF block");
358
359 memset(helperbuf, 0x0, SDIO_BLOCK_SIZE);
360
361 ret = sdio_writesb(card->func, card->ioport, helperbuf,
362 SDIO_BLOCK_SIZE);
363 if (ret < 0) {
364 BT_ERR("IO error in writing helper image EOF block");
365 goto done;
366 }
367
368 ret = 0;
369
370done:
371 kfree(tmphlprbuf);
372 release_firmware(fw_helper);
373 return ret;
374}
375
376static int btmrvl_sdio_download_fw_w_helper(struct btmrvl_sdio_card *card)
377{
378 const struct firmware *fw_firmware = NULL;
379 const u8 *firmware = NULL;
380 int firmwarelen, tmpfwbufsz, ret;
381 unsigned int tries, offset;
382 u8 base0, base1;
383 void *tmpfwbuf = NULL;
384 u8 *fwbuf;
385 u16 len, blksz_dl = card->sd_blksz_fw_dl;
386 int txlen = 0, tx_blocks = 0, count = 0;
387
388 ret = request_firmware(&fw_firmware, card->firmware,
389 &card->func->dev);
390 if ((ret < 0) || !fw_firmware) {
391 BT_ERR("request_firmware(firmware) failed, error code = %d",
392 ret);
393 ret = -ENOENT;
394 goto done;
395 }
396
397 firmware = fw_firmware->data;
398 firmwarelen = fw_firmware->size;
399
400 BT_DBG("Downloading FW image (%d bytes)", firmwarelen);
401
402 tmpfwbufsz = ALIGN_SZ(BTM_UPLD_SIZE, BTSDIO_DMA_ALIGN);
403 tmpfwbuf = kzalloc(tmpfwbufsz, GFP_KERNEL);
404 if (!tmpfwbuf) {
405 BT_ERR("Unable to allocate buffer for firmware."
406 " Terminating download");
407 ret = -ENOMEM;
408 goto done;
409 }
410
411 /* Ensure aligned firmware buffer */
412 fwbuf = (u8 *) ALIGN_ADDR(tmpfwbuf, BTSDIO_DMA_ALIGN);
413
414 /* Perform firmware data transfer */
415 offset = 0;
416 do {
417 ret = btmrvl_sdio_poll_card_status(card,
418 CARD_IO_READY | DN_LD_CARD_RDY);
419 if (ret < 0) {
420 BT_ERR("FW download with helper poll status"
421 " timeout @ %d", offset);
422 goto done;
423 }
424
425 /* Check if there is more data ? */
426 if (offset >= firmwarelen)
427 break;
428
429 for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
430 base0 = sdio_readb(card->func,
431 card->reg->sq_read_base_addr_a0, &ret);
432 if (ret) {
433 BT_ERR("BASE0 register read failed:"
434 " base0 = 0x%04X(%d)."
435 " Terminating download",
436 base0, base0);
437 ret = -EIO;
438 goto done;
439 }
440 base1 = sdio_readb(card->func,
441 card->reg->sq_read_base_addr_a1, &ret);
442 if (ret) {
443 BT_ERR("BASE1 register read failed:"
444 " base1 = 0x%04X(%d)."
445 " Terminating download",
446 base1, base1);
447 ret = -EIO;
448 goto done;
449 }
450
451 len = (((u16) base1) << 8) | base0;
452 if (len)
453 break;
454
455 udelay(10);
456 }
457
458 if (!len)
459 break;
460 else if (len > BTM_UPLD_SIZE) {
461 BT_ERR("FW download failure @%d, invalid length %d",
462 offset, len);
463 ret = -EINVAL;
464 goto done;
465 }
466
467 txlen = len;
468
469 if (len & BIT(0)) {
470 count++;
471 if (count > MAX_WRITE_IOMEM_RETRY) {
472 BT_ERR("FW download failure @%d, "
473 "over max retry count", offset);
474 ret = -EIO;
475 goto done;
476 }
477 BT_ERR("FW CRC error indicated by the helper: "
478 "len = 0x%04X, txlen = %d", len, txlen);
479 len &= ~BIT(0);
480 /* Set txlen to 0 so as to resend from same offset */
481 txlen = 0;
482 } else {
483 count = 0;
484
485 /* Last block ? */
486 if (firmwarelen - offset < txlen)
487 txlen = firmwarelen - offset;
488
489 tx_blocks = DIV_ROUND_UP(txlen, blksz_dl);
490
491 memcpy(fwbuf, &firmware[offset], txlen);
492 }
493
494 ret = sdio_writesb(card->func, card->ioport, fwbuf,
495 tx_blocks * blksz_dl);
496
497 if (ret < 0) {
498 BT_ERR("FW download, writesb(%d) failed @%d",
499 count, offset);
500 sdio_writeb(card->func, HOST_CMD53_FIN,
501 card->reg->cfg, &ret);
502 if (ret)
503 BT_ERR("writeb failed (CFG)");
504 }
505
506 offset += txlen;
507 } while (true);
508
509 BT_DBG("FW download over, size %d bytes", offset);
510
511 ret = 0;
512
513done:
514 kfree(tmpfwbuf);
515 release_firmware(fw_firmware);
516 return ret;
517}
518
519static int btmrvl_sdio_card_to_host(struct btmrvl_private *priv)
520{
521 u16 buf_len = 0;
522 int ret, num_blocks, blksz;
523 struct sk_buff *skb = NULL;
524 u32 type;
525 u8 *payload = NULL;
526 struct hci_dev *hdev = priv->btmrvl_dev.hcidev;
527 struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
528
529 if (!card || !card->func) {
530 BT_ERR("card or function is NULL!");
531 ret = -EINVAL;
532 goto exit;
533 }
534
535 /* Read the length of data to be transferred */
536 ret = btmrvl_sdio_read_rx_len(card, &buf_len);
537 if (ret < 0) {
538 BT_ERR("read rx_len failed");
539 ret = -EIO;
540 goto exit;
541 }
542
543 blksz = SDIO_BLOCK_SIZE;
544 num_blocks = DIV_ROUND_UP(buf_len, blksz);
545
546 if (buf_len <= SDIO_HEADER_LEN
547 || (num_blocks * blksz) > ALLOC_BUF_SIZE) {
548 BT_ERR("invalid packet length: %d", buf_len);
549 ret = -EINVAL;
550 goto exit;
551 }
552
553 /* Allocate buffer */
554 skb = bt_skb_alloc(num_blocks * blksz + BTSDIO_DMA_ALIGN, GFP_ATOMIC);
555 if (skb == NULL) {
556 BT_ERR("No free skb");
557 ret = -ENOMEM;
558 goto exit;
559 }
560
561 if ((unsigned long) skb->data & (BTSDIO_DMA_ALIGN - 1)) {
562 skb_put(skb, (unsigned long) skb->data &
563 (BTSDIO_DMA_ALIGN - 1));
564 skb_pull(skb, (unsigned long) skb->data &
565 (BTSDIO_DMA_ALIGN - 1));
566 }
567
568 payload = skb->data;
569
570 ret = sdio_readsb(card->func, payload, card->ioport,
571 num_blocks * blksz);
572 if (ret < 0) {
573 BT_ERR("readsb failed: %d", ret);
574 ret = -EIO;
575 goto exit;
576 }
577
578 /* This is SDIO specific header length: byte[2][1][0], type: byte[3]
579 * (HCI_COMMAND = 1, ACL_DATA = 2, SCO_DATA = 3, 0xFE = Vendor)
580 */
581
582 buf_len = payload[0];
583 buf_len |= payload[1] << 8;
584 buf_len |= payload[2] << 16;
585
586 if (buf_len > blksz * num_blocks) {
587 BT_ERR("Skip incorrect packet: hdrlen %d buffer %d",
588 buf_len, blksz * num_blocks);
589 ret = -EIO;
590 goto exit;
591 }
592
593 type = payload[3];
594
595 switch (type) {
596 case HCI_ACLDATA_PKT:
597 case HCI_SCODATA_PKT:
598 case HCI_EVENT_PKT:
599 bt_cb(skb)->pkt_type = type;
600 skb_put(skb, buf_len);
601 skb_pull(skb, SDIO_HEADER_LEN);
602
603 if (type == HCI_EVENT_PKT) {
604 if (btmrvl_check_evtpkt(priv, skb))
605 hci_recv_frame(hdev, skb);
606 } else {
607 hci_recv_frame(hdev, skb);
608 }
609
610 hdev->stat.byte_rx += buf_len;
611 break;
612
613 case MRVL_VENDOR_PKT:
614 bt_cb(skb)->pkt_type = HCI_VENDOR_PKT;
615 skb_put(skb, buf_len);
616 skb_pull(skb, SDIO_HEADER_LEN);
617
618 if (btmrvl_process_event(priv, skb))
619 hci_recv_frame(hdev, skb);
620
621 hdev->stat.byte_rx += buf_len;
622 break;
623
624 default:
625 BT_ERR("Unknown packet type:%d", type);
626 BT_ERR("hex: %*ph", blksz * num_blocks, payload);
627
628 kfree_skb(skb);
629 skb = NULL;
630 break;
631 }
632
633exit:
634 if (ret) {
635 hdev->stat.err_rx++;
636 kfree_skb(skb);
637 }
638
639 return ret;
640}
641
642static int btmrvl_sdio_process_int_status(struct btmrvl_private *priv)
643{
644 ulong flags;
645 u8 ireg;
646 struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
647
648 spin_lock_irqsave(&priv->driver_lock, flags);
649 ireg = sdio_ireg;
650 sdio_ireg = 0;
651 spin_unlock_irqrestore(&priv->driver_lock, flags);
652
653 sdio_claim_host(card->func);
654 if (ireg & DN_LD_HOST_INT_STATUS) {
655 if (priv->btmrvl_dev.tx_dnld_rdy)
656 BT_DBG("tx_done already received: "
657 " int_status=0x%x", ireg);
658 else
659 priv->btmrvl_dev.tx_dnld_rdy = true;
660 }
661
662 if (ireg & UP_LD_HOST_INT_STATUS)
663 btmrvl_sdio_card_to_host(priv);
664
665 sdio_release_host(card->func);
666
667 return 0;
668}
669
670static void btmrvl_sdio_interrupt(struct sdio_func *func)
671{
672 struct btmrvl_private *priv;
673 struct btmrvl_sdio_card *card;
674 ulong flags;
675 u8 ireg = 0;
676 int ret;
677
678 card = sdio_get_drvdata(func);
679 if (!card || !card->priv) {
680 BT_ERR("sbi_interrupt(%p) card or priv is "
681 "NULL, card=%p\n", func, card);
682 return;
683 }
684
685 priv = card->priv;
686
687 ireg = sdio_readb(card->func, card->reg->host_intstatus, &ret);
688 if (ret) {
689 BT_ERR("sdio_readb: read int status register failed");
690 return;
691 }
692
693 if (ireg != 0) {
694 /*
695 * DN_LD_HOST_INT_STATUS and/or UP_LD_HOST_INT_STATUS
696 * Clear the interrupt status register and re-enable the
697 * interrupt.
698 */
699 BT_DBG("ireg = 0x%x", ireg);
700
701 sdio_writeb(card->func, ~(ireg) & (DN_LD_HOST_INT_STATUS |
702 UP_LD_HOST_INT_STATUS),
703 card->reg->host_intstatus, &ret);
704 if (ret) {
705 BT_ERR("sdio_writeb: clear int status register failed");
706 return;
707 }
708 }
709
710 spin_lock_irqsave(&priv->driver_lock, flags);
711 sdio_ireg |= ireg;
712 spin_unlock_irqrestore(&priv->driver_lock, flags);
713
714 btmrvl_interrupt(priv);
715}
716
717static int btmrvl_sdio_register_dev(struct btmrvl_sdio_card *card)
718{
719 struct sdio_func *func;
720 u8 reg;
721 int ret = 0;
722
723 if (!card || !card->func) {
724 BT_ERR("Error: card or function is NULL!");
725 ret = -EINVAL;
726 goto failed;
727 }
728
729 func = card->func;
730
731 sdio_claim_host(func);
732
733 ret = sdio_enable_func(func);
734 if (ret) {
735 BT_ERR("sdio_enable_func() failed: ret=%d", ret);
736 ret = -EIO;
737 goto release_host;
738 }
739
740 ret = sdio_claim_irq(func, btmrvl_sdio_interrupt);
741 if (ret) {
742 BT_ERR("sdio_claim_irq failed: ret=%d", ret);
743 ret = -EIO;
744 goto disable_func;
745 }
746
747 ret = sdio_set_block_size(card->func, SDIO_BLOCK_SIZE);
748 if (ret) {
749 BT_ERR("cannot set SDIO block size");
750 ret = -EIO;
751 goto release_irq;
752 }
753
754 reg = sdio_readb(func, card->reg->io_port_0, &ret);
755 if (ret < 0) {
756 ret = -EIO;
757 goto release_irq;
758 }
759
760 card->ioport = reg;
761
762 reg = sdio_readb(func, card->reg->io_port_1, &ret);
763 if (ret < 0) {
764 ret = -EIO;
765 goto release_irq;
766 }
767
768 card->ioport |= (reg << 8);
769
770 reg = sdio_readb(func, card->reg->io_port_2, &ret);
771 if (ret < 0) {
772 ret = -EIO;
773 goto release_irq;
774 }
775
776 card->ioport |= (reg << 16);
777
778 BT_DBG("SDIO FUNC%d IO port: 0x%x", func->num, card->ioport);
779
780 sdio_set_drvdata(func, card);
781
782 sdio_release_host(func);
783
784 return 0;
785
786release_irq:
787 sdio_release_irq(func);
788
789disable_func:
790 sdio_disable_func(func);
791
792release_host:
793 sdio_release_host(func);
794
795failed:
796 return ret;
797}
798
799static int btmrvl_sdio_unregister_dev(struct btmrvl_sdio_card *card)
800{
801 if (card && card->func) {
802 sdio_claim_host(card->func);
803 sdio_release_irq(card->func);
804 sdio_disable_func(card->func);
805 sdio_release_host(card->func);
806 sdio_set_drvdata(card->func, NULL);
807 }
808
809 return 0;
810}
811
812static int btmrvl_sdio_enable_host_int(struct btmrvl_sdio_card *card)
813{
814 int ret;
815
816 if (!card || !card->func)
817 return -EINVAL;
818
819 sdio_claim_host(card->func);
820
821 ret = btmrvl_sdio_enable_host_int_mask(card, HIM_ENABLE);
822
823 btmrvl_sdio_get_rx_unit(card);
824
825 sdio_release_host(card->func);
826
827 return ret;
828}
829
830static int btmrvl_sdio_disable_host_int(struct btmrvl_sdio_card *card)
831{
832 int ret;
833
834 if (!card || !card->func)
835 return -EINVAL;
836
837 sdio_claim_host(card->func);
838
839 ret = btmrvl_sdio_disable_host_int_mask(card, HIM_DISABLE);
840
841 sdio_release_host(card->func);
842
843 return ret;
844}
845
846static int btmrvl_sdio_host_to_card(struct btmrvl_private *priv,
847 u8 *payload, u16 nb)
848{
849 struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
850 int ret = 0;
851 int buf_block_len;
852 int blksz;
853 int i = 0;
854 u8 *buf = NULL;
855 void *tmpbuf = NULL;
856 int tmpbufsz;
857
858 if (!card || !card->func) {
859 BT_ERR("card or function is NULL!");
860 return -EINVAL;
861 }
862
863 buf = payload;
864 if ((unsigned long) payload & (BTSDIO_DMA_ALIGN - 1)) {
865 tmpbufsz = ALIGN_SZ(nb, BTSDIO_DMA_ALIGN);
866 tmpbuf = kzalloc(tmpbufsz, GFP_KERNEL);
867 if (!tmpbuf)
868 return -ENOMEM;
869 buf = (u8 *) ALIGN_ADDR(tmpbuf, BTSDIO_DMA_ALIGN);
870 memcpy(buf, payload, nb);
871 }
872
873 blksz = SDIO_BLOCK_SIZE;
874 buf_block_len = DIV_ROUND_UP(nb, blksz);
875
876 sdio_claim_host(card->func);
877
878 do {
879 /* Transfer data to card */
880 ret = sdio_writesb(card->func, card->ioport, buf,
881 buf_block_len * blksz);
882 if (ret < 0) {
883 i++;
884 BT_ERR("i=%d writesb failed: %d", i, ret);
885 BT_ERR("hex: %*ph", nb, payload);
886 ret = -EIO;
887 if (i > MAX_WRITE_IOMEM_RETRY)
888 goto exit;
889 }
890 } while (ret);
891
892 priv->btmrvl_dev.tx_dnld_rdy = false;
893
894exit:
895 sdio_release_host(card->func);
896 kfree(tmpbuf);
897
898 return ret;
899}
900
901static int btmrvl_sdio_download_fw(struct btmrvl_sdio_card *card)
902{
903 int ret;
904 u8 fws0;
905 int pollnum = MAX_POLL_TRIES;
906
907 if (!card || !card->func) {
908 BT_ERR("card or function is NULL!");
909 return -EINVAL;
910 }
911
912 if (!btmrvl_sdio_verify_fw_download(card, 1)) {
913 BT_DBG("Firmware already downloaded!");
914 return 0;
915 }
916
917 sdio_claim_host(card->func);
918
919 /* Check if other function driver is downloading the firmware */
920 fws0 = sdio_readb(card->func, card->reg->card_fw_status0, &ret);
921 if (ret) {
922 BT_ERR("Failed to read FW downloading status!");
923 ret = -EIO;
924 goto done;
925 }
926 if (fws0) {
927 BT_DBG("BT not the winner (%#x). Skip FW downloading", fws0);
928
929 /* Give other function more time to download the firmware */
930 pollnum *= 10;
931 } else {
932 if (card->helper) {
933 ret = btmrvl_sdio_download_helper(card);
934 if (ret) {
935 BT_ERR("Failed to download helper!");
936 ret = -EIO;
937 goto done;
938 }
939 }
940
941 if (btmrvl_sdio_download_fw_w_helper(card)) {
942 BT_ERR("Failed to download firmware!");
943 ret = -EIO;
944 goto done;
945 }
946 }
947
948 sdio_release_host(card->func);
949
950 /*
951 * winner or not, with this test the FW synchronizes when the
952 * module can continue its initialization
953 */
954 if (btmrvl_sdio_verify_fw_download(card, pollnum)) {
955 BT_ERR("FW failed to be active in time!");
956 return -ETIMEDOUT;
957 }
958
959 return 0;
960
961done:
962 sdio_release_host(card->func);
963 return ret;
964}
965
966static int btmrvl_sdio_wakeup_fw(struct btmrvl_private *priv)
967{
968 struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
969 int ret = 0;
970
971 if (!card || !card->func) {
972 BT_ERR("card or function is NULL!");
973 return -EINVAL;
974 }
975
976 sdio_claim_host(card->func);
977
978 sdio_writeb(card->func, HOST_POWER_UP, card->reg->cfg, &ret);
979
980 sdio_release_host(card->func);
981
982 BT_DBG("wake up firmware");
983
984 return ret;
985}
986
987static int btmrvl_sdio_probe(struct sdio_func *func,
988 const struct sdio_device_id *id)
989{
990 int ret = 0;
991 struct btmrvl_private *priv = NULL;
992 struct btmrvl_sdio_card *card = NULL;
993
994 BT_INFO("vendor=0x%x, device=0x%x, class=%d, fn=%d",
995 id->vendor, id->device, id->class, func->num);
996
997 card = devm_kzalloc(&func->dev, sizeof(*card), GFP_KERNEL);
998 if (!card)
999 return -ENOMEM;
1000
1001 card->func = func;
1002
1003 if (id->driver_data) {
1004 struct btmrvl_sdio_device *data = (void *) id->driver_data;
1005 card->helper = data->helper;
1006 card->firmware = data->firmware;
1007 card->reg = data->reg;
1008 card->sd_blksz_fw_dl = data->sd_blksz_fw_dl;
1009 }
1010
1011 if (btmrvl_sdio_register_dev(card) < 0) {
1012 BT_ERR("Failed to register BT device!");
1013 return -ENODEV;
1014 }
1015
1016 /* Disable the interrupts on the card */
1017 btmrvl_sdio_disable_host_int(card);
1018
1019 if (btmrvl_sdio_download_fw(card)) {
1020 BT_ERR("Downloading firmware failed!");
1021 ret = -ENODEV;
1022 goto unreg_dev;
1023 }
1024
1025 btmrvl_sdio_enable_host_int(card);
1026
1027 priv = btmrvl_add_card(card);
1028 if (!priv) {
1029 BT_ERR("Initializing card failed!");
1030 ret = -ENODEV;
1031 goto disable_host_int;
1032 }
1033
1034 card->priv = priv;
1035
1036 /* Initialize the interface specific function pointers */
1037 priv->hw_host_to_card = btmrvl_sdio_host_to_card;
1038 priv->hw_wakeup_firmware = btmrvl_sdio_wakeup_fw;
1039 priv->hw_process_int_status = btmrvl_sdio_process_int_status;
1040
1041 if (btmrvl_register_hdev(priv)) {
1042 BT_ERR("Register hdev failed!");
1043 ret = -ENODEV;
1044 goto disable_host_int;
1045 }
1046
1047 return 0;
1048
1049disable_host_int:
1050 btmrvl_sdio_disable_host_int(card);
1051unreg_dev:
1052 btmrvl_sdio_unregister_dev(card);
1053 return ret;
1054}
1055
1056static void btmrvl_sdio_remove(struct sdio_func *func)
1057{
1058 struct btmrvl_sdio_card *card;
1059
1060 if (func) {
1061 card = sdio_get_drvdata(func);
1062 if (card) {
1063 /* Send SHUTDOWN command & disable interrupt
1064 * if user removes the module.
1065 */
1066 if (user_rmmod) {
1067 btmrvl_send_module_cfg_cmd(card->priv,
1068 MODULE_SHUTDOWN_REQ);
1069 btmrvl_sdio_disable_host_int(card);
1070 }
1071 BT_DBG("unregester dev");
1072 btmrvl_sdio_unregister_dev(card);
1073 btmrvl_remove_card(card->priv);
1074 }
1075 }
1076}
1077
1078static int btmrvl_sdio_suspend(struct device *dev)
1079{
1080 struct sdio_func *func = dev_to_sdio_func(dev);
1081 struct btmrvl_sdio_card *card;
1082 struct btmrvl_private *priv;
1083 mmc_pm_flag_t pm_flags;
1084 struct hci_dev *hcidev;
1085
1086 if (func) {
1087 pm_flags = sdio_get_host_pm_caps(func);
1088 BT_DBG("%s: suspend: PM flags = 0x%x", sdio_func_id(func),
1089 pm_flags);
1090 if (!(pm_flags & MMC_PM_KEEP_POWER)) {
1091 BT_ERR("%s: cannot remain alive while suspended",
1092 sdio_func_id(func));
1093 return -ENOSYS;
1094 }
1095 card = sdio_get_drvdata(func);
1096 if (!card || !card->priv) {
1097 BT_ERR("card or priv structure is not valid");
1098 return 0;
1099 }
1100 } else {
1101 BT_ERR("sdio_func is not specified");
1102 return 0;
1103 }
1104
1105 priv = card->priv;
1106
1107 if (priv->adapter->hs_state != HS_ACTIVATED) {
1108 if (btmrvl_enable_hs(priv)) {
1109 BT_ERR("HS not actived, suspend failed!");
1110 return -EBUSY;
1111 }
1112 }
1113 hcidev = priv->btmrvl_dev.hcidev;
1114 BT_DBG("%s: SDIO suspend", hcidev->name);
1115 hci_suspend_dev(hcidev);
1116 skb_queue_purge(&priv->adapter->tx_queue);
1117
1118 priv->adapter->is_suspended = true;
1119
1120 /* We will keep the power when hs enabled successfully */
1121 if (priv->adapter->hs_state == HS_ACTIVATED) {
1122 BT_DBG("suspend with MMC_PM_KEEP_POWER");
1123 return sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER);
1124 } else {
1125 BT_DBG("suspend without MMC_PM_KEEP_POWER");
1126 return 0;
1127 }
1128}
1129
1130static int btmrvl_sdio_resume(struct device *dev)
1131{
1132 struct sdio_func *func = dev_to_sdio_func(dev);
1133 struct btmrvl_sdio_card *card;
1134 struct btmrvl_private *priv;
1135 mmc_pm_flag_t pm_flags;
1136 struct hci_dev *hcidev;
1137
1138 if (func) {
1139 pm_flags = sdio_get_host_pm_caps(func);
1140 BT_DBG("%s: resume: PM flags = 0x%x", sdio_func_id(func),
1141 pm_flags);
1142 card = sdio_get_drvdata(func);
1143 if (!card || !card->priv) {
1144 BT_ERR("card or priv structure is not valid");
1145 return 0;
1146 }
1147 } else {
1148 BT_ERR("sdio_func is not specified");
1149 return 0;
1150 }
1151 priv = card->priv;
1152
1153 if (!priv->adapter->is_suspended) {
1154 BT_DBG("device already resumed");
1155 return 0;
1156 }
1157
1158 priv->adapter->is_suspended = false;
1159 hcidev = priv->btmrvl_dev.hcidev;
1160 BT_DBG("%s: SDIO resume", hcidev->name);
1161 hci_resume_dev(hcidev);
1162 priv->hw_wakeup_firmware(priv);
1163 priv->adapter->hs_state = HS_DEACTIVATED;
1164 BT_DBG("%s: HS DEACTIVATED in resume!", hcidev->name);
1165
1166 return 0;
1167}
1168
1169static const struct dev_pm_ops btmrvl_sdio_pm_ops = {
1170 .suspend = btmrvl_sdio_suspend,
1171 .resume = btmrvl_sdio_resume,
1172};
1173
1174static struct sdio_driver bt_mrvl_sdio = {
1175 .name = "btmrvl_sdio",
1176 .id_table = btmrvl_sdio_ids,
1177 .probe = btmrvl_sdio_probe,
1178 .remove = btmrvl_sdio_remove,
1179 .drv = {
1180 .owner = THIS_MODULE,
1181 .pm = &btmrvl_sdio_pm_ops,
1182 }
1183};
1184
1185static int __init btmrvl_sdio_init_module(void)
1186{
1187 if (sdio_register_driver(&bt_mrvl_sdio) != 0) {
1188 BT_ERR("SDIO Driver Registration Failed");
1189 return -ENODEV;
1190 }
1191
1192 /* Clear the flag in case user removes the card. */
1193 user_rmmod = 0;
1194
1195 return 0;
1196}
1197
1198static void __exit btmrvl_sdio_exit_module(void)
1199{
1200 /* Set the flag as user is removing this module. */
1201 user_rmmod = 1;
1202
1203 sdio_unregister_driver(&bt_mrvl_sdio);
1204}
1205
1206module_init(btmrvl_sdio_init_module);
1207module_exit(btmrvl_sdio_exit_module);
1208
1209MODULE_AUTHOR("Marvell International Ltd.");
1210MODULE_DESCRIPTION("Marvell BT-over-SDIO driver ver " VERSION);
1211MODULE_VERSION(VERSION);
1212MODULE_LICENSE("GPL v2");
1213MODULE_FIRMWARE("mrvl/sd8688_helper.bin");
1214MODULE_FIRMWARE("mrvl/sd8688.bin");
1215MODULE_FIRMWARE("mrvl/sd8787_uapsta.bin");
1216MODULE_FIRMWARE("mrvl/sd8797_uapsta.bin");
1217MODULE_FIRMWARE("mrvl/sd8897_uapsta.bin");