2 * linux/drivers/net/wireless/libertas/if_sdio.c
4 * Copyright 2007-2008 Pierre Ossman
6 * Inspired by if_cs.c, Copyright 2007 Holger Schurig
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or (at
11 * your option) any later version.
13 * This hardware has more or less no CMD53 support, so all registers
14 * must be accessed using sdio_readb()/sdio_writeb().
16 * Transfers must be in one transaction or the firmware goes bonkers.
17 * This means that the transfer must either be small enough to do a
18 * byte based transfer or it must be padded to a multiple of the
21 * As SDIO is still new to the kernel, it is unfortunately common with
22 * bugs in the host controllers related to that. One such bug is that
23 * controllers cannot do transfers that aren't a multiple of 4 bytes.
24 * If you don't have time to fix the host controller driver, you can
25 * work around the problem by modifying if_sdio_host_to_card() and
26 * if_sdio_card_to_host() to pad the data.
29 #include <linux/kernel.h>
30 #include <linux/moduleparam.h>
31 #include <linux/firmware.h>
32 #include <linux/netdevice.h>
33 #include <linux/delay.h>
34 #include <linux/mmc/card.h>
35 #include <linux/mmc/sdio_func.h>
36 #include <linux/mmc/sdio_ids.h>
45 /* The if_sdio_remove() callback function is called when
46 * user removes this module from kernel space or ejects
47 * the card from the slot. The driver handles these 2 cases
48 * differently for SD8688 combo chip.
49 * If the user is removing the module, the FUNC_SHUTDOWN
50 * command for SD8688 is sent to the firmware.
51 * If the card is removed, there is no need to send this command.
53 * The variable 'user_rmmod' is used to distinguish these two
54 * scenarios. This flag is initialized as FALSE in case the card
55 * is removed, and will be set to TRUE for module removal when
56 * module_exit function is called.
60 static char *lbs_helper_name
= NULL
;
61 module_param_named(helper_name
, lbs_helper_name
, charp
, 0644);
63 static char *lbs_fw_name
= NULL
;
64 module_param_named(fw_name
, lbs_fw_name
, charp
, 0644);
66 static const struct sdio_device_id if_sdio_ids
[] = {
67 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL
,
68 SDIO_DEVICE_ID_MARVELL_LIBERTAS
) },
69 { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL
,
70 SDIO_DEVICE_ID_MARVELL_8688WLAN
) },
71 { /* end: all zeroes */ },
74 MODULE_DEVICE_TABLE(sdio
, if_sdio_ids
);
76 struct if_sdio_model
{
82 static struct if_sdio_model if_sdio_models
[] = {
85 .model
= IF_SDIO_MODEL_8385
,
86 .helper
= "sd8385_helper.bin",
87 .firmware
= "sd8385.bin",
91 .model
= IF_SDIO_MODEL_8686
,
92 .helper
= "sd8686_helper.bin",
93 .firmware
= "sd8686.bin",
97 .model
= IF_SDIO_MODEL_8688
,
98 .helper
= "sd8688_helper.bin",
99 .firmware
= "sd8688.bin",
102 MODULE_FIRMWARE("sd8385_helper.bin");
103 MODULE_FIRMWARE("sd8385.bin");
104 MODULE_FIRMWARE("sd8686_helper.bin");
105 MODULE_FIRMWARE("sd8686.bin");
106 MODULE_FIRMWARE("sd8688_helper.bin");
107 MODULE_FIRMWARE("sd8688.bin");
109 struct if_sdio_packet
{
110 struct if_sdio_packet
*next
;
112 u8 buffer
[0] __attribute__((aligned(4)));
115 struct if_sdio_card
{
116 struct sdio_func
*func
;
117 struct lbs_private
*priv
;
120 unsigned long ioport
;
121 unsigned int scratch_reg
;
124 const char *firmware
;
129 struct if_sdio_packet
*packets
;
131 struct workqueue_struct
*workqueue
;
132 struct work_struct packet_worker
;
137 /********************************************************************/
139 /********************************************************************/
142 * For SD8385/SD8686, this function reads firmware status after
143 * the image is downloaded, or reads RX packet length when
144 * interrupt (with IF_SDIO_H_INT_UPLD bit set) is received.
145 * For SD8688, this function reads firmware status only.
147 static u16
if_sdio_read_scratch(struct if_sdio_card
*card
, int *err
)
152 scratch
= sdio_readb(card
->func
, card
->scratch_reg
, &ret
);
154 scratch
|= sdio_readb(card
->func
, card
->scratch_reg
+ 1,
166 static u8
if_sdio_read_rx_unit(struct if_sdio_card
*card
)
171 rx_unit
= sdio_readb(card
->func
, IF_SDIO_RX_UNIT
, &ret
);
179 static u16
if_sdio_read_rx_len(struct if_sdio_card
*card
, int *err
)
184 switch (card
->model
) {
185 case IF_SDIO_MODEL_8385
:
186 case IF_SDIO_MODEL_8686
:
187 rx_len
= if_sdio_read_scratch(card
, &ret
);
189 case IF_SDIO_MODEL_8688
:
190 default: /* for newer chipsets */
191 rx_len
= sdio_readb(card
->func
, IF_SDIO_RX_LEN
, &ret
);
193 rx_len
<<= card
->rx_unit
;
195 rx_len
= 0xffff; /* invalid length */
206 static int if_sdio_handle_cmd(struct if_sdio_card
*card
,
207 u8
*buffer
, unsigned size
)
209 struct lbs_private
*priv
= card
->priv
;
214 lbs_deb_enter(LBS_DEB_SDIO
);
216 if (size
> LBS_CMD_BUFFER_SIZE
) {
217 lbs_deb_sdio("response packet too large (%d bytes)\n",
223 spin_lock_irqsave(&priv
->driver_lock
, flags
);
225 i
= (priv
->resp_idx
== 0) ? 1 : 0;
226 BUG_ON(priv
->resp_len
[i
]);
227 priv
->resp_len
[i
] = size
;
228 memcpy(priv
->resp_buf
[i
], buffer
, size
);
229 lbs_notify_command_response(priv
, i
);
231 spin_unlock_irqrestore(&card
->priv
->driver_lock
, flags
);
236 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
240 static int if_sdio_handle_data(struct if_sdio_card
*card
,
241 u8
*buffer
, unsigned size
)
247 lbs_deb_enter(LBS_DEB_SDIO
);
249 if (size
> MRVDRV_ETH_RX_PACKET_BUFFER_SIZE
) {
250 lbs_deb_sdio("response packet too large (%d bytes)\n",
256 skb
= dev_alloc_skb(MRVDRV_ETH_RX_PACKET_BUFFER_SIZE
+ NET_IP_ALIGN
);
262 skb_reserve(skb
, NET_IP_ALIGN
);
264 data
= skb_put(skb
, size
);
266 memcpy(data
, buffer
, size
);
268 lbs_process_rxed_packet(card
->priv
, skb
);
273 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
278 static int if_sdio_handle_event(struct if_sdio_card
*card
,
279 u8
*buffer
, unsigned size
)
284 lbs_deb_enter(LBS_DEB_SDIO
);
286 if (card
->model
== IF_SDIO_MODEL_8385
) {
287 event
= sdio_readb(card
->func
, IF_SDIO_EVENT
, &ret
);
291 /* right shift 3 bits to get the event id */
295 lbs_deb_sdio("event packet too small (%d bytes)\n",
300 event
= buffer
[3] << 24;
301 event
|= buffer
[2] << 16;
302 event
|= buffer
[1] << 8;
303 event
|= buffer
[0] << 0;
306 lbs_queue_event(card
->priv
, event
& 0xFF);
310 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
315 static int if_sdio_card_to_host(struct if_sdio_card
*card
)
319 u16 size
, type
, chunk
;
320 unsigned long timeout
;
322 lbs_deb_enter(LBS_DEB_SDIO
);
324 size
= if_sdio_read_rx_len(card
, &ret
);
329 lbs_deb_sdio("invalid packet size (%d bytes) from firmware\n",
335 timeout
= jiffies
+ HZ
;
337 status
= sdio_readb(card
->func
, IF_SDIO_STATUS
, &ret
);
340 if (status
& IF_SDIO_IO_RDY
)
342 if (time_after(jiffies
, timeout
)) {
350 * The transfer must be in one transaction or the firmware
351 * goes suicidal. There's no way to guarantee that for all
352 * controllers, but we can at least try.
354 chunk
= sdio_align_size(card
->func
, size
);
356 ret
= sdio_readsb(card
->func
, card
->buffer
, card
->ioport
, chunk
);
360 chunk
= card
->buffer
[0] | (card
->buffer
[1] << 8);
361 type
= card
->buffer
[2] | (card
->buffer
[3] << 8);
363 lbs_deb_sdio("packet of type %d and size %d bytes\n",
364 (int)type
, (int)chunk
);
367 lbs_deb_sdio("packet fragment (%d > %d)\n",
368 (int)chunk
, (int)size
);
374 lbs_deb_sdio("packet fragment (%d < %d)\n",
375 (int)chunk
, (int)size
);
380 ret
= if_sdio_handle_cmd(card
, card
->buffer
+ 4, chunk
- 4);
385 ret
= if_sdio_handle_data(card
, card
->buffer
+ 4, chunk
- 4);
390 ret
= if_sdio_handle_event(card
, card
->buffer
+ 4, chunk
- 4);
395 lbs_deb_sdio("invalid type (%d) from firmware\n",
403 lbs_pr_err("problem fetching packet from firmware\n");
405 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
410 static void if_sdio_host_to_card_worker(struct work_struct
*work
)
412 struct if_sdio_card
*card
;
413 struct if_sdio_packet
*packet
;
414 unsigned long timeout
;
419 lbs_deb_enter(LBS_DEB_SDIO
);
421 card
= container_of(work
, struct if_sdio_card
, packet_worker
);
424 spin_lock_irqsave(&card
->lock
, flags
);
425 packet
= card
->packets
;
427 card
->packets
= packet
->next
;
428 spin_unlock_irqrestore(&card
->lock
, flags
);
433 sdio_claim_host(card
->func
);
435 timeout
= jiffies
+ HZ
;
437 status
= sdio_readb(card
->func
, IF_SDIO_STATUS
, &ret
);
440 if (status
& IF_SDIO_IO_RDY
)
442 if (time_after(jiffies
, timeout
)) {
449 ret
= sdio_writesb(card
->func
, card
->ioport
,
450 packet
->buffer
, packet
->nb
);
454 sdio_release_host(card
->func
);
459 lbs_deb_leave(LBS_DEB_SDIO
);
462 /********************************************************************/
464 /********************************************************************/
466 static int if_sdio_prog_helper(struct if_sdio_card
*card
)
470 const struct firmware
*fw
;
471 unsigned long timeout
;
477 lbs_deb_enter(LBS_DEB_SDIO
);
479 ret
= request_firmware(&fw
, card
->helper
, &card
->func
->dev
);
481 lbs_pr_err("can't load helper firmware\n");
485 chunk_buffer
= kzalloc(64, GFP_KERNEL
);
491 sdio_claim_host(card
->func
);
493 ret
= sdio_set_block_size(card
->func
, 32);
501 timeout
= jiffies
+ HZ
;
503 status
= sdio_readb(card
->func
, IF_SDIO_STATUS
, &ret
);
506 if ((status
& IF_SDIO_IO_RDY
) &&
507 (status
& IF_SDIO_DL_RDY
))
509 if (time_after(jiffies
, timeout
)) {
516 chunk_size
= min(size
, (size_t)60);
518 *((__le32
*)chunk_buffer
) = cpu_to_le32(chunk_size
);
519 memcpy(chunk_buffer
+ 4, firmware
, chunk_size
);
521 lbs_deb_sdio("sending %d bytes chunk\n", chunk_size);
523 ret
= sdio_writesb(card
->func
, card
->ioport
,
528 firmware
+= chunk_size
;
532 /* an empty block marks the end of the transfer */
533 memset(chunk_buffer
, 0, 4);
534 ret
= sdio_writesb(card
->func
, card
->ioport
, chunk_buffer
, 64);
538 lbs_deb_sdio("waiting for helper to boot...\n");
540 /* wait for the helper to boot by looking at the size register */
541 timeout
= jiffies
+ HZ
;
545 req_size
= sdio_readb(card
->func
, IF_SDIO_RD_BASE
, &ret
);
549 req_size
|= sdio_readb(card
->func
, IF_SDIO_RD_BASE
+ 1, &ret
) << 8;
556 if (time_after(jiffies
, timeout
)) {
567 sdio_release_host(card
->func
);
570 release_firmware(fw
);
574 lbs_pr_err("failed to load helper firmware\n");
576 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
581 static int if_sdio_prog_real(struct if_sdio_card
*card
)
585 const struct firmware
*fw
;
586 unsigned long timeout
;
590 size_t size
, req_size
;
592 lbs_deb_enter(LBS_DEB_SDIO
);
594 ret
= request_firmware(&fw
, card
->firmware
, &card
->func
->dev
);
596 lbs_pr_err("can't load firmware\n");
600 chunk_buffer
= kzalloc(512, GFP_KERNEL
);
606 sdio_claim_host(card
->func
);
608 ret
= sdio_set_block_size(card
->func
, 32);
616 timeout
= jiffies
+ HZ
;
618 status
= sdio_readb(card
->func
, IF_SDIO_STATUS
, &ret
);
621 if ((status
& IF_SDIO_IO_RDY
) &&
622 (status
& IF_SDIO_DL_RDY
))
624 if (time_after(jiffies
, timeout
)) {
631 req_size
= sdio_readb(card
->func
, IF_SDIO_RD_BASE
, &ret
);
635 req_size
|= sdio_readb(card
->func
, IF_SDIO_RD_BASE
+ 1, &ret
) << 8;
639 lbs_deb_sdio("firmware wants %d bytes\n", (int)req_size);
642 lbs_deb_sdio("firmware helper gave up early\n");
647 if (req_size
& 0x01) {
648 lbs_deb_sdio("firmware helper signalled error\n");
657 chunk_size
= min(req_size
, (size_t)512);
659 memcpy(chunk_buffer
, firmware
, chunk_size
);
661 lbs_deb_sdio("sending %d bytes (%d bytes) chunk\n",
662 chunk_size, (chunk_size + 31) / 32 * 32);
664 ret
= sdio_writesb(card
->func
, card
->ioport
,
665 chunk_buffer
, roundup(chunk_size
, 32));
669 firmware
+= chunk_size
;
671 req_size
-= chunk_size
;
677 lbs_deb_sdio("waiting for firmware to boot...\n");
679 /* wait for the firmware to boot */
680 timeout
= jiffies
+ HZ
;
684 scratch
= if_sdio_read_scratch(card
, &ret
);
688 if (scratch
== IF_SDIO_FIRMWARE_OK
)
691 if (time_after(jiffies
, timeout
)) {
702 sdio_release_host(card
->func
);
705 release_firmware(fw
);
709 lbs_pr_err("failed to load firmware\n");
711 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
716 static int if_sdio_prog_firmware(struct if_sdio_card
*card
)
721 lbs_deb_enter(LBS_DEB_SDIO
);
723 sdio_claim_host(card
->func
);
724 scratch
= if_sdio_read_scratch(card
, &ret
);
725 sdio_release_host(card
->func
);
730 lbs_deb_sdio("firmware status = %#x\n", scratch
);
732 if (scratch
== IF_SDIO_FIRMWARE_OK
) {
733 lbs_deb_sdio("firmware already loaded\n");
737 ret
= if_sdio_prog_helper(card
);
741 ret
= if_sdio_prog_real(card
);
746 sdio_claim_host(card
->func
);
747 sdio_set_block_size(card
->func
, IF_SDIO_BLOCK_SIZE
);
748 sdio_release_host(card
->func
);
752 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
757 /*******************************************************************/
758 /* Libertas callbacks */
759 /*******************************************************************/
761 static int if_sdio_host_to_card(struct lbs_private
*priv
,
762 u8 type
, u8
*buf
, u16 nb
)
765 struct if_sdio_card
*card
;
766 struct if_sdio_packet
*packet
, *cur
;
770 lbs_deb_enter_args(LBS_DEB_SDIO
, "type %d, bytes %d", type
, nb
);
774 if (nb
> (65536 - sizeof(struct if_sdio_packet
) - 4)) {
780 * The transfer must be in one transaction or the firmware
781 * goes suicidal. There's no way to guarantee that for all
782 * controllers, but we can at least try.
784 size
= sdio_align_size(card
->func
, nb
+ 4);
786 packet
= kzalloc(sizeof(struct if_sdio_packet
) + size
,
797 * SDIO specific header.
799 packet
->buffer
[0] = (nb
+ 4) & 0xff;
800 packet
->buffer
[1] = ((nb
+ 4) >> 8) & 0xff;
801 packet
->buffer
[2] = type
;
802 packet
->buffer
[3] = 0;
804 memcpy(packet
->buffer
+ 4, buf
, nb
);
806 spin_lock_irqsave(&card
->lock
, flags
);
809 card
->packets
= packet
;
819 priv
->dnld_sent
= DNLD_CMD_SENT
;
822 priv
->dnld_sent
= DNLD_DATA_SENT
;
825 lbs_deb_sdio("unknown packet type %d\n", (int)type
);
828 spin_unlock_irqrestore(&card
->lock
, flags
);
830 queue_work(card
->workqueue
, &card
->packet_worker
);
835 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
840 static int if_sdio_enter_deep_sleep(struct lbs_private
*priv
)
843 struct cmd_header cmd
;
845 memset(&cmd
, 0, sizeof(cmd
));
847 lbs_deb_sdio("send DEEP_SLEEP command\n");
848 ret
= __lbs_cmd(priv
, CMD_802_11_DEEP_SLEEP
, &cmd
, sizeof(cmd
),
849 lbs_cmd_copyback
, (unsigned long) &cmd
);
851 lbs_pr_err("DEEP_SLEEP cmd failed\n");
857 static int if_sdio_exit_deep_sleep(struct lbs_private
*priv
)
859 struct if_sdio_card
*card
= priv
->card
;
862 lbs_deb_enter(LBS_DEB_SDIO
);
863 sdio_claim_host(card
->func
);
865 sdio_writeb(card
->func
, HOST_POWER_UP
, CONFIGURATION_REG
, &ret
);
867 lbs_pr_err("sdio_writeb failed!\n");
869 sdio_release_host(card
->func
);
870 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
874 static int if_sdio_reset_deep_sleep_wakeup(struct lbs_private
*priv
)
876 struct if_sdio_card
*card
= priv
->card
;
879 lbs_deb_enter(LBS_DEB_SDIO
);
880 sdio_claim_host(card
->func
);
882 sdio_writeb(card
->func
, 0, CONFIGURATION_REG
, &ret
);
884 lbs_pr_err("sdio_writeb failed!\n");
886 sdio_release_host(card
->func
);
887 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
892 /*******************************************************************/
894 /*******************************************************************/
896 static void if_sdio_interrupt(struct sdio_func
*func
)
899 struct if_sdio_card
*card
;
902 lbs_deb_enter(LBS_DEB_SDIO
);
904 card
= sdio_get_drvdata(func
);
906 cause
= sdio_readb(card
->func
, IF_SDIO_H_INT_STATUS
, &ret
);
910 lbs_deb_sdio("interrupt: 0x%X\n", (unsigned)cause
);
912 sdio_writeb(card
->func
, ~cause
, IF_SDIO_H_INT_STATUS
, &ret
);
917 * Ignore the define name, this really means the card has
918 * successfully received the command.
920 card
->priv
->is_activity_detected
= 1;
921 if (cause
& IF_SDIO_H_INT_DNLD
)
922 lbs_host_to_card_done(card
->priv
);
925 if (cause
& IF_SDIO_H_INT_UPLD
) {
926 ret
= if_sdio_card_to_host(card
);
934 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
937 static int if_sdio_probe(struct sdio_func
*func
,
938 const struct sdio_device_id
*id
)
940 struct if_sdio_card
*card
;
941 struct lbs_private
*priv
;
944 struct if_sdio_packet
*packet
;
946 lbs_deb_enter(LBS_DEB_SDIO
);
948 for (i
= 0;i
< func
->card
->num_info
;i
++) {
949 if (sscanf(func
->card
->info
[i
],
950 "802.11 SDIO ID: %x", &model
) == 1)
952 if (sscanf(func
->card
->info
[i
],
953 "ID: %x", &model
) == 1)
955 if (!strcmp(func
->card
->info
[i
], "IBIS Wireless SDIO Card")) {
956 model
= IF_SDIO_MODEL_8385
;
961 if (i
== func
->card
->num_info
) {
962 lbs_pr_err("unable to identify card model\n");
966 card
= kzalloc(sizeof(struct if_sdio_card
), GFP_KERNEL
);
973 switch (card
->model
) {
974 case IF_SDIO_MODEL_8385
:
975 card
->scratch_reg
= IF_SDIO_SCRATCH_OLD
;
977 case IF_SDIO_MODEL_8686
:
978 card
->scratch_reg
= IF_SDIO_SCRATCH
;
980 case IF_SDIO_MODEL_8688
:
981 default: /* for newer chipsets */
982 card
->scratch_reg
= IF_SDIO_FW_STATUS
;
986 spin_lock_init(&card
->lock
);
987 card
->workqueue
= create_workqueue("libertas_sdio");
988 INIT_WORK(&card
->packet_worker
, if_sdio_host_to_card_worker
);
990 for (i
= 0;i
< ARRAY_SIZE(if_sdio_models
);i
++) {
991 if (card
->model
== if_sdio_models
[i
].model
)
995 if (i
== ARRAY_SIZE(if_sdio_models
)) {
996 lbs_pr_err("unknown card model 0x%x\n", card
->model
);
1001 card
->helper
= if_sdio_models
[i
].helper
;
1002 card
->firmware
= if_sdio_models
[i
].firmware
;
1004 if (lbs_helper_name
) {
1005 lbs_deb_sdio("overriding helper firmware: %s\n",
1007 card
->helper
= lbs_helper_name
;
1011 lbs_deb_sdio("overriding firmware: %s\n", lbs_fw_name
);
1012 card
->firmware
= lbs_fw_name
;
1015 sdio_claim_host(func
);
1017 ret
= sdio_enable_func(func
);
1021 ret
= sdio_claim_irq(func
, if_sdio_interrupt
);
1025 card
->ioport
= sdio_readb(func
, IF_SDIO_IOPORT
, &ret
);
1029 card
->ioport
|= sdio_readb(func
, IF_SDIO_IOPORT
+ 1, &ret
) << 8;
1033 card
->ioport
|= sdio_readb(func
, IF_SDIO_IOPORT
+ 2, &ret
) << 16;
1037 sdio_release_host(func
);
1039 sdio_set_drvdata(func
, card
);
1041 lbs_deb_sdio("class = 0x%X, vendor = 0x%X, "
1042 "device = 0x%X, model = 0x%X, ioport = 0x%X\n",
1043 func
->class, func
->vendor
, func
->device
,
1044 model
, (unsigned)card
->ioport
);
1046 ret
= if_sdio_prog_firmware(card
);
1050 priv
= lbs_add_card(card
, &func
->dev
);
1059 priv
->hw_host_to_card
= if_sdio_host_to_card
;
1060 priv
->enter_deep_sleep
= if_sdio_enter_deep_sleep
;
1061 priv
->exit_deep_sleep
= if_sdio_exit_deep_sleep
;
1062 priv
->reset_deep_sleep_wakeup
= if_sdio_reset_deep_sleep_wakeup
;
1066 sdio_claim_host(func
);
1069 * Get rx_unit if the chip is SD8688 or newer.
1070 * SD8385 & SD8686 do not have rx_unit.
1072 if ((card
->model
!= IF_SDIO_MODEL_8385
)
1073 && (card
->model
!= IF_SDIO_MODEL_8686
))
1074 card
->rx_unit
= if_sdio_read_rx_unit(card
);
1079 * Enable interrupts now that everything is set up
1081 sdio_writeb(func
, 0x0f, IF_SDIO_H_INT_MASK
, &ret
);
1082 sdio_release_host(func
);
1087 * FUNC_INIT is required for SD8688 WLAN/BT multiple functions
1089 if (card
->model
== IF_SDIO_MODEL_8688
) {
1090 struct cmd_header cmd
;
1092 memset(&cmd
, 0, sizeof(cmd
));
1094 lbs_deb_sdio("send function INIT command\n");
1095 if (__lbs_cmd(priv
, CMD_FUNC_INIT
, &cmd
, sizeof(cmd
),
1096 lbs_cmd_copyback
, (unsigned long) &cmd
))
1097 lbs_pr_alert("CMD_FUNC_INIT cmd failed\n");
1100 ret
= lbs_start_card(priv
);
1102 goto err_activate_card
;
1105 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
1110 flush_workqueue(card
->workqueue
);
1111 lbs_remove_card(priv
);
1113 sdio_claim_host(func
);
1115 sdio_release_irq(func
);
1117 sdio_disable_func(func
);
1119 sdio_release_host(func
);
1121 destroy_workqueue(card
->workqueue
);
1122 while (card
->packets
) {
1123 packet
= card
->packets
;
1124 card
->packets
= card
->packets
->next
;
1133 static void if_sdio_remove(struct sdio_func
*func
)
1135 struct if_sdio_card
*card
;
1136 struct if_sdio_packet
*packet
;
1138 lbs_deb_enter(LBS_DEB_SDIO
);
1140 card
= sdio_get_drvdata(func
);
1142 if (user_rmmod
&& (card
->model
== IF_SDIO_MODEL_8688
)) {
1144 * FUNC_SHUTDOWN is required for SD8688 WLAN/BT
1145 * multiple functions
1147 struct cmd_header cmd
;
1149 memset(&cmd
, 0, sizeof(cmd
));
1151 lbs_deb_sdio("send function SHUTDOWN command\n");
1152 if (__lbs_cmd(card
->priv
, CMD_FUNC_SHUTDOWN
,
1153 &cmd
, sizeof(cmd
), lbs_cmd_copyback
,
1154 (unsigned long) &cmd
))
1155 lbs_pr_alert("CMD_FUNC_SHUTDOWN cmd failed\n");
1159 lbs_deb_sdio("call remove card\n");
1160 lbs_stop_card(card
->priv
);
1161 lbs_remove_card(card
->priv
);
1162 card
->priv
->surpriseremoved
= 1;
1164 flush_workqueue(card
->workqueue
);
1165 destroy_workqueue(card
->workqueue
);
1167 sdio_claim_host(func
);
1168 sdio_release_irq(func
);
1169 sdio_disable_func(func
);
1170 sdio_release_host(func
);
1172 while (card
->packets
) {
1173 packet
= card
->packets
;
1174 card
->packets
= card
->packets
->next
;
1180 lbs_deb_leave(LBS_DEB_SDIO
);
1183 static struct sdio_driver if_sdio_driver
= {
1184 .name
= "libertas_sdio",
1185 .id_table
= if_sdio_ids
,
1186 .probe
= if_sdio_probe
,
1187 .remove
= if_sdio_remove
,
1190 /*******************************************************************/
1191 /* Module functions */
1192 /*******************************************************************/
1194 static int __init
if_sdio_init_module(void)
1198 lbs_deb_enter(LBS_DEB_SDIO
);
1200 printk(KERN_INFO
"libertas_sdio: Libertas SDIO driver\n");
1201 printk(KERN_INFO
"libertas_sdio: Copyright Pierre Ossman\n");
1203 ret
= sdio_register_driver(&if_sdio_driver
);
1205 /* Clear the flag in case user removes the card. */
1208 lbs_deb_leave_args(LBS_DEB_SDIO
, "ret %d", ret
);
1213 static void __exit
if_sdio_exit_module(void)
1215 lbs_deb_enter(LBS_DEB_SDIO
);
1217 /* Set the flag as user is removing this module. */
1220 sdio_unregister_driver(&if_sdio_driver
);
1222 lbs_deb_leave(LBS_DEB_SDIO
);
1225 module_init(if_sdio_init_module
);
1226 module_exit(if_sdio_exit_module
);
1228 MODULE_DESCRIPTION("Libertas SDIO WLAN Driver");
1229 MODULE_AUTHOR("Pierre Ossman");
1230 MODULE_LICENSE("GPL");