if_wi_pcmcia.c revision 1.60 1 /* $NetBSD: if_wi_pcmcia.c,v 1.60 2005/02/04 02:10:45 perry Exp $ */
2
3 /*-
4 * Copyright (c) 2001, 2004 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to The NetBSD Foundation
8 * by Ichiro FUKUHARA (ichiro (at) ichiro.org), and by Charles M. Hannum.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 * 3. All advertising materials mentioning features or use of this software
19 * must display the following acknowledgement:
20 * This product includes software developed by the NetBSD
21 * Foundation, Inc. and its contributors.
22 * 4. Neither the name of The NetBSD Foundation nor the names of its
23 * contributors may be used to endorse or promote products derived
24 * from this software without specific prior written permission.
25 *
26 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 * POSSIBILITY OF SUCH DAMAGE.
37 */
38
39 /*
40 * PCMCIA attachment for Lucent & Intersil WaveLAN PCMCIA card
41 */
42
43 #include <sys/cdefs.h>
44 __KERNEL_RCSID(0, "$NetBSD: if_wi_pcmcia.c,v 1.60 2005/02/04 02:10:45 perry Exp $");
45
46 #include <sys/param.h>
47 #include <sys/systm.h>
48 #include <sys/callout.h>
49 #include <sys/device.h>
50 #include <sys/proc.h>
51 #include <sys/socket.h>
52
53 #include <net/if.h>
54 #include <net/if_ether.h>
55 #include <net/if_media.h>
56
57 #include <net80211/ieee80211_var.h>
58 #include <net80211/ieee80211_compat.h>
59 #include <net80211/ieee80211_radiotap.h>
60 #include <net80211/ieee80211_rssadapt.h>
61
62 #include <machine/cpu.h>
63 #include <machine/bus.h>
64 #include <machine/intr.h>
65
66 #include <dev/ic/wi_ieee.h>
67 #include <dev/ic/wireg.h>
68 #include <dev/ic/wivar.h>
69
70 #include <dev/pcmcia/pcmciareg.h>
71 #include <dev/pcmcia/pcmciavar.h>
72 #include <dev/pcmcia/pcmciadevs.h>
73
74 #include <dev/microcode/wi/spectrum24t_cf.h>
75
76 static int wi_pcmcia_match(struct device *, struct cfdata *, void *);
77 static int wi_pcmcia_validate_config(struct pcmcia_config_entry *);
78 static void wi_pcmcia_attach(struct device *, struct device *, void *);
79 static int wi_pcmcia_detach(struct device *, int);
80 static int wi_pcmcia_enable(struct wi_softc *);
81 static void wi_pcmcia_disable(struct wi_softc *);
82 static void wi_pcmcia_powerhook(int, void *);
83 static void wi_pcmcia_shutdown(void *);
84
85 /* support to download firmware for symbol CF card */
86 static int wi_pcmcia_load_firm(struct wi_softc *, const void *, int, const void *, int);
87 static int wi_pcmcia_write_firm(struct wi_softc *, const void *, int, const void *, int);
88 static int wi_pcmcia_set_hcr(struct wi_softc *, int);
89
90 struct wi_pcmcia_softc {
91 struct wi_softc sc_wi;
92
93 void *sc_powerhook; /* power hook descriptor */
94 void *sc_sdhook; /* shutdown hook */
95 int sc_symbol_cf; /* Spectrum24t CF card */
96
97 struct pcmcia_function *sc_pf; /* PCMCIA function */
98 int sc_state;
99 #define WI_PCMCIA_ATTACHED 3
100 };
101
102 CFATTACH_DECL(wi_pcmcia, sizeof(struct wi_pcmcia_softc),
103 wi_pcmcia_match, wi_pcmcia_attach, wi_pcmcia_detach, wi_activate);
104
105 static const struct pcmcia_product wi_pcmcia_products[] = {
106 { PCMCIA_VENDOR_INVALID, PCMCIA_PRODUCT_INVALID,
107 PCMCIA_CIS_SMC_2632W },
108
109 { PCMCIA_VENDOR_INVALID, PCMCIA_PRODUCT_INVALID,
110 PCMCIA_CIS_NANOSPEED_PRISM2 },
111
112 { PCMCIA_VENDOR_INVALID, PCMCIA_PRODUCT_INVALID,
113 PCMCIA_CIS_NEC_CMZ_RT_WP },
114
115 { PCMCIA_VENDOR_INVALID, PCMCIA_PRODUCT_INVALID,
116 PCMCIA_CIS_NTT_ME_WLAN },
117
118 { PCMCIA_VENDOR_LUCENT, PCMCIA_PRODUCT_LUCENT_HERMES,
119 PCMCIA_CIS_INVALID },
120
121 { PCMCIA_VENDOR_LUCENT, PCMCIA_PRODUCT_LUCENT_HERMES2,
122 PCMCIA_CIS_INVALID },
123
124 { PCMCIA_VENDOR_3COM, PCMCIA_PRODUCT_3COM_3CRWE737A,
125 PCMCIA_CIS_3COM_3CRWE737A },
126
127 { PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_PCC_11,
128 PCMCIA_CIS_COREGA_WIRELESS_LAN_PCC_11 },
129
130 { PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_PCCA_11,
131 PCMCIA_CIS_COREGA_WIRELESS_LAN_PCCA_11 },
132
133 { PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_PCCB_11,
134 PCMCIA_CIS_COREGA_WIRELESS_LAN_PCCB_11 },
135
136 { PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_PCCL_11,
137 PCMCIA_CIS_COREGA_WIRELESS_LAN_PCCL_11 },
138
139 { PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_WLCFL_11,
140 PCMCIA_CIS_COREGA_WIRELESS_LAN_WLCFL_11 },
141
142 { PCMCIA_VENDOR_INTEL, PCMCIA_PRODUCT_INTEL_PRO_WLAN_2011,
143 PCMCIA_CIS_INTEL_PRO_WLAN_2011 },
144
145 { PCMCIA_VENDOR_INTERSIL2, PCMCIA_PRODUCT_INTERSIL2_PRISM2,
146 PCMCIA_CIS_INTERSIL2_PRISM2 },
147
148 { PCMCIA_VENDOR_INTERSIL2, PCMCIA_PRODUCT_GEMTEK_WLAN,
149 PCMCIA_CIS_GEMTEK_WLAN },
150
151 { PCMCIA_VENDOR_SAMSUNG, PCMCIA_PRODUCT_SAMSUNG_SWL_2000N,
152 PCMCIA_CIS_SAMSUNG_SWL_2000N },
153
154 { PCMCIA_VENDOR_ELSA, PCMCIA_PRODUCT_ELSA_XI300_IEEE,
155 PCMCIA_CIS_ELSA_XI300_IEEE },
156
157 { PCMCIA_VENDOR_ELSA, PCMCIA_PRODUCT_ELSA_XI325_IEEE,
158 PCMCIA_CIS_ELSA_XI325_IEEE },
159
160 { PCMCIA_VENDOR_ELSA, PCMCIA_PRODUCT_ELSA_XI800_IEEE,
161 PCMCIA_CIS_ELSA_XI800_IEEE },
162
163 { PCMCIA_VENDOR_COMPAQ, PCMCIA_PRODUCT_COMPAQ_NC5004,
164 PCMCIA_CIS_COMPAQ_NC5004 },
165
166 { PCMCIA_VENDOR_CONTEC, PCMCIA_PRODUCT_CONTEC_FX_DS110_PCC,
167 PCMCIA_CIS_CONTEC_FX_DS110_PCC },
168
169 { PCMCIA_VENDOR_TDK, PCMCIA_PRODUCT_TDK_LAK_CD011WL,
170 PCMCIA_CIS_TDK_LAK_CD011WL },
171
172 { PCMCIA_VENDOR_IODATA2, PCMCIA_PRODUCT_IODATA2_WNB11PCM,
173 PCMCIA_CIS_IODATA2_WNB11PCM },
174
175 { PCMCIA_VENDOR_IODATA2, PCMCIA_PRODUCT_IODATA2_WCF12,
176 PCMCIA_CIS_IODATA2_WCF12 },
177
178 { PCMCIA_VENDOR_BUFFALO, PCMCIA_PRODUCT_BUFFALO_WLI_PCM_S11,
179 PCMCIA_CIS_BUFFALO_WLI_PCM_S11 },
180
181 { PCMCIA_VENDOR_BUFFALO, PCMCIA_PRODUCT_BUFFALO_WLI_CF_S11G,
182 PCMCIA_CIS_BUFFALO_WLI_CF_S11G },
183
184 { PCMCIA_VENDOR_EMTAC, PCMCIA_PRODUCT_EMTAC_WLAN,
185 PCMCIA_CIS_EMTAC_WLAN },
186
187 { PCMCIA_VENDOR_INTERSIL, PCMCIA_PRODUCT_INTERSIL_ISL37100P,
188 PCMCIA_CIS_INTERSIL_ISL37100P },
189
190 { PCMCIA_VENDOR_INTERSIL, PCMCIA_PRODUCT_INTERSIL_ISL37110P,
191 PCMCIA_CIS_INTERSIL_ISL37110P },
192
193 { PCMCIA_VENDOR_INTERSIL, PCMCIA_PRODUCT_INTERSIL_ISL37300P,
194 PCMCIA_CIS_INTERSIL_ISL37300P },
195
196 { PCMCIA_VENDOR_SIMPLETECH, PCMCIA_PRODUCT_SIMPLETECH_SPECTRUM24,
197 PCMCIA_CIS_SIMPLETECH_SPECTRUM24 },
198
199 { PCMCIA_VENDOR_ERICSSON, PCMCIA_PRODUCT_ERICSSON_WIRELESSLAN,
200 PCMCIA_CIS_ERICSSON_WIRELESSLAN },
201
202 { PCMCIA_VENDOR_SYMBOL, PCMCIA_PRODUCT_SYMBOL_LA4100,
203 PCMCIA_CIS_SYMBOL_LA4100 },
204
205 { PCMCIA_VENDOR_LINKSYS2, PCMCIA_PRODUCT_LINKSYS2_IWN,
206 PCMCIA_CIS_NANOSPEED_PRISM2 },
207
208 { PCMCIA_VENDOR_LINKSYS2, PCMCIA_PRODUCT_LINKSYS2_IWN3,
209 PCMCIA_CIS_LINKSYS2_IWN3 },
210
211 { PCMCIA_VENDOR_LINKSYS2, PCMCIA_PRODUCT_LINKSYS2_WCF11,
212 PCMCIA_CIS_LINKSYS2_WCF11 },
213
214 { PCMCIA_VENDOR_PLANEX, PCMCIA_PRODUCT_PLANEX_GWNS11H,
215 PCMCIA_CIS_PLANEX_GWNS11H },
216
217 { PCMCIA_VENDOR_BAY, PCMCIA_PRODUCT_BAY_EMOBILITY_11B,
218 PCMCIA_CIS_BAY_EMOBILITY_11B },
219
220 { PCMCIA_VENDOR_ACTIONTEC, PCMCIA_PRODUCT_ACTIONTEC_PRISM,
221 PCMCIA_CIS_ACTIONTEC_PRISM },
222
223 { PCMCIA_VENDOR_DLINK_2, PCMCIA_PRODUCT_DLINK_DWL650H,
224 PCMCIA_CIS_DLINK_DWL650H },
225
226 { PCMCIA_VENDOR_FUJITSU, PCMCIA_PRODUCT_FUJITSU_WL110,
227 PCMCIA_CIS_FUJITSU_WL110 },
228
229 { PCMCIA_VENDOR_ARTEM, PCMCIA_PRODUCT_ARTEM_ONAIR,
230 PCMCIA_CIS_ARTEM_ONAIR },
231
232 { PCMCIA_VENDOR_ASUSTEK, PCMCIA_PRODUCT_ASUSTEK_WL_100,
233 PCMCIA_CIS_ASUSTEK_WL_100 },
234 };
235 static const size_t wi_pcmcia_nproducts =
236 sizeof(wi_pcmcia_products) / sizeof(wi_pcmcia_products[0]);
237
238 static int
239 wi_pcmcia_match(parent, match, aux)
240 struct device *parent;
241 struct cfdata *match;
242 void *aux;
243 {
244 struct pcmcia_attach_args *pa = aux;
245
246 if (pcmcia_product_lookup(pa, wi_pcmcia_products, wi_pcmcia_nproducts,
247 sizeof(wi_pcmcia_products[0]), NULL))
248 return (1);
249 return (0);
250 }
251
252 static int
253 wi_pcmcia_enable(sc)
254 struct wi_softc *sc;
255 {
256 struct wi_pcmcia_softc *psc = (struct wi_pcmcia_softc *)sc;
257 struct pcmcia_function *pf = psc->sc_pf;
258 int error;
259
260 /* establish the interrupt. */
261 sc->sc_ih = pcmcia_intr_establish(pf, IPL_NET, wi_intr, sc);
262 if (!sc->sc_ih)
263 return (EIO);
264
265 error = pcmcia_function_enable(pf);
266 if (error) {
267 pcmcia_intr_disestablish(pf, sc->sc_ih);
268 sc->sc_ih = 0;
269 return (EIO);
270 }
271
272 if (psc->sc_symbol_cf) {
273 if (wi_pcmcia_load_firm(sc,
274 spectrum24t_primsym, sizeof(spectrum24t_primsym),
275 spectrum24t_secsym, sizeof(spectrum24t_secsym))) {
276 printf("%s: couldn't load firmware\n",
277 sc->sc_dev.dv_xname);
278 wi_pcmcia_disable(sc);
279 return (EIO);
280 }
281 }
282 DELAY(1000);
283
284 return (0);
285 }
286
287 static void
288 wi_pcmcia_disable(sc)
289 struct wi_softc *sc;
290 {
291 struct wi_pcmcia_softc *psc = (struct wi_pcmcia_softc *)sc;
292
293 pcmcia_function_disable(psc->sc_pf);
294 pcmcia_intr_disestablish(psc->sc_pf, sc->sc_ih);
295 sc->sc_ih = 0;
296 }
297
298 static int
299 wi_pcmcia_validate_config(cfe)
300 struct pcmcia_config_entry *cfe;
301 {
302 if (cfe->iftype != PCMCIA_IFTYPE_IO ||
303 cfe->num_iospace != 1 ||
304 cfe->iospace[0].length < WI_IOSIZE)
305 return (EINVAL);
306 cfe->num_memspace = 0;
307 return (0);
308 }
309
310 static void
311 wi_pcmcia_attach(parent, self, aux)
312 struct device *parent, *self;
313 void *aux;
314 {
315 struct wi_pcmcia_softc *psc = (void *)self;
316 struct wi_softc *sc = &psc->sc_wi;
317 struct pcmcia_attach_args *pa = aux;
318 struct pcmcia_config_entry *cfe;
319 int haveaddr;
320 int error;
321
322 psc->sc_pf = pa->pf;
323
324 error = pcmcia_function_configure(pa->pf, wi_pcmcia_validate_config);
325 if (error) {
326 aprint_error("%s: configure failed, error=%d\n", self->dv_xname,
327 error);
328 return;
329 }
330
331 cfe = pa->pf->cfe;
332 sc->sc_iot = cfe->iospace[0].handle.iot;
333 sc->sc_ioh = cfe->iospace[0].handle.ioh;
334
335 if (pa->manufacturer == PCMCIA_VENDOR_SYMBOL &&
336 pa->product == PCMCIA_PRODUCT_SYMBOL_LA4100)
337 psc->sc_symbol_cf = 1;
338 /*
339 * XXX: Sony PEGA-WL100 CF card has a same vendor/product id as
340 * Intel PCMCIA card. It may be incorrect to detect by the
341 * initial value of COR register.
342 */
343 if (pa->manufacturer == PCMCIA_VENDOR_INTEL &&
344 pa->product == PCMCIA_PRODUCT_INTEL_PRO_WLAN_2011 &&
345 CSR_READ_2(sc, WI_COR) == WI_COR_IOMODE)
346 psc->sc_symbol_cf = 1;
347
348 error = wi_pcmcia_enable(sc);
349 if (error)
350 goto fail;
351
352 sc->sc_pci = 0;
353 sc->sc_enable = wi_pcmcia_enable;
354 sc->sc_disable = wi_pcmcia_disable;
355
356 printf("%s:", self->dv_xname);
357
358 haveaddr = pa->pf->pf_funce_lan_nidlen == IEEE80211_ADDR_LEN;
359 if (wi_attach(sc, haveaddr ? pa->pf->pf_funce_lan_nid : 0) != 0) {
360 aprint_error("%s: failed to attach controller\n", self->dv_xname);
361 goto fail2;
362 }
363
364 psc->sc_sdhook = shutdownhook_establish(wi_pcmcia_shutdown, psc);
365 psc->sc_powerhook = powerhook_establish(wi_pcmcia_powerhook, psc);
366
367 wi_pcmcia_disable(sc);
368 psc->sc_state = WI_PCMCIA_ATTACHED;
369 return;
370
371 fail2:
372 wi_pcmcia_disable(sc);
373 fail:
374 pcmcia_function_unconfigure(pa->pf);
375 }
376
377 static int
378 wi_pcmcia_detach(self, flags)
379 struct device *self;
380 int flags;
381 {
382 struct wi_pcmcia_softc *psc = (struct wi_pcmcia_softc *)self;
383 int error;
384
385 if (psc->sc_state != WI_PCMCIA_ATTACHED)
386 return (0);
387
388 if (psc->sc_powerhook)
389 powerhook_disestablish(psc->sc_powerhook);
390 if (psc->sc_sdhook)
391 shutdownhook_disestablish(psc->sc_sdhook);
392
393 error = wi_detach(&psc->sc_wi);
394 if (error != 0)
395 return (error);
396
397 pcmcia_function_unconfigure(psc->sc_pf);
398
399 return (0);
400 }
401
402 static void
403 wi_pcmcia_powerhook(why, arg)
404 int why;
405 void *arg;
406 {
407 struct wi_pcmcia_softc *psc = arg;
408 struct wi_softc *sc = &psc->sc_wi;
409
410 wi_power(sc, why);
411 }
412
413 static void
414 wi_pcmcia_shutdown(arg)
415 void *arg;
416 {
417 struct wi_pcmcia_softc *psc = arg;
418 struct wi_softc *sc = &psc->sc_wi;
419
420 wi_shutdown(sc);
421 }
422
423 /*
424 * Special routines to download firmware for Symbol CF card.
425 * XXX: This should be modified generic into any PRISM-2 based card.
426 */
427
428 #define WI_SBCF_PDIADDR 0x3100
429
430 /* unaligned load little endian */
431 #define GETLE32(p) ((p)[0] | ((p)[1]<<8) | ((p)[2]<<16) | ((p)[3]<<24))
432 #define GETLE16(p) ((p)[0] | ((p)[1]<<8))
433
434 static int
435 wi_pcmcia_load_firm(sc, primsym, primlen, secsym, seclen)
436 struct wi_softc *sc;
437 const void *primsym, *secsym;
438 int primlen, seclen;
439 {
440 u_int8_t ebuf[256];
441 int i;
442
443 /* load primary code and run it */
444 wi_pcmcia_set_hcr(sc, WI_HCR_EEHOLD);
445 if (wi_pcmcia_write_firm(sc, primsym, primlen, NULL, 0))
446 return EIO;
447 wi_pcmcia_set_hcr(sc, WI_HCR_RUN);
448 for (i = 0; ; i++) {
449 if (i == 10)
450 return ETIMEDOUT;
451 tsleep(sc, PWAIT, "wiinit", 1);
452 if (CSR_READ_2(sc, WI_CNTL) == WI_CNTL_AUX_ENA_STAT)
453 break;
454 /* write the magic key value to unlock aux port */
455 CSR_WRITE_2(sc, WI_PARAM0, WI_AUX_KEY0);
456 CSR_WRITE_2(sc, WI_PARAM1, WI_AUX_KEY1);
457 CSR_WRITE_2(sc, WI_PARAM2, WI_AUX_KEY2);
458 CSR_WRITE_2(sc, WI_CNTL, WI_CNTL_AUX_ENA_CNTL);
459 }
460
461 /* issue read EEPROM command: XXX copied from wi_cmd() */
462 CSR_WRITE_2(sc, WI_PARAM0, 0);
463 CSR_WRITE_2(sc, WI_PARAM1, 0);
464 CSR_WRITE_2(sc, WI_PARAM2, 0);
465 CSR_WRITE_2(sc, WI_COMMAND, WI_CMD_READEE);
466 for (i = 0; i < WI_TIMEOUT; i++) {
467 if (CSR_READ_2(sc, WI_EVENT_STAT) & WI_EV_CMD)
468 break;
469 DELAY(1);
470 }
471 CSR_WRITE_2(sc, WI_EVENT_ACK, WI_EV_CMD);
472
473 CSR_WRITE_2(sc, WI_AUX_PAGE, WI_SBCF_PDIADDR / WI_AUX_PGSZ);
474 CSR_WRITE_2(sc, WI_AUX_OFFSET, WI_SBCF_PDIADDR % WI_AUX_PGSZ);
475 CSR_READ_MULTI_STREAM_2(sc, WI_AUX_DATA,
476 (u_int16_t *)ebuf, sizeof(ebuf) / 2);
477 if (GETLE16(ebuf) > sizeof(ebuf))
478 return EIO;
479 if (wi_pcmcia_write_firm(sc, secsym, seclen, ebuf + 4, GETLE16(ebuf)))
480 return EIO;
481 return 0;
482 }
483
484 static int
485 wi_pcmcia_write_firm(sc, buf, buflen, ebuf, ebuflen)
486 struct wi_softc *sc;
487 const void *buf, *ebuf;
488 int buflen, ebuflen;
489 {
490 const u_int8_t *p, *ep, *q, *eq;
491 u_int32_t addr, id, eid;
492 int i, len, elen, nblk, pdrlen;
493
494 /*
495 * Parse the header of the firmware image.
496 */
497 p = buf;
498 ep = p + buflen;
499 while (p < ep && *p++ != ' '); /* FILE: */
500 while (p < ep && *p++ != ' '); /* filename */
501 while (p < ep && *p++ != ' '); /* type of the firmware */
502 nblk = strtoul(p, (void *)&p, 10);
503 pdrlen = strtoul(p + 1, (void *)&p, 10);
504 while (p < ep && *p++ != 0x1a); /* skip rest of header */
505
506 /*
507 * Block records: address[4], length[2], data[length];
508 */
509 for (i = 0; i < nblk; i++) {
510 addr = GETLE32(p); p += 4;
511 len = GETLE16(p); p += 2;
512 CSR_WRITE_2(sc, WI_AUX_PAGE, addr / WI_AUX_PGSZ);
513 CSR_WRITE_2(sc, WI_AUX_OFFSET, addr % WI_AUX_PGSZ);
514 CSR_WRITE_MULTI_STREAM_2(sc, WI_AUX_DATA,
515 (const u_int16_t *)p, len / 2);
516 p += len;
517 }
518
519 /*
520 * PDR: id[4], address[4], length[4];
521 */
522 for (i = 0; i < pdrlen; ) {
523 id = GETLE32(p); p += 4; i += 4;
524 addr = GETLE32(p); p += 4; i += 4;
525 len = GETLE32(p); p += 4; i += 4;
526 /* replace PDR entry with the values from EEPROM, if any */
527 for (q = ebuf, eq = q + ebuflen; q < eq; q += elen * 2) {
528 elen = GETLE16(q); q += 2;
529 eid = GETLE16(q); q += 2;
530 elen--; /* elen includes eid */
531 if (eid == 0)
532 break;
533 if (eid != id)
534 continue;
535 CSR_WRITE_2(sc, WI_AUX_PAGE, addr / WI_AUX_PGSZ);
536 CSR_WRITE_2(sc, WI_AUX_OFFSET, addr % WI_AUX_PGSZ);
537 CSR_WRITE_MULTI_STREAM_2(sc, WI_AUX_DATA,
538 (const u_int16_t *)q, len / 2);
539 break;
540 }
541 }
542 return 0;
543 }
544
545 static int
546 wi_pcmcia_set_hcr(sc, mode)
547 struct wi_softc *sc;
548 int mode;
549 {
550 u_int16_t hcr;
551
552 CSR_WRITE_2(sc, WI_COR, WI_COR_RESET);
553 tsleep(sc, PWAIT, "wiinit", 1);
554 hcr = CSR_READ_2(sc, WI_HCR);
555 hcr = (hcr & WI_HCR_4WIRE) | (mode & ~WI_HCR_4WIRE);
556 CSR_WRITE_2(sc, WI_HCR, hcr);
557 tsleep(sc, PWAIT, "wiinit", 1);
558 CSR_WRITE_2(sc, WI_COR, WI_COR_IOMODE);
559 tsleep(sc, PWAIT, "wiinit", 1);
560 return 0;
561 }
562