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