blob: 0f0dc42e7c6c5a64a1ed42b7d2d9bb3e53a764a3 [file] [log] [blame]
Henry Ptasinskicf2b4482010-09-20 22:33:12 -07001/*
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 */
Greg Kroah-Hartmana1c16ed2010-10-21 11:17:44 -070016#include <linux/types.h>
Brett Rudleyc6ac24e2010-10-26 11:55:23 -070017#include <linux/netdevice.h>
Franky Lin0df46042011-06-01 13:45:40 +020018#include <linux/mmc/sdio.h>
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070019#include <linux/mmc/core.h>
20#include <linux/mmc/sdio_func.h>
21#include <linux/mmc/sdio_ids.h>
Sukesh Srikakulae6e8f892011-05-13 11:59:39 +020022#include <linux/suspend.h>
Roland Vossen67f72be2011-06-29 16:47:56 -070023#include <linux/errno.h>
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070024
Roland Vossenc4daa842011-06-09 16:44:50 +020025#include <defs.h>
26#include <brcm_hw_ids.h>
27#include <brcmu_utils.h>
28#include <brcmu_wifi.h>
29#include "sdio_host.h"
Roland Vossen62dd6562011-07-05 22:05:57 +020030#include "bcmsdbus.h"
Roland Vossenc4daa842011-06-09 16:44:50 +020031#include "sdiovar.h" /* ioctl/iovars */
32#include "dngl_stats.h"
33#include "dhd.h"
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070034#include "bcmsdh_sdmmc.h"
35
Roland Vossen54ca2962011-06-29 16:46:59 -070036static void brcmf_sdioh_irqhandler(struct sdio_func *func);
37static void brcmf_sdioh_irqhandler_f2(struct sdio_func *func);
Roland Vossen294f2432011-06-29 16:47:20 -070038static int brcmf_sdioh_get_cisaddr(struct sdioh_info *sd, u32 regaddr);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070039
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070040uint sd_f2_blocksize = 512; /* Default blocksize */
41
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070042uint sd_msglevel = 0x01;
Arend van Spriel40695d12011-06-29 16:47:51 -070043BRCMF_PM_RESUME_WAIT_INIT(sdioh_request_byte_wait);
44BRCMF_PM_RESUME_WAIT_INIT(sdioh_request_word_wait);
45BRCMF_PM_RESUME_WAIT_INIT(sdioh_request_packet_wait);
46BRCMF_PM_RESUME_WAIT_INIT(sdioh_request_buffer_wait);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070047
48#define DMA_ALIGN_MASK 0x03
49
Roland Vossenb9a74292011-06-29 16:47:57 -070050static int
51brcmf_sdioh_card_regread(struct sdioh_info *sd, int func, u32 regaddr,
52 int regsize, u32 *data);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070053
Roland Vossen294f2432011-06-29 16:47:20 -070054static int brcmf_sdioh_enablefuncs(struct sdioh_info *sd)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070055{
56 int err_ret;
Greg Kroah-Hartman66cbd3a2010-10-08 11:05:47 -070057 u32 fbraddr;
Greg Kroah-Hartman3fd79f72010-10-05 10:11:12 -070058 u8 func;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070059
60 sd_trace(("%s\n", __func__));
61
62 /* Get the Card's common CIS address */
Roland Vossen54ca2962011-06-29 16:46:59 -070063 sd->com_cis_ptr = brcmf_sdioh_get_cisaddr(sd, SDIO_CCCR_CIS);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070064 sd->func_cis_ptr[0] = sd->com_cis_ptr;
65 sd_info(("%s: Card's Common CIS Ptr = 0x%x\n", __func__,
66 sd->com_cis_ptr));
67
68 /* Get the Card's function CIS (for each function) */
Franky Lin0df46042011-06-01 13:45:40 +020069 for (fbraddr = SDIO_FBR_BASE(1), func = 1;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070070 func <= sd->num_funcs; func++, fbraddr += SDIOD_FBR_SIZE) {
71 sd->func_cis_ptr[func] =
Roland Vossen54ca2962011-06-29 16:46:59 -070072 brcmf_sdioh_get_cisaddr(sd, SDIO_FBR_CIS + fbraddr);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070073 sd_info(("%s: Function %d CIS Ptr = 0x%x\n", __func__, func,
74 sd->func_cis_ptr[func]));
75 }
76
77 sd->func_cis_ptr[0] = sd->com_cis_ptr;
78 sd_info(("%s: Card's Common CIS Ptr = 0x%x\n", __func__,
79 sd->com_cis_ptr));
80
81 /* Enable Function 1 */
82 sdio_claim_host(gInstance->func[1]);
83 err_ret = sdio_enable_func(gInstance->func[1]);
84 sdio_release_host(gInstance->func[1]);
85 if (err_ret) {
Roland Vossen62dd6562011-07-05 22:05:57 +020086 sd_err(("brcmf_sdioh_enablefuncs: Failed to enable F1 "
87 "Err: 0x%08x", err_ret));
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070088 }
89
Greg Kroah-Hartman0965ae82010-10-12 12:50:15 -070090 return false;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070091}
92
93/*
94 * Public entry points & extern's
95 */
Roland Vossen294f2432011-06-29 16:47:20 -070096struct sdioh_info *brcmf_sdioh_attach(void *bar0, uint irq)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070097{
Roland Vossen294f2432011-06-29 16:47:20 -070098 struct sdioh_info *sd;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -070099 int err_ret;
100
101 sd_trace(("%s\n", __func__));
102
103 if (gInstance == NULL) {
104 sd_err(("%s: SDIO Device not present\n", __func__));
105 return NULL;
106 }
107
Roland Vossen294f2432011-06-29 16:47:20 -0700108 sd = kzalloc(sizeof(struct sdioh_info), GFP_ATOMIC);
Jason Coopera1b04b02010-09-30 15:15:37 -0400109 if (sd == NULL) {
mike.rapoport@gmail.com97e17d02010-10-13 00:09:09 +0200110 sd_err(("sdioh_attach: out of memory\n"));
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700111 return NULL;
112 }
Roland Vossen54ca2962011-06-29 16:46:59 -0700113 if (brcmf_sdioh_osinit(sd) != 0) {
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700114 sd_err(("%s:sdioh_sdmmc_osinit() failed\n", __func__));
mike.rapoport@gmail.com182acb32010-10-13 00:09:12 +0200115 kfree(sd);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700116 return NULL;
117 }
118
119 sd->num_funcs = 2;
Greg Kroah-Hartman0f0881b2010-10-12 12:15:18 -0700120 sd->use_client_ints = true;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700121 sd->client_block_size[0] = 64;
122
123 gInstance->sd = sd;
124
125 /* Claim host controller */
126 sdio_claim_host(gInstance->func[1]);
127
128 sd->client_block_size[1] = 64;
129 err_ret = sdio_set_block_size(gInstance->func[1], 64);
130 if (err_ret)
Roland Vossen62dd6562011-07-05 22:05:57 +0200131 sd_err(("brcmf_sdioh_attach: Failed to set F1 blocksize\n"));
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700132
133 /* Release host controller F1 */
134 sdio_release_host(gInstance->func[1]);
135
136 if (gInstance->func[2]) {
137 /* Claim host controller F2 */
138 sdio_claim_host(gInstance->func[2]);
139
140 sd->client_block_size[2] = sd_f2_blocksize;
141 err_ret =
142 sdio_set_block_size(gInstance->func[2], sd_f2_blocksize);
143 if (err_ret)
Roland Vossen62dd6562011-07-05 22:05:57 +0200144 sd_err(("brcmf_sdioh_attach: Failed to set F2 blocksize"
145 " to %d\n", sd_f2_blocksize));
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700146
147 /* Release host controller F2 */
148 sdio_release_host(gInstance->func[2]);
149 }
150
Roland Vossen54ca2962011-06-29 16:46:59 -0700151 brcmf_sdioh_enablefuncs(sd);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700152
153 sd_trace(("%s: Done\n", __func__));
154 return sd;
155}
156
Roland Vossen3c793822011-06-29 16:47:23 -0700157extern int brcmf_sdioh_detach(struct sdioh_info *sd)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700158{
159 sd_trace(("%s\n", __func__));
160
161 if (sd) {
162
163 /* Disable Function 2 */
164 sdio_claim_host(gInstance->func[2]);
165 sdio_disable_func(gInstance->func[2]);
166 sdio_release_host(gInstance->func[2]);
167
168 /* Disable Function 1 */
169 sdio_claim_host(gInstance->func[1]);
170 sdio_disable_func(gInstance->func[1]);
171 sdio_release_host(gInstance->func[1]);
172
173 /* deregister irq */
Roland Vossen54ca2962011-06-29 16:46:59 -0700174 brcmf_sdioh_osfree(sd);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700175
mike.rapoport@gmail.com182acb32010-10-13 00:09:12 +0200176 kfree(sd);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700177 }
Roland Vossen67f72be2011-06-29 16:47:56 -0700178 return 0;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700179}
180
Peter Hueweb3b97f52011-03-26 02:17:52 +0100181/* Configure callback to client when we receive client interrupt */
Roland Vossen3c793822011-06-29 16:47:23 -0700182extern int
Roland Vossen294f2432011-06-29 16:47:20 -0700183brcmf_sdioh_interrupt_register(struct sdioh_info *sd, sdioh_cb_fn_t fn,
184 void *argh)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700185{
186 sd_trace(("%s: Entering\n", __func__));
187 if (fn == NULL) {
188 sd_err(("%s: interrupt handler is NULL, not registering\n",
189 __func__));
Roland Vossen67f72be2011-06-29 16:47:56 -0700190 return -EINVAL;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700191 }
Arend van Spriel67a646f2011-06-29 16:47:38 -0700192
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700193 sd->intr_handler = fn;
194 sd->intr_handler_arg = argh;
Greg Kroah-Hartman0f0881b2010-10-12 12:15:18 -0700195 sd->intr_handler_valid = true;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700196
197 /* register and unmask irq */
198 if (gInstance->func[2]) {
199 sdio_claim_host(gInstance->func[2]);
Roland Vossen54ca2962011-06-29 16:46:59 -0700200 sdio_claim_irq(gInstance->func[2], brcmf_sdioh_irqhandler_f2);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700201 sdio_release_host(gInstance->func[2]);
202 }
203
204 if (gInstance->func[1]) {
205 sdio_claim_host(gInstance->func[1]);
Roland Vossen54ca2962011-06-29 16:46:59 -0700206 sdio_claim_irq(gInstance->func[1], brcmf_sdioh_irqhandler);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700207 sdio_release_host(gInstance->func[1]);
208 }
Arend van Spriel67a646f2011-06-29 16:47:38 -0700209
Roland Vossen67f72be2011-06-29 16:47:56 -0700210 return 0;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700211}
212
Roland Vossen3c793822011-06-29 16:47:23 -0700213extern int brcmf_sdioh_interrupt_deregister(struct sdioh_info *sd)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700214{
215 sd_trace(("%s: Entering\n", __func__));
216
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700217 if (gInstance->func[1]) {
218 /* register and unmask irq */
219 sdio_claim_host(gInstance->func[1]);
220 sdio_release_irq(gInstance->func[1]);
221 sdio_release_host(gInstance->func[1]);
222 }
223
224 if (gInstance->func[2]) {
225 /* Claim host controller F2 */
226 sdio_claim_host(gInstance->func[2]);
227 sdio_release_irq(gInstance->func[2]);
228 /* Release host controller F2 */
229 sdio_release_host(gInstance->func[2]);
230 }
231
Greg Kroah-Hartman0965ae82010-10-12 12:50:15 -0700232 sd->intr_handler_valid = false;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700233 sd->intr_handler = NULL;
234 sd->intr_handler_arg = NULL;
Arend van Spriel67a646f2011-06-29 16:47:38 -0700235
Roland Vossen67f72be2011-06-29 16:47:56 -0700236 return 0;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700237}
238
Roland Vossen3c793822011-06-29 16:47:23 -0700239extern int
Roland Vossen294f2432011-06-29 16:47:20 -0700240brcmf_sdioh_interrupt_query(struct sdioh_info *sd, bool *onoff)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700241{
242 sd_trace(("%s: Entering\n", __func__));
243 *onoff = sd->client_intr_enabled;
Roland Vossen67f72be2011-06-29 16:47:56 -0700244 return 0;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700245}
246
Roland Vossen294f2432011-06-29 16:47:20 -0700247uint brcmf_sdioh_query_iofnum(struct sdioh_info *sd)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700248{
249 return sd->num_funcs;
250}
251
252/* IOVar table */
253enum {
254 IOV_MSGLEVEL = 1,
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700255 IOV_BLOCKSIZE,
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700256 IOV_USEINTS,
257 IOV_NUMINTS,
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700258 IOV_DEVREG,
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700259 IOV_HCIREGS,
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700260 IOV_RXCHAIN
261};
262
Roland Vossen67ad48b2011-06-01 13:45:51 +0200263const struct brcmu_iovar sdioh_iovars[] = {
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700264 {"sd_msglevel", IOV_MSGLEVEL, 0, IOVT_UINT32, 0},
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700265 {"sd_blocksize", IOV_BLOCKSIZE, 0, IOVT_UINT32, 0},/* ((fn << 16) |
266 size) */
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700267 {"sd_ints", IOV_USEINTS, 0, IOVT_BOOL, 0},
268 {"sd_numints", IOV_NUMINTS, 0, IOVT_UINT32, 0},
Roland Vossen51851252011-06-29 16:47:24 -0700269 {"sd_devreg", IOV_DEVREG, 0, IOVT_BUFFER, sizeof(struct brcmf_sdreg)}
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700270 ,
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700271 {"sd_rxchain", IOV_RXCHAIN, 0, IOVT_BOOL, 0}
272 ,
273 {NULL, 0, 0, 0, 0}
274};
275
276int
Roland Vossen294f2432011-06-29 16:47:20 -0700277brcmf_sdioh_iovar_op(struct sdioh_info *si, const char *name,
Roland Vossen54ca2962011-06-29 16:46:59 -0700278 void *params, int plen, void *arg, int len, bool set)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700279{
Roland Vossen67ad48b2011-06-01 13:45:51 +0200280 const struct brcmu_iovar *vi = NULL;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700281 int bcmerror = 0;
282 int val_size;
Greg Kroah-Hartman3e264162010-10-08 11:11:13 -0700283 s32 int_val = 0;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700284 bool bool_val;
Greg Kroah-Hartman66cbd3a2010-10-08 11:05:47 -0700285 u32 actionid;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700286
287 ASSERT(name);
288 ASSERT(len >= 0);
289
290 /* Get must have return space; Set does not take qualifiers */
291 ASSERT(set || (arg && len));
292 ASSERT(!set || (!params && !plen));
293
294 sd_trace(("%s: Enter (%s %s)\n", __func__, (set ? "set" : "get"),
295 name));
296
Roland Vossen67ad48b2011-06-01 13:45:51 +0200297 vi = brcmu_iovar_lookup(sdioh_iovars, name);
Jason Coopera1b04b02010-09-30 15:15:37 -0400298 if (vi == NULL) {
Roland Vossene10d82d2011-05-03 11:35:19 +0200299 bcmerror = -ENOTSUPP;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700300 goto exit;
301 }
302
Roland Vossen67ad48b2011-06-01 13:45:51 +0200303 bcmerror = brcmu_iovar_lencheck(vi, arg, len, set);
Jason Coopera1b04b02010-09-30 15:15:37 -0400304 if (bcmerror != 0)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700305 goto exit;
306
307 /* Set up params so get and set can share the convenience variables */
308 if (params == NULL) {
309 params = arg;
310 plen = len;
311 }
312
313 if (vi->type == IOVT_VOID)
314 val_size = 0;
315 else if (vi->type == IOVT_BUFFER)
316 val_size = len;
317 else
318 val_size = sizeof(int);
319
320 if (plen >= (int)sizeof(int_val))
Stanislav Fomichev02160692011-02-15 01:05:10 +0300321 memcpy(&int_val, params, sizeof(int_val));
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700322
Greg Kroah-Hartman0965ae82010-10-12 12:50:15 -0700323 bool_val = (int_val != 0) ? true : false;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700324
325 actionid = set ? IOV_SVAL(vi->varid) : IOV_GVAL(vi->varid);
326 switch (actionid) {
327 case IOV_GVAL(IOV_MSGLEVEL):
Greg Kroah-Hartman3e264162010-10-08 11:11:13 -0700328 int_val = (s32) sd_msglevel;
Stanislav Fomichev02160692011-02-15 01:05:10 +0300329 memcpy(arg, &int_val, val_size);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700330 break;
331
332 case IOV_SVAL(IOV_MSGLEVEL):
333 sd_msglevel = int_val;
334 break;
335
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700336 case IOV_GVAL(IOV_BLOCKSIZE):
Greg Kroah-Hartman66cbd3a2010-10-08 11:05:47 -0700337 if ((u32) int_val > si->num_funcs) {
Roland Vossene10d82d2011-05-03 11:35:19 +0200338 bcmerror = -EINVAL;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700339 break;
340 }
Greg Kroah-Hartman3e264162010-10-08 11:11:13 -0700341 int_val = (s32) si->client_block_size[int_val];
Stanislav Fomichev02160692011-02-15 01:05:10 +0300342 memcpy(arg, &int_val, val_size);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700343 break;
344
345 case IOV_SVAL(IOV_BLOCKSIZE):
346 {
Greg Kroah-Hartman66cbd3a2010-10-08 11:05:47 -0700347 uint func = ((u32) int_val >> 16);
Greg Kroah-Hartman7d4df482010-10-07 17:04:47 -0700348 uint blksize = (u16) int_val;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700349 uint maxsize;
350
351 if (func > si->num_funcs) {
Roland Vossene10d82d2011-05-03 11:35:19 +0200352 bcmerror = -EINVAL;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700353 break;
354 }
355
356 switch (func) {
357 case 0:
358 maxsize = 32;
359 break;
360 case 1:
361 maxsize = BLOCK_SIZE_4318;
362 break;
363 case 2:
364 maxsize = BLOCK_SIZE_4328;
365 break;
366 default:
367 maxsize = 0;
368 }
369 if (blksize > maxsize) {
Roland Vossene10d82d2011-05-03 11:35:19 +0200370 bcmerror = -EINVAL;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700371 break;
372 }
373 if (!blksize)
374 blksize = maxsize;
375
376 /* Now set it */
377 si->client_block_size[func] = blksize;
378
379 break;
380 }
381
382 case IOV_GVAL(IOV_RXCHAIN):
Greg Kroah-Hartman0965ae82010-10-12 12:50:15 -0700383 int_val = false;
Stanislav Fomichev02160692011-02-15 01:05:10 +0300384 memcpy(arg, &int_val, val_size);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700385 break;
386
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700387 case IOV_GVAL(IOV_USEINTS):
Greg Kroah-Hartman3e264162010-10-08 11:11:13 -0700388 int_val = (s32) si->use_client_ints;
Stanislav Fomichev02160692011-02-15 01:05:10 +0300389 memcpy(arg, &int_val, val_size);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700390 break;
391
392 case IOV_SVAL(IOV_USEINTS):
393 si->use_client_ints = (bool) int_val;
394 if (si->use_client_ints)
395 si->intmask |= CLIENT_INTR;
396 else
397 si->intmask &= ~CLIENT_INTR;
398
399 break;
400
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700401 case IOV_GVAL(IOV_NUMINTS):
Greg Kroah-Hartman3e264162010-10-08 11:11:13 -0700402 int_val = (s32) si->intrcount;
Stanislav Fomichev02160692011-02-15 01:05:10 +0300403 memcpy(arg, &int_val, val_size);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700404 break;
405
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700406 case IOV_GVAL(IOV_DEVREG):
407 {
Roland Vossen51851252011-06-29 16:47:24 -0700408 struct brcmf_sdreg *sd_ptr =
409 (struct brcmf_sdreg *) params;
Greg Kroah-Hartman3fd79f72010-10-05 10:11:12 -0700410 u8 data = 0;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700411
Roland Vossen54ca2962011-06-29 16:46:59 -0700412 if (brcmf_sdioh_cfg_read
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700413 (si, sd_ptr->func, sd_ptr->offset, &data)) {
Roland Vossenb74ac122011-05-03 11:35:20 +0200414 bcmerror = -EIO;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700415 break;
416 }
417
418 int_val = (int)data;
Stanislav Fomichev02160692011-02-15 01:05:10 +0300419 memcpy(arg, &int_val, sizeof(int_val));
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700420 break;
421 }
422
423 case IOV_SVAL(IOV_DEVREG):
424 {
Roland Vossen51851252011-06-29 16:47:24 -0700425 struct brcmf_sdreg *sd_ptr =
426 (struct brcmf_sdreg *) params;
Greg Kroah-Hartman3fd79f72010-10-05 10:11:12 -0700427 u8 data = (u8) sd_ptr->value;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700428
Roland Vossen54ca2962011-06-29 16:46:59 -0700429 if (brcmf_sdioh_cfg_write
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700430 (si, sd_ptr->func, sd_ptr->offset, &data)) {
Roland Vossenb74ac122011-05-03 11:35:20 +0200431 bcmerror = -EIO;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700432 break;
433 }
434 break;
435 }
436
437 default:
Roland Vossene10d82d2011-05-03 11:35:19 +0200438 bcmerror = -ENOTSUPP;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700439 break;
440 }
441exit:
442
443 return bcmerror;
444}
445
Roland Vossen3c793822011-06-29 16:47:23 -0700446extern int
Roland Vossen294f2432011-06-29 16:47:20 -0700447brcmf_sdioh_cfg_read(struct sdioh_info *sd, uint fnc_num, u32 addr, u8 *data)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700448{
Roland Vossen3c793822011-06-29 16:47:23 -0700449 int status;
Roland Vossen54ca2962011-06-29 16:46:59 -0700450 /* No lock needed since brcmf_sdioh_request_byte does locking */
451 status = brcmf_sdioh_request_byte(sd, SDIOH_READ, fnc_num, addr, data);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700452 return status;
453}
454
Roland Vossen3c793822011-06-29 16:47:23 -0700455extern int
Roland Vossen294f2432011-06-29 16:47:20 -0700456brcmf_sdioh_cfg_write(struct sdioh_info *sd, uint fnc_num, u32 addr, u8 *data)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700457{
Roland Vossen54ca2962011-06-29 16:46:59 -0700458 /* No lock needed since brcmf_sdioh_request_byte does locking */
Roland Vossen3c793822011-06-29 16:47:23 -0700459 int status;
Roland Vossen54ca2962011-06-29 16:46:59 -0700460 status = brcmf_sdioh_request_byte(sd, SDIOH_WRITE, fnc_num, addr, data);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700461 return status;
462}
463
Roland Vossen294f2432011-06-29 16:47:20 -0700464static int brcmf_sdioh_get_cisaddr(struct sdioh_info *sd, u32 regaddr)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700465{
466 /* read 24 bits and return valid 17 bit addr */
467 int i;
Greg Kroah-Hartman66cbd3a2010-10-08 11:05:47 -0700468 u32 scratch, regdata;
Greg Kroah-Hartman3fd79f72010-10-05 10:11:12 -0700469 u8 *ptr = (u8 *)&scratch;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700470 for (i = 0; i < 3; i++) {
Roland Vossen54ca2962011-06-29 16:46:59 -0700471 if ((brcmf_sdioh_card_regread(sd, 0, regaddr, 1, &regdata)) !=
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700472 SUCCESS)
473 sd_err(("%s: Can't read!\n", __func__));
474
Greg Kroah-Hartman3fd79f72010-10-05 10:11:12 -0700475 *ptr++ = (u8) regdata;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700476 regaddr++;
477 }
478
479 /* Only the lower 17-bits are valid */
Stanislav Fomichev628f10b2011-02-20 21:43:32 +0300480 scratch = le32_to_cpu(scratch);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700481 scratch &= 0x0001FFFF;
482 return scratch;
483}
484
Roland Vossen3c793822011-06-29 16:47:23 -0700485extern int
Roland Vossen294f2432011-06-29 16:47:20 -0700486brcmf_sdioh_cis_read(struct sdioh_info *sd, uint func, u8 *cisd, u32 length)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700487{
Greg Kroah-Hartman66cbd3a2010-10-08 11:05:47 -0700488 u32 count;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700489 int offset;
Greg Kroah-Hartman66cbd3a2010-10-08 11:05:47 -0700490 u32 foo;
Greg Kroah-Hartman3fd79f72010-10-05 10:11:12 -0700491 u8 *cis = cisd;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700492
493 sd_trace(("%s: Func = %d\n", __func__, func));
494
495 if (!sd->func_cis_ptr[func]) {
Brett Rudley9249ede2010-11-30 20:09:49 -0800496 memset(cis, 0, length);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700497 sd_err(("%s: no func_cis_ptr[%d]\n", __func__, func));
Roland Vossen67f72be2011-06-29 16:47:56 -0700498 return -ENOTSUPP;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700499 }
500
501 sd_err(("%s: func_cis_ptr[%d]=0x%04x\n", __func__, func,
502 sd->func_cis_ptr[func]));
503
504 for (count = 0; count < length; count++) {
505 offset = sd->func_cis_ptr[func] + count;
Roland Vossen54ca2962011-06-29 16:46:59 -0700506 if (brcmf_sdioh_card_regread(sd, 0, offset, 1, &foo) < 0) {
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700507 sd_err(("%s: regread failed: Can't read CIS\n",
508 __func__));
Roland Vossen67f72be2011-06-29 16:47:56 -0700509 return -EIO;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700510 }
511
Greg Kroah-Hartman3fd79f72010-10-05 10:11:12 -0700512 *cis = (u8) (foo & 0xff);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700513 cis++;
514 }
515
Roland Vossen67f72be2011-06-29 16:47:56 -0700516 return 0;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700517}
518
Roland Vossen3c793822011-06-29 16:47:23 -0700519extern int
Roland Vossen294f2432011-06-29 16:47:20 -0700520brcmf_sdioh_request_byte(struct sdioh_info *sd, uint rw, uint func,
521 uint regaddr, u8 *byte)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700522{
523 int err_ret;
524
525 sd_info(("%s: rw=%d, func=%d, addr=0x%05x\n", __func__, rw, func,
526 regaddr));
527
Arend van Spriel40695d12011-06-29 16:47:51 -0700528 BRCMF_PM_RESUME_WAIT(sdioh_request_byte_wait);
Roland Vossen67f72be2011-06-29 16:47:56 -0700529 BRCMF_PM_RESUME_RETURN_ERROR(-EIO);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700530 if (rw) { /* CMD52 Write */
531 if (func == 0) {
532 /* Can only directly write to some F0 registers.
533 * Handle F2 enable
534 * as a special case.
535 */
Franky Lin0df46042011-06-01 13:45:40 +0200536 if (regaddr == SDIO_CCCR_IOEx) {
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700537 if (gInstance->func[2]) {
538 sdio_claim_host(gInstance->func[2]);
539 if (*byte & SDIO_FUNC_ENABLE_2) {
540 /* Enable Function 2 */
541 err_ret =
542 sdio_enable_func
543 (gInstance->func[2]);
544 if (err_ret)
Roland Vossen62dd6562011-07-05 22:05:57 +0200545 sd_err(("request_byte: "
546 "enable F2 "
547 "failed:%d",
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700548 err_ret));
549 } else {
550 /* Disable Function 2 */
551 err_ret =
552 sdio_disable_func
553 (gInstance->func[2]);
554 if (err_ret)
Roland Vossen62dd6562011-07-05 22:05:57 +0200555 sd_err(("request_byte: "
556 "Disab F2 "
557 "failed:%d",
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700558 err_ret));
559 }
560 sdio_release_host(gInstance->func[2]);
561 }
562 }
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700563 /* to allow abort command through F1 */
Franky Lin0df46042011-06-01 13:45:40 +0200564 else if (regaddr == SDIO_CCCR_ABORT) {
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700565 sdio_claim_host(gInstance->func[func]);
566 /*
567 * this sdio_f0_writeb() can be replaced
568 * with another api
569 * depending upon MMC driver change.
570 * As of this time, this is temporaray one
571 */
572 sdio_writeb(gInstance->func[func], *byte,
573 regaddr, &err_ret);
574 sdio_release_host(gInstance->func[func]);
575 }
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700576 else if (regaddr < 0xF0) {
Roland Vossen62dd6562011-07-05 22:05:57 +0200577 sd_err(("brcmf: F0 Wr:0x%02x: write "
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700578 "disallowed\n", regaddr));
579 } else {
580 /* Claim host controller, perform F0 write,
581 and release */
582 sdio_claim_host(gInstance->func[func]);
583 sdio_f0_writeb(gInstance->func[func], *byte,
584 regaddr, &err_ret);
585 sdio_release_host(gInstance->func[func]);
586 }
587 } else {
588 /* Claim host controller, perform Fn write,
589 and release */
590 sdio_claim_host(gInstance->func[func]);
591 sdio_writeb(gInstance->func[func], *byte, regaddr,
592 &err_ret);
593 sdio_release_host(gInstance->func[func]);
594 }
595 } else { /* CMD52 Read */
596 /* Claim host controller, perform Fn read, and release */
597 sdio_claim_host(gInstance->func[func]);
598
599 if (func == 0) {
600 *byte =
601 sdio_f0_readb(gInstance->func[func], regaddr,
602 &err_ret);
603 } else {
604 *byte =
605 sdio_readb(gInstance->func[func], regaddr,
606 &err_ret);
607 }
608
609 sdio_release_host(gInstance->func[func]);
610 }
611
612 if (err_ret)
Roland Vossen62dd6562011-07-05 22:05:57 +0200613 sd_err(("brcmf: Failed to %s byte F%d:@0x%05x=%02x, "
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700614 "Err: %d\n", rw ? "Write" : "Read", func, regaddr,
615 *byte, err_ret));
616
Roland Vossen67f72be2011-06-29 16:47:56 -0700617 return err_ret;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700618}
619
Roland Vossen3c793822011-06-29 16:47:23 -0700620extern int
Roland Vossen294f2432011-06-29 16:47:20 -0700621brcmf_sdioh_request_word(struct sdioh_info *sd, uint cmd_type, uint rw,
622 uint func, uint addr, u32 *word, uint nbytes)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700623{
Roland Vossen67f72be2011-06-29 16:47:56 -0700624 int err_ret = -EIO;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700625
626 if (func == 0) {
627 sd_err(("%s: Only CMD52 allowed to F0.\n", __func__));
Roland Vossen67f72be2011-06-29 16:47:56 -0700628 return -EINVAL;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700629 }
630
631 sd_info(("%s: cmd_type=%d, rw=%d, func=%d, addr=0x%05x, nbytes=%d\n",
632 __func__, cmd_type, rw, func, addr, nbytes));
633
Arend van Spriel40695d12011-06-29 16:47:51 -0700634 BRCMF_PM_RESUME_WAIT(sdioh_request_word_wait);
Roland Vossen67f72be2011-06-29 16:47:56 -0700635 BRCMF_PM_RESUME_RETURN_ERROR(-EIO);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700636 /* Claim host controller */
637 sdio_claim_host(gInstance->func[func]);
638
639 if (rw) { /* CMD52 Write */
640 if (nbytes == 4) {
641 sdio_writel(gInstance->func[func], *word, addr,
642 &err_ret);
643 } else if (nbytes == 2) {
644 sdio_writew(gInstance->func[func], (*word & 0xFFFF),
645 addr, &err_ret);
646 } else {
647 sd_err(("%s: Invalid nbytes: %d\n", __func__, nbytes));
648 }
649 } else { /* CMD52 Read */
650 if (nbytes == 4) {
651 *word =
652 sdio_readl(gInstance->func[func], addr, &err_ret);
653 } else if (nbytes == 2) {
654 *word =
655 sdio_readw(gInstance->func[func], addr,
656 &err_ret) & 0xFFFF;
657 } else {
658 sd_err(("%s: Invalid nbytes: %d\n", __func__, nbytes));
659 }
660 }
661
662 /* Release host controller */
663 sdio_release_host(gInstance->func[func]);
664
665 if (err_ret) {
Roland Vossen62dd6562011-07-05 22:05:57 +0200666 sd_err(("brcmf: Failed to %s word, Err: 0x%08x",
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700667 rw ? "Write" : "Read", err_ret));
668 }
669
Roland Vossen67f72be2011-06-29 16:47:56 -0700670 return err_ret;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700671}
672
Roland Vossen3c793822011-06-29 16:47:23 -0700673static int
Roland Vossen294f2432011-06-29 16:47:20 -0700674brcmf_sdioh_request_packet(struct sdioh_info *sd, uint fix_inc, uint write,
Roland Vossen54ca2962011-06-29 16:46:59 -0700675 uint func, uint addr, struct sk_buff *pkt)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700676{
677 bool fifo = (fix_inc == SDIOH_DATA_FIX);
Greg Kroah-Hartman66cbd3a2010-10-08 11:05:47 -0700678 u32 SGCount = 0;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700679 int err_ret = 0;
680
Arend van Sprielc26b1372010-11-23 14:06:23 +0100681 struct sk_buff *pnext;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700682
683 sd_trace(("%s: Enter\n", __func__));
684
685 ASSERT(pkt);
Arend van Spriel40695d12011-06-29 16:47:51 -0700686 BRCMF_PM_RESUME_WAIT(sdioh_request_packet_wait);
Roland Vossen67f72be2011-06-29 16:47:56 -0700687 BRCMF_PM_RESUME_RETURN_ERROR(-EIO);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700688
689 /* Claim host controller */
690 sdio_claim_host(gInstance->func[func]);
Arend van Spriel54991ad2010-11-23 14:06:24 +0100691 for (pnext = pkt; pnext; pnext = pnext->next) {
692 uint pkt_len = pnext->len;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700693 pkt_len += 3;
694 pkt_len &= 0xFFFFFFFC;
695
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700696 /* Make sure the packet is aligned properly.
697 * If it isn't, then this
Roland Vossen54ca2962011-06-29 16:46:59 -0700698 * is the fault of brcmf_sdioh_request_buffer() which
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700699 * is supposed to give
700 * us something we can work with.
701 */
Arend van Spriel54991ad2010-11-23 14:06:24 +0100702 ASSERT(((u32) (pkt->data) & DMA_ALIGN_MASK) == 0);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700703
704 if ((write) && (!fifo)) {
705 err_ret = sdio_memcpy_toio(gInstance->func[func], addr,
Arend van Spriel54991ad2010-11-23 14:06:24 +0100706 ((u8 *) (pnext->data)),
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700707 pkt_len);
708 } else if (write) {
709 err_ret = sdio_memcpy_toio(gInstance->func[func], addr,
Arend van Spriel54991ad2010-11-23 14:06:24 +0100710 ((u8 *) (pnext->data)),
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700711 pkt_len);
712 } else if (fifo) {
713 err_ret = sdio_readsb(gInstance->func[func],
Arend van Spriel54991ad2010-11-23 14:06:24 +0100714 ((u8 *) (pnext->data)),
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700715 addr, pkt_len);
716 } else {
717 err_ret = sdio_memcpy_fromio(gInstance->func[func],
Arend van Spriel54991ad2010-11-23 14:06:24 +0100718 ((u8 *) (pnext->data)),
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700719 addr, pkt_len);
720 }
721
722 if (err_ret) {
723 sd_err(("%s: %s FAILED %p[%d], addr=0x%05x, pkt_len=%d,"
Jason Coopere9887c92010-10-06 10:08:02 -0400724 "ERR=0x%08x\n", __func__,
725 (write) ? "TX" : "RX",
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700726 pnext, SGCount, addr, pkt_len, err_ret));
727 } else {
728 sd_trace(("%s: %s xfr'd %p[%d], addr=0x%05x, len=%d\n",
729 __func__,
730 (write) ? "TX" : "RX",
731 pnext, SGCount, addr, pkt_len));
732 }
733
734 if (!fifo)
735 addr += pkt_len;
736 SGCount++;
737
738 }
739
740 /* Release host controller */
741 sdio_release_host(gInstance->func[func]);
742
743 sd_trace(("%s: Exit\n", __func__));
Roland Vossen67f72be2011-06-29 16:47:56 -0700744 return err_ret;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700745}
746
747/*
748 * This function takes a buffer or packet, and fixes everything up
Grant Grundler4b455e02011-05-04 09:59:47 -0700749 * so that in the end, a DMA-able packet is created.
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700750 *
751 * A buffer does not have an associated packet pointer,
752 * and may or may not be aligned.
753 * A packet may consist of a single packet, or a packet chain.
Grant Grundler4b455e02011-05-04 09:59:47 -0700754 * If it is a packet chain, then all the packets in the chain
755 * must be properly aligned.
756 *
757 * If the packet data is not aligned, then there may only be
758 * one packet, and in this case, it is copied to a new
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700759 * aligned packet.
760 *
761 */
Roland Vossen3c793822011-06-29 16:47:23 -0700762extern int
Roland Vossen294f2432011-06-29 16:47:20 -0700763brcmf_sdioh_request_buffer(struct sdioh_info *sd, uint pio_dma, uint fix_inc,
Roland Vossen54ca2962011-06-29 16:46:59 -0700764 uint write, uint func, uint addr, uint reg_width,
765 uint buflen_u, u8 *buffer, struct sk_buff *pkt)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700766{
Roland Vossen3c793822011-06-29 16:47:23 -0700767 int Status;
Arend van Sprielc26b1372010-11-23 14:06:23 +0100768 struct sk_buff *mypkt = NULL;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700769
770 sd_trace(("%s: Enter\n", __func__));
771
Arend van Spriel40695d12011-06-29 16:47:51 -0700772 BRCMF_PM_RESUME_WAIT(sdioh_request_buffer_wait);
Roland Vossen67f72be2011-06-29 16:47:56 -0700773 BRCMF_PM_RESUME_RETURN_ERROR(-EIO);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700774 /* Case 1: we don't have a packet. */
775 if (pkt == NULL) {
776 sd_data(("%s: Creating new %s Packet, len=%d\n",
777 __func__, write ? "TX" : "RX", buflen_u));
Roland Vossen67ad48b2011-06-01 13:45:51 +0200778 mypkt = brcmu_pkt_buf_get_skb(buflen_u);
Jason Coopera1b04b02010-09-30 15:15:37 -0400779 if (!mypkt) {
Roland Vossen67ad48b2011-06-01 13:45:51 +0200780 sd_err(("%s: brcmu_pkt_buf_get_skb failed: len %d\n",
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700781 __func__, buflen_u));
Roland Vossen67f72be2011-06-29 16:47:56 -0700782 return -EIO;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700783 }
784
785 /* For a write, copy the buffer data into the packet. */
786 if (write)
Stanislav Fomichev02160692011-02-15 01:05:10 +0300787 memcpy(mypkt->data, buffer, buflen_u);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700788
Roland Vossen54ca2962011-06-29 16:46:59 -0700789 Status = brcmf_sdioh_request_packet(sd, fix_inc, write, func,
790 addr, mypkt);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700791
792 /* For a read, copy the packet data back to the buffer. */
793 if (!write)
Stanislav Fomichev02160692011-02-15 01:05:10 +0300794 memcpy(buffer, mypkt->data, buflen_u);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700795
Roland Vossen67ad48b2011-06-01 13:45:51 +0200796 brcmu_pkt_buf_free_skb(mypkt);
Arend van Spriel54991ad2010-11-23 14:06:24 +0100797 } else if (((u32) (pkt->data) & DMA_ALIGN_MASK) != 0) {
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700798 /* Case 2: We have a packet, but it is unaligned. */
799
800 /* In this case, we cannot have a chain. */
Arend van Spriel54991ad2010-11-23 14:06:24 +0100801 ASSERT(pkt->next == NULL);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700802
803 sd_data(("%s: Creating aligned %s Packet, len=%d\n",
Arend van Spriel54991ad2010-11-23 14:06:24 +0100804 __func__, write ? "TX" : "RX", pkt->len));
Roland Vossen67ad48b2011-06-01 13:45:51 +0200805 mypkt = brcmu_pkt_buf_get_skb(pkt->len);
Jason Coopera1b04b02010-09-30 15:15:37 -0400806 if (!mypkt) {
Roland Vossen67ad48b2011-06-01 13:45:51 +0200807 sd_err(("%s: brcmu_pkt_buf_get_skb failed: len %d\n",
Arend van Spriel54991ad2010-11-23 14:06:24 +0100808 __func__, pkt->len));
Roland Vossen67f72be2011-06-29 16:47:56 -0700809 return -EIO;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700810 }
811
812 /* For a write, copy the buffer data into the packet. */
813 if (write)
Stanislav Fomichev02160692011-02-15 01:05:10 +0300814 memcpy(mypkt->data, pkt->data, pkt->len);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700815
Roland Vossen54ca2962011-06-29 16:46:59 -0700816 Status = brcmf_sdioh_request_packet(sd, fix_inc, write, func,
817 addr, mypkt);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700818
819 /* For a read, copy the packet data back to the buffer. */
820 if (!write)
Stanislav Fomichev02160692011-02-15 01:05:10 +0300821 memcpy(pkt->data, mypkt->data, mypkt->len);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700822
Roland Vossen67ad48b2011-06-01 13:45:51 +0200823 brcmu_pkt_buf_free_skb(mypkt);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700824 } else { /* case 3: We have a packet and
825 it is aligned. */
826 sd_data(("%s: Aligned %s Packet, direct DMA\n",
827 __func__, write ? "Tx" : "Rx"));
Roland Vossen54ca2962011-06-29 16:46:59 -0700828 Status = brcmf_sdioh_request_packet(sd, fix_inc, write, func,
829 addr, pkt);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700830 }
831
832 return Status;
833}
834
835/* this function performs "abort" for both of host & device */
Roland Vossen294f2432011-06-29 16:47:20 -0700836extern int brcmf_sdioh_abort(struct sdioh_info *sd, uint func)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700837{
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700838 char t_func = (char)func;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700839 sd_trace(("%s: Enter\n", __func__));
840
Franky Lin0df46042011-06-01 13:45:40 +0200841 /* issue abort cmd52 command through F0 */
Roland Vossen54ca2962011-06-29 16:46:59 -0700842 brcmf_sdioh_request_byte(sd, SDIOH_WRITE, SDIO_FUNC_0, SDIO_CCCR_ABORT,
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700843 &t_func);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700844
845 sd_trace(("%s: Exit\n", __func__));
Roland Vossen67f72be2011-06-29 16:47:56 -0700846 return 0;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700847}
848
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700849/* Disable device interrupt */
Roland Vossen294f2432011-06-29 16:47:20 -0700850void brcmf_sdioh_dev_intr_off(struct sdioh_info *sd)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700851{
852 sd_trace(("%s: %d\n", __func__, sd->use_client_ints));
853 sd->intmask &= ~CLIENT_INTR;
854}
855
856/* Enable device interrupt */
Roland Vossen294f2432011-06-29 16:47:20 -0700857void brcmf_sdioh_dev_intr_on(struct sdioh_info *sd)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700858{
859 sd_trace(("%s: %d\n", __func__, sd->use_client_ints));
860 sd->intmask |= CLIENT_INTR;
861}
862
863/* Read client card reg */
864int
Roland Vossen294f2432011-06-29 16:47:20 -0700865brcmf_sdioh_card_regread(struct sdioh_info *sd, int func, u32 regaddr,
Greg Kroah-Hartman66cbd3a2010-10-08 11:05:47 -0700866 int regsize, u32 *data)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700867{
868
869 if ((func == 0) || (regsize == 1)) {
Greg Kroah-Hartman3fd79f72010-10-05 10:11:12 -0700870 u8 temp = 0;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700871
Roland Vossen54ca2962011-06-29 16:46:59 -0700872 brcmf_sdioh_request_byte(sd, SDIOH_READ, func, regaddr, &temp);
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700873 *data = temp;
874 *data &= 0xff;
875 sd_data(("%s: byte read data=0x%02x\n", __func__, *data));
876 } else {
Roland Vossen54ca2962011-06-29 16:46:59 -0700877 brcmf_sdioh_request_word(sd, 0, SDIOH_READ, func, regaddr, data,
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700878 regsize);
879 if (regsize == 2)
880 *data &= 0xffff;
881
882 sd_data(("%s: word read data=0x%08x\n", __func__, *data));
883 }
884
885 return SUCCESS;
886}
887
Roland Vossen54ca2962011-06-29 16:46:59 -0700888static void brcmf_sdioh_irqhandler(struct sdio_func *func)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700889{
Roland Vossen294f2432011-06-29 16:47:20 -0700890 struct sdioh_info *sd;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700891
Roland Vossen62dd6562011-07-05 22:05:57 +0200892 sd_trace(("brcmf: ***IRQHandler\n"));
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700893 sd = gInstance->sd;
894
895 ASSERT(sd != NULL);
896 sdio_release_host(gInstance->func[0]);
897
898 if (sd->use_client_ints) {
899 sd->intrcount++;
900 ASSERT(sd->intr_handler);
901 ASSERT(sd->intr_handler_arg);
902 (sd->intr_handler) (sd->intr_handler_arg);
903 } else {
Roland Vossen62dd6562011-07-05 22:05:57 +0200904 sd_err(("brcmf: ***IRQHandler\n"));
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700905
906 sd_err(("%s: Not ready for intr: enabled %d, handler %p\n",
907 __func__, sd->client_intr_enabled, sd->intr_handler));
908 }
909
910 sdio_claim_host(gInstance->func[0]);
911}
912
Roland Vossen62dd6562011-07-05 22:05:57 +0200913/* interrupt handler for F2 (dummy handler) */
Roland Vossen54ca2962011-06-29 16:46:59 -0700914static void brcmf_sdioh_irqhandler_f2(struct sdio_func *func)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700915{
Roland Vossen294f2432011-06-29 16:47:20 -0700916 struct sdioh_info *sd;
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700917
Roland Vossen62dd6562011-07-05 22:05:57 +0200918 sd_trace(("brcmf: ***IRQHandlerF2\n"));
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700919
920 sd = gInstance->sd;
921
922 ASSERT(sd != NULL);
923}
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700924
Roland Vossen294f2432011-06-29 16:47:20 -0700925int brcmf_sdioh_start(struct sdioh_info *si, int stage)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700926{
927 return 0;
928}
929
Roland Vossen294f2432011-06-29 16:47:20 -0700930int brcmf_sdioh_stop(struct sdioh_info *si)
Henry Ptasinskicf2b4482010-09-20 22:33:12 -0700931{
932 return 0;
933}