blob: 1aec4342875d4b72ed7a9249b0a5b184f038ff94 [file] [log] [blame]
Arend van Spriel5b435de2011-10-05 13:19:03 +02001/*
2 * Copyright (c) 2010 Broadcom Corporation
3 *
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
7 *
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
11 * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
13 * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
14 * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15 */
16/* ****************** SDIO CARD Interface Functions **************************/
17
Joe Perches02f77192012-01-15 00:38:44 -080018#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
19
Arend van Spriel5b435de2011-10-05 13:19:03 +020020#include <linux/types.h>
21#include <linux/netdevice.h>
Paul Gortmakeree40fa02011-05-27 16:14:23 -040022#include <linux/export.h>
Arend van Spriel5b435de2011-10-05 13:19:03 +020023#include <linux/pci.h>
24#include <linux/pci_ids.h>
25#include <linux/sched.h>
26#include <linux/completion.h>
27#include <linux/mmc/sdio.h>
28#include <linux/mmc/sdio_func.h>
29#include <linux/mmc/card.h>
30
31#include <defs.h>
32#include <brcm_hw_ids.h>
33#include <brcmu_utils.h>
34#include <brcmu_wifi.h>
35#include <soc.h>
Arend van Spriel5b435de2011-10-05 13:19:03 +020036#include "dhd_bus.h"
37#include "dhd_dbg.h"
38#include "sdio_host.h"
39
40#define SDIOH_API_ACCESS_RETRY_LIMIT 2
41
Franky Linba89bf12012-04-27 18:56:59 -070042#ifdef CONFIG_BRCMFMAC_SDIO_OOB
43static irqreturn_t brcmf_sdio_irqhandler(int irq, void *dev_id)
44{
45 struct brcmf_sdio_dev *sdiodev = dev_get_drvdata(dev_id);
46
47 brcmf_dbg(INTR, "oob intr triggered\n");
48
49 /*
50 * out-of-band interrupt is level-triggered which won't
51 * be cleared until dpc
52 */
53 if (sdiodev->irq_en) {
54 disable_irq_nosync(irq);
55 sdiodev->irq_en = false;
56 }
57
58 brcmf_sdbrcm_isr(sdiodev->bus);
59
60 return IRQ_HANDLED;
61}
62
63int brcmf_sdio_intr_register(struct brcmf_sdio_dev *sdiodev)
64{
65 int ret = 0;
66 u8 data;
67 unsigned long flags;
68
69 brcmf_dbg(TRACE, "Entering\n");
70
71 brcmf_dbg(ERROR, "requesting irq %d\n", sdiodev->irq);
72 ret = request_irq(sdiodev->irq, brcmf_sdio_irqhandler,
73 sdiodev->irq_flags, "brcmf_oob_intr",
74 &sdiodev->func[1]->card->dev);
75 if (ret != 0)
76 return ret;
77 spin_lock_init(&sdiodev->irq_en_lock);
78 spin_lock_irqsave(&sdiodev->irq_en_lock, flags);
79 sdiodev->irq_en = true;
80 spin_unlock_irqrestore(&sdiodev->irq_en_lock, flags);
81
82 ret = enable_irq_wake(sdiodev->irq);
83 if (ret != 0)
84 return ret;
85 sdiodev->irq_wake = true;
86
Franky Lin38b0b0d2012-11-05 16:22:24 -080087 sdio_claim_host(sdiodev->func[1]);
88
Franky Linba89bf12012-04-27 18:56:59 -070089 /* must configure SDIO_CCCR_IENx to enable irq */
Franky Lin45db3392012-05-04 18:27:32 -070090 data = brcmf_sdio_regrb(sdiodev, SDIO_CCCR_IENx, &ret);
Franky Linba89bf12012-04-27 18:56:59 -070091 data |= 1 << SDIO_FUNC_1 | 1 << SDIO_FUNC_2 | 1;
Franky Lin3bba8292012-05-04 18:27:33 -070092 brcmf_sdio_regwb(sdiodev, SDIO_CCCR_IENx, data, &ret);
Franky Linba89bf12012-04-27 18:56:59 -070093
Joe Perchesf304a992012-05-30 13:25:56 -070094 /* redirect, configure and enable io for interrupt signal */
Franky Linba89bf12012-04-27 18:56:59 -070095 data = SDIO_SEPINT_MASK | SDIO_SEPINT_OE;
Joe Perchesf304a992012-05-30 13:25:56 -070096 if (sdiodev->irq_flags & IRQF_TRIGGER_HIGH)
Franky Linba89bf12012-04-27 18:56:59 -070097 data |= SDIO_SEPINT_ACT_HI;
Franky Lin3bba8292012-05-04 18:27:33 -070098 brcmf_sdio_regwb(sdiodev, SDIO_CCCR_BRCM_SEPINT, data, &ret);
Franky Linba89bf12012-04-27 18:56:59 -070099
Franky Lin38b0b0d2012-11-05 16:22:24 -0800100 sdio_release_host(sdiodev->func[1]);
101
Franky Linba89bf12012-04-27 18:56:59 -0700102 return 0;
103}
104
105int brcmf_sdio_intr_unregister(struct brcmf_sdio_dev *sdiodev)
106{
107 brcmf_dbg(TRACE, "Entering\n");
108
Franky Lin38b0b0d2012-11-05 16:22:24 -0800109 sdio_claim_host(sdiodev->func[1]);
Franky Lin3bba8292012-05-04 18:27:33 -0700110 brcmf_sdio_regwb(sdiodev, SDIO_CCCR_BRCM_SEPINT, 0, NULL);
111 brcmf_sdio_regwb(sdiodev, SDIO_CCCR_IENx, 0, NULL);
Franky Lin38b0b0d2012-11-05 16:22:24 -0800112 sdio_release_host(sdiodev->func[1]);
Franky Linba89bf12012-04-27 18:56:59 -0700113
114 if (sdiodev->irq_wake) {
115 disable_irq_wake(sdiodev->irq);
116 sdiodev->irq_wake = false;
117 }
118 free_irq(sdiodev->irq, &sdiodev->func[1]->card->dev);
119 sdiodev->irq_en = false;
120
121 return 0;
122}
123#else /* CONFIG_BRCMFMAC_SDIO_OOB */
124static void brcmf_sdio_irqhandler(struct sdio_func *func)
Arend van Spriel5b435de2011-10-05 13:19:03 +0200125{
Franky Lind76d1c82011-12-08 15:06:37 -0800126 struct brcmf_sdio_dev *sdiodev = dev_get_drvdata(&func->card->dev);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200127
Franky Linba89bf12012-04-27 18:56:59 -0700128 brcmf_dbg(INTR, "ib intr triggered\n");
Arend van Spriel5b435de2011-10-05 13:19:03 +0200129
Arend van Spriel5b435de2011-10-05 13:19:03 +0200130 brcmf_sdbrcm_isr(sdiodev->bus);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200131}
132
Franky Linfbf59102011-12-16 18:36:53 -0800133/* dummy handler for SDIO function 2 interrupt */
Franky Linba89bf12012-04-27 18:56:59 -0700134static void brcmf_sdio_dummy_irqhandler(struct sdio_func *func)
Franky Linfbf59102011-12-16 18:36:53 -0800135{
136}
137
Franky Linba89bf12012-04-27 18:56:59 -0700138int brcmf_sdio_intr_register(struct brcmf_sdio_dev *sdiodev)
Arend van Spriel5b435de2011-10-05 13:19:03 +0200139{
140 brcmf_dbg(TRACE, "Entering\n");
141
142 sdio_claim_host(sdiodev->func[1]);
Franky Linba89bf12012-04-27 18:56:59 -0700143 sdio_claim_irq(sdiodev->func[1], brcmf_sdio_irqhandler);
144 sdio_claim_irq(sdiodev->func[2], brcmf_sdio_dummy_irqhandler);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200145 sdio_release_host(sdiodev->func[1]);
146
147 return 0;
148}
149
Franky Linba89bf12012-04-27 18:56:59 -0700150int brcmf_sdio_intr_unregister(struct brcmf_sdio_dev *sdiodev)
Arend van Spriel5b435de2011-10-05 13:19:03 +0200151{
152 brcmf_dbg(TRACE, "Entering\n");
153
154 sdio_claim_host(sdiodev->func[1]);
Franky Linfbf59102011-12-16 18:36:53 -0800155 sdio_release_irq(sdiodev->func[2]);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200156 sdio_release_irq(sdiodev->func[1]);
157 sdio_release_host(sdiodev->func[1]);
158
159 return 0;
160}
Franky Linba89bf12012-04-27 18:56:59 -0700161#endif /* CONFIG_BRCMFMAC_SDIO_OOB */
Arend van Spriel5b435de2011-10-05 13:19:03 +0200162
Arend van Spriel5b435de2011-10-05 13:19:03 +0200163int
164brcmf_sdcard_set_sbaddr_window(struct brcmf_sdio_dev *sdiodev, u32 address)
165{
Franky Lin7d9cfc22012-05-04 18:27:30 -0700166 int err = 0, i;
167 u8 addr[3];
168 s32 retry;
169
170 addr[0] = (address >> 8) & SBSDIO_SBADDRLOW_MASK;
171 addr[1] = (address >> 16) & SBSDIO_SBADDRMID_MASK;
172 addr[2] = (address >> 24) & SBSDIO_SBADDRHIGH_MASK;
173
174 for (i = 0; i < 3; i++) {
175 retry = 0;
176 do {
177 if (retry)
178 usleep_range(1000, 2000);
179 err = brcmf_sdioh_request_byte(sdiodev, SDIOH_WRITE,
180 SDIO_FUNC_1, SBSDIO_FUNC1_SBADDRLOW + i,
181 &addr[i]);
182 } while (err != 0 && retry++ < SDIOH_API_ACCESS_RETRY_LIMIT);
183
184 if (err) {
185 brcmf_dbg(ERROR, "failed at addr:0x%0x\n",
186 SBSDIO_FUNC1_SBADDRLOW + i);
187 break;
188 }
189 }
Arend van Spriel5b435de2011-10-05 13:19:03 +0200190
191 return err;
192}
193
Franky Lin45316032012-09-13 21:12:03 +0200194int
Franky Line9b8d912012-05-04 18:27:31 -0700195brcmf_sdio_regrw_helper(struct brcmf_sdio_dev *sdiodev, u32 addr,
196 void *data, bool write)
197{
198 u8 func_num, reg_size;
199 u32 bar;
200 s32 retry = 0;
201 int ret;
202
203 /*
204 * figure out how to read the register based on address range
Franky Lind8b3fc52012-05-04 18:27:38 -0700205 * 0x00 ~ 0x7FF: function 0 CCCR and FBR
Franky Line9b8d912012-05-04 18:27:31 -0700206 * 0x10000 ~ 0x1FFFF: function 1 miscellaneous registers
207 * The rest: function 1 silicon backplane core registers
208 */
Franky Lind8b3fc52012-05-04 18:27:38 -0700209 if ((addr & ~REG_F0_REG_MASK) == 0) {
Franky Line9b8d912012-05-04 18:27:31 -0700210 func_num = SDIO_FUNC_0;
211 reg_size = 1;
212 } else if ((addr & ~REG_F1_MISC_MASK) == 0) {
213 func_num = SDIO_FUNC_1;
214 reg_size = 1;
215 } else {
216 func_num = SDIO_FUNC_1;
217 reg_size = 4;
218
219 /* Set the window for SB core register */
220 bar = addr & ~SBSDIO_SB_OFT_ADDR_MASK;
221 if (bar != sdiodev->sbwad) {
222 ret = brcmf_sdcard_set_sbaddr_window(sdiodev, bar);
223 if (ret != 0) {
224 memset(data, 0xFF, reg_size);
225 return ret;
226 }
227 sdiodev->sbwad = bar;
228 }
229 addr &= SBSDIO_SB_OFT_ADDR_MASK;
230 addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
231 }
232
233 do {
234 if (!write)
235 memset(data, 0, reg_size);
236 if (retry) /* wait for 1 ms till bus get settled down */
237 usleep_range(1000, 2000);
238 if (reg_size == 1)
239 ret = brcmf_sdioh_request_byte(sdiodev, write,
240 func_num, addr, data);
241 else
242 ret = brcmf_sdioh_request_word(sdiodev, write,
243 func_num, addr, data, 4);
244 } while (ret != 0 && retry++ < SDIOH_API_ACCESS_RETRY_LIMIT);
245
Franky Lin5c15c232012-05-04 18:27:37 -0700246 if (ret != 0)
Franky Line9b8d912012-05-04 18:27:31 -0700247 brcmf_dbg(ERROR, "failed with %d\n", ret);
248
249 return ret;
250}
251
252u8 brcmf_sdio_regrb(struct brcmf_sdio_dev *sdiodev, u32 addr, int *ret)
253{
254 u8 data;
255 int retval;
256
257 brcmf_dbg(INFO, "addr:0x%08x\n", addr);
258 retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, false);
259 brcmf_dbg(INFO, "data:0x%02x\n", data);
260
261 if (ret)
262 *ret = retval;
263
264 return data;
265}
266
267u32 brcmf_sdio_regrl(struct brcmf_sdio_dev *sdiodev, u32 addr, int *ret)
268{
269 u32 data;
270 int retval;
271
272 brcmf_dbg(INFO, "addr:0x%08x\n", addr);
273 retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, false);
274 brcmf_dbg(INFO, "data:0x%08x\n", data);
275
276 if (ret)
277 *ret = retval;
278
279 return data;
280}
281
282void brcmf_sdio_regwb(struct brcmf_sdio_dev *sdiodev, u32 addr,
283 u8 data, int *ret)
284{
285 int retval;
286
287 brcmf_dbg(INFO, "addr:0x%08x, data:0x%02x\n", addr, data);
288 retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, true);
289
290 if (ret)
291 *ret = retval;
292}
293
294void brcmf_sdio_regwl(struct brcmf_sdio_dev *sdiodev, u32 addr,
295 u32 data, int *ret)
296{
297 int retval;
298
299 brcmf_dbg(INFO, "addr:0x%08x, data:0x%08x\n", addr, data);
300 retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, true);
301
302 if (ret)
303 *ret = retval;
304}
305
Arend van Spriel5adfeb62011-11-22 17:21:38 -0800306static int brcmf_sdcard_recv_prepare(struct brcmf_sdio_dev *sdiodev, uint fn,
307 uint flags, uint width, u32 *addr)
Arend van Spriel5b435de2011-10-05 13:19:03 +0200308{
Arend van Spriel5adfeb62011-11-22 17:21:38 -0800309 uint bar0 = *addr & ~SBSDIO_SB_OFT_ADDR_MASK;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200310 int err = 0;
311
Arend van Spriel5b435de2011-10-05 13:19:03 +0200312 /* Async not implemented yet */
313 if (flags & SDIO_REQ_ASYNC)
314 return -ENOTSUPP;
315
316 if (bar0 != sdiodev->sbwad) {
317 err = brcmf_sdcard_set_sbaddr_window(sdiodev, bar0);
318 if (err)
319 return err;
320
321 sdiodev->sbwad = bar0;
322 }
323
Arend van Spriel5adfeb62011-11-22 17:21:38 -0800324 *addr &= SBSDIO_SB_OFT_ADDR_MASK;
325
326 if (width == 4)
327 *addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
328
329 return 0;
330}
331
332int
333brcmf_sdcard_recv_buf(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
334 uint flags, u8 *buf, uint nbytes)
335{
336 struct sk_buff *mypkt;
337 int err;
338
339 mypkt = brcmu_pkt_buf_get_skb(nbytes);
340 if (!mypkt) {
341 brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
342 nbytes);
343 return -EIO;
344 }
345
346 err = brcmf_sdcard_recv_pkt(sdiodev, addr, fn, flags, mypkt);
347 if (!err)
348 memcpy(buf, mypkt->data, nbytes);
349
350 brcmu_pkt_buf_free_skb(mypkt);
351 return err;
352}
353
354int
355brcmf_sdcard_recv_pkt(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
356 uint flags, struct sk_buff *pkt)
357{
358 uint incr_fix;
359 uint width;
360 int err = 0;
361
362 brcmf_dbg(INFO, "fun = %d, addr = 0x%x, size = %d\n",
363 fn, addr, pkt->len);
364
365 width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
366 err = brcmf_sdcard_recv_prepare(sdiodev, fn, flags, width, &addr);
367 if (err)
Franky Lin7057fd02012-09-13 21:12:02 +0200368 goto done;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200369
370 incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
Arend van Spriel5adfeb62011-11-22 17:21:38 -0800371 err = brcmf_sdioh_request_buffer(sdiodev, incr_fix, SDIOH_READ,
Arend van Spriel4c6e8692011-11-22 17:21:40 -0800372 fn, addr, pkt);
Arend van Spriel5adfeb62011-11-22 17:21:38 -0800373
Franky Lin7057fd02012-09-13 21:12:02 +0200374done:
Arend van Spriel5adfeb62011-11-22 17:21:38 -0800375 return err;
376}
377
378int brcmf_sdcard_recv_chain(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
379 uint flags, struct sk_buff_head *pktq)
380{
381 uint incr_fix;
382 uint width;
383 int err = 0;
384
385 brcmf_dbg(INFO, "fun = %d, addr = 0x%x, size = %d\n",
386 fn, addr, pktq->qlen);
387
Arend van Spriel5b435de2011-10-05 13:19:03 +0200388 width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
Arend van Spriel5adfeb62011-11-22 17:21:38 -0800389 err = brcmf_sdcard_recv_prepare(sdiodev, fn, flags, width, &addr);
390 if (err)
Franky Lin7057fd02012-09-13 21:12:02 +0200391 goto done;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200392
Arend van Spriel5adfeb62011-11-22 17:21:38 -0800393 incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
394 err = brcmf_sdioh_request_chain(sdiodev, incr_fix, SDIOH_READ, fn, addr,
395 pktq);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200396
Franky Lin7057fd02012-09-13 21:12:02 +0200397done:
Arend van Spriel5adfeb62011-11-22 17:21:38 -0800398 return err;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200399}
400
401int
402brcmf_sdcard_send_buf(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
Arend van Spriel5adfeb62011-11-22 17:21:38 -0800403 uint flags, u8 *buf, uint nbytes)
404{
405 struct sk_buff *mypkt;
406 int err;
407
408 mypkt = brcmu_pkt_buf_get_skb(nbytes);
409 if (!mypkt) {
410 brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
411 nbytes);
412 return -EIO;
413 }
414
415 memcpy(mypkt->data, buf, nbytes);
416 err = brcmf_sdcard_send_pkt(sdiodev, addr, fn, flags, mypkt);
417
418 brcmu_pkt_buf_free_skb(mypkt);
419 return err;
420
421}
422
423int
424brcmf_sdcard_send_pkt(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
425 uint flags, struct sk_buff *pkt)
Arend van Spriel5b435de2011-10-05 13:19:03 +0200426{
427 uint incr_fix;
428 uint width;
429 uint bar0 = addr & ~SBSDIO_SB_OFT_ADDR_MASK;
430 int err = 0;
431
Arend van Spriel5adfeb62011-11-22 17:21:38 -0800432 brcmf_dbg(INFO, "fun = %d, addr = 0x%x, size = %d\n",
433 fn, addr, pkt->len);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200434
435 /* Async not implemented yet */
436 if (flags & SDIO_REQ_ASYNC)
437 return -ENOTSUPP;
438
439 if (bar0 != sdiodev->sbwad) {
440 err = brcmf_sdcard_set_sbaddr_window(sdiodev, bar0);
441 if (err)
Franky Lin7057fd02012-09-13 21:12:02 +0200442 goto done;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200443
444 sdiodev->sbwad = bar0;
445 }
446
447 addr &= SBSDIO_SB_OFT_ADDR_MASK;
448
449 incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
450 width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
451 if (width == 4)
452 addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
453
Franky Lin7057fd02012-09-13 21:12:02 +0200454 err = brcmf_sdioh_request_buffer(sdiodev, incr_fix, SDIOH_WRITE, fn,
455 addr, pkt);
456
457done:
Franky Lin7057fd02012-09-13 21:12:02 +0200458 return err;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200459}
460
461int brcmf_sdcard_rwdata(struct brcmf_sdio_dev *sdiodev, uint rw, u32 addr,
462 u8 *buf, uint nbytes)
463{
Arend van Spriel4c6e8692011-11-22 17:21:40 -0800464 struct sk_buff *mypkt;
465 bool write = rw ? SDIOH_WRITE : SDIOH_READ;
466 int err;
467
Arend van Spriel5b435de2011-10-05 13:19:03 +0200468 addr &= SBSDIO_SB_OFT_ADDR_MASK;
469 addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
470
Arend van Spriel4c6e8692011-11-22 17:21:40 -0800471 mypkt = brcmu_pkt_buf_get_skb(nbytes);
472 if (!mypkt) {
473 brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
474 nbytes);
475 return -EIO;
476 }
477
478 /* For a write, copy the buffer data into the packet. */
479 if (write)
480 memcpy(mypkt->data, buf, nbytes);
481
482 err = brcmf_sdioh_request_buffer(sdiodev, SDIOH_DATA_INC, write,
483 SDIO_FUNC_1, addr, mypkt);
484
485 /* For a read, copy the packet data back to the buffer. */
486 if (!err && !write)
487 memcpy(buf, mypkt->data, nbytes);
488
489 brcmu_pkt_buf_free_skb(mypkt);
490 return err;
Arend van Spriel5b435de2011-10-05 13:19:03 +0200491}
492
493int brcmf_sdcard_abort(struct brcmf_sdio_dev *sdiodev, uint fn)
494{
495 char t_func = (char)fn;
496 brcmf_dbg(TRACE, "Enter\n");
497
498 /* issue abort cmd52 command through F0 */
499 brcmf_sdioh_request_byte(sdiodev, SDIOH_WRITE, SDIO_FUNC_0,
500 SDIO_CCCR_ABORT, &t_func);
501
502 brcmf_dbg(TRACE, "Exit\n");
503 return 0;
504}
505
506int brcmf_sdio_probe(struct brcmf_sdio_dev *sdiodev)
507{
508 u32 regs = 0;
509 int ret = 0;
510
511 ret = brcmf_sdioh_attach(sdiodev);
512 if (ret)
513 goto out;
514
515 regs = SI_ENUM_BASE;
516
517 /* Report the BAR, to fix if needed */
518 sdiodev->sbwad = SI_ENUM_BASE;
519
520 /* try to attach to the target device */
Franky Lin4175b882011-11-22 17:21:49 -0800521 sdiodev->bus = brcmf_sdbrcm_probe(regs, sdiodev);
Arend van Spriel5b435de2011-10-05 13:19:03 +0200522 if (!sdiodev->bus) {
523 brcmf_dbg(ERROR, "device attach failed\n");
524 ret = -ENODEV;
525 goto out;
526 }
527
528out:
529 if (ret)
530 brcmf_sdio_remove(sdiodev);
531
532 return ret;
533}
534EXPORT_SYMBOL(brcmf_sdio_probe);
535
536int brcmf_sdio_remove(struct brcmf_sdio_dev *sdiodev)
537{
538 if (sdiodev->bus) {
539 brcmf_sdbrcm_disconnect(sdiodev->bus);
540 sdiodev->bus = NULL;
541 }
542
543 brcmf_sdioh_detach(sdiodev);
544
545 sdiodev->sbwad = 0;
546
547 return 0;
548}
549EXPORT_SYMBOL(brcmf_sdio_remove);
550
551void brcmf_sdio_wdtmr_enable(struct brcmf_sdio_dev *sdiodev, bool enable)
552{
553 if (enable)
554 brcmf_sdbrcm_wd_timer(sdiodev->bus, BRCMF_WD_POLL_MS);
555 else
556 brcmf_sdbrcm_wd_timer(sdiodev->bus, 0);
557}