brcmfmac: Fix likely misuse of | for &
[deliverable/linux.git] / drivers / net / wireless / brcm80211 / brcmfmac / bcmsdh.c
1 /*
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
18 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
19
20 #include <linux/types.h>
21 #include <linux/netdevice.h>
22 #include <linux/export.h>
23 #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>
36 #include "dhd_bus.h"
37 #include "dhd_dbg.h"
38 #include "sdio_host.h"
39
40 #define SDIOH_API_ACCESS_RETRY_LIMIT 2
41
42 #ifdef CONFIG_BRCMFMAC_SDIO_OOB
43 static 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
63 int 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
87 /* must configure SDIO_CCCR_IENx to enable irq */
88 data = brcmf_sdio_regrb(sdiodev, SDIO_CCCR_IENx, &ret);
89 data |= 1 << SDIO_FUNC_1 | 1 << SDIO_FUNC_2 | 1;
90 brcmf_sdio_regwb(sdiodev, SDIO_CCCR_IENx, data, &ret);
91
92 /* redirect, configure and enable io for interrupt signal */
93 data = SDIO_SEPINT_MASK | SDIO_SEPINT_OE;
94 if (sdiodev->irq_flags & IRQF_TRIGGER_HIGH)
95 data |= SDIO_SEPINT_ACT_HI;
96 brcmf_sdio_regwb(sdiodev, SDIO_CCCR_BRCM_SEPINT, data, &ret);
97
98 return 0;
99 }
100
101 int brcmf_sdio_intr_unregister(struct brcmf_sdio_dev *sdiodev)
102 {
103 brcmf_dbg(TRACE, "Entering\n");
104
105 brcmf_sdio_regwb(sdiodev, SDIO_CCCR_BRCM_SEPINT, 0, NULL);
106 brcmf_sdio_regwb(sdiodev, SDIO_CCCR_IENx, 0, NULL);
107
108 if (sdiodev->irq_wake) {
109 disable_irq_wake(sdiodev->irq);
110 sdiodev->irq_wake = false;
111 }
112 free_irq(sdiodev->irq, &sdiodev->func[1]->card->dev);
113 sdiodev->irq_en = false;
114
115 return 0;
116 }
117 #else /* CONFIG_BRCMFMAC_SDIO_OOB */
118 static void brcmf_sdio_irqhandler(struct sdio_func *func)
119 {
120 struct brcmf_sdio_dev *sdiodev = dev_get_drvdata(&func->card->dev);
121
122 brcmf_dbg(INTR, "ib intr triggered\n");
123
124 brcmf_sdbrcm_isr(sdiodev->bus);
125 }
126
127 /* dummy handler for SDIO function 2 interrupt */
128 static void brcmf_sdio_dummy_irqhandler(struct sdio_func *func)
129 {
130 }
131
132 int brcmf_sdio_intr_register(struct brcmf_sdio_dev *sdiodev)
133 {
134 brcmf_dbg(TRACE, "Entering\n");
135
136 sdio_claim_host(sdiodev->func[1]);
137 sdio_claim_irq(sdiodev->func[1], brcmf_sdio_irqhandler);
138 sdio_claim_irq(sdiodev->func[2], brcmf_sdio_dummy_irqhandler);
139 sdio_release_host(sdiodev->func[1]);
140
141 return 0;
142 }
143
144 int brcmf_sdio_intr_unregister(struct brcmf_sdio_dev *sdiodev)
145 {
146 brcmf_dbg(TRACE, "Entering\n");
147
148 sdio_claim_host(sdiodev->func[1]);
149 sdio_release_irq(sdiodev->func[2]);
150 sdio_release_irq(sdiodev->func[1]);
151 sdio_release_host(sdiodev->func[1]);
152
153 return 0;
154 }
155 #endif /* CONFIG_BRCMFMAC_SDIO_OOB */
156
157 int
158 brcmf_sdcard_set_sbaddr_window(struct brcmf_sdio_dev *sdiodev, u32 address)
159 {
160 int err = 0, i;
161 u8 addr[3];
162 s32 retry;
163
164 addr[0] = (address >> 8) & SBSDIO_SBADDRLOW_MASK;
165 addr[1] = (address >> 16) & SBSDIO_SBADDRMID_MASK;
166 addr[2] = (address >> 24) & SBSDIO_SBADDRHIGH_MASK;
167
168 for (i = 0; i < 3; i++) {
169 retry = 0;
170 do {
171 if (retry)
172 usleep_range(1000, 2000);
173 err = brcmf_sdioh_request_byte(sdiodev, SDIOH_WRITE,
174 SDIO_FUNC_1, SBSDIO_FUNC1_SBADDRLOW + i,
175 &addr[i]);
176 } while (err != 0 && retry++ < SDIOH_API_ACCESS_RETRY_LIMIT);
177
178 if (err) {
179 brcmf_dbg(ERROR, "failed at addr:0x%0x\n",
180 SBSDIO_FUNC1_SBADDRLOW + i);
181 break;
182 }
183 }
184
185 return err;
186 }
187
188 static int
189 brcmf_sdio_regrw_helper(struct brcmf_sdio_dev *sdiodev, u32 addr,
190 void *data, bool write)
191 {
192 u8 func_num, reg_size;
193 u32 bar;
194 s32 retry = 0;
195 int ret;
196
197 /*
198 * figure out how to read the register based on address range
199 * 0x00 ~ 0x7FF: function 0 CCCR and FBR
200 * 0x10000 ~ 0x1FFFF: function 1 miscellaneous registers
201 * The rest: function 1 silicon backplane core registers
202 */
203 if ((addr & ~REG_F0_REG_MASK) == 0) {
204 func_num = SDIO_FUNC_0;
205 reg_size = 1;
206 } else if ((addr & ~REG_F1_MISC_MASK) == 0) {
207 func_num = SDIO_FUNC_1;
208 reg_size = 1;
209 } else {
210 func_num = SDIO_FUNC_1;
211 reg_size = 4;
212
213 /* Set the window for SB core register */
214 bar = addr & ~SBSDIO_SB_OFT_ADDR_MASK;
215 if (bar != sdiodev->sbwad) {
216 ret = brcmf_sdcard_set_sbaddr_window(sdiodev, bar);
217 if (ret != 0) {
218 memset(data, 0xFF, reg_size);
219 return ret;
220 }
221 sdiodev->sbwad = bar;
222 }
223 addr &= SBSDIO_SB_OFT_ADDR_MASK;
224 addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
225 }
226
227 do {
228 if (!write)
229 memset(data, 0, reg_size);
230 if (retry) /* wait for 1 ms till bus get settled down */
231 usleep_range(1000, 2000);
232 if (reg_size == 1)
233 ret = brcmf_sdioh_request_byte(sdiodev, write,
234 func_num, addr, data);
235 else
236 ret = brcmf_sdioh_request_word(sdiodev, write,
237 func_num, addr, data, 4);
238 } while (ret != 0 && retry++ < SDIOH_API_ACCESS_RETRY_LIMIT);
239
240 if (ret != 0)
241 brcmf_dbg(ERROR, "failed with %d\n", ret);
242
243 return ret;
244 }
245
246 u8 brcmf_sdio_regrb(struct brcmf_sdio_dev *sdiodev, u32 addr, int *ret)
247 {
248 u8 data;
249 int retval;
250
251 brcmf_dbg(INFO, "addr:0x%08x\n", addr);
252 retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, false);
253 brcmf_dbg(INFO, "data:0x%02x\n", data);
254
255 if (ret)
256 *ret = retval;
257
258 return data;
259 }
260
261 u32 brcmf_sdio_regrl(struct brcmf_sdio_dev *sdiodev, u32 addr, int *ret)
262 {
263 u32 data;
264 int retval;
265
266 brcmf_dbg(INFO, "addr:0x%08x\n", addr);
267 retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, false);
268 brcmf_dbg(INFO, "data:0x%08x\n", data);
269
270 if (ret)
271 *ret = retval;
272
273 return data;
274 }
275
276 void brcmf_sdio_regwb(struct brcmf_sdio_dev *sdiodev, u32 addr,
277 u8 data, int *ret)
278 {
279 int retval;
280
281 brcmf_dbg(INFO, "addr:0x%08x, data:0x%02x\n", addr, data);
282 retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, true);
283
284 if (ret)
285 *ret = retval;
286 }
287
288 void brcmf_sdio_regwl(struct brcmf_sdio_dev *sdiodev, u32 addr,
289 u32 data, int *ret)
290 {
291 int retval;
292
293 brcmf_dbg(INFO, "addr:0x%08x, data:0x%08x\n", addr, data);
294 retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, true);
295
296 if (ret)
297 *ret = retval;
298 }
299
300 static int brcmf_sdcard_recv_prepare(struct brcmf_sdio_dev *sdiodev, uint fn,
301 uint flags, uint width, u32 *addr)
302 {
303 uint bar0 = *addr & ~SBSDIO_SB_OFT_ADDR_MASK;
304 int err = 0;
305
306 /* Async not implemented yet */
307 if (flags & SDIO_REQ_ASYNC)
308 return -ENOTSUPP;
309
310 if (bar0 != sdiodev->sbwad) {
311 err = brcmf_sdcard_set_sbaddr_window(sdiodev, bar0);
312 if (err)
313 return err;
314
315 sdiodev->sbwad = bar0;
316 }
317
318 *addr &= SBSDIO_SB_OFT_ADDR_MASK;
319
320 if (width == 4)
321 *addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
322
323 return 0;
324 }
325
326 int
327 brcmf_sdcard_recv_buf(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
328 uint flags, u8 *buf, uint nbytes)
329 {
330 struct sk_buff *mypkt;
331 int err;
332
333 mypkt = brcmu_pkt_buf_get_skb(nbytes);
334 if (!mypkt) {
335 brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
336 nbytes);
337 return -EIO;
338 }
339
340 err = brcmf_sdcard_recv_pkt(sdiodev, addr, fn, flags, mypkt);
341 if (!err)
342 memcpy(buf, mypkt->data, nbytes);
343
344 brcmu_pkt_buf_free_skb(mypkt);
345 return err;
346 }
347
348 int
349 brcmf_sdcard_recv_pkt(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
350 uint flags, struct sk_buff *pkt)
351 {
352 uint incr_fix;
353 uint width;
354 int err = 0;
355
356 brcmf_dbg(INFO, "fun = %d, addr = 0x%x, size = %d\n",
357 fn, addr, pkt->len);
358
359 width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
360 err = brcmf_sdcard_recv_prepare(sdiodev, fn, flags, width, &addr);
361 if (err)
362 return err;
363
364 incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
365 err = brcmf_sdioh_request_buffer(sdiodev, incr_fix, SDIOH_READ,
366 fn, addr, pkt);
367
368 return err;
369 }
370
371 int brcmf_sdcard_recv_chain(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
372 uint flags, struct sk_buff_head *pktq)
373 {
374 uint incr_fix;
375 uint width;
376 int err = 0;
377
378 brcmf_dbg(INFO, "fun = %d, addr = 0x%x, size = %d\n",
379 fn, addr, pktq->qlen);
380
381 width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
382 err = brcmf_sdcard_recv_prepare(sdiodev, fn, flags, width, &addr);
383 if (err)
384 return err;
385
386 incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
387 err = brcmf_sdioh_request_chain(sdiodev, incr_fix, SDIOH_READ, fn, addr,
388 pktq);
389
390 return err;
391 }
392
393 int
394 brcmf_sdcard_send_buf(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
395 uint flags, u8 *buf, uint nbytes)
396 {
397 struct sk_buff *mypkt;
398 int err;
399
400 mypkt = brcmu_pkt_buf_get_skb(nbytes);
401 if (!mypkt) {
402 brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
403 nbytes);
404 return -EIO;
405 }
406
407 memcpy(mypkt->data, buf, nbytes);
408 err = brcmf_sdcard_send_pkt(sdiodev, addr, fn, flags, mypkt);
409
410 brcmu_pkt_buf_free_skb(mypkt);
411 return err;
412
413 }
414
415 int
416 brcmf_sdcard_send_pkt(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
417 uint flags, struct sk_buff *pkt)
418 {
419 uint incr_fix;
420 uint width;
421 uint bar0 = addr & ~SBSDIO_SB_OFT_ADDR_MASK;
422 int err = 0;
423
424 brcmf_dbg(INFO, "fun = %d, addr = 0x%x, size = %d\n",
425 fn, addr, pkt->len);
426
427 /* Async not implemented yet */
428 if (flags & SDIO_REQ_ASYNC)
429 return -ENOTSUPP;
430
431 if (bar0 != sdiodev->sbwad) {
432 err = brcmf_sdcard_set_sbaddr_window(sdiodev, bar0);
433 if (err)
434 return err;
435
436 sdiodev->sbwad = bar0;
437 }
438
439 addr &= SBSDIO_SB_OFT_ADDR_MASK;
440
441 incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
442 width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
443 if (width == 4)
444 addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
445
446 return brcmf_sdioh_request_buffer(sdiodev, incr_fix, SDIOH_WRITE, fn,
447 addr, pkt);
448 }
449
450 int brcmf_sdcard_rwdata(struct brcmf_sdio_dev *sdiodev, uint rw, u32 addr,
451 u8 *buf, uint nbytes)
452 {
453 struct sk_buff *mypkt;
454 bool write = rw ? SDIOH_WRITE : SDIOH_READ;
455 int err;
456
457 addr &= SBSDIO_SB_OFT_ADDR_MASK;
458 addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
459
460 mypkt = brcmu_pkt_buf_get_skb(nbytes);
461 if (!mypkt) {
462 brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
463 nbytes);
464 return -EIO;
465 }
466
467 /* For a write, copy the buffer data into the packet. */
468 if (write)
469 memcpy(mypkt->data, buf, nbytes);
470
471 err = brcmf_sdioh_request_buffer(sdiodev, SDIOH_DATA_INC, write,
472 SDIO_FUNC_1, addr, mypkt);
473
474 /* For a read, copy the packet data back to the buffer. */
475 if (!err && !write)
476 memcpy(buf, mypkt->data, nbytes);
477
478 brcmu_pkt_buf_free_skb(mypkt);
479 return err;
480 }
481
482 int brcmf_sdcard_abort(struct brcmf_sdio_dev *sdiodev, uint fn)
483 {
484 char t_func = (char)fn;
485 brcmf_dbg(TRACE, "Enter\n");
486
487 /* issue abort cmd52 command through F0 */
488 brcmf_sdioh_request_byte(sdiodev, SDIOH_WRITE, SDIO_FUNC_0,
489 SDIO_CCCR_ABORT, &t_func);
490
491 brcmf_dbg(TRACE, "Exit\n");
492 return 0;
493 }
494
495 int brcmf_sdio_probe(struct brcmf_sdio_dev *sdiodev)
496 {
497 u32 regs = 0;
498 int ret = 0;
499
500 ret = brcmf_sdioh_attach(sdiodev);
501 if (ret)
502 goto out;
503
504 regs = SI_ENUM_BASE;
505
506 /* Report the BAR, to fix if needed */
507 sdiodev->sbwad = SI_ENUM_BASE;
508
509 /* try to attach to the target device */
510 sdiodev->bus = brcmf_sdbrcm_probe(regs, sdiodev);
511 if (!sdiodev->bus) {
512 brcmf_dbg(ERROR, "device attach failed\n");
513 ret = -ENODEV;
514 goto out;
515 }
516
517 out:
518 if (ret)
519 brcmf_sdio_remove(sdiodev);
520
521 return ret;
522 }
523 EXPORT_SYMBOL(brcmf_sdio_probe);
524
525 int brcmf_sdio_remove(struct brcmf_sdio_dev *sdiodev)
526 {
527 if (sdiodev->bus) {
528 brcmf_sdbrcm_disconnect(sdiodev->bus);
529 sdiodev->bus = NULL;
530 }
531
532 brcmf_sdioh_detach(sdiodev);
533
534 sdiodev->sbwad = 0;
535
536 return 0;
537 }
538 EXPORT_SYMBOL(brcmf_sdio_remove);
539
540 void brcmf_sdio_wdtmr_enable(struct brcmf_sdio_dev *sdiodev, bool enable)
541 {
542 if (enable)
543 brcmf_sdbrcm_wd_timer(sdiodev->bus, BRCMF_WD_POLL_MS);
544 else
545 brcmf_sdbrcm_wd_timer(sdiodev->bus, 0);
546 }
This page took 0.043737 seconds and 5 git commands to generate.