]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blame - drivers/net/wireless/brcm80211/brcmfmac/bcmsdh.c
brcmfmac: remove SDIO_REQ_ASYNC flag
[mirror_ubuntu-artful-kernel.git] / drivers / net / wireless / brcm80211 / brcmfmac / bcmsdh.c
CommitLineData
5b435de0
AS
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#include <linux/types.h>
19#include <linux/netdevice.h>
ee40fa06 20#include <linux/export.h>
5b435de0
AS
21#include <linux/pci.h>
22#include <linux/pci_ids.h>
23#include <linux/sched.h>
24#include <linux/completion.h>
354b75bf 25#include <linux/scatterlist.h>
5b435de0
AS
26#include <linux/mmc/sdio.h>
27#include <linux/mmc/sdio_func.h>
28#include <linux/mmc/card.h>
354b75bf 29#include <linux/mmc/host.h>
668761ac 30#include <linux/platform_data/brcmfmac-sdio.h>
5b435de0
AS
31
32#include <defs.h>
33#include <brcm_hw_ids.h>
34#include <brcmu_utils.h>
35#include <brcmu_wifi.h>
36#include <soc.h>
5b435de0
AS
37#include "dhd_bus.h"
38#include "dhd_dbg.h"
39#include "sdio_host.h"
40
41#define SDIOH_API_ACCESS_RETRY_LIMIT 2
42
668761ac
HM
43
44static irqreturn_t brcmf_sdio_oob_irqhandler(int irq, void *dev_id)
ba89bf19 45{
5b3c1832
HM
46 struct brcmf_bus *bus_if = dev_get_drvdata(dev_id);
47 struct brcmf_sdio_dev *sdiodev = bus_if->bus_priv.sdio;
ba89bf19 48
668761ac 49 brcmf_dbg(INTR, "OOB intr triggered\n");
ba89bf19 50
668761ac 51 /* out-of-band interrupt is level-triggered which won't
ba89bf19
FL
52 * be cleared until dpc
53 */
54 if (sdiodev->irq_en) {
55 disable_irq_nosync(irq);
56 sdiodev->irq_en = false;
57 }
58
59 brcmf_sdbrcm_isr(sdiodev->bus);
60
61 return IRQ_HANDLED;
62}
63
668761ac 64static void brcmf_sdio_ib_irqhandler(struct sdio_func *func)
5b435de0 65{
5b3c1832
HM
66 struct brcmf_bus *bus_if = dev_get_drvdata(&func->dev);
67 struct brcmf_sdio_dev *sdiodev = bus_if->bus_priv.sdio;
5b435de0 68
668761ac 69 brcmf_dbg(INTR, "IB intr triggered\n");
5b435de0 70
5b435de0 71 brcmf_sdbrcm_isr(sdiodev->bus);
5b435de0
AS
72}
73
fbf59108 74/* dummy handler for SDIO function 2 interrupt */
ba89bf19 75static void brcmf_sdio_dummy_irqhandler(struct sdio_func *func)
fbf59108
FL
76{
77}
78
ba89bf19 79int brcmf_sdio_intr_register(struct brcmf_sdio_dev *sdiodev)
5b435de0 80{
668761ac
HM
81 int ret = 0;
82 u8 data;
83 unsigned long flags;
5b435de0 84
668761ac
HM
85 if ((sdiodev->pdata) && (sdiodev->pdata->oob_irq_supported)) {
86 brcmf_dbg(SDIO, "Enter, register OOB IRQ %d\n",
87 sdiodev->pdata->oob_irq_nr);
88 ret = request_irq(sdiodev->pdata->oob_irq_nr,
89 brcmf_sdio_oob_irqhandler,
90 sdiodev->pdata->oob_irq_flags,
91 "brcmf_oob_intr",
92 &sdiodev->func[1]->dev);
93 if (ret != 0) {
94 brcmf_err("request_irq failed %d\n", ret);
95 return ret;
96 }
97 sdiodev->oob_irq_requested = true;
98 spin_lock_init(&sdiodev->irq_en_lock);
99 spin_lock_irqsave(&sdiodev->irq_en_lock, flags);
100 sdiodev->irq_en = true;
101 spin_unlock_irqrestore(&sdiodev->irq_en_lock, flags);
102
103 ret = enable_irq_wake(sdiodev->pdata->oob_irq_nr);
104 if (ret != 0) {
105 brcmf_err("enable_irq_wake failed %d\n", ret);
106 return ret;
107 }
108 sdiodev->irq_wake = true;
109
110 sdio_claim_host(sdiodev->func[1]);
111
112 /* must configure SDIO_CCCR_IENx to enable irq */
113 data = brcmf_sdio_regrb(sdiodev, SDIO_CCCR_IENx, &ret);
114 data |= 1 << SDIO_FUNC_1 | 1 << SDIO_FUNC_2 | 1;
115 brcmf_sdio_regwb(sdiodev, SDIO_CCCR_IENx, data, &ret);
116
117 /* redirect, configure and enable io for interrupt signal */
118 data = SDIO_SEPINT_MASK | SDIO_SEPINT_OE;
119 if (sdiodev->pdata->oob_irq_flags & IRQF_TRIGGER_HIGH)
120 data |= SDIO_SEPINT_ACT_HI;
121 brcmf_sdio_regwb(sdiodev, SDIO_CCCR_BRCM_SEPINT, data, &ret);
122
123 sdio_release_host(sdiodev->func[1]);
124 } else {
125 brcmf_dbg(SDIO, "Entering\n");
126 sdio_claim_host(sdiodev->func[1]);
127 sdio_claim_irq(sdiodev->func[1], brcmf_sdio_ib_irqhandler);
128 sdio_claim_irq(sdiodev->func[2], brcmf_sdio_dummy_irqhandler);
129 sdio_release_host(sdiodev->func[1]);
130 }
5b435de0
AS
131
132 return 0;
133}
134
ba89bf19 135int brcmf_sdio_intr_unregister(struct brcmf_sdio_dev *sdiodev)
5b435de0 136{
c3203374 137 brcmf_dbg(SDIO, "Entering\n");
5b435de0 138
668761ac
HM
139 if ((sdiodev->pdata) && (sdiodev->pdata->oob_irq_supported)) {
140 sdio_claim_host(sdiodev->func[1]);
141 brcmf_sdio_regwb(sdiodev, SDIO_CCCR_BRCM_SEPINT, 0, NULL);
142 brcmf_sdio_regwb(sdiodev, SDIO_CCCR_IENx, 0, NULL);
143 sdio_release_host(sdiodev->func[1]);
144
145 if (sdiodev->oob_irq_requested) {
146 sdiodev->oob_irq_requested = false;
147 if (sdiodev->irq_wake) {
148 disable_irq_wake(sdiodev->pdata->oob_irq_nr);
149 sdiodev->irq_wake = false;
150 }
151 free_irq(sdiodev->pdata->oob_irq_nr,
152 &sdiodev->func[1]->dev);
153 sdiodev->irq_en = false;
154 }
155 } else {
156 sdio_claim_host(sdiodev->func[1]);
157 sdio_release_irq(sdiodev->func[2]);
158 sdio_release_irq(sdiodev->func[1]);
159 sdio_release_host(sdiodev->func[1]);
160 }
5b435de0
AS
161
162 return 0;
163}
164
5b435de0
AS
165int
166brcmf_sdcard_set_sbaddr_window(struct brcmf_sdio_dev *sdiodev, u32 address)
167{
7d9cfc28
FL
168 int err = 0, i;
169 u8 addr[3];
170 s32 retry;
171
172 addr[0] = (address >> 8) & SBSDIO_SBADDRLOW_MASK;
173 addr[1] = (address >> 16) & SBSDIO_SBADDRMID_MASK;
174 addr[2] = (address >> 24) & SBSDIO_SBADDRHIGH_MASK;
175
176 for (i = 0; i < 3; i++) {
177 retry = 0;
178 do {
179 if (retry)
180 usleep_range(1000, 2000);
181 err = brcmf_sdioh_request_byte(sdiodev, SDIOH_WRITE,
182 SDIO_FUNC_1, SBSDIO_FUNC1_SBADDRLOW + i,
183 &addr[i]);
184 } while (err != 0 && retry++ < SDIOH_API_ACCESS_RETRY_LIMIT);
185
186 if (err) {
5e8149f5 187 brcmf_err("failed at addr:0x%0x\n",
7d9cfc28
FL
188 SBSDIO_FUNC1_SBADDRLOW + i);
189 break;
190 }
191 }
5b435de0
AS
192
193 return err;
194}
195
4531603a 196int
e9b8d91d
FL
197brcmf_sdio_regrw_helper(struct brcmf_sdio_dev *sdiodev, u32 addr,
198 void *data, bool write)
199{
200 u8 func_num, reg_size;
201 u32 bar;
202 s32 retry = 0;
203 int ret;
204
205 /*
206 * figure out how to read the register based on address range
d8b3fc59 207 * 0x00 ~ 0x7FF: function 0 CCCR and FBR
e9b8d91d
FL
208 * 0x10000 ~ 0x1FFFF: function 1 miscellaneous registers
209 * The rest: function 1 silicon backplane core registers
210 */
d8b3fc59 211 if ((addr & ~REG_F0_REG_MASK) == 0) {
e9b8d91d
FL
212 func_num = SDIO_FUNC_0;
213 reg_size = 1;
214 } else if ((addr & ~REG_F1_MISC_MASK) == 0) {
215 func_num = SDIO_FUNC_1;
216 reg_size = 1;
217 } else {
218 func_num = SDIO_FUNC_1;
219 reg_size = 4;
220
221 /* Set the window for SB core register */
222 bar = addr & ~SBSDIO_SB_OFT_ADDR_MASK;
223 if (bar != sdiodev->sbwad) {
224 ret = brcmf_sdcard_set_sbaddr_window(sdiodev, bar);
225 if (ret != 0) {
226 memset(data, 0xFF, reg_size);
227 return ret;
228 }
229 sdiodev->sbwad = bar;
230 }
231 addr &= SBSDIO_SB_OFT_ADDR_MASK;
232 addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
233 }
234
235 do {
236 if (!write)
237 memset(data, 0, reg_size);
238 if (retry) /* wait for 1 ms till bus get settled down */
239 usleep_range(1000, 2000);
240 if (reg_size == 1)
241 ret = brcmf_sdioh_request_byte(sdiodev, write,
242 func_num, addr, data);
243 else
244 ret = brcmf_sdioh_request_word(sdiodev, write,
245 func_num, addr, data, 4);
246 } while (ret != 0 && retry++ < SDIOH_API_ACCESS_RETRY_LIMIT);
247
5c15c23a 248 if (ret != 0)
5e8149f5 249 brcmf_err("failed with %d\n", ret);
e9b8d91d
FL
250
251 return ret;
252}
253
254u8 brcmf_sdio_regrb(struct brcmf_sdio_dev *sdiodev, u32 addr, int *ret)
255{
256 u8 data;
257 int retval;
258
c3203374 259 brcmf_dbg(SDIO, "addr:0x%08x\n", addr);
e9b8d91d 260 retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, false);
c3203374 261 brcmf_dbg(SDIO, "data:0x%02x\n", data);
e9b8d91d
FL
262
263 if (ret)
264 *ret = retval;
265
266 return data;
267}
268
269u32 brcmf_sdio_regrl(struct brcmf_sdio_dev *sdiodev, u32 addr, int *ret)
270{
271 u32 data;
272 int retval;
273
c3203374 274 brcmf_dbg(SDIO, "addr:0x%08x\n", addr);
e9b8d91d 275 retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, false);
c3203374 276 brcmf_dbg(SDIO, "data:0x%08x\n", data);
e9b8d91d
FL
277
278 if (ret)
279 *ret = retval;
280
281 return data;
282}
283
284void brcmf_sdio_regwb(struct brcmf_sdio_dev *sdiodev, u32 addr,
285 u8 data, int *ret)
286{
287 int retval;
288
c3203374 289 brcmf_dbg(SDIO, "addr:0x%08x, data:0x%02x\n", addr, data);
e9b8d91d
FL
290 retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, true);
291
292 if (ret)
293 *ret = retval;
294}
295
296void brcmf_sdio_regwl(struct brcmf_sdio_dev *sdiodev, u32 addr,
297 u32 data, int *ret)
298{
299 int retval;
300
c3203374 301 brcmf_dbg(SDIO, "addr:0x%08x, data:0x%08x\n", addr, data);
e9b8d91d
FL
302 retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, true);
303
304 if (ret)
305 *ret = retval;
306}
307
78b3f1c5
FL
308/**
309 * brcmf_sdio_buffrw - SDIO interface function for block data access
310 * @sdiodev: brcmfmac sdio device
311 * @fn: SDIO function number
312 * @write: direction flag
313 * @addr: dongle memory address as source/destination
314 * @pkt: skb pointer
315 *
316 * This function takes the respbonsibility as the interface function to MMC
317 * stack for block data access. It assumes that the skb passed down by the
318 * caller has already been padded and aligned.
319 */
320static int brcmf_sdio_buffrw(struct brcmf_sdio_dev *sdiodev, uint fn,
354b75bf 321 bool write, u32 addr, struct sk_buff_head *pktlist)
78b3f1c5 322{
354b75bf
FL
323 unsigned int req_sz, func_blk_sz, sg_cnt, sg_data_sz, pkt_offset;
324 unsigned int max_blks, max_req_sz;
325 unsigned short max_seg_sz, seg_sz;
326 unsigned char *pkt_data;
327 struct sk_buff *pkt_next = NULL;
328 struct mmc_request mmc_req;
329 struct mmc_command mmc_cmd;
330 struct mmc_data mmc_dat;
331 struct sg_table st;
332 struct scatterlist *sgl;
333 struct mmc_host *host;
334 int ret = 0;
335
336 if (!pktlist->qlen)
337 return -EINVAL;
78b3f1c5
FL
338
339 brcmf_pm_resume_wait(sdiodev, &sdiodev->request_buffer_wait);
340 if (brcmf_pm_resume_error(sdiodev))
341 return -EIO;
342
343 /* Single skb use the standard mmc interface */
354b75bf
FL
344 if (pktlist->qlen == 1) {
345 pkt_next = pktlist->next;
346 req_sz = pkt_next->len + 3;
347 req_sz &= (uint)~3;
78b3f1c5
FL
348
349 if (write)
350 return sdio_memcpy_toio(sdiodev->func[fn], addr,
354b75bf
FL
351 ((u8 *)(pkt_next->data)),
352 req_sz);
78b3f1c5
FL
353 else if (fn == 1)
354 return sdio_memcpy_fromio(sdiodev->func[fn],
354b75bf
FL
355 ((u8 *)(pkt_next->data)),
356 addr, req_sz);
78b3f1c5
FL
357 else
358 /* function 2 read is FIFO operation */
359 return sdio_readsb(sdiodev->func[fn],
354b75bf
FL
360 ((u8 *)(pkt_next->data)), addr,
361 req_sz);
78b3f1c5
FL
362 }
363
354b75bf
FL
364 host = sdiodev->func[fn]->card->host;
365 func_blk_sz = sdiodev->func[fn]->cur_blksize;
366 /* Blocks per command is limited by host count, host transfer
367 * size and the maximum for IO_RW_EXTENDED of 511 blocks.
368 */
369 max_blks = min_t(unsigned int, host->max_blk_count, 511u);
370 max_req_sz = min_t(unsigned int, host->max_req_size,
371 max_blks * func_blk_sz);
372 max_seg_sz = min_t(unsigned short, host->max_segs, SG_MAX_SINGLE_ALLOC);
373 max_seg_sz = min_t(unsigned short, max_seg_sz, pktlist->qlen);
374 seg_sz = pktlist->qlen;
375 pkt_offset = 0;
376 pkt_next = pktlist->next;
377
378 if (sg_alloc_table(&st, max_seg_sz, GFP_KERNEL))
379 return -ENOMEM;
380
381 while (seg_sz) {
382 req_sz = 0;
383 sg_cnt = 0;
384 memset(&mmc_req, 0, sizeof(struct mmc_request));
385 memset(&mmc_cmd, 0, sizeof(struct mmc_command));
386 memset(&mmc_dat, 0, sizeof(struct mmc_data));
387 sgl = st.sgl;
388 /* prep sg table */
389 while (pkt_next != (struct sk_buff *)pktlist) {
390 pkt_data = pkt_next->data + pkt_offset;
391 sg_data_sz = pkt_next->len - pkt_offset;
392 if (sg_data_sz > host->max_seg_size)
393 sg_data_sz = host->max_seg_size;
394 if (sg_data_sz > max_req_sz - req_sz)
395 sg_data_sz = max_req_sz - req_sz;
396
397 sg_set_buf(sgl, pkt_data, sg_data_sz);
398
399 sg_cnt++;
400 sgl = sg_next(sgl);
401 req_sz += sg_data_sz;
402 pkt_offset += sg_data_sz;
403 if (pkt_offset == pkt_next->len) {
404 pkt_offset = 0;
405 pkt_next = pkt_next->next;
406 }
407
408 if (req_sz >= max_req_sz || sg_cnt >= max_seg_sz)
409 break;
410 }
411 seg_sz -= sg_cnt;
412
413 if (req_sz % func_blk_sz != 0) {
414 brcmf_err("sg request length %u is not %u aligned\n",
415 req_sz, func_blk_sz);
416 sg_free_table(&st);
417 return -ENOTBLK;
418 }
419 mmc_dat.sg = st.sgl;
420 mmc_dat.sg_len = sg_cnt;
421 mmc_dat.blksz = func_blk_sz;
422 mmc_dat.blocks = req_sz / func_blk_sz;
423 mmc_dat.flags = write ? MMC_DATA_WRITE : MMC_DATA_READ;
424 mmc_cmd.opcode = SD_IO_RW_EXTENDED;
425 mmc_cmd.arg = write ? 1<<31 : 0; /* write flag */
426 mmc_cmd.arg |= (fn & 0x7) << 28; /* SDIO func num */
427 mmc_cmd.arg |= 1<<27; /* block mode */
428 /* incrementing addr for function 1 */
429 mmc_cmd.arg |= (fn == 1) ? 1<<26 : 0;
430 mmc_cmd.arg |= (addr & 0x1FFFF) << 9; /* address */
431 mmc_cmd.arg |= mmc_dat.blocks & 0x1FF; /* block count */
432 mmc_cmd.flags = MMC_RSP_SPI_R5 | MMC_RSP_R5 | MMC_CMD_ADTC;
433 mmc_req.cmd = &mmc_cmd;
434 mmc_req.data = &mmc_dat;
435 if (fn == 1)
436 addr += req_sz;
437
438 mmc_set_data_timeout(&mmc_dat, sdiodev->func[fn]->card);
439 mmc_wait_for_req(host, &mmc_req);
440
441 ret = mmc_cmd.error ? mmc_cmd.error : mmc_dat.error;
442 if (ret != 0) {
443 brcmf_err("CMD53 sg block %s failed %d\n",
444 write ? "write" : "read", ret);
445 ret = -EIO;
446 break;
447 }
448 }
449
450 sg_free_table(&st);
451
452 return ret;
78b3f1c5
FL
453}
454
5adfeb63 455static int brcmf_sdcard_recv_prepare(struct brcmf_sdio_dev *sdiodev, uint fn,
b058d4d2 456 uint width, u32 *addr)
5b435de0 457{
5adfeb63 458 uint bar0 = *addr & ~SBSDIO_SB_OFT_ADDR_MASK;
5b435de0
AS
459 int err = 0;
460
5b435de0
AS
461 if (bar0 != sdiodev->sbwad) {
462 err = brcmf_sdcard_set_sbaddr_window(sdiodev, bar0);
463 if (err)
464 return err;
465
466 sdiodev->sbwad = bar0;
467 }
468
5adfeb63
AS
469 *addr &= SBSDIO_SB_OFT_ADDR_MASK;
470
471 if (width == 4)
472 *addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
473
474 return 0;
475}
476
477int
478brcmf_sdcard_recv_buf(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
479 uint flags, u8 *buf, uint nbytes)
480{
481 struct sk_buff *mypkt;
482 int err;
483
484 mypkt = brcmu_pkt_buf_get_skb(nbytes);
485 if (!mypkt) {
5e8149f5 486 brcmf_err("brcmu_pkt_buf_get_skb failed: len %d\n",
5adfeb63
AS
487 nbytes);
488 return -EIO;
489 }
490
491 err = brcmf_sdcard_recv_pkt(sdiodev, addr, fn, flags, mypkt);
492 if (!err)
493 memcpy(buf, mypkt->data, nbytes);
494
495 brcmu_pkt_buf_free_skb(mypkt);
496 return err;
497}
498
499int
500brcmf_sdcard_recv_pkt(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
501 uint flags, struct sk_buff *pkt)
502{
5adfeb63
AS
503 uint width;
504 int err = 0;
354b75bf 505 struct sk_buff_head pkt_list;
5adfeb63 506
c3203374 507 brcmf_dbg(SDIO, "fun = %d, addr = 0x%x, size = %d\n",
5adfeb63
AS
508 fn, addr, pkt->len);
509
510 width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
b058d4d2 511 err = brcmf_sdcard_recv_prepare(sdiodev, fn, width, &addr);
5adfeb63 512 if (err)
7057fd00 513 goto done;
5b435de0 514
354b75bf
FL
515 skb_queue_head_init(&pkt_list);
516 skb_queue_tail(&pkt_list, pkt);
517 err = brcmf_sdio_buffrw(sdiodev, fn, false, addr, &pkt_list);
518 skb_dequeue_tail(&pkt_list);
5adfeb63 519
7057fd00 520done:
5adfeb63
AS
521 return err;
522}
523
524int brcmf_sdcard_recv_chain(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
525 uint flags, struct sk_buff_head *pktq)
526{
527 uint incr_fix;
528 uint width;
529 int err = 0;
530
c3203374 531 brcmf_dbg(SDIO, "fun = %d, addr = 0x%x, size = %d\n",
5adfeb63
AS
532 fn, addr, pktq->qlen);
533
5b435de0 534 width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
b058d4d2 535 err = brcmf_sdcard_recv_prepare(sdiodev, fn, width, &addr);
5adfeb63 536 if (err)
7057fd00 537 goto done;
5b435de0 538
5adfeb63 539 incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
354b75bf 540 err = brcmf_sdio_buffrw(sdiodev, fn, false, addr, pktq);
5b435de0 541
7057fd00 542done:
5adfeb63 543 return err;
5b435de0
AS
544}
545
546int
547brcmf_sdcard_send_buf(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
5adfeb63
AS
548 uint flags, u8 *buf, uint nbytes)
549{
550 struct sk_buff *mypkt;
551 int err;
552
553 mypkt = brcmu_pkt_buf_get_skb(nbytes);
554 if (!mypkt) {
5e8149f5 555 brcmf_err("brcmu_pkt_buf_get_skb failed: len %d\n",
5adfeb63
AS
556 nbytes);
557 return -EIO;
558 }
559
560 memcpy(mypkt->data, buf, nbytes);
561 err = brcmf_sdcard_send_pkt(sdiodev, addr, fn, flags, mypkt);
562
563 brcmu_pkt_buf_free_skb(mypkt);
564 return err;
565
566}
567
568int
569brcmf_sdcard_send_pkt(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
570 uint flags, struct sk_buff *pkt)
5b435de0 571{
5b435de0
AS
572 uint width;
573 uint bar0 = addr & ~SBSDIO_SB_OFT_ADDR_MASK;
574 int err = 0;
354b75bf 575 struct sk_buff_head pkt_list;
5b435de0 576
c3203374 577 brcmf_dbg(SDIO, "fun = %d, addr = 0x%x, size = %d\n",
5adfeb63 578 fn, addr, pkt->len);
5b435de0 579
5b435de0
AS
580 if (bar0 != sdiodev->sbwad) {
581 err = brcmf_sdcard_set_sbaddr_window(sdiodev, bar0);
582 if (err)
7057fd00 583 goto done;
5b435de0
AS
584
585 sdiodev->sbwad = bar0;
586 }
587
588 addr &= SBSDIO_SB_OFT_ADDR_MASK;
589
5b435de0
AS
590 width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
591 if (width == 4)
592 addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
593
354b75bf
FL
594 skb_queue_head_init(&pkt_list);
595 skb_queue_tail(&pkt_list, pkt);
596 err = brcmf_sdio_buffrw(sdiodev, fn, true, addr, &pkt_list);
597 skb_dequeue_tail(&pkt_list);
7057fd00
FL
598
599done:
7057fd00 600 return err;
5b435de0
AS
601}
602
ba540b01
FL
603int
604brcmf_sdio_ramrw(struct brcmf_sdio_dev *sdiodev, bool write, u32 address,
605 u8 *data, uint size)
5b435de0 606{
ba540b01
FL
607 int bcmerror = 0;
608 struct sk_buff *pkt;
609 u32 sdaddr;
610 uint dsize;
354b75bf 611 struct sk_buff_head pkt_list;
ba540b01
FL
612
613 dsize = min_t(uint, SBSDIO_SB_OFT_ADDR_LIMIT, size);
614 pkt = dev_alloc_skb(dsize);
615 if (!pkt) {
616 brcmf_err("dev_alloc_skb failed: len %d\n", dsize);
617 return -EIO;
618 }
619 pkt->priority = 0;
354b75bf 620 skb_queue_head_init(&pkt_list);
4c6e869d 621
ba540b01
FL
622 /* Determine initial transfer parameters */
623 sdaddr = address & SBSDIO_SB_OFT_ADDR_MASK;
624 if ((sdaddr + size) & SBSDIO_SBWINDOW_MASK)
625 dsize = (SBSDIO_SB_OFT_ADDR_LIMIT - sdaddr);
626 else
627 dsize = size;
5b435de0 628
ba540b01
FL
629 sdio_claim_host(sdiodev->func[1]);
630
631 /* Do the transfer(s) */
632 while (size) {
633 /* Set the backplane window to include the start address */
634 bcmerror = brcmf_sdcard_set_sbaddr_window(sdiodev, address);
635 if (bcmerror)
636 break;
637
638 brcmf_dbg(SDIO, "%s %d bytes at offset 0x%08x in window 0x%08x\n",
639 write ? "write" : "read", dsize,
640 sdaddr, address & SBSDIO_SBWINDOW_MASK);
641
642 sdaddr &= SBSDIO_SB_OFT_ADDR_MASK;
643 sdaddr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
644
645 skb_put(pkt, dsize);
646 if (write)
647 memcpy(pkt->data, data, dsize);
354b75bf 648 skb_queue_tail(&pkt_list, pkt);
78b3f1c5 649 bcmerror = brcmf_sdio_buffrw(sdiodev, SDIO_FUNC_1, write,
354b75bf
FL
650 sdaddr, &pkt_list);
651 skb_dequeue_tail(&pkt_list);
ba540b01
FL
652 if (bcmerror) {
653 brcmf_err("membytes transfer failed\n");
654 break;
655 }
656 if (!write)
657 memcpy(data, pkt->data, dsize);
658 skb_trim(pkt, dsize);
659
660 /* Adjust for next transfer (if any) */
661 size -= dsize;
662 if (size) {
663 data += dsize;
664 address += dsize;
665 sdaddr = 0;
666 dsize = min_t(uint, SBSDIO_SB_OFT_ADDR_LIMIT, size);
667 }
4c6e869d
AS
668 }
669
ba540b01 670 dev_kfree_skb(pkt);
4c6e869d 671
ba540b01
FL
672 /* Return the window to backplane enumeration space for core access */
673 if (brcmf_sdcard_set_sbaddr_window(sdiodev, sdiodev->sbwad))
674 brcmf_err("FAILED to set window back to 0x%x\n",
675 sdiodev->sbwad);
4c6e869d 676
ba540b01 677 sdio_release_host(sdiodev->func[1]);
4c6e869d 678
ba540b01 679 return bcmerror;
5b435de0
AS
680}
681
682int brcmf_sdcard_abort(struct brcmf_sdio_dev *sdiodev, uint fn)
683{
684 char t_func = (char)fn;
c3203374 685 brcmf_dbg(SDIO, "Enter\n");
5b435de0
AS
686
687 /* issue abort cmd52 command through F0 */
688 brcmf_sdioh_request_byte(sdiodev, SDIOH_WRITE, SDIO_FUNC_0,
689 SDIO_CCCR_ABORT, &t_func);
690
c3203374 691 brcmf_dbg(SDIO, "Exit\n");
5b435de0
AS
692 return 0;
693}
694
695int brcmf_sdio_probe(struct brcmf_sdio_dev *sdiodev)
696{
697 u32 regs = 0;
698 int ret = 0;
699
700 ret = brcmf_sdioh_attach(sdiodev);
701 if (ret)
702 goto out;
703
704 regs = SI_ENUM_BASE;
705
5b435de0 706 /* try to attach to the target device */
4175b88b 707 sdiodev->bus = brcmf_sdbrcm_probe(regs, sdiodev);
5b435de0 708 if (!sdiodev->bus) {
5e8149f5 709 brcmf_err("device attach failed\n");
5b435de0
AS
710 ret = -ENODEV;
711 goto out;
712 }
713
714out:
715 if (ret)
716 brcmf_sdio_remove(sdiodev);
717
718 return ret;
719}
720EXPORT_SYMBOL(brcmf_sdio_probe);
721
722int brcmf_sdio_remove(struct brcmf_sdio_dev *sdiodev)
723{
2def5c10
HM
724 sdiodev->bus_if->state = BRCMF_BUS_DOWN;
725
5b435de0
AS
726 if (sdiodev->bus) {
727 brcmf_sdbrcm_disconnect(sdiodev->bus);
728 sdiodev->bus = NULL;
729 }
730
731 brcmf_sdioh_detach(sdiodev);
732
733 sdiodev->sbwad = 0;
734
735 return 0;
736}
737EXPORT_SYMBOL(brcmf_sdio_remove);
738
739void brcmf_sdio_wdtmr_enable(struct brcmf_sdio_dev *sdiodev, bool enable)
740{
741 if (enable)
742 brcmf_sdbrcm_wd_timer(sdiodev->bus, BRCMF_WD_POLL_MS);
743 else
744 brcmf_sdbrcm_wd_timer(sdiodev->bus, 0);
745}