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