if_wi_pcmcia.c revision 1.75 1 /* $NetBSD: if_wi_pcmcia.c,v 1.75 2006/12/10 03:44:28 uwe 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.75 2006/12/10 03:44:28 uwe 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_netbsd.h>
58 #include <net80211/ieee80211_var.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 #ifdef _LKM
75 #define WI_PCMCIA_SPECTRUM24T_FW 1
76 #else
77 #include <opt_if_wi_pcmcia.h>
78 #endif
79
80 #if WI_PCMCIA_SPECTRUM24T_FW
81 #include <dev/microcode/wi/spectrum24t_cf.h>
82 #endif
83
84 static int wi_pcmcia_match(struct device *, struct cfdata *, void *);
85 static int wi_pcmcia_validate_config(struct pcmcia_config_entry *);
86 static void wi_pcmcia_attach(struct device *, struct device *, void *);
87 static int wi_pcmcia_detach(struct device *, int);
88 static int wi_pcmcia_enable(struct wi_softc *);
89 static void wi_pcmcia_disable(struct wi_softc *);
90 static void wi_pcmcia_powerhook(int, void *);
91 static void wi_pcmcia_shutdown(void *);
92
93 #if WI_PCMCIA_SPECTRUM24T_FW
94 /* support to download firmware for symbol CF card */
95 static int wi_pcmcia_load_firm(struct wi_softc *, const void *, int, const void *, int);
96 static int wi_pcmcia_write_firm(struct wi_softc *, const void *, int, const void *, int);
97 static int wi_pcmcia_set_hcr(struct wi_softc *, int);
98 #endif
99
100 struct wi_pcmcia_softc {
101 struct wi_softc sc_wi;
102
103 void *sc_powerhook; /* power hook descriptor */
104 void *sc_sdhook; /* shutdown hook */
105 int sc_symbol_cf; /* Spectrum24t CF card */
106
107 struct pcmcia_function *sc_pf; /* PCMCIA function */
108 int sc_state;
109 #define WI_PCMCIA_ATTACHED 3
110 };
111
112 CFATTACH_DECL(wi_pcmcia, sizeof(struct wi_pcmcia_softc),
113 wi_pcmcia_match, wi_pcmcia_attach, wi_pcmcia_detach, wi_activate);
114
115 static const struct pcmcia_product wi_pcmcia_products[] = {
116 { PCMCIA_VENDOR_INVALID, PCMCIA_PRODUCT_INVALID,
117 PCMCIA_CIS_SMC_2632W },
118
119 { PCMCIA_VENDOR_INVALID, PCMCIA_PRODUCT_INVALID,
120 PCMCIA_CIS_NANOSPEED_PRISM2 },
121
122 { PCMCIA_VENDOR_INVALID, PCMCIA_PRODUCT_INVALID,
123 PCMCIA_CIS_NEC_CMZ_RT_WP },
124
125 { PCMCIA_VENDOR_INVALID, PCMCIA_PRODUCT_INVALID,
126 PCMCIA_CIS_NTT_ME_WLAN },
127
128 { PCMCIA_VENDOR_LUCENT, PCMCIA_PRODUCT_LUCENT_HERMES,
129 PCMCIA_CIS_INVALID },
130
131 { PCMCIA_VENDOR_LUCENT, PCMCIA_PRODUCT_LUCENT_HERMES2,
132 PCMCIA_CIS_INVALID },
133
134 { PCMCIA_VENDOR_3COM, PCMCIA_PRODUCT_3COM_3CRWE737A,
135 PCMCIA_CIS_3COM_3CRWE737A },
136
137 { PCMCIA_VENDOR_ALVARION,
138 PCMCIA_PRODUCT_ALVARION_BREEZENET,
139 PCMCIA_CIS_ALVARION_BREEZENET },
140
141 { PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_PCC_11,
142 PCMCIA_CIS_COREGA_WIRELESS_LAN_PCC_11 },
143
144 { PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_PCCA_11,
145 PCMCIA_CIS_COREGA_WIRELESS_LAN_PCCA_11 },
146
147 { PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_PCCB_11,
148 PCMCIA_CIS_COREGA_WIRELESS_LAN_PCCB_11 },
149
150 { PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_PCCL_11,
151 PCMCIA_CIS_COREGA_WIRELESS_LAN_PCCL_11 },
152
153 { PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_WLCFL_11,
154 PCMCIA_CIS_COREGA_WIRELESS_LAN_WLCFL_11 },
155
156 { PCMCIA_VENDOR_INTEL, PCMCIA_PRODUCT_INTEL_PRO_WLAN_2011,
157 PCMCIA_CIS_INTEL_PRO_WLAN_2011 },
158
159 { PCMCIA_VENDOR_INTERSIL2, PCMCIA_PRODUCT_INTERSIL2_PRISM2,
160 PCMCIA_CIS_INTERSIL2_PRISM2 },
161
162 { PCMCIA_VENDOR_INTERSIL2, PCMCIA_PRODUCT_GEMTEK_WLAN,
163 PCMCIA_CIS_GEMTEK_WLAN },
164
165 { PCMCIA_VENDOR_SAMSUNG, PCMCIA_PRODUCT_SAMSUNG_SWL_2000N,
166 PCMCIA_CIS_SAMSUNG_SWL_2000N },
167
168 { PCMCIA_VENDOR_ELSA, PCMCIA_PRODUCT_ELSA_XI300_IEEE,
169 PCMCIA_CIS_ELSA_XI300_IEEE },
170
171 { PCMCIA_VENDOR_ELSA, PCMCIA_PRODUCT_ELSA_XI325_IEEE,
172 PCMCIA_CIS_ELSA_XI325_IEEE },
173
174 { PCMCIA_VENDOR_ELSA, PCMCIA_PRODUCT_ELSA_XI800_IEEE,
175 PCMCIA_CIS_ELSA_XI800_IEEE },
176
177 { PCMCIA_VENDOR_ELSA, PCMCIA_PRODUCT_ELSA_SMC2531WB,
178 PCMCIA_CIS_ELSA_SMC2531WB },
179
180 { PCMCIA_VENDOR_COMPAQ, PCMCIA_PRODUCT_COMPAQ_NC5004,
181 PCMCIA_CIS_COMPAQ_NC5004 },
182
183 { PCMCIA_VENDOR_CONTEC, PCMCIA_PRODUCT_CONTEC_FX_DS110_PCC,
184 PCMCIA_CIS_CONTEC_FX_DS110_PCC },
185
186 { PCMCIA_VENDOR_TDK, PCMCIA_PRODUCT_TDK_LAK_CD011WL,
187 PCMCIA_CIS_TDK_LAK_CD011WL },
188
189 { PCMCIA_VENDOR_IODATA2, PCMCIA_PRODUCT_IODATA2_WNB11PCM,
190 PCMCIA_CIS_IODATA2_WNB11PCM },
191
192 { PCMCIA_VENDOR_IODATA2, PCMCIA_PRODUCT_IODATA2_WCF12,
193 PCMCIA_CIS_IODATA2_WCF12 },
194
195 { PCMCIA_VENDOR_BUFFALO, PCMCIA_PRODUCT_BUFFALO_WLI_PCM_S11,
196 PCMCIA_CIS_BUFFALO_WLI_PCM_S11 },
197
198 { PCMCIA_VENDOR_BUFFALO, PCMCIA_PRODUCT_BUFFALO_WLI_CF_S11G,
199 PCMCIA_CIS_BUFFALO_WLI_CF_S11G },
200
201 { PCMCIA_VENDOR_EMTAC, PCMCIA_PRODUCT_EMTAC_WLAN,
202 PCMCIA_CIS_EMTAC_WLAN },
203
204 { PCMCIA_VENDOR_INTERSIL, PCMCIA_PRODUCT_INTERSIL_ISL37100P,
205 PCMCIA_CIS_INTERSIL_ISL37100P },
206
207 { PCMCIA_VENDOR_INTERSIL, PCMCIA_PRODUCT_INTERSIL_ISL37110P,
208 PCMCIA_CIS_INTERSIL_ISL37110P },
209
210 { PCMCIA_VENDOR_INTERSIL, PCMCIA_PRODUCT_INTERSIL_ISL37300P,
211 PCMCIA_CIS_INTERSIL_ISL37300P },
212
213 { PCMCIA_VENDOR_SIMPLETECH, PCMCIA_PRODUCT_SIMPLETECH_SPECTRUM24,
214 PCMCIA_CIS_SIMPLETECH_SPECTRUM24 },
215
216 { PCMCIA_VENDOR_ERICSSON, PCMCIA_PRODUCT_ERICSSON_WIRELESSLAN,
217 PCMCIA_CIS_ERICSSON_WIRELESSLAN },
218
219 { PCMCIA_VENDOR_SYMBOL, PCMCIA_PRODUCT_SYMBOL_LA4100,
220 PCMCIA_CIS_SYMBOL_LA4100 },
221
222 { PCMCIA_VENDOR_LINKSYS2, PCMCIA_PRODUCT_LINKSYS2_IWN,
223 PCMCIA_CIS_NANOSPEED_PRISM2 },
224
225 { PCMCIA_VENDOR_LINKSYS2, PCMCIA_PRODUCT_LINKSYS2_IWN3,
226 PCMCIA_CIS_LINKSYS2_IWN3 },
227
228 { PCMCIA_VENDOR_LINKSYS2, PCMCIA_PRODUCT_LINKSYS2_WCF11,
229 PCMCIA_CIS_LINKSYS2_WCF11 },
230
231 { PCMCIA_VENDOR_MICROSOFT, PCMCIA_PRODUCT_MICROSOFT_MN_520,
232 PCMCIA_CIS_MICROSOFT_MN_520 },
233
234 { PCMCIA_VENDOR_PLANEX, PCMCIA_PRODUCT_PLANEX_GWNS11H,
235 PCMCIA_CIS_PLANEX_GWNS11H },
236
237 { PCMCIA_VENDOR_BAY, PCMCIA_PRODUCT_BAY_EMOBILITY_11B,
238 PCMCIA_CIS_BAY_EMOBILITY_11B },
239
240 { PCMCIA_VENDOR_ACTIONTEC, PCMCIA_PRODUCT_ACTIONTEC_PRISM,
241 PCMCIA_CIS_ACTIONTEC_PRISM },
242
243 { PCMCIA_VENDOR_DLINK_2, PCMCIA_PRODUCT_DLINK_DWL650H,
244 PCMCIA_CIS_DLINK_DWL650H },
245
246 { PCMCIA_VENDOR_FUJITSU, PCMCIA_PRODUCT_FUJITSU_WL110,
247 PCMCIA_CIS_FUJITSU_WL110 },
248
249 { PCMCIA_VENDOR_ARTEM, PCMCIA_PRODUCT_ARTEM_ONAIR,
250 PCMCIA_CIS_ARTEM_ONAIR },
251
252 { PCMCIA_VENDOR_ASUSTEK, PCMCIA_PRODUCT_ASUSTEK_WL_100,
253 PCMCIA_CIS_ASUSTEK_WL_100 },
254
255 { PCMCIA_VENDOR_PROXIM, PCMCIA_PRODUCT_PROXIM_RANGELANDS_8430,
256 PCMCIA_CIS_PROXIM_RANGELANDS_8430 },
257
258 { PCMCIA_VENDOR_SIEMENS, PCMCIA_PRODUCT_SIEMENS_SS1021,
259 PCMCIA_CIS_SIEMENS_SS1021 },
260 };
261 static const size_t wi_pcmcia_nproducts =
262 sizeof(wi_pcmcia_products) / sizeof(wi_pcmcia_products[0]);
263
264 static int
265 wi_pcmcia_match(struct device *parent, struct cfdata *match,
266 void *aux)
267 {
268 struct pcmcia_attach_args *pa = aux;
269
270 if (pcmcia_product_lookup(pa, wi_pcmcia_products, wi_pcmcia_nproducts,
271 sizeof(wi_pcmcia_products[0]), NULL))
272 return (1);
273 return (0);
274 }
275
276 static int
277 wi_pcmcia_enable(sc)
278 struct wi_softc *sc;
279 {
280 struct wi_pcmcia_softc *psc = (struct wi_pcmcia_softc *)sc;
281 struct pcmcia_function *pf = psc->sc_pf;
282 int error;
283
284 /* establish the interrupt. */
285 sc->sc_ih = pcmcia_intr_establish(pf, IPL_NET, wi_intr, sc);
286 if (!sc->sc_ih)
287 return (EIO);
288
289 error = pcmcia_function_enable(pf);
290 if (error) {
291 pcmcia_intr_disestablish(pf, sc->sc_ih);
292 sc->sc_ih = 0;
293 return (EIO);
294 }
295
296 if (psc->sc_symbol_cf) {
297 #if WI_PCMCIA_SPECTRUM24T_FW
298 if (wi_pcmcia_load_firm(sc,
299 spectrum24t_primsym, sizeof(spectrum24t_primsym),
300 spectrum24t_secsym, sizeof(spectrum24t_secsym))) {
301 printf("%s: couldn't load firmware\n",
302 sc->sc_dev.dv_xname);
303 wi_pcmcia_disable(sc);
304 return (EIO);
305 }
306 #else
307 printf("%s: firmware load not configured\n",
308 sc->sc_dev.dv_xname);
309 return EIO;
310 #endif
311 }
312 DELAY(1000);
313
314 return (0);
315 }
316
317 static void
318 wi_pcmcia_disable(sc)
319 struct wi_softc *sc;
320 {
321 struct wi_pcmcia_softc *psc = (struct wi_pcmcia_softc *)sc;
322
323 pcmcia_function_disable(psc->sc_pf);
324 pcmcia_intr_disestablish(psc->sc_pf, sc->sc_ih);
325 sc->sc_ih = 0;
326 }
327
328 static int
329 wi_pcmcia_validate_config(cfe)
330 struct pcmcia_config_entry *cfe;
331 {
332 if (cfe->iftype != PCMCIA_IFTYPE_IO ||
333 cfe->num_iospace != 1 ||
334 cfe->iospace[0].length < WI_IOSIZE)
335 return (EINVAL);
336 cfe->num_memspace = 0;
337 return (0);
338 }
339
340 static void
341 wi_pcmcia_attach(struct device *parent, struct device *self,
342 void *aux)
343 {
344 struct wi_pcmcia_softc *psc = (void *)self;
345 struct wi_softc *sc = &psc->sc_wi;
346 struct pcmcia_attach_args *pa = aux;
347 struct pcmcia_config_entry *cfe;
348 int haveaddr;
349 int error;
350
351 aprint_naive("\n");
352
353 psc->sc_pf = pa->pf;
354
355 error = pcmcia_function_configure(pa->pf, wi_pcmcia_validate_config);
356 if (error) {
357 aprint_error("%s: configure failed, error=%d\n", self->dv_xname,
358 error);
359 return;
360 }
361
362 cfe = pa->pf->cfe;
363 sc->sc_iot = cfe->iospace[0].handle.iot;
364 sc->sc_ioh = cfe->iospace[0].handle.ioh;
365
366 if (pa->manufacturer == PCMCIA_VENDOR_SYMBOL &&
367 pa->product == PCMCIA_PRODUCT_SYMBOL_LA4100)
368 psc->sc_symbol_cf = 1;
369 /*
370 * XXX: Sony PEGA-WL100 CF card has a same vendor/product id as
371 * Intel PCMCIA card. It may be incorrect to detect by the
372 * initial value of COR register.
373 */
374 if (pa->manufacturer == PCMCIA_VENDOR_INTEL &&
375 pa->product == PCMCIA_PRODUCT_INTEL_PRO_WLAN_2011 &&
376 CSR_READ_2(sc, WI_COR) == WI_COR_IOMODE)
377 psc->sc_symbol_cf = 1;
378
379 error = wi_pcmcia_enable(sc);
380 if (error)
381 goto fail;
382
383 sc->sc_pci = 0;
384 sc->sc_enable = wi_pcmcia_enable;
385 sc->sc_disable = wi_pcmcia_disable;
386
387 printf("%s:", self->dv_xname);
388
389 haveaddr = pa->pf->pf_funce_lan_nidlen == IEEE80211_ADDR_LEN;
390 if (wi_attach(sc, haveaddr ? pa->pf->pf_funce_lan_nid : 0) != 0) {
391 aprint_error("%s: failed to attach controller\n", self->dv_xname);
392 goto fail2;
393 }
394
395 psc->sc_sdhook = shutdownhook_establish(wi_pcmcia_shutdown, psc);
396 psc->sc_powerhook = powerhook_establish(self->dv_xname,
397 wi_pcmcia_powerhook, psc);
398
399 wi_pcmcia_disable(sc);
400 psc->sc_state = WI_PCMCIA_ATTACHED;
401 return;
402
403 fail2:
404 wi_pcmcia_disable(sc);
405 fail:
406 pcmcia_function_unconfigure(pa->pf);
407 }
408
409 static int
410 wi_pcmcia_detach(struct device *self, int flags)
411 {
412 struct wi_pcmcia_softc *psc = (struct wi_pcmcia_softc *)self;
413 int error;
414
415 if (psc->sc_state != WI_PCMCIA_ATTACHED)
416 return (0);
417
418 if (psc->sc_powerhook)
419 powerhook_disestablish(psc->sc_powerhook);
420 if (psc->sc_sdhook)
421 shutdownhook_disestablish(psc->sc_sdhook);
422
423 error = wi_detach(&psc->sc_wi);
424 if (error != 0)
425 return (error);
426
427 pcmcia_function_unconfigure(psc->sc_pf);
428
429 return (0);
430 }
431
432 static void
433 wi_pcmcia_powerhook(why, arg)
434 int why;
435 void *arg;
436 {
437 struct wi_pcmcia_softc *psc = arg;
438 struct wi_softc *sc = &psc->sc_wi;
439
440 wi_power(sc, why);
441 }
442
443 static void
444 wi_pcmcia_shutdown(arg)
445 void *arg;
446 {
447 struct wi_pcmcia_softc *psc = arg;
448 struct wi_softc *sc = &psc->sc_wi;
449
450 wi_shutdown(sc);
451 }
452
453 /*
454 * Special routines to download firmware for Symbol CF card.
455 * XXX: This should be modified generic into any PRISM-2 based card.
456 */
457
458 #define WI_SBCF_PDIADDR 0x3100
459
460 /* unaligned load little endian */
461 #define GETLE32(p) ((p)[0] | ((p)[1]<<8) | ((p)[2]<<16) | ((p)[3]<<24))
462 #define GETLE16(p) ((p)[0] | ((p)[1]<<8))
463
464 #if WI_PCMCIA_SPECTRUM24T_FW
465 static int
466 wi_pcmcia_load_firm(sc, primsym, primlen, secsym, seclen)
467 struct wi_softc *sc;
468 const void *primsym, *secsym;
469 int primlen, seclen;
470 {
471 u_int8_t ebuf[256];
472 int i;
473
474 /* load primary code and run it */
475 wi_pcmcia_set_hcr(sc, WI_HCR_EEHOLD);
476 if (wi_pcmcia_write_firm(sc, primsym, primlen, NULL, 0))
477 return EIO;
478 wi_pcmcia_set_hcr(sc, WI_HCR_RUN);
479 for (i = 0; ; i++) {
480 if (i == 10)
481 return ETIMEDOUT;
482 tsleep(sc, PWAIT, "wiinit", 1);
483 if (CSR_READ_2(sc, WI_CNTL) == WI_CNTL_AUX_ENA_STAT)
484 break;
485 /* write the magic key value to unlock aux port */
486 CSR_WRITE_2(sc, WI_PARAM0, WI_AUX_KEY0);
487 CSR_WRITE_2(sc, WI_PARAM1, WI_AUX_KEY1);
488 CSR_WRITE_2(sc, WI_PARAM2, WI_AUX_KEY2);
489 CSR_WRITE_2(sc, WI_CNTL, WI_CNTL_AUX_ENA_CNTL);
490 }
491
492 /* issue read EEPROM command: XXX copied from wi_cmd() */
493 CSR_WRITE_2(sc, WI_PARAM0, 0);
494 CSR_WRITE_2(sc, WI_PARAM1, 0);
495 CSR_WRITE_2(sc, WI_PARAM2, 0);
496 CSR_WRITE_2(sc, WI_COMMAND, WI_CMD_READEE);
497 for (i = 0; i < WI_TIMEOUT; i++) {
498 if (CSR_READ_2(sc, WI_EVENT_STAT) & WI_EV_CMD)
499 break;
500 DELAY(1);
501 }
502 CSR_WRITE_2(sc, WI_EVENT_ACK, WI_EV_CMD);
503
504 CSR_WRITE_2(sc, WI_AUX_PAGE, WI_SBCF_PDIADDR / WI_AUX_PGSZ);
505 CSR_WRITE_2(sc, WI_AUX_OFFSET, WI_SBCF_PDIADDR % WI_AUX_PGSZ);
506 CSR_READ_MULTI_STREAM_2(sc, WI_AUX_DATA,
507 (u_int16_t *)ebuf, sizeof(ebuf) / 2);
508 if (GETLE16(ebuf) > sizeof(ebuf))
509 return EIO;
510 if (wi_pcmcia_write_firm(sc, secsym, seclen, ebuf + 4, GETLE16(ebuf)))
511 return EIO;
512 return 0;
513 }
514
515 static int
516 wi_pcmcia_write_firm(sc, buf, buflen, ebuf, ebuflen)
517 struct wi_softc *sc;
518 const void *buf, *ebuf;
519 int buflen, ebuflen;
520 {
521 const u_int8_t *p, *ep, *q, *eq;
522 char *endp;
523 u_int32_t addr, id, eid;
524 int i, len, elen, nblk, pdrlen;
525
526 /*
527 * Parse the header of the firmware image.
528 */
529 p = buf;
530 ep = p + buflen;
531 while (p < ep && *p++ != ' '); /* FILE: */
532 while (p < ep && *p++ != ' '); /* filename */
533 while (p < ep && *p++ != ' '); /* type of the firmware */
534 nblk = strtoul(p, &endp, 10);
535 p = (void *)endp;
536 pdrlen = strtoul(p + 1, &endp, 10);
537 p = (void *)endp;
538 while (p < ep && *p++ != 0x1a); /* skip rest of header */
539
540 /*
541 * Block records: address[4], length[2], data[length];
542 */
543 for (i = 0; i < nblk; i++) {
544 addr = GETLE32(p); p += 4;
545 len = GETLE16(p); p += 2;
546 CSR_WRITE_2(sc, WI_AUX_PAGE, addr / WI_AUX_PGSZ);
547 CSR_WRITE_2(sc, WI_AUX_OFFSET, addr % WI_AUX_PGSZ);
548 CSR_WRITE_MULTI_STREAM_2(sc, WI_AUX_DATA,
549 (const u_int16_t *)p, len / 2);
550 p += len;
551 }
552
553 /*
554 * PDR: id[4], address[4], length[4];
555 */
556 for (i = 0; i < pdrlen; ) {
557 id = GETLE32(p); p += 4; i += 4;
558 addr = GETLE32(p); p += 4; i += 4;
559 len = GETLE32(p); p += 4; i += 4;
560 /* replace PDR entry with the values from EEPROM, if any */
561 for (q = ebuf, eq = q + ebuflen; q < eq; q += elen * 2) {
562 elen = GETLE16(q); q += 2;
563 eid = GETLE16(q); q += 2;
564 elen--; /* elen includes eid */
565 if (eid == 0)
566 break;
567 if (eid != id)
568 continue;
569 CSR_WRITE_2(sc, WI_AUX_PAGE, addr / WI_AUX_PGSZ);
570 CSR_WRITE_2(sc, WI_AUX_OFFSET, addr % WI_AUX_PGSZ);
571 CSR_WRITE_MULTI_STREAM_2(sc, WI_AUX_DATA,
572 (const u_int16_t *)q, len / 2);
573 break;
574 }
575 }
576 return 0;
577 }
578
579 static int
580 wi_pcmcia_set_hcr(sc, mode)
581 struct wi_softc *sc;
582 int mode;
583 {
584 u_int16_t hcr;
585
586 CSR_WRITE_2(sc, WI_COR, WI_COR_RESET);
587 tsleep(sc, PWAIT, "wiinit", 1);
588 hcr = CSR_READ_2(sc, WI_HCR);
589 hcr = (hcr & WI_HCR_4WIRE) | (mode & ~WI_HCR_4WIRE);
590 CSR_WRITE_2(sc, WI_HCR, hcr);
591 tsleep(sc, PWAIT, "wiinit", 1);
592 CSR_WRITE_2(sc, WI_COR, WI_COR_IOMODE);
593 tsleep(sc, PWAIT, "wiinit", 1);
594 return 0;
595 }
596 #endif
597