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