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