5b33b85790f24eb76c809a1d52f91b89e4abeac6
[pandora-kernel.git] / drivers / bluetooth / btmrvl_sdio.c
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
23 #include <linux/mmc/sdio_ids.h>
24 #include <linux/mmc/sdio_func.h>
25
26 #include <net/bluetooth/bluetooth.h>
27 #include <net/bluetooth/hci_core.h>
28
29 #include "btmrvl_drv.h"
30 #include "btmrvl_sdio.h"
31
32 #define VERSION "1.0"
33
34 /* The btmrvl_sdio_remove() callback function is called
35  * when user removes this module from kernel space or ejects
36  * the card from the slot. The driver handles these 2 cases
37  * differently.
38  * If the user is removing the module, a MODULE_SHUTDOWN_REQ
39  * command is sent to firmware and interrupt will be disabled.
40  * If the card is removed, there is no need to send command
41  * or disable interrupt.
42  *
43  * The variable 'user_rmmod' is used to distinguish these two
44  * scenarios. This flag is initialized as FALSE in case the card
45  * is removed, and will be set to TRUE for module removal when
46  * module_exit function is called.
47  */
48 static u8 user_rmmod;
49
50 static const struct btmrvl_sdio_device btmrvl_sdio_sd6888 = {
51         .helper         = "sd8688_helper.bin",
52         .firmware       = "sd8688.bin",
53 };
54
55 static const struct sdio_device_id btmrvl_sdio_ids[] = {
56         /* Marvell SD8688 Bluetooth device */
57         { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x9105),
58                         .driver_data = (unsigned long) &btmrvl_sdio_sd6888 },
59
60         { }     /* Terminating entry */
61 };
62
63 MODULE_DEVICE_TABLE(sdio, btmrvl_sdio_ids);
64
65 static int btmrvl_sdio_get_rx_unit(struct btmrvl_sdio_card *card)
66 {
67         u8 reg;
68         int ret;
69
70         reg = sdio_readb(card->func, CARD_RX_UNIT_REG, &ret);
71         if (!ret)
72                 card->rx_unit = reg;
73
74         return ret;
75 }
76
77 static int btmrvl_sdio_read_fw_status(struct btmrvl_sdio_card *card, u16 *dat)
78 {
79         u8 fws0, fws1;
80         int ret;
81
82         *dat = 0;
83
84         fws0 = sdio_readb(card->func, CARD_FW_STATUS0_REG, &ret);
85
86         if (!ret)
87                 fws1 = sdio_readb(card->func, CARD_FW_STATUS1_REG, &ret);
88
89         if (ret)
90                 return -EIO;
91
92         *dat = (((u16) fws1) << 8) | fws0;
93
94         return 0;
95 }
96
97 static int btmrvl_sdio_read_rx_len(struct btmrvl_sdio_card *card, u16 *dat)
98 {
99         u8 reg;
100         int ret;
101
102         reg = sdio_readb(card->func, CARD_RX_LEN_REG, &ret);
103         if (!ret)
104                 *dat = (u16) reg << card->rx_unit;
105
106         return ret;
107 }
108
109 static int btmrvl_sdio_enable_host_int_mask(struct btmrvl_sdio_card *card,
110                                                                 u8 mask)
111 {
112         int ret;
113
114         sdio_writeb(card->func, mask, HOST_INT_MASK_REG, &ret);
115         if (ret) {
116                 BT_ERR("Unable to enable the host interrupt!");
117                 ret = -EIO;
118         }
119
120         return ret;
121 }
122
123 static int btmrvl_sdio_disable_host_int_mask(struct btmrvl_sdio_card *card,
124                                                                 u8 mask)
125 {
126         u8 host_int_mask;
127         int ret;
128
129         host_int_mask = sdio_readb(card->func, HOST_INT_MASK_REG, &ret);
130         if (ret)
131                 return -EIO;
132
133         host_int_mask &= ~mask;
134
135         sdio_writeb(card->func, host_int_mask, HOST_INT_MASK_REG, &ret);
136         if (ret < 0) {
137                 BT_ERR("Unable to disable the host interrupt!");
138                 return -EIO;
139         }
140
141         return 0;
142 }
143
144 static int btmrvl_sdio_poll_card_status(struct btmrvl_sdio_card *card, u8 bits)
145 {
146         unsigned int tries;
147         u8 status;
148         int ret;
149
150         for (tries = 0; tries < MAX_POLL_TRIES * 1000; tries++) {
151                 status = sdio_readb(card->func, CARD_STATUS_REG, &ret);
152                 if (ret)
153                         goto failed;
154                 if ((status & bits) == bits)
155                         return ret;
156
157                 udelay(1);
158         }
159
160         ret = -ETIMEDOUT;
161
162 failed:
163         BT_ERR("FAILED! ret=%d", ret);
164
165         return ret;
166 }
167
168 static int btmrvl_sdio_verify_fw_download(struct btmrvl_sdio_card *card,
169                                                                 int pollnum)
170 {
171         int ret = -ETIMEDOUT;
172         u16 firmwarestat;
173         unsigned int tries;
174
175          /* Wait for firmware to become ready */
176         for (tries = 0; tries < pollnum; tries++) {
177                 if (btmrvl_sdio_read_fw_status(card, &firmwarestat) < 0)
178                         continue;
179
180                 if (firmwarestat == FIRMWARE_READY) {
181                         ret = 0;
182                         break;
183                 } else {
184                         msleep(10);
185                 }
186         }
187
188         return ret;
189 }
190
191 static int btmrvl_sdio_download_helper(struct btmrvl_sdio_card *card)
192 {
193         const struct firmware *fw_helper = NULL;
194         const u8 *helper = NULL;
195         int ret;
196         void *tmphlprbuf = NULL;
197         int tmphlprbufsz, hlprblknow, helperlen;
198         u8 *helperbuf;
199         u32 tx_len;
200
201         ret = request_firmware(&fw_helper, card->helper,
202                                                 &card->func->dev);
203         if ((ret < 0) || !fw_helper) {
204                 BT_ERR("request_firmware(helper) failed, error code = %d",
205                                                                         ret);
206                 ret = -ENOENT;
207                 goto done;
208         }
209
210         helper = fw_helper->data;
211         helperlen = fw_helper->size;
212
213         BT_DBG("Downloading helper image (%d bytes), block size %d bytes",
214                                                 helperlen, SDIO_BLOCK_SIZE);
215
216         tmphlprbufsz = ALIGN_SZ(BTM_UPLD_SIZE, BTSDIO_DMA_ALIGN);
217
218         tmphlprbuf = kmalloc(tmphlprbufsz, GFP_KERNEL);
219         if (!tmphlprbuf) {
220                 BT_ERR("Unable to allocate buffer for helper."
221                         " Terminating download");
222                 ret = -ENOMEM;
223                 goto done;
224         }
225
226         memset(tmphlprbuf, 0, tmphlprbufsz);
227
228         helperbuf = (u8 *) ALIGN_ADDR(tmphlprbuf, BTSDIO_DMA_ALIGN);
229
230         /* Perform helper data transfer */
231         tx_len = (FIRMWARE_TRANSFER_NBLOCK * SDIO_BLOCK_SIZE)
232                         - SDIO_HEADER_LEN;
233         hlprblknow = 0;
234
235         do {
236                 ret = btmrvl_sdio_poll_card_status(card,
237                                             CARD_IO_READY | DN_LD_CARD_RDY);
238                 if (ret < 0) {
239                         BT_ERR("Helper download poll status timeout @ %d",
240                                 hlprblknow);
241                         goto done;
242                 }
243
244                 /* Check if there is more data? */
245                 if (hlprblknow >= helperlen)
246                         break;
247
248                 if (helperlen - hlprblknow < tx_len)
249                         tx_len = helperlen - hlprblknow;
250
251                 /* Little-endian */
252                 helperbuf[0] = ((tx_len & 0x000000ff) >> 0);
253                 helperbuf[1] = ((tx_len & 0x0000ff00) >> 8);
254                 helperbuf[2] = ((tx_len & 0x00ff0000) >> 16);
255                 helperbuf[3] = ((tx_len & 0xff000000) >> 24);
256
257                 memcpy(&helperbuf[SDIO_HEADER_LEN], &helper[hlprblknow],
258                                 tx_len);
259
260                 /* Now send the data */
261                 ret = sdio_writesb(card->func, card->ioport, helperbuf,
262                                 FIRMWARE_TRANSFER_NBLOCK * SDIO_BLOCK_SIZE);
263                 if (ret < 0) {
264                         BT_ERR("IO error during helper download @ %d",
265                                 hlprblknow);
266                         goto done;
267                 }
268
269                 hlprblknow += tx_len;
270         } while (true);
271
272         BT_DBG("Transferring helper image EOF block");
273
274         memset(helperbuf, 0x0, SDIO_BLOCK_SIZE);
275
276         ret = sdio_writesb(card->func, card->ioport, helperbuf,
277                                                         SDIO_BLOCK_SIZE);
278         if (ret < 0) {
279                 BT_ERR("IO error in writing helper image EOF block");
280                 goto done;
281         }
282
283         ret = 0;
284
285 done:
286         kfree(tmphlprbuf);
287         if (fw_helper)
288                 release_firmware(fw_helper);
289
290         return ret;
291 }
292
293 static int btmrvl_sdio_download_fw_w_helper(struct btmrvl_sdio_card *card)
294 {
295         const struct firmware *fw_firmware = NULL;
296         const u8 *firmware = NULL;
297         int firmwarelen, tmpfwbufsz, ret;
298         unsigned int tries, offset;
299         u8 base0, base1;
300         void *tmpfwbuf = NULL;
301         u8 *fwbuf;
302         u16 len;
303         int txlen = 0, tx_blocks = 0, count = 0;
304
305         ret = request_firmware(&fw_firmware, card->firmware,
306                                                         &card->func->dev);
307         if ((ret < 0) || !fw_firmware) {
308                 BT_ERR("request_firmware(firmware) failed, error code = %d",
309                                                                         ret);
310                 ret = -ENOENT;
311                 goto done;
312         }
313
314         firmware = fw_firmware->data;
315         firmwarelen = fw_firmware->size;
316
317         BT_DBG("Downloading FW image (%d bytes)", firmwarelen);
318
319         tmpfwbufsz = ALIGN_SZ(BTM_UPLD_SIZE, BTSDIO_DMA_ALIGN);
320         tmpfwbuf = kmalloc(tmpfwbufsz, GFP_KERNEL);
321         if (!tmpfwbuf) {
322                 BT_ERR("Unable to allocate buffer for firmware."
323                        " Terminating download");
324                 ret = -ENOMEM;
325                 goto done;
326         }
327
328         memset(tmpfwbuf, 0, tmpfwbufsz);
329
330         /* Ensure aligned firmware buffer */
331         fwbuf = (u8 *) ALIGN_ADDR(tmpfwbuf, BTSDIO_DMA_ALIGN);
332
333         /* Perform firmware data transfer */
334         offset = 0;
335         do {
336                 ret = btmrvl_sdio_poll_card_status(card,
337                                         CARD_IO_READY | DN_LD_CARD_RDY);
338                 if (ret < 0) {
339                         BT_ERR("FW download with helper poll status"
340                                                 " timeout @ %d", offset);
341                         goto done;
342                 }
343
344                 /* Check if there is more data ? */
345                 if (offset >= firmwarelen)
346                         break;
347
348                 for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
349                         base0 = sdio_readb(card->func,
350                                         SQ_READ_BASE_ADDRESS_A0_REG, &ret);
351                         if (ret) {
352                                 BT_ERR("BASE0 register read failed:"
353                                         " base0 = 0x%04X(%d)."
354                                         " Terminating download",
355                                         base0, base0);
356                                 ret = -EIO;
357                                 goto done;
358                         }
359                         base1 = sdio_readb(card->func,
360                                         SQ_READ_BASE_ADDRESS_A1_REG, &ret);
361                         if (ret) {
362                                 BT_ERR("BASE1 register read failed:"
363                                         " base1 = 0x%04X(%d)."
364                                         " Terminating download",
365                                         base1, base1);
366                                 ret = -EIO;
367                                 goto done;
368                         }
369
370                         len = (((u16) base1) << 8) | base0;
371                         if (len)
372                                 break;
373
374                         udelay(10);
375                 }
376
377                 if (!len)
378                         break;
379                 else if (len > BTM_UPLD_SIZE) {
380                         BT_ERR("FW download failure @%d, invalid length %d",
381                                                                 offset, len);
382                         ret = -EINVAL;
383                         goto done;
384                 }
385
386                 txlen = len;
387
388                 if (len & BIT(0)) {
389                         count++;
390                         if (count > MAX_WRITE_IOMEM_RETRY) {
391                                 BT_ERR("FW download failure @%d, "
392                                         "over max retry count", offset);
393                                 ret = -EIO;
394                                 goto done;
395                         }
396                         BT_ERR("FW CRC error indicated by the helper: "
397                                 "len = 0x%04X, txlen = %d", len, txlen);
398                         len &= ~BIT(0);
399                         /* Set txlen to 0 so as to resend from same offset */
400                         txlen = 0;
401                 } else {
402                         count = 0;
403
404                         /* Last block ? */
405                         if (firmwarelen - offset < txlen)
406                                 txlen = firmwarelen - offset;
407
408                         tx_blocks =
409                             (txlen + SDIO_BLOCK_SIZE - 1) / SDIO_BLOCK_SIZE;
410
411                         memcpy(fwbuf, &firmware[offset], txlen);
412                 }
413
414                 ret = sdio_writesb(card->func, card->ioport, fwbuf,
415                                         tx_blocks * SDIO_BLOCK_SIZE);
416
417                 if (ret < 0) {
418                         BT_ERR("FW download, writesb(%d) failed @%d",
419                                                         count, offset);
420                         sdio_writeb(card->func, HOST_CMD53_FIN, CONFIG_REG,
421                                                                         &ret);
422                         if (ret)
423                                 BT_ERR("writeb failed (CFG)");
424                 }
425
426                 offset += txlen;
427         } while (true);
428
429         BT_DBG("FW download over, size %d bytes", offset);
430
431         ret = 0;
432
433 done:
434         kfree(tmpfwbuf);
435
436         if (fw_firmware)
437                 release_firmware(fw_firmware);
438
439         return ret;
440 }
441
442 static int btmrvl_sdio_card_to_host(struct btmrvl_private *priv)
443 {
444         u16 buf_len = 0;
445         int ret, buf_block_len, blksz;
446         struct sk_buff *skb = NULL;
447         u32 type;
448         u8 *payload = NULL;
449         struct hci_dev *hdev = priv->btmrvl_dev.hcidev;
450         struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
451
452         if (!card || !card->func) {
453                 BT_ERR("card or function is NULL!");
454                 ret = -EINVAL;
455                 goto exit;
456         }
457
458         /* Read the length of data to be transferred */
459         ret = btmrvl_sdio_read_rx_len(card, &buf_len);
460         if (ret < 0) {
461                 BT_ERR("read rx_len failed");
462                 ret = -EIO;
463                 goto exit;
464         }
465
466         blksz = SDIO_BLOCK_SIZE;
467         buf_block_len = (buf_len + blksz - 1) / blksz;
468
469         if (buf_len <= SDIO_HEADER_LEN
470                         || (buf_block_len * blksz) > ALLOC_BUF_SIZE) {
471                 BT_ERR("invalid packet length: %d", buf_len);
472                 ret = -EINVAL;
473                 goto exit;
474         }
475
476         /* Allocate buffer */
477         skb = bt_skb_alloc(buf_block_len * blksz + BTSDIO_DMA_ALIGN,
478                                                                 GFP_ATOMIC);
479         if (skb == NULL) {
480                 BT_ERR("No free skb");
481                 goto exit;
482         }
483
484         if ((unsigned long) skb->data & (BTSDIO_DMA_ALIGN - 1)) {
485                 skb_put(skb, (unsigned long) skb->data &
486                                         (BTSDIO_DMA_ALIGN - 1));
487                 skb_pull(skb, (unsigned long) skb->data &
488                                         (BTSDIO_DMA_ALIGN - 1));
489         }
490
491         payload = skb->data;
492
493         ret = sdio_readsb(card->func, payload, card->ioport,
494                           buf_block_len * blksz);
495         if (ret < 0) {
496                 BT_ERR("readsb failed: %d", ret);
497                 ret = -EIO;
498                 goto exit;
499         }
500
501         /* This is SDIO specific header length: byte[2][1][0], type: byte[3]
502          * (HCI_COMMAND = 1, ACL_DATA = 2, SCO_DATA = 3, 0xFE = Vendor)
503          */
504
505         buf_len = payload[0];
506         buf_len |= (u16) payload[1] << 8;
507         type = payload[3];
508
509         switch (type) {
510         case HCI_ACLDATA_PKT:
511         case HCI_SCODATA_PKT:
512         case HCI_EVENT_PKT:
513                 bt_cb(skb)->pkt_type = type;
514                 skb->dev = (void *)hdev;
515                 skb_put(skb, buf_len);
516                 skb_pull(skb, SDIO_HEADER_LEN);
517
518                 if (type == HCI_EVENT_PKT)
519                         btmrvl_check_evtpkt(priv, skb);
520
521                 hci_recv_frame(skb);
522                 hdev->stat.byte_rx += buf_len;
523                 break;
524
525         case MRVL_VENDOR_PKT:
526                 bt_cb(skb)->pkt_type = HCI_VENDOR_PKT;
527                 skb->dev = (void *)hdev;
528                 skb_put(skb, buf_len);
529                 skb_pull(skb, SDIO_HEADER_LEN);
530
531                 if (btmrvl_process_event(priv, skb))
532                         hci_recv_frame(skb);
533
534                 hdev->stat.byte_rx += buf_len;
535                 break;
536
537         default:
538                 BT_ERR("Unknow packet type:%d", type);
539                 print_hex_dump_bytes("", DUMP_PREFIX_OFFSET, payload,
540                                                 blksz * buf_block_len);
541
542                 kfree_skb(skb);
543                 skb = NULL;
544                 break;
545         }
546
547 exit:
548         if (ret) {
549                 hdev->stat.err_rx++;
550                 if (skb)
551                         kfree_skb(skb);
552         }
553
554         return ret;
555 }
556
557 static int btmrvl_sdio_get_int_status(struct btmrvl_private *priv, u8 * ireg)
558 {
559         int ret;
560         u8 sdio_ireg = 0;
561         struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
562
563         *ireg = 0;
564
565         sdio_ireg = sdio_readb(card->func, HOST_INTSTATUS_REG, &ret);
566         if (ret) {
567                 BT_ERR("sdio_readb: read int status register failed");
568                 ret = -EIO;
569                 goto done;
570         }
571
572         if (sdio_ireg != 0) {
573                 /*
574                  * DN_LD_HOST_INT_STATUS and/or UP_LD_HOST_INT_STATUS
575                  * Clear the interrupt status register and re-enable the
576                  * interrupt.
577                  */
578                 BT_DBG("sdio_ireg = 0x%x", sdio_ireg);
579
580                 sdio_writeb(card->func, ~(sdio_ireg) & (DN_LD_HOST_INT_STATUS |
581                                                         UP_LD_HOST_INT_STATUS),
582                             HOST_INTSTATUS_REG, &ret);
583                 if (ret) {
584                         BT_ERR("sdio_writeb: clear int status register "
585                                 "failed");
586                         ret = -EIO;
587                         goto done;
588                 }
589         }
590
591         if (sdio_ireg & DN_LD_HOST_INT_STATUS) {
592                 if (priv->btmrvl_dev.tx_dnld_rdy)
593                         BT_DBG("tx_done already received: "
594                                 " int_status=0x%x", sdio_ireg);
595                 else
596                         priv->btmrvl_dev.tx_dnld_rdy = true;
597         }
598
599         if (sdio_ireg & UP_LD_HOST_INT_STATUS)
600                 btmrvl_sdio_card_to_host(priv);
601
602         *ireg = sdio_ireg;
603
604         ret = 0;
605
606 done:
607         return ret;
608 }
609
610 static void btmrvl_sdio_interrupt(struct sdio_func *func)
611 {
612         struct btmrvl_private *priv;
613         struct hci_dev *hcidev;
614         struct btmrvl_sdio_card *card;
615         u8 ireg = 0;
616
617         card = sdio_get_drvdata(func);
618         if (card && card->priv) {
619                 priv = card->priv;
620                 hcidev = priv->btmrvl_dev.hcidev;
621
622                 if (btmrvl_sdio_get_int_status(priv, &ireg))
623                         BT_ERR("reading HOST_INT_STATUS_REG failed");
624                 else
625                         BT_DBG("HOST_INT_STATUS_REG %#x", ireg);
626
627                 btmrvl_interrupt(priv);
628         }
629 }
630
631 static int btmrvl_sdio_register_dev(struct btmrvl_sdio_card *card)
632 {
633         struct sdio_func *func;
634         u8 reg;
635         int ret = 0;
636
637         if (!card || !card->func) {
638                 BT_ERR("Error: card or function is NULL!");
639                 ret = -EINVAL;
640                 goto failed;
641         }
642
643         func = card->func;
644
645         sdio_claim_host(func);
646
647         ret = sdio_enable_func(func);
648         if (ret) {
649                 BT_ERR("sdio_enable_func() failed: ret=%d", ret);
650                 ret = -EIO;
651                 goto release_host;
652         }
653
654         ret = sdio_claim_irq(func, btmrvl_sdio_interrupt);
655         if (ret) {
656                 BT_ERR("sdio_claim_irq failed: ret=%d", ret);
657                 ret = -EIO;
658                 goto disable_func;
659         }
660
661         ret = sdio_set_block_size(card->func, SDIO_BLOCK_SIZE);
662         if (ret) {
663                 BT_ERR("cannot set SDIO block size");
664                 ret = -EIO;
665                 goto release_irq;
666         }
667
668         reg = sdio_readb(func, IO_PORT_0_REG, &ret);
669         if (ret < 0) {
670                 ret = -EIO;
671                 goto release_irq;
672         }
673
674         card->ioport = reg;
675
676         reg = sdio_readb(func, IO_PORT_1_REG, &ret);
677         if (ret < 0) {
678                 ret = -EIO;
679                 goto release_irq;
680         }
681
682         card->ioport |= (reg << 8);
683
684         reg = sdio_readb(func, IO_PORT_2_REG, &ret);
685         if (ret < 0) {
686                 ret = -EIO;
687                 goto release_irq;
688         }
689
690         card->ioport |= (reg << 16);
691
692         BT_DBG("SDIO FUNC%d IO port: 0x%x", func->num, card->ioport);
693
694         sdio_set_drvdata(func, card);
695
696         sdio_release_host(func);
697
698         return 0;
699
700 release_irq:
701         sdio_release_irq(func);
702
703 disable_func:
704         sdio_disable_func(func);
705
706 release_host:
707         sdio_release_host(func);
708
709 failed:
710         return ret;
711 }
712
713 static int btmrvl_sdio_unregister_dev(struct btmrvl_sdio_card *card)
714 {
715         if (card && card->func) {
716                 sdio_claim_host(card->func);
717                 sdio_release_irq(card->func);
718                 sdio_disable_func(card->func);
719                 sdio_release_host(card->func);
720                 sdio_set_drvdata(card->func, NULL);
721         }
722
723         return 0;
724 }
725
726 static int btmrvl_sdio_enable_host_int(struct btmrvl_sdio_card *card)
727 {
728         int ret;
729
730         if (!card || !card->func)
731                 return -EINVAL;
732
733         sdio_claim_host(card->func);
734
735         ret = btmrvl_sdio_enable_host_int_mask(card, HIM_ENABLE);
736
737         btmrvl_sdio_get_rx_unit(card);
738
739         sdio_release_host(card->func);
740
741         return ret;
742 }
743
744 static int btmrvl_sdio_disable_host_int(struct btmrvl_sdio_card *card)
745 {
746         int ret;
747
748         if (!card || !card->func)
749                 return -EINVAL;
750
751         sdio_claim_host(card->func);
752
753         ret = btmrvl_sdio_disable_host_int_mask(card, HIM_DISABLE);
754
755         sdio_release_host(card->func);
756
757         return ret;
758 }
759
760 static int btmrvl_sdio_host_to_card(struct btmrvl_private *priv,
761                                 u8 *payload, u16 nb)
762 {
763         struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
764         int ret = 0;
765         int buf_block_len;
766         int blksz;
767         int i = 0;
768         u8 *buf = NULL;
769         void *tmpbuf = NULL;
770         int tmpbufsz;
771
772         if (!card || !card->func) {
773                 BT_ERR("card or function is NULL!");
774                 return -EINVAL;
775         }
776
777         buf = payload;
778         if ((unsigned long) payload & (BTSDIO_DMA_ALIGN - 1)) {
779                 tmpbufsz = ALIGN_SZ(nb, BTSDIO_DMA_ALIGN);
780                 tmpbuf = kzalloc(tmpbufsz, GFP_KERNEL);
781                 if (!tmpbuf)
782                         return -ENOMEM;
783                 buf = (u8 *) ALIGN_ADDR(tmpbuf, BTSDIO_DMA_ALIGN);
784                 memcpy(buf, payload, nb);
785         }
786
787         blksz = SDIO_BLOCK_SIZE;
788         buf_block_len = (nb + blksz - 1) / blksz;
789
790         sdio_claim_host(card->func);
791
792         do {
793                 /* Transfer data to card */
794                 ret = sdio_writesb(card->func, card->ioport, buf,
795                                    buf_block_len * blksz);
796                 if (ret < 0) {
797                         i++;
798                         BT_ERR("i=%d writesb failed: %d", i, ret);
799                         print_hex_dump_bytes("", DUMP_PREFIX_OFFSET,
800                                                 payload, nb);
801                         ret = -EIO;
802                         if (i > MAX_WRITE_IOMEM_RETRY)
803                                 goto exit;
804                 }
805         } while (ret);
806
807         priv->btmrvl_dev.tx_dnld_rdy = false;
808
809 exit:
810         sdio_release_host(card->func);
811
812         return ret;
813 }
814
815 static int btmrvl_sdio_download_fw(struct btmrvl_sdio_card *card)
816 {
817         int ret = 0;
818
819         if (!card || !card->func) {
820                 BT_ERR("card or function is NULL!");
821                 return -EINVAL;
822         }
823         sdio_claim_host(card->func);
824
825         if (!btmrvl_sdio_verify_fw_download(card, 1)) {
826                 BT_DBG("Firmware already downloaded!");
827                 goto done;
828         }
829
830         ret = btmrvl_sdio_download_helper(card);
831         if (ret) {
832                 BT_ERR("Failed to download helper!");
833                 ret = -EIO;
834                 goto done;
835         }
836
837         if (btmrvl_sdio_download_fw_w_helper(card)) {
838                 BT_ERR("Failed to download firmware!");
839                 ret = -EIO;
840                 goto done;
841         }
842
843         if (btmrvl_sdio_verify_fw_download(card, MAX_POLL_TRIES)) {
844                 BT_ERR("FW failed to be active in time!");
845                 ret = -ETIMEDOUT;
846                 goto done;
847         }
848
849 done:
850         sdio_release_host(card->func);
851
852         return ret;
853 }
854
855 static int btmrvl_sdio_wakeup_fw(struct btmrvl_private *priv)
856 {
857         struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
858         int ret = 0;
859
860         if (!card || !card->func) {
861                 BT_ERR("card or function is NULL!");
862                 return -EINVAL;
863         }
864
865         sdio_claim_host(card->func);
866
867         sdio_writeb(card->func, HOST_POWER_UP, CONFIG_REG, &ret);
868
869         sdio_release_host(card->func);
870
871         BT_DBG("wake up firmware");
872
873         return ret;
874 }
875
876 static int btmrvl_sdio_probe(struct sdio_func *func,
877                                         const struct sdio_device_id *id)
878 {
879         int ret = 0;
880         struct btmrvl_private *priv = NULL;
881         struct btmrvl_sdio_card *card = NULL;
882
883         BT_INFO("vendor=0x%x, device=0x%x, class=%d, fn=%d",
884                         id->vendor, id->device, id->class, func->num);
885
886         card = kzalloc(sizeof(*card), GFP_KERNEL);
887         if (!card) {
888                 ret = -ENOMEM;
889                 goto done;
890         }
891
892         card->func = func;
893
894         if (id->driver_data) {
895                 struct btmrvl_sdio_device *data = (void *) id->driver_data;
896                 card->helper   = data->helper;
897                 card->firmware = data->firmware;
898         }
899
900         if (btmrvl_sdio_register_dev(card) < 0) {
901                 BT_ERR("Failed to register BT device!");
902                 ret = -ENODEV;
903                 goto free_card;
904         }
905
906         /* Disable the interrupts on the card */
907         btmrvl_sdio_disable_host_int(card);
908
909         if (btmrvl_sdio_download_fw(card)) {
910                 BT_ERR("Downloading firmware failed!");
911                 ret = -ENODEV;
912                 goto unreg_dev;
913         }
914
915         msleep(100);
916
917         btmrvl_sdio_enable_host_int(card);
918
919         priv = btmrvl_add_card(card);
920         if (!priv) {
921                 BT_ERR("Initializing card failed!");
922                 ret = -ENODEV;
923                 goto disable_host_int;
924         }
925
926         card->priv = priv;
927
928         /* Initialize the interface specific function pointers */
929         priv->hw_host_to_card = btmrvl_sdio_host_to_card;
930         priv->hw_wakeup_firmware = btmrvl_sdio_wakeup_fw;
931
932         btmrvl_send_module_cfg_cmd(priv, MODULE_BRINGUP_REQ);
933
934         return 0;
935
936 disable_host_int:
937         btmrvl_sdio_disable_host_int(card);
938 unreg_dev:
939         btmrvl_sdio_unregister_dev(card);
940 free_card:
941         kfree(card);
942 done:
943         return ret;
944 }
945
946 static void btmrvl_sdio_remove(struct sdio_func *func)
947 {
948         struct btmrvl_sdio_card *card;
949
950         if (func) {
951                 card = sdio_get_drvdata(func);
952                 if (card) {
953                         /* Send SHUTDOWN command & disable interrupt
954                          * if user removes the module.
955                          */
956                         if (user_rmmod) {
957                                 btmrvl_send_module_cfg_cmd(card->priv,
958                                                         MODULE_SHUTDOWN_REQ);
959                                 btmrvl_sdio_disable_host_int(card);
960                         }
961                         BT_DBG("unregester dev");
962                         btmrvl_sdio_unregister_dev(card);
963                         btmrvl_remove_card(card->priv);
964                         kfree(card);
965                 }
966         }
967 }
968
969 static struct sdio_driver bt_mrvl_sdio = {
970         .name           = "btmrvl_sdio",
971         .id_table       = btmrvl_sdio_ids,
972         .probe          = btmrvl_sdio_probe,
973         .remove         = btmrvl_sdio_remove,
974 };
975
976 static int btmrvl_sdio_init_module(void)
977 {
978         if (sdio_register_driver(&bt_mrvl_sdio) != 0) {
979                 BT_ERR("SDIO Driver Registration Failed");
980                 return -ENODEV;
981         }
982
983         /* Clear the flag in case user removes the card. */
984         user_rmmod = 0;
985
986         return 0;
987 }
988
989 static void btmrvl_sdio_exit_module(void)
990 {
991         /* Set the flag as user is removing this module. */
992         user_rmmod = 1;
993
994         sdio_unregister_driver(&bt_mrvl_sdio);
995 }
996
997 module_init(btmrvl_sdio_init_module);
998 module_exit(btmrvl_sdio_exit_module);
999
1000 MODULE_AUTHOR("Marvell International Ltd.");
1001 MODULE_DESCRIPTION("Marvell BT-over-SDIO driver ver " VERSION);
1002 MODULE_VERSION(VERSION);
1003 MODULE_LICENSE("GPL v2");