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