blob: 62c46218145599adff38b85a259b00de8466ee58 [file] [log] [blame]
Franky Lina83369b2011-11-04 22:23:28 +01001/*
2 * Copyright (c) 2011 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 interface chip backplane handle functions ***** */
17
18#include <linux/types.h>
19#include <linux/netdevice.h>
20#include <linux/mmc/card.h>
Franky Lin61213be2011-11-04 22:23:41 +010021#include <linux/ssb/ssb_regs.h>
22
Franky Lina83369b2011-11-04 22:23:28 +010023#include <chipcommon.h>
24#include <brcm_hw_ids.h>
25#include <brcmu_wifi.h>
26#include <brcmu_utils.h>
Franky Lin2d4a9af2011-11-04 22:23:31 +010027#include <soc.h>
Franky Lina83369b2011-11-04 22:23:28 +010028#include "dhd.h"
29#include "dhd_dbg.h"
30#include "sdio_host.h"
31#include "sdio_chip.h"
32
33/* chip core base & ramsize */
34/* bcm4329 */
35/* SDIO device core, ID 0x829 */
36#define BCM4329_CORE_BUS_BASE 0x18011000
37/* internal memory core, ID 0x80e */
38#define BCM4329_CORE_SOCRAM_BASE 0x18003000
39/* ARM Cortex M3 core, ID 0x82a */
40#define BCM4329_CORE_ARM_BASE 0x18002000
41#define BCM4329_RAMSIZE 0x48000
42
Franky Lina83369b2011-11-04 22:23:28 +010043#define SBCOREREV(sbidh) \
Franky Lin61213be2011-11-04 22:23:41 +010044 ((((sbidh) & SSB_IDHIGH_RCHI) >> SSB_IDHIGH_RCHI_SHIFT) | \
45 ((sbidh) & SSB_IDHIGH_RCLO))
Franky Lina83369b2011-11-04 22:23:28 +010046
Franky Line12afb62011-11-04 22:23:40 +010047#define SDIOD_DRVSTR_KEY(chip, pmu) (((chip) << 16) | (pmu))
48/* SDIO Pad drive strength to select value mappings */
49struct sdiod_drive_str {
50 u8 strength; /* Pad Drive Strength in mA */
51 u8 sel; /* Chip-specific select value */
52};
53/* SDIO Drive Strength to sel value table for PMU Rev 1 */
54static const struct sdiod_drive_str sdiod_drive_strength_tab1[] = {
55 {
56 4, 0x2}, {
57 2, 0x3}, {
58 1, 0x0}, {
59 0, 0x0}
60 };
61/* SDIO Drive Strength to sel value table for PMU Rev 2, 3 */
62static const struct sdiod_drive_str sdiod_drive_strength_tab2[] = {
63 {
64 12, 0x7}, {
65 10, 0x6}, {
66 8, 0x5}, {
67 6, 0x4}, {
68 4, 0x2}, {
69 2, 0x1}, {
70 0, 0x0}
71 };
72/* SDIO Drive Strength to sel value table for PMU Rev 8 (1.8V) */
73static const struct sdiod_drive_str sdiod_drive_strength_tab3[] = {
74 {
75 32, 0x7}, {
76 26, 0x6}, {
77 22, 0x5}, {
78 16, 0x4}, {
79 12, 0x3}, {
80 8, 0x2}, {
81 4, 0x1}, {
82 0, 0x0}
83 };
84
Franky Lin454d2a82011-11-04 22:23:37 +010085static u32
86brcmf_sdio_chip_corerev(struct brcmf_sdio_dev *sdiodev,
87 u32 corebase)
88{
89 u32 regdata;
90
91 regdata = brcmf_sdcard_reg_read(sdiodev,
92 CORE_SB(corebase, sbidhigh), 4);
93 return SBCOREREV(regdata);
94}
95
Franky Lind8f64a42011-11-04 22:23:36 +010096bool
97brcmf_sdio_chip_iscoreup(struct brcmf_sdio_dev *sdiodev,
98 u32 corebase)
99{
100 u32 regdata;
101
102 regdata = brcmf_sdcard_reg_read(sdiodev,
103 CORE_SB(corebase, sbtmstatelow), 4);
Franky Lin61213be2011-11-04 22:23:41 +0100104 regdata &= (SSB_TMSLOW_RESET | SSB_TMSLOW_REJECT |
105 SSB_IMSTATE_REJECT | SSB_TMSLOW_CLOCK);
106 return (SSB_TMSLOW_CLOCK == regdata);
Franky Lind8f64a42011-11-04 22:23:36 +0100107}
108
Franky Lin2d4a9af2011-11-04 22:23:31 +0100109void
110brcmf_sdio_chip_coredisable(struct brcmf_sdio_dev *sdiodev, u32 corebase)
111{
112 u32 regdata;
113
114 regdata = brcmf_sdcard_reg_read(sdiodev,
115 CORE_SB(corebase, sbtmstatelow), 4);
Franky Lin61213be2011-11-04 22:23:41 +0100116 if (regdata & SSB_TMSLOW_RESET)
Franky Lin2d4a9af2011-11-04 22:23:31 +0100117 return;
118
119 regdata = brcmf_sdcard_reg_read(sdiodev,
120 CORE_SB(corebase, sbtmstatelow), 4);
Franky Lin61213be2011-11-04 22:23:41 +0100121 if ((regdata & SSB_TMSLOW_CLOCK) != 0) {
Franky Lin2d4a9af2011-11-04 22:23:31 +0100122 /*
123 * set target reject and spin until busy is clear
124 * (preserve core-specific bits)
125 */
126 regdata = brcmf_sdcard_reg_read(sdiodev,
127 CORE_SB(corebase, sbtmstatelow), 4);
128 brcmf_sdcard_reg_write(sdiodev, CORE_SB(corebase, sbtmstatelow),
Franky Lin61213be2011-11-04 22:23:41 +0100129 4, regdata | SSB_TMSLOW_REJECT);
Franky Lin2d4a9af2011-11-04 22:23:31 +0100130
131 regdata = brcmf_sdcard_reg_read(sdiodev,
132 CORE_SB(corebase, sbtmstatelow), 4);
133 udelay(1);
134 SPINWAIT((brcmf_sdcard_reg_read(sdiodev,
135 CORE_SB(corebase, sbtmstatehigh), 4) &
Franky Lin61213be2011-11-04 22:23:41 +0100136 SSB_TMSHIGH_BUSY), 100000);
Franky Lin2d4a9af2011-11-04 22:23:31 +0100137
138 regdata = brcmf_sdcard_reg_read(sdiodev,
139 CORE_SB(corebase, sbtmstatehigh), 4);
Franky Lin61213be2011-11-04 22:23:41 +0100140 if (regdata & SSB_TMSHIGH_BUSY)
Franky Lin2d4a9af2011-11-04 22:23:31 +0100141 brcmf_dbg(ERROR, "core state still busy\n");
142
143 regdata = brcmf_sdcard_reg_read(sdiodev,
144 CORE_SB(corebase, sbidlow), 4);
Franky Lin61213be2011-11-04 22:23:41 +0100145 if (regdata & SSB_IDLOW_INITIATOR) {
Franky Lin2d4a9af2011-11-04 22:23:31 +0100146 regdata = brcmf_sdcard_reg_read(sdiodev,
147 CORE_SB(corebase, sbimstate), 4) |
Franky Lin61213be2011-11-04 22:23:41 +0100148 SSB_IMSTATE_REJECT;
Franky Lin2d4a9af2011-11-04 22:23:31 +0100149 brcmf_sdcard_reg_write(sdiodev,
150 CORE_SB(corebase, sbimstate), 4,
151 regdata);
152 regdata = brcmf_sdcard_reg_read(sdiodev,
153 CORE_SB(corebase, sbimstate), 4);
154 udelay(1);
155 SPINWAIT((brcmf_sdcard_reg_read(sdiodev,
156 CORE_SB(corebase, sbimstate), 4) &
Franky Lin61213be2011-11-04 22:23:41 +0100157 SSB_IMSTATE_BUSY), 100000);
Franky Lin2d4a9af2011-11-04 22:23:31 +0100158 }
159
160 /* set reset and reject while enabling the clocks */
161 brcmf_sdcard_reg_write(sdiodev,
162 CORE_SB(corebase, sbtmstatelow), 4,
Franky Lin61213be2011-11-04 22:23:41 +0100163 (SSB_TMSLOW_FGC | SSB_TMSLOW_CLOCK |
164 SSB_TMSLOW_REJECT | SSB_TMSLOW_RESET));
Franky Lin2d4a9af2011-11-04 22:23:31 +0100165 regdata = brcmf_sdcard_reg_read(sdiodev,
166 CORE_SB(corebase, sbtmstatelow), 4);
167 udelay(10);
168
169 /* clear the initiator reject bit */
170 regdata = brcmf_sdcard_reg_read(sdiodev,
171 CORE_SB(corebase, sbidlow), 4);
Franky Lin61213be2011-11-04 22:23:41 +0100172 if (regdata & SSB_IDLOW_INITIATOR) {
Franky Lin2d4a9af2011-11-04 22:23:31 +0100173 regdata = brcmf_sdcard_reg_read(sdiodev,
174 CORE_SB(corebase, sbimstate), 4) &
Franky Lin61213be2011-11-04 22:23:41 +0100175 ~SSB_IMSTATE_REJECT;
Franky Lin2d4a9af2011-11-04 22:23:31 +0100176 brcmf_sdcard_reg_write(sdiodev,
177 CORE_SB(corebase, sbimstate), 4,
178 regdata);
179 }
180 }
181
182 /* leave reset and reject asserted */
183 brcmf_sdcard_reg_write(sdiodev, CORE_SB(corebase, sbtmstatelow), 4,
Franky Lin61213be2011-11-04 22:23:41 +0100184 (SSB_TMSLOW_REJECT | SSB_TMSLOW_RESET));
Franky Lin2d4a9af2011-11-04 22:23:31 +0100185 udelay(1);
186}
187
Franky Lin2bc78e12011-11-04 22:23:38 +0100188void
189brcmf_sdio_chip_resetcore(struct brcmf_sdio_dev *sdiodev, u32 corebase)
190{
191 u32 regdata;
192
193 /*
194 * Must do the disable sequence first to work for
195 * arbitrary current core state.
196 */
197 brcmf_sdio_chip_coredisable(sdiodev, corebase);
198
199 /*
200 * Now do the initialization sequence.
201 * set reset while enabling the clock and
202 * forcing them on throughout the core
203 */
204 brcmf_sdcard_reg_write(sdiodev, CORE_SB(corebase, sbtmstatelow), 4,
Franky Lin61213be2011-11-04 22:23:41 +0100205 SSB_TMSLOW_FGC | SSB_TMSLOW_CLOCK | SSB_TMSLOW_RESET);
Franky Lin2bc78e12011-11-04 22:23:38 +0100206 udelay(1);
207
208 regdata = brcmf_sdcard_reg_read(sdiodev,
209 CORE_SB(corebase, sbtmstatehigh), 4);
Franky Lin61213be2011-11-04 22:23:41 +0100210 if (regdata & SSB_TMSHIGH_SERR)
Franky Lin2bc78e12011-11-04 22:23:38 +0100211 brcmf_sdcard_reg_write(sdiodev,
212 CORE_SB(corebase, sbtmstatehigh), 4, 0);
213
214 regdata = brcmf_sdcard_reg_read(sdiodev,
215 CORE_SB(corebase, sbimstate), 4);
Franky Lin61213be2011-11-04 22:23:41 +0100216 if (regdata & (SSB_IMSTATE_IBE | SSB_IMSTATE_TO))
Franky Lin2bc78e12011-11-04 22:23:38 +0100217 brcmf_sdcard_reg_write(sdiodev, CORE_SB(corebase, sbimstate), 4,
Franky Lin61213be2011-11-04 22:23:41 +0100218 regdata & ~(SSB_IMSTATE_IBE | SSB_IMSTATE_TO));
Franky Lin2bc78e12011-11-04 22:23:38 +0100219
220 /* clear reset and allow it to propagate throughout the core */
221 brcmf_sdcard_reg_write(sdiodev, CORE_SB(corebase, sbtmstatelow), 4,
Franky Lin61213be2011-11-04 22:23:41 +0100222 SSB_TMSLOW_FGC | SSB_TMSLOW_CLOCK);
Franky Lin2bc78e12011-11-04 22:23:38 +0100223 udelay(1);
224
225 /* leave clock enabled */
Franky Lin61213be2011-11-04 22:23:41 +0100226 brcmf_sdcard_reg_write(sdiodev, CORE_SB(corebase, sbtmstatelow),
227 4, SSB_TMSLOW_CLOCK);
Franky Lin2bc78e12011-11-04 22:23:38 +0100228 udelay(1);
229}
230
Franky Lina83369b2011-11-04 22:23:28 +0100231static int brcmf_sdio_chip_recognition(struct brcmf_sdio_dev *sdiodev,
232 struct chip_info *ci, u32 regs)
233{
234 u32 regdata;
235
236 /*
237 * Get CC core rev
238 * Chipid is assume to be at offset 0 from regs arg
239 * For different chiptypes or old sdio hosts w/o chipcommon,
240 * other ways of recognition should be added here.
241 */
242 ci->cccorebase = regs;
243 regdata = brcmf_sdcard_reg_read(sdiodev,
244 CORE_CC_REG(ci->cccorebase, chipid), 4);
245 ci->chip = regdata & CID_ID_MASK;
246 ci->chiprev = (regdata & CID_REV_MASK) >> CID_REV_SHIFT;
247
248 brcmf_dbg(INFO, "chipid=0x%x chiprev=%d\n", ci->chip, ci->chiprev);
249
250 /* Address of cores for new chips should be added here */
251 switch (ci->chip) {
252 case BCM4329_CHIP_ID:
253 ci->buscorebase = BCM4329_CORE_BUS_BASE;
254 ci->ramcorebase = BCM4329_CORE_SOCRAM_BASE;
255 ci->armcorebase = BCM4329_CORE_ARM_BASE;
256 ci->ramsize = BCM4329_RAMSIZE;
257 break;
258 default:
259 brcmf_dbg(ERROR, "chipid 0x%x is not supported\n", ci->chip);
260 return -ENODEV;
261 }
262
Franky Lina83369b2011-11-04 22:23:28 +0100263 return 0;
264}
265
Franky Line63ac6b2011-11-04 22:23:29 +0100266static int
267brcmf_sdio_chip_buscoreprep(struct brcmf_sdio_dev *sdiodev)
268{
269 int err = 0;
270 u8 clkval, clkset;
271
272 /* Try forcing SDIO core to do ALPAvail request only */
273 clkset = SBSDIO_FORCE_HW_CLKREQ_OFF | SBSDIO_ALP_AVAIL_REQ;
274 brcmf_sdcard_cfg_write(sdiodev, SDIO_FUNC_1,
275 SBSDIO_FUNC1_CHIPCLKCSR, clkset, &err);
276 if (err) {
277 brcmf_dbg(ERROR, "error writing for HT off\n");
278 return err;
279 }
280
281 /* If register supported, wait for ALPAvail and then force ALP */
282 /* This may take up to 15 milliseconds */
283 clkval = brcmf_sdcard_cfg_read(sdiodev, SDIO_FUNC_1,
284 SBSDIO_FUNC1_CHIPCLKCSR, NULL);
285
286 if ((clkval & ~SBSDIO_AVBITS) != clkset) {
287 brcmf_dbg(ERROR, "ChipClkCSR access: wrote 0x%02x read 0x%02x\n",
288 clkset, clkval);
289 return -EACCES;
290 }
291
292 SPINWAIT(((clkval = brcmf_sdcard_cfg_read(sdiodev, SDIO_FUNC_1,
293 SBSDIO_FUNC1_CHIPCLKCSR, NULL)),
294 !SBSDIO_ALPAV(clkval)),
295 PMU_MAX_TRANSITION_DLY);
296 if (!SBSDIO_ALPAV(clkval)) {
297 brcmf_dbg(ERROR, "timeout on ALPAV wait, clkval 0x%02x\n",
298 clkval);
299 return -EBUSY;
300 }
301
302 clkset = SBSDIO_FORCE_HW_CLKREQ_OFF | SBSDIO_FORCE_ALP;
303 brcmf_sdcard_cfg_write(sdiodev, SDIO_FUNC_1,
304 SBSDIO_FUNC1_CHIPCLKCSR, clkset, &err);
305 udelay(65);
306
307 /* Also, disable the extra SDIO pull-ups */
308 brcmf_sdcard_cfg_write(sdiodev, SDIO_FUNC_1,
309 SBSDIO_FUNC1_SDIOPULLUP, 0, NULL);
310
311 return 0;
312}
313
Franky Lin5b45e542011-11-04 22:23:30 +0100314static void
315brcmf_sdio_chip_buscoresetup(struct brcmf_sdio_dev *sdiodev,
316 struct chip_info *ci)
317{
318 u32 regdata;
319
320 /* get chipcommon rev */
Franky Lin454d2a82011-11-04 22:23:37 +0100321 ci->ccrev = brcmf_sdio_chip_corerev(sdiodev, ci->cccorebase);
Franky Lin5b45e542011-11-04 22:23:30 +0100322
323 /* get chipcommon capabilites */
324 ci->cccaps = brcmf_sdcard_reg_read(sdiodev,
325 CORE_CC_REG(ci->cccorebase, capabilities), 4);
326
327 /* get pmu caps & rev */
328 if (ci->cccaps & CC_CAP_PMU) {
329 ci->pmucaps = brcmf_sdcard_reg_read(sdiodev,
330 CORE_CC_REG(ci->cccorebase, pmucapabilities), 4);
331 ci->pmurev = ci->pmucaps & PCAP_REV_MASK;
332 }
333
Franky Lin454d2a82011-11-04 22:23:37 +0100334
335 ci->buscorerev = brcmf_sdio_chip_corerev(sdiodev, ci->buscorebase);
Franky Lin5b45e542011-11-04 22:23:30 +0100336 regdata = brcmf_sdcard_reg_read(sdiodev,
337 CORE_SB(ci->buscorebase, sbidhigh), 4);
Franky Lin61213be2011-11-04 22:23:41 +0100338 ci->buscoretype = (regdata & SSB_IDHIGH_CC) >> SSB_IDHIGH_CC_SHIFT;
Franky Lin5b45e542011-11-04 22:23:30 +0100339
340 brcmf_dbg(INFO, "ccrev=%d, pmurev=%d, buscore rev/type=%d/0x%x\n",
341 ci->ccrev, ci->pmurev, ci->buscorerev, ci->buscoretype);
Franky Lin966414d2011-11-04 22:23:32 +0100342
343 /*
344 * Make sure any on-chip ARM is off (in case strapping is wrong),
345 * or downloaded code was already running.
346 */
347 brcmf_sdio_chip_coredisable(sdiodev, ci->armcorebase);
Franky Lin5b45e542011-11-04 22:23:30 +0100348}
349
Franky Lina83369b2011-11-04 22:23:28 +0100350int brcmf_sdio_chip_attach(struct brcmf_sdio_dev *sdiodev,
Franky Lina97e4fc2011-11-04 22:23:35 +0100351 struct chip_info **ci_ptr, u32 regs)
Franky Lina83369b2011-11-04 22:23:28 +0100352{
Franky Lina97e4fc2011-11-04 22:23:35 +0100353 int ret;
354 struct chip_info *ci;
355
356 brcmf_dbg(TRACE, "Enter\n");
357
358 /* alloc chip_info_t */
359 ci = kzalloc(sizeof(struct chip_info), GFP_ATOMIC);
360 if (!ci)
361 return -ENOMEM;
Franky Lina83369b2011-11-04 22:23:28 +0100362
Franky Line63ac6b2011-11-04 22:23:29 +0100363 ret = brcmf_sdio_chip_buscoreprep(sdiodev);
364 if (ret != 0)
Franky Lina97e4fc2011-11-04 22:23:35 +0100365 goto err;
Franky Line63ac6b2011-11-04 22:23:29 +0100366
Franky Lina83369b2011-11-04 22:23:28 +0100367 ret = brcmf_sdio_chip_recognition(sdiodev, ci, regs);
368 if (ret != 0)
Franky Lina97e4fc2011-11-04 22:23:35 +0100369 goto err;
Franky Lina83369b2011-11-04 22:23:28 +0100370
Franky Lin5b45e542011-11-04 22:23:30 +0100371 brcmf_sdio_chip_buscoresetup(sdiodev, ci);
372
Franky Lin960908d2011-11-04 22:23:33 +0100373 brcmf_sdcard_reg_write(sdiodev,
374 CORE_CC_REG(ci->cccorebase, gpiopullup), 4, 0);
375 brcmf_sdcard_reg_write(sdiodev,
376 CORE_CC_REG(ci->cccorebase, gpiopulldown), 4, 0);
377
Franky Lina97e4fc2011-11-04 22:23:35 +0100378 *ci_ptr = ci;
379 return 0;
380
381err:
382 kfree(ci);
Franky Lina83369b2011-11-04 22:23:28 +0100383 return ret;
384}
Franky Lina8a6c042011-11-04 22:23:39 +0100385
386void
387brcmf_sdio_chip_detach(struct chip_info **ci_ptr)
388{
389 brcmf_dbg(TRACE, "Enter\n");
390
391 kfree(*ci_ptr);
392 *ci_ptr = NULL;
393}
Franky Line12afb62011-11-04 22:23:40 +0100394
395static char *brcmf_sdio_chip_name(uint chipid, char *buf, uint len)
396{
397 const char *fmt;
398
399 fmt = ((chipid > 0xa000) || (chipid < 0x4000)) ? "%d" : "%x";
400 snprintf(buf, len, fmt, chipid);
401 return buf;
402}
403
404void
405brcmf_sdio_chip_drivestrengthinit(struct brcmf_sdio_dev *sdiodev,
406 struct chip_info *ci, u32 drivestrength)
407{
408 struct sdiod_drive_str *str_tab = NULL;
409 u32 str_mask = 0;
410 u32 str_shift = 0;
411 char chn[8];
412
413 if (!(ci->cccaps & CC_CAP_PMU))
414 return;
415
416 switch (SDIOD_DRVSTR_KEY(ci->chip, ci->pmurev)) {
417 case SDIOD_DRVSTR_KEY(BCM4325_CHIP_ID, 1):
418 str_tab = (struct sdiod_drive_str *)&sdiod_drive_strength_tab1;
419 str_mask = 0x30000000;
420 str_shift = 28;
421 break;
422 case SDIOD_DRVSTR_KEY(BCM4325_CHIP_ID, 2):
423 case SDIOD_DRVSTR_KEY(BCM4325_CHIP_ID, 3):
424 str_tab = (struct sdiod_drive_str *)&sdiod_drive_strength_tab2;
425 str_mask = 0x00003800;
426 str_shift = 11;
427 break;
428 case SDIOD_DRVSTR_KEY(BCM4336_CHIP_ID, 8):
429 str_tab = (struct sdiod_drive_str *)&sdiod_drive_strength_tab3;
430 str_mask = 0x00003800;
431 str_shift = 11;
432 break;
433 default:
434 brcmf_dbg(ERROR, "No SDIO Drive strength init done for chip %s rev %d pmurev %d\n",
435 brcmf_sdio_chip_name(ci->chip, chn, 8),
436 ci->chiprev, ci->pmurev);
437 break;
438 }
439
440 if (str_tab != NULL) {
441 u32 drivestrength_sel = 0;
442 u32 cc_data_temp;
443 int i;
444
445 for (i = 0; str_tab[i].strength != 0; i++) {
446 if (drivestrength >= str_tab[i].strength) {
447 drivestrength_sel = str_tab[i].sel;
448 break;
449 }
450 }
451
452 brcmf_sdcard_reg_write(sdiodev,
453 CORE_CC_REG(ci->cccorebase, chipcontrol_addr),
454 4, 1);
455 cc_data_temp = brcmf_sdcard_reg_read(sdiodev,
456 CORE_CC_REG(ci->cccorebase, chipcontrol_addr), 4);
457 cc_data_temp &= ~str_mask;
458 drivestrength_sel <<= str_shift;
459 cc_data_temp |= drivestrength_sel;
460 brcmf_sdcard_reg_write(sdiodev,
461 CORE_CC_REG(ci->cccorebase, chipcontrol_addr),
462 4, cc_data_temp);
463
464 brcmf_dbg(INFO, "SDIO: %dmA drive strength selected, set to 0x%08x\n",
465 drivestrength, cc_data_temp);
466 }
467}