diff options
author | Jonathan Herman <hermanjl@cs.unc.edu> | 2013-01-22 10:38:37 -0500 |
---|---|---|
committer | Jonathan Herman <hermanjl@cs.unc.edu> | 2013-01-22 10:38:37 -0500 |
commit | fcc9d2e5a6c89d22b8b773a64fb4ad21ac318446 (patch) | |
tree | a57612d1888735a2ec7972891b68c1ac5ec8faea /drivers/net/wireless/bcmdhd/aiutils.c | |
parent | 8dea78da5cee153b8af9c07a2745f6c55057fe12 (diff) |
Diffstat (limited to 'drivers/net/wireless/bcmdhd/aiutils.c')
-rw-r--r-- | drivers/net/wireless/bcmdhd/aiutils.c | 675 |
1 files changed, 675 insertions, 0 deletions
diff --git a/drivers/net/wireless/bcmdhd/aiutils.c b/drivers/net/wireless/bcmdhd/aiutils.c new file mode 100644 index 00000000000..059df890792 --- /dev/null +++ b/drivers/net/wireless/bcmdhd/aiutils.c | |||
@@ -0,0 +1,675 @@ | |||
1 | /* | ||
2 | * Misc utility routines for accessing chip-specific features | ||
3 | * of the SiliconBackplane-based Broadcom chips. | ||
4 | * | ||
5 | * Copyright (C) 1999-2011, Broadcom Corporation | ||
6 | * | ||
7 | * Unless you and Broadcom execute a separate written software license | ||
8 | * agreement governing use of this software, this software is licensed to you | ||
9 | * under the terms of the GNU General Public License version 2 (the "GPL"), | ||
10 | * available at http://www.broadcom.com/licenses/GPLv2.php, with the | ||
11 | * following added to such license: | ||
12 | * | ||
13 | * As a special exception, the copyright holders of this software give you | ||
14 | * permission to link this software with independent modules, and to copy and | ||
15 | * distribute the resulting executable under terms of your choice, provided that | ||
16 | * you also meet, for each linked independent module, the terms and conditions of | ||
17 | * the license of that module. An independent module is a module which is not | ||
18 | * derived from this software. The special exception does not apply to any | ||
19 | * modifications of the software. | ||
20 | * | ||
21 | * Notwithstanding the above, under no circumstances may you combine this | ||
22 | * software in any way with any other Broadcom software provided under a license | ||
23 | * other than the GPL, without Broadcom's express prior written consent. | ||
24 | * | ||
25 | * $Id: aiutils.c,v 1.26.2.1 2010-03-09 18:41:21 Exp $ | ||
26 | */ | ||
27 | |||
28 | |||
29 | #include <typedefs.h> | ||
30 | #include <bcmdefs.h> | ||
31 | #include <osl.h> | ||
32 | #include <bcmutils.h> | ||
33 | #include <siutils.h> | ||
34 | #include <hndsoc.h> | ||
35 | #include <sbchipc.h> | ||
36 | #include <pcicfg.h> | ||
37 | |||
38 | #include "siutils_priv.h" | ||
39 | |||
40 | |||
41 | |||
42 | |||
43 | |||
44 | static uint32 | ||
45 | get_erom_ent(si_t *sih, uint32 **eromptr, uint32 mask, uint32 match) | ||
46 | { | ||
47 | uint32 ent; | ||
48 | uint inv = 0, nom = 0; | ||
49 | |||
50 | while (TRUE) { | ||
51 | ent = R_REG(si_osh(sih), *eromptr); | ||
52 | (*eromptr)++; | ||
53 | |||
54 | if (mask == 0) | ||
55 | break; | ||
56 | |||
57 | if ((ent & ER_VALID) == 0) { | ||
58 | inv++; | ||
59 | continue; | ||
60 | } | ||
61 | |||
62 | if (ent == (ER_END | ER_VALID)) | ||
63 | break; | ||
64 | |||
65 | if ((ent & mask) == match) | ||
66 | break; | ||
67 | |||
68 | nom++; | ||
69 | } | ||
70 | |||
71 | SI_VMSG(("%s: Returning ent 0x%08x\n", __FUNCTION__, ent)); | ||
72 | if (inv + nom) { | ||
73 | SI_VMSG((" after %d invalid and %d non-matching entries\n", inv, nom)); | ||
74 | } | ||
75 | return ent; | ||
76 | } | ||
77 | |||
78 | static uint32 | ||
79 | get_asd(si_t *sih, uint32 **eromptr, uint sp, uint ad, uint st, uint32 *addrl, uint32 *addrh, | ||
80 | uint32 *sizel, uint32 *sizeh) | ||
81 | { | ||
82 | uint32 asd, sz, szd; | ||
83 | |||
84 | asd = get_erom_ent(sih, eromptr, ER_VALID, ER_VALID); | ||
85 | if (((asd & ER_TAG1) != ER_ADD) || | ||
86 | (((asd & AD_SP_MASK) >> AD_SP_SHIFT) != sp) || | ||
87 | ((asd & AD_ST_MASK) != st)) { | ||
88 | |||
89 | (*eromptr)--; | ||
90 | return 0; | ||
91 | } | ||
92 | *addrl = asd & AD_ADDR_MASK; | ||
93 | if (asd & AD_AG32) | ||
94 | *addrh = get_erom_ent(sih, eromptr, 0, 0); | ||
95 | else | ||
96 | *addrh = 0; | ||
97 | *sizeh = 0; | ||
98 | sz = asd & AD_SZ_MASK; | ||
99 | if (sz == AD_SZ_SZD) { | ||
100 | szd = get_erom_ent(sih, eromptr, 0, 0); | ||
101 | *sizel = szd & SD_SZ_MASK; | ||
102 | if (szd & SD_SG32) | ||
103 | *sizeh = get_erom_ent(sih, eromptr, 0, 0); | ||
104 | } else | ||
105 | *sizel = AD_SZ_BASE << (sz >> AD_SZ_SHIFT); | ||
106 | |||
107 | SI_VMSG((" SP %d, ad %d: st = %d, 0x%08x_0x%08x @ 0x%08x_0x%08x\n", | ||
108 | sp, ad, st, *sizeh, *sizel, *addrh, *addrl)); | ||
109 | |||
110 | return asd; | ||
111 | } | ||
112 | |||
113 | static void | ||
114 | ai_hwfixup(si_info_t *sii) | ||
115 | { | ||
116 | } | ||
117 | |||
118 | |||
119 | void | ||
120 | ai_scan(si_t *sih, void *regs, uint devid) | ||
121 | { | ||
122 | si_info_t *sii = SI_INFO(sih); | ||
123 | chipcregs_t *cc = (chipcregs_t *)regs; | ||
124 | uint32 erombase, *eromptr, *eromlim; | ||
125 | |||
126 | erombase = R_REG(sii->osh, &cc->eromptr); | ||
127 | |||
128 | switch (BUSTYPE(sih->bustype)) { | ||
129 | case SI_BUS: | ||
130 | eromptr = (uint32 *)REG_MAP(erombase, SI_CORE_SIZE); | ||
131 | break; | ||
132 | |||
133 | case PCI_BUS: | ||
134 | |||
135 | sii->curwrap = (void *)((uintptr)regs + SI_CORE_SIZE); | ||
136 | |||
137 | |||
138 | OSL_PCI_WRITE_CONFIG(sii->osh, PCI_BAR0_WIN, 4, erombase); | ||
139 | eromptr = regs; | ||
140 | break; | ||
141 | |||
142 | case SPI_BUS: | ||
143 | case SDIO_BUS: | ||
144 | eromptr = (uint32 *)(uintptr)erombase; | ||
145 | break; | ||
146 | |||
147 | case PCMCIA_BUS: | ||
148 | default: | ||
149 | SI_ERROR(("Don't know how to do AXI enumertion on bus %d\n", sih->bustype)); | ||
150 | ASSERT(0); | ||
151 | return; | ||
152 | } | ||
153 | eromlim = eromptr + (ER_REMAPCONTROL / sizeof(uint32)); | ||
154 | |||
155 | SI_VMSG(("ai_scan: regs = 0x%p, erombase = 0x%08x, eromptr = 0x%p, eromlim = 0x%p\n", | ||
156 | regs, erombase, eromptr, eromlim)); | ||
157 | while (eromptr < eromlim) { | ||
158 | uint32 cia, cib, cid, mfg, crev, nmw, nsw, nmp, nsp; | ||
159 | uint32 mpd, asd, addrl, addrh, sizel, sizeh; | ||
160 | uint32 *base; | ||
161 | uint i, j, idx; | ||
162 | bool br; | ||
163 | |||
164 | br = FALSE; | ||
165 | |||
166 | |||
167 | cia = get_erom_ent(sih, &eromptr, ER_TAG, ER_CI); | ||
168 | if (cia == (ER_END | ER_VALID)) { | ||
169 | SI_VMSG(("Found END of erom after %d cores\n", sii->numcores)); | ||
170 | ai_hwfixup(sii); | ||
171 | return; | ||
172 | } | ||
173 | base = eromptr - 1; | ||
174 | cib = get_erom_ent(sih, &eromptr, 0, 0); | ||
175 | |||
176 | if ((cib & ER_TAG) != ER_CI) { | ||
177 | SI_ERROR(("CIA not followed by CIB\n")); | ||
178 | goto error; | ||
179 | } | ||
180 | |||
181 | cid = (cia & CIA_CID_MASK) >> CIA_CID_SHIFT; | ||
182 | mfg = (cia & CIA_MFG_MASK) >> CIA_MFG_SHIFT; | ||
183 | crev = (cib & CIB_REV_MASK) >> CIB_REV_SHIFT; | ||
184 | nmw = (cib & CIB_NMW_MASK) >> CIB_NMW_SHIFT; | ||
185 | nsw = (cib & CIB_NSW_MASK) >> CIB_NSW_SHIFT; | ||
186 | nmp = (cib & CIB_NMP_MASK) >> CIB_NMP_SHIFT; | ||
187 | nsp = (cib & CIB_NSP_MASK) >> CIB_NSP_SHIFT; | ||
188 | |||
189 | SI_VMSG(("Found component 0x%04x/0x%04x rev %d at erom addr 0x%p, with nmw = %d, " | ||
190 | "nsw = %d, nmp = %d & nsp = %d\n", | ||
191 | mfg, cid, crev, base, nmw, nsw, nmp, nsp)); | ||
192 | |||
193 | if (((mfg == MFGID_ARM) && (cid == DEF_AI_COMP)) || (nsp == 0)) | ||
194 | continue; | ||
195 | if ((nmw + nsw == 0)) { | ||
196 | |||
197 | if (cid == OOB_ROUTER_CORE_ID) { | ||
198 | asd = get_asd(sih, &eromptr, 0, 0, AD_ST_SLAVE, | ||
199 | &addrl, &addrh, &sizel, &sizeh); | ||
200 | if (asd != 0) { | ||
201 | sii->oob_router = addrl; | ||
202 | } | ||
203 | } | ||
204 | continue; | ||
205 | } | ||
206 | |||
207 | idx = sii->numcores; | ||
208 | |||
209 | sii->cia[idx] = cia; | ||
210 | sii->cib[idx] = cib; | ||
211 | sii->coreid[idx] = cid; | ||
212 | |||
213 | for (i = 0; i < nmp; i++) { | ||
214 | mpd = get_erom_ent(sih, &eromptr, ER_VALID, ER_VALID); | ||
215 | if ((mpd & ER_TAG) != ER_MP) { | ||
216 | SI_ERROR(("Not enough MP entries for component 0x%x\n", cid)); | ||
217 | goto error; | ||
218 | } | ||
219 | SI_VMSG((" Master port %d, mp: %d id: %d\n", i, | ||
220 | (mpd & MPD_MP_MASK) >> MPD_MP_SHIFT, | ||
221 | (mpd & MPD_MUI_MASK) >> MPD_MUI_SHIFT)); | ||
222 | } | ||
223 | |||
224 | |||
225 | asd = get_asd(sih, &eromptr, 0, 0, AD_ST_SLAVE, &addrl, &addrh, &sizel, &sizeh); | ||
226 | if (asd == 0) { | ||
227 | |||
228 | asd = get_asd(sih, &eromptr, 0, 0, AD_ST_BRIDGE, &addrl, &addrh, | ||
229 | &sizel, &sizeh); | ||
230 | if (asd != 0) | ||
231 | br = TRUE; | ||
232 | else | ||
233 | if ((addrh != 0) || (sizeh != 0) || (sizel != SI_CORE_SIZE)) { | ||
234 | SI_ERROR(("First Slave ASD for core 0x%04x malformed " | ||
235 | "(0x%08x)\n", cid, asd)); | ||
236 | goto error; | ||
237 | } | ||
238 | } | ||
239 | sii->coresba[idx] = addrl; | ||
240 | sii->coresba_size[idx] = sizel; | ||
241 | |||
242 | j = 1; | ||
243 | do { | ||
244 | asd = get_asd(sih, &eromptr, 0, j, AD_ST_SLAVE, &addrl, &addrh, | ||
245 | &sizel, &sizeh); | ||
246 | if ((asd != 0) && (j == 1) && (sizel == SI_CORE_SIZE)) { | ||
247 | sii->coresba2[idx] = addrl; | ||
248 | sii->coresba2_size[idx] = sizel; | ||
249 | } | ||
250 | j++; | ||
251 | } while (asd != 0); | ||
252 | |||
253 | |||
254 | for (i = 1; i < nsp; i++) { | ||
255 | j = 0; | ||
256 | do { | ||
257 | asd = get_asd(sih, &eromptr, i, j++, AD_ST_SLAVE, &addrl, &addrh, | ||
258 | &sizel, &sizeh); | ||
259 | } while (asd != 0); | ||
260 | if (j == 0) { | ||
261 | SI_ERROR((" SP %d has no address descriptors\n", i)); | ||
262 | goto error; | ||
263 | } | ||
264 | } | ||
265 | |||
266 | |||
267 | for (i = 0; i < nmw; i++) { | ||
268 | asd = get_asd(sih, &eromptr, i, 0, AD_ST_MWRAP, &addrl, &addrh, | ||
269 | &sizel, &sizeh); | ||
270 | if (asd == 0) { | ||
271 | SI_ERROR(("Missing descriptor for MW %d\n", i)); | ||
272 | goto error; | ||
273 | } | ||
274 | if ((sizeh != 0) || (sizel != SI_CORE_SIZE)) { | ||
275 | SI_ERROR(("Master wrapper %d is not 4KB\n", i)); | ||
276 | goto error; | ||
277 | } | ||
278 | if (i == 0) | ||
279 | sii->wrapba[idx] = addrl; | ||
280 | } | ||
281 | |||
282 | |||
283 | for (i = 0; i < nsw; i++) { | ||
284 | uint fwp = (nsp == 1) ? 0 : 1; | ||
285 | asd = get_asd(sih, &eromptr, fwp + i, 0, AD_ST_SWRAP, &addrl, &addrh, | ||
286 | &sizel, &sizeh); | ||
287 | if (asd == 0) { | ||
288 | SI_ERROR(("Missing descriptor for SW %d\n", i)); | ||
289 | goto error; | ||
290 | } | ||
291 | if ((sizeh != 0) || (sizel != SI_CORE_SIZE)) { | ||
292 | SI_ERROR(("Slave wrapper %d is not 4KB\n", i)); | ||
293 | goto error; | ||
294 | } | ||
295 | if ((nmw == 0) && (i == 0)) | ||
296 | sii->wrapba[idx] = addrl; | ||
297 | } | ||
298 | |||
299 | |||
300 | if (br) | ||
301 | continue; | ||
302 | |||
303 | |||
304 | sii->numcores++; | ||
305 | } | ||
306 | |||
307 | SI_ERROR(("Reached end of erom without finding END")); | ||
308 | |||
309 | error: | ||
310 | sii->numcores = 0; | ||
311 | return; | ||
312 | } | ||
313 | |||
314 | |||
315 | void * | ||
316 | ai_setcoreidx(si_t *sih, uint coreidx) | ||
317 | { | ||
318 | si_info_t *sii = SI_INFO(sih); | ||
319 | uint32 addr = sii->coresba[coreidx]; | ||
320 | uint32 wrap = sii->wrapba[coreidx]; | ||
321 | void *regs; | ||
322 | |||
323 | if (coreidx >= sii->numcores) | ||
324 | return (NULL); | ||
325 | |||
326 | |||
327 | ASSERT((sii->intrsenabled_fn == NULL) || !(*(sii)->intrsenabled_fn)((sii)->intr_arg)); | ||
328 | |||
329 | switch (BUSTYPE(sih->bustype)) { | ||
330 | case SI_BUS: | ||
331 | |||
332 | if (!sii->regs[coreidx]) { | ||
333 | sii->regs[coreidx] = REG_MAP(addr, SI_CORE_SIZE); | ||
334 | ASSERT(GOODREGS(sii->regs[coreidx])); | ||
335 | } | ||
336 | sii->curmap = regs = sii->regs[coreidx]; | ||
337 | if (!sii->wrappers[coreidx]) { | ||
338 | sii->wrappers[coreidx] = REG_MAP(wrap, SI_CORE_SIZE); | ||
339 | ASSERT(GOODREGS(sii->wrappers[coreidx])); | ||
340 | } | ||
341 | sii->curwrap = sii->wrappers[coreidx]; | ||
342 | break; | ||
343 | |||
344 | |||
345 | case SPI_BUS: | ||
346 | case SDIO_BUS: | ||
347 | sii->curmap = regs = (void *)((uintptr)addr); | ||
348 | sii->curwrap = (void *)((uintptr)wrap); | ||
349 | break; | ||
350 | |||
351 | case PCMCIA_BUS: | ||
352 | default: | ||
353 | ASSERT(0); | ||
354 | regs = NULL; | ||
355 | break; | ||
356 | } | ||
357 | |||
358 | sii->curmap = regs; | ||
359 | sii->curidx = coreidx; | ||
360 | |||
361 | return regs; | ||
362 | } | ||
363 | |||
364 | |||
365 | int | ||
366 | ai_numaddrspaces(si_t *sih) | ||
367 | { | ||
368 | return 2; | ||
369 | } | ||
370 | |||
371 | |||
372 | uint32 | ||
373 | ai_addrspace(si_t *sih, uint asidx) | ||
374 | { | ||
375 | si_info_t *sii; | ||
376 | uint cidx; | ||
377 | |||
378 | sii = SI_INFO(sih); | ||
379 | cidx = sii->curidx; | ||
380 | |||
381 | if (asidx == 0) | ||
382 | return sii->coresba[cidx]; | ||
383 | else if (asidx == 1) | ||
384 | return sii->coresba2[cidx]; | ||
385 | else { | ||
386 | SI_ERROR(("%s: Need to parse the erom again to find addr space %d\n", | ||
387 | __FUNCTION__, asidx)); | ||
388 | return 0; | ||
389 | } | ||
390 | } | ||
391 | |||
392 | |||
393 | uint32 | ||
394 | ai_addrspacesize(si_t *sih, uint asidx) | ||
395 | { | ||
396 | si_info_t *sii; | ||
397 | uint cidx; | ||
398 | |||
399 | sii = SI_INFO(sih); | ||
400 | cidx = sii->curidx; | ||
401 | |||
402 | if (asidx == 0) | ||
403 | return sii->coresba_size[cidx]; | ||
404 | else if (asidx == 1) | ||
405 | return sii->coresba2_size[cidx]; | ||
406 | else { | ||
407 | SI_ERROR(("%s: Need to parse the erom again to find addr space %d\n", | ||
408 | __FUNCTION__, asidx)); | ||
409 | return 0; | ||
410 | } | ||
411 | } | ||
412 | |||
413 | uint | ||
414 | ai_flag(si_t *sih) | ||
415 | { | ||
416 | si_info_t *sii; | ||
417 | aidmp_t *ai; | ||
418 | |||
419 | sii = SI_INFO(sih); | ||
420 | ai = sii->curwrap; | ||
421 | |||
422 | return (R_REG(sii->osh, &ai->oobselouta30) & 0x1f); | ||
423 | } | ||
424 | |||
425 | void | ||
426 | ai_setint(si_t *sih, int siflag) | ||
427 | { | ||
428 | } | ||
429 | |||
430 | uint | ||
431 | ai_wrap_reg(si_t *sih, uint32 offset, uint32 mask, uint32 val) | ||
432 | { | ||
433 | si_info_t *sii = SI_INFO(sih); | ||
434 | uint32 *map = (uint32 *) sii->curwrap; | ||
435 | |||
436 | if (mask || val) { | ||
437 | uint32 w = R_REG(sii->osh, map+(offset/4)); | ||
438 | w &= ~mask; | ||
439 | w |= val; | ||
440 | W_REG(sii->osh, map+(offset/4), val); | ||
441 | } | ||
442 | |||
443 | return (R_REG(sii->osh, map+(offset/4))); | ||
444 | } | ||
445 | |||
446 | uint | ||
447 | ai_corevendor(si_t *sih) | ||
448 | { | ||
449 | si_info_t *sii; | ||
450 | uint32 cia; | ||
451 | |||
452 | sii = SI_INFO(sih); | ||
453 | cia = sii->cia[sii->curidx]; | ||
454 | return ((cia & CIA_MFG_MASK) >> CIA_MFG_SHIFT); | ||
455 | } | ||
456 | |||
457 | uint | ||
458 | ai_corerev(si_t *sih) | ||
459 | { | ||
460 | si_info_t *sii; | ||
461 | uint32 cib; | ||
462 | |||
463 | sii = SI_INFO(sih); | ||
464 | cib = sii->cib[sii->curidx]; | ||
465 | return ((cib & CIB_REV_MASK) >> CIB_REV_SHIFT); | ||
466 | } | ||
467 | |||
468 | bool | ||
469 | ai_iscoreup(si_t *sih) | ||
470 | { | ||
471 | si_info_t *sii; | ||
472 | aidmp_t *ai; | ||
473 | |||
474 | sii = SI_INFO(sih); | ||
475 | ai = sii->curwrap; | ||
476 | |||
477 | return (((R_REG(sii->osh, &ai->ioctrl) & (SICF_FGC | SICF_CLOCK_EN)) == SICF_CLOCK_EN) && | ||
478 | ((R_REG(sii->osh, &ai->resetctrl) & AIRC_RESET) == 0)); | ||
479 | } | ||
480 | |||
481 | |||
482 | uint | ||
483 | ai_corereg(si_t *sih, uint coreidx, uint regoff, uint mask, uint val) | ||
484 | { | ||
485 | uint origidx = 0; | ||
486 | uint32 *r = NULL; | ||
487 | uint w; | ||
488 | uint intr_val = 0; | ||
489 | bool fast = FALSE; | ||
490 | si_info_t *sii; | ||
491 | |||
492 | sii = SI_INFO(sih); | ||
493 | |||
494 | ASSERT(GOODIDX(coreidx)); | ||
495 | ASSERT(regoff < SI_CORE_SIZE); | ||
496 | ASSERT((val & ~mask) == 0); | ||
497 | |||
498 | if (coreidx >= SI_MAXCORES) | ||
499 | return 0; | ||
500 | |||
501 | if (BUSTYPE(sih->bustype) == SI_BUS) { | ||
502 | |||
503 | fast = TRUE; | ||
504 | |||
505 | if (!sii->regs[coreidx]) { | ||
506 | sii->regs[coreidx] = REG_MAP(sii->coresba[coreidx], | ||
507 | SI_CORE_SIZE); | ||
508 | ASSERT(GOODREGS(sii->regs[coreidx])); | ||
509 | } | ||
510 | r = (uint32 *)((uchar *)sii->regs[coreidx] + regoff); | ||
511 | } else if (BUSTYPE(sih->bustype) == PCI_BUS) { | ||
512 | |||
513 | |||
514 | if ((sii->coreid[coreidx] == CC_CORE_ID) && SI_FAST(sii)) { | ||
515 | |||
516 | |||
517 | fast = TRUE; | ||
518 | r = (uint32 *)((char *)sii->curmap + PCI_16KB0_CCREGS_OFFSET + regoff); | ||
519 | } else if (sii->pub.buscoreidx == coreidx) { | ||
520 | |||
521 | fast = TRUE; | ||
522 | if (SI_FAST(sii)) | ||
523 | r = (uint32 *)((char *)sii->curmap + | ||
524 | PCI_16KB0_PCIREGS_OFFSET + regoff); | ||
525 | else | ||
526 | r = (uint32 *)((char *)sii->curmap + | ||
527 | ((regoff >= SBCONFIGOFF) ? | ||
528 | PCI_BAR0_PCISBR_OFFSET : PCI_BAR0_PCIREGS_OFFSET) + | ||
529 | regoff); | ||
530 | } | ||
531 | } | ||
532 | |||
533 | if (!fast) { | ||
534 | INTR_OFF(sii, intr_val); | ||
535 | |||
536 | |||
537 | origidx = si_coreidx(&sii->pub); | ||
538 | |||
539 | |||
540 | r = (uint32*) ((uchar*) ai_setcoreidx(&sii->pub, coreidx) + regoff); | ||
541 | } | ||
542 | ASSERT(r != NULL); | ||
543 | |||
544 | |||
545 | if (mask || val) { | ||
546 | w = (R_REG(sii->osh, r) & ~mask) | val; | ||
547 | W_REG(sii->osh, r, w); | ||
548 | } | ||
549 | |||
550 | |||
551 | w = R_REG(sii->osh, r); | ||
552 | |||
553 | if (!fast) { | ||
554 | |||
555 | if (origidx != coreidx) | ||
556 | ai_setcoreidx(&sii->pub, origidx); | ||
557 | |||
558 | INTR_RESTORE(sii, intr_val); | ||
559 | } | ||
560 | |||
561 | return (w); | ||
562 | } | ||
563 | |||
564 | void | ||
565 | ai_core_disable(si_t *sih, uint32 bits) | ||
566 | { | ||
567 | si_info_t *sii; | ||
568 | volatile uint32 dummy; | ||
569 | aidmp_t *ai; | ||
570 | |||
571 | sii = SI_INFO(sih); | ||
572 | |||
573 | ASSERT(GOODREGS(sii->curwrap)); | ||
574 | ai = sii->curwrap; | ||
575 | |||
576 | |||
577 | if (R_REG(sii->osh, &ai->resetctrl) & AIRC_RESET) | ||
578 | return; | ||
579 | |||
580 | W_REG(sii->osh, &ai->ioctrl, bits); | ||
581 | dummy = R_REG(sii->osh, &ai->ioctrl); | ||
582 | OSL_DELAY(10); | ||
583 | |||
584 | W_REG(sii->osh, &ai->resetctrl, AIRC_RESET); | ||
585 | OSL_DELAY(1); | ||
586 | } | ||
587 | |||
588 | |||
589 | void | ||
590 | ai_core_reset(si_t *sih, uint32 bits, uint32 resetbits) | ||
591 | { | ||
592 | si_info_t *sii; | ||
593 | aidmp_t *ai; | ||
594 | volatile uint32 dummy; | ||
595 | |||
596 | sii = SI_INFO(sih); | ||
597 | ASSERT(GOODREGS(sii->curwrap)); | ||
598 | ai = sii->curwrap; | ||
599 | |||
600 | |||
601 | ai_core_disable(sih, (bits | resetbits)); | ||
602 | |||
603 | |||
604 | W_REG(sii->osh, &ai->ioctrl, (bits | SICF_FGC | SICF_CLOCK_EN)); | ||
605 | dummy = R_REG(sii->osh, &ai->ioctrl); | ||
606 | W_REG(sii->osh, &ai->resetctrl, 0); | ||
607 | OSL_DELAY(1); | ||
608 | |||
609 | W_REG(sii->osh, &ai->ioctrl, (bits | SICF_CLOCK_EN)); | ||
610 | dummy = R_REG(sii->osh, &ai->ioctrl); | ||
611 | OSL_DELAY(1); | ||
612 | } | ||
613 | |||
614 | |||
615 | void | ||
616 | ai_core_cflags_wo(si_t *sih, uint32 mask, uint32 val) | ||
617 | { | ||
618 | si_info_t *sii; | ||
619 | aidmp_t *ai; | ||
620 | uint32 w; | ||
621 | |||
622 | sii = SI_INFO(sih); | ||
623 | ASSERT(GOODREGS(sii->curwrap)); | ||
624 | ai = sii->curwrap; | ||
625 | |||
626 | ASSERT((val & ~mask) == 0); | ||
627 | |||
628 | if (mask || val) { | ||
629 | w = ((R_REG(sii->osh, &ai->ioctrl) & ~mask) | val); | ||
630 | W_REG(sii->osh, &ai->ioctrl, w); | ||
631 | } | ||
632 | } | ||
633 | |||
634 | uint32 | ||
635 | ai_core_cflags(si_t *sih, uint32 mask, uint32 val) | ||
636 | { | ||
637 | si_info_t *sii; | ||
638 | aidmp_t *ai; | ||
639 | uint32 w; | ||
640 | |||
641 | sii = SI_INFO(sih); | ||
642 | ASSERT(GOODREGS(sii->curwrap)); | ||
643 | ai = sii->curwrap; | ||
644 | |||
645 | ASSERT((val & ~mask) == 0); | ||
646 | |||
647 | if (mask || val) { | ||
648 | w = ((R_REG(sii->osh, &ai->ioctrl) & ~mask) | val); | ||
649 | W_REG(sii->osh, &ai->ioctrl, w); | ||
650 | } | ||
651 | |||
652 | return R_REG(sii->osh, &ai->ioctrl); | ||
653 | } | ||
654 | |||
655 | uint32 | ||
656 | ai_core_sflags(si_t *sih, uint32 mask, uint32 val) | ||
657 | { | ||
658 | si_info_t *sii; | ||
659 | aidmp_t *ai; | ||
660 | uint32 w; | ||
661 | |||
662 | sii = SI_INFO(sih); | ||
663 | ASSERT(GOODREGS(sii->curwrap)); | ||
664 | ai = sii->curwrap; | ||
665 | |||
666 | ASSERT((val & ~mask) == 0); | ||
667 | ASSERT((mask & ~SISF_CORE_BITS) == 0); | ||
668 | |||
669 | if (mask || val) { | ||
670 | w = ((R_REG(sii->osh, &ai->iostatus) & ~mask) | val); | ||
671 | W_REG(sii->osh, &ai->iostatus, w); | ||
672 | } | ||
673 | |||
674 | return R_REG(sii->osh, &ai->iostatus); | ||
675 | } | ||