if_wi_pcmcia.c revision 1.65
1 /* $NetBSD: if_wi_pcmcia.c,v 1.65 2005/06/10 14:08:06 itohy 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.65 2005/06/10 14:08:06 itohy 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_ELSA, PCMCIA_PRODUCT_ELSA_SMC2531WB, 164 PCMCIA_CIS_ELSA_SMC2531WB }, 165 166 { PCMCIA_VENDOR_COMPAQ, PCMCIA_PRODUCT_COMPAQ_NC5004, 167 PCMCIA_CIS_COMPAQ_NC5004 }, 168 169 { PCMCIA_VENDOR_CONTEC, PCMCIA_PRODUCT_CONTEC_FX_DS110_PCC, 170 PCMCIA_CIS_CONTEC_FX_DS110_PCC }, 171 172 { PCMCIA_VENDOR_TDK, PCMCIA_PRODUCT_TDK_LAK_CD011WL, 173 PCMCIA_CIS_TDK_LAK_CD011WL }, 174 175 { PCMCIA_VENDOR_IODATA2, PCMCIA_PRODUCT_IODATA2_WNB11PCM, 176 PCMCIA_CIS_IODATA2_WNB11PCM }, 177 178 { PCMCIA_VENDOR_IODATA2, PCMCIA_PRODUCT_IODATA2_WCF12, 179 PCMCIA_CIS_IODATA2_WCF12 }, 180 181 { PCMCIA_VENDOR_BUFFALO, PCMCIA_PRODUCT_BUFFALO_WLI_PCM_S11, 182 PCMCIA_CIS_BUFFALO_WLI_PCM_S11 }, 183 184 { PCMCIA_VENDOR_BUFFALO, PCMCIA_PRODUCT_BUFFALO_WLI_CF_S11G, 185 PCMCIA_CIS_BUFFALO_WLI_CF_S11G }, 186 187 { PCMCIA_VENDOR_EMTAC, PCMCIA_PRODUCT_EMTAC_WLAN, 188 PCMCIA_CIS_EMTAC_WLAN }, 189 190 { PCMCIA_VENDOR_INTERSIL, PCMCIA_PRODUCT_INTERSIL_ISL37100P, 191 PCMCIA_CIS_INTERSIL_ISL37100P }, 192 193 { PCMCIA_VENDOR_INTERSIL, PCMCIA_PRODUCT_INTERSIL_ISL37110P, 194 PCMCIA_CIS_INTERSIL_ISL37110P }, 195 196 { PCMCIA_VENDOR_INTERSIL, PCMCIA_PRODUCT_INTERSIL_ISL37300P, 197 PCMCIA_CIS_INTERSIL_ISL37300P }, 198 199 { PCMCIA_VENDOR_SIMPLETECH, PCMCIA_PRODUCT_SIMPLETECH_SPECTRUM24, 200 PCMCIA_CIS_SIMPLETECH_SPECTRUM24 }, 201 202 { PCMCIA_VENDOR_ERICSSON, PCMCIA_PRODUCT_ERICSSON_WIRELESSLAN, 203 PCMCIA_CIS_ERICSSON_WIRELESSLAN }, 204 205 { PCMCIA_VENDOR_SYMBOL, PCMCIA_PRODUCT_SYMBOL_LA4100, 206 PCMCIA_CIS_SYMBOL_LA4100 }, 207 208 { PCMCIA_VENDOR_LINKSYS2, PCMCIA_PRODUCT_LINKSYS2_IWN, 209 PCMCIA_CIS_NANOSPEED_PRISM2 }, 210 211 { PCMCIA_VENDOR_LINKSYS2, PCMCIA_PRODUCT_LINKSYS2_IWN3, 212 PCMCIA_CIS_LINKSYS2_IWN3 }, 213 214 { PCMCIA_VENDOR_LINKSYS2, PCMCIA_PRODUCT_LINKSYS2_WCF11, 215 PCMCIA_CIS_LINKSYS2_WCF11 }, 216 217 { PCMCIA_VENDOR_MICROSOFT, PCMCIA_PRODUCT_MICROSOFT_MN_520, 218 PCMCIA_CIS_MICROSOFT_MN_520 }, 219 220 { PCMCIA_VENDOR_PLANEX, PCMCIA_PRODUCT_PLANEX_GWNS11H, 221 PCMCIA_CIS_PLANEX_GWNS11H }, 222 223 { PCMCIA_VENDOR_BAY, PCMCIA_PRODUCT_BAY_EMOBILITY_11B, 224 PCMCIA_CIS_BAY_EMOBILITY_11B }, 225 226 { PCMCIA_VENDOR_ACTIONTEC, PCMCIA_PRODUCT_ACTIONTEC_PRISM, 227 PCMCIA_CIS_ACTIONTEC_PRISM }, 228 229 { PCMCIA_VENDOR_DLINK_2, PCMCIA_PRODUCT_DLINK_DWL650H, 230 PCMCIA_CIS_DLINK_DWL650H }, 231 232 { PCMCIA_VENDOR_FUJITSU, PCMCIA_PRODUCT_FUJITSU_WL110, 233 PCMCIA_CIS_FUJITSU_WL110 }, 234 235 { PCMCIA_VENDOR_ARTEM, PCMCIA_PRODUCT_ARTEM_ONAIR, 236 PCMCIA_CIS_ARTEM_ONAIR }, 237 238 { PCMCIA_VENDOR_ASUSTEK, PCMCIA_PRODUCT_ASUSTEK_WL_100, 239 PCMCIA_CIS_ASUSTEK_WL_100 }, 240 241 { PCMCIA_VENDOR_PROXIM, PCMCIA_PRODUCT_PROXIM_RANGELANDS_8430, 242 PCMCIA_CIS_PROXIM_RANGELANDS_8430 }, 243 }; 244 static const size_t wi_pcmcia_nproducts = 245 sizeof(wi_pcmcia_products) / sizeof(wi_pcmcia_products[0]); 246 247 static int 248 wi_pcmcia_match(parent, match, aux) 249 struct device *parent; 250 struct cfdata *match; 251 void *aux; 252 { 253 struct pcmcia_attach_args *pa = aux; 254 255 if (pcmcia_product_lookup(pa, wi_pcmcia_products, wi_pcmcia_nproducts, 256 sizeof(wi_pcmcia_products[0]), NULL)) 257 return (1); 258 return (0); 259 } 260 261 static int 262 wi_pcmcia_enable(sc) 263 struct wi_softc *sc; 264 { 265 struct wi_pcmcia_softc *psc = (struct wi_pcmcia_softc *)sc; 266 struct pcmcia_function *pf = psc->sc_pf; 267 int error; 268 269 /* establish the interrupt. */ 270 sc->sc_ih = pcmcia_intr_establish(pf, IPL_NET, wi_intr, sc); 271 if (!sc->sc_ih) 272 return (EIO); 273 274 error = pcmcia_function_enable(pf); 275 if (error) { 276 pcmcia_intr_disestablish(pf, sc->sc_ih); 277 sc->sc_ih = 0; 278 return (EIO); 279 } 280 281 if (psc->sc_symbol_cf) { 282 if (wi_pcmcia_load_firm(sc, 283 spectrum24t_primsym, sizeof(spectrum24t_primsym), 284 spectrum24t_secsym, sizeof(spectrum24t_secsym))) { 285 printf("%s: couldn't load firmware\n", 286 sc->sc_dev.dv_xname); 287 wi_pcmcia_disable(sc); 288 return (EIO); 289 } 290 } 291 DELAY(1000); 292 293 return (0); 294 } 295 296 static void 297 wi_pcmcia_disable(sc) 298 struct wi_softc *sc; 299 { 300 struct wi_pcmcia_softc *psc = (struct wi_pcmcia_softc *)sc; 301 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 static int 308 wi_pcmcia_validate_config(cfe) 309 struct pcmcia_config_entry *cfe; 310 { 311 if (cfe->iftype != PCMCIA_IFTYPE_IO || 312 cfe->num_iospace != 1 || 313 cfe->iospace[0].length < WI_IOSIZE) 314 return (EINVAL); 315 cfe->num_memspace = 0; 316 return (0); 317 } 318 319 static void 320 wi_pcmcia_attach(parent, self, aux) 321 struct device *parent, *self; 322 void *aux; 323 { 324 struct wi_pcmcia_softc *psc = (void *)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 psc->sc_pf = pa->pf; 332 333 error = pcmcia_function_configure(pa->pf, wi_pcmcia_validate_config); 334 if (error) { 335 aprint_error("%s: configure failed, error=%d\n", self->dv_xname, 336 error); 337 return; 338 } 339 340 cfe = pa->pf->cfe; 341 sc->sc_iot = cfe->iospace[0].handle.iot; 342 sc->sc_ioh = cfe->iospace[0].handle.ioh; 343 344 if (pa->manufacturer == PCMCIA_VENDOR_SYMBOL && 345 pa->product == PCMCIA_PRODUCT_SYMBOL_LA4100) 346 psc->sc_symbol_cf = 1; 347 /* 348 * XXX: Sony PEGA-WL100 CF card has a same vendor/product id as 349 * Intel PCMCIA card. It may be incorrect to detect by the 350 * initial value of COR register. 351 */ 352 if (pa->manufacturer == PCMCIA_VENDOR_INTEL && 353 pa->product == PCMCIA_PRODUCT_INTEL_PRO_WLAN_2011 && 354 CSR_READ_2(sc, WI_COR) == WI_COR_IOMODE) 355 psc->sc_symbol_cf = 1; 356 357 error = wi_pcmcia_enable(sc); 358 if (error) 359 goto fail; 360 361 sc->sc_pci = 0; 362 sc->sc_enable = wi_pcmcia_enable; 363 sc->sc_disable = wi_pcmcia_disable; 364 365 printf("%s:", self->dv_xname); 366 367 haveaddr = pa->pf->pf_funce_lan_nidlen == IEEE80211_ADDR_LEN; 368 if (wi_attach(sc, haveaddr ? pa->pf->pf_funce_lan_nid : 0) != 0) { 369 aprint_error("%s: failed to attach controller\n", self->dv_xname); 370 goto fail2; 371 } 372 373 psc->sc_sdhook = shutdownhook_establish(wi_pcmcia_shutdown, psc); 374 psc->sc_powerhook = powerhook_establish(wi_pcmcia_powerhook, psc); 375 376 wi_pcmcia_disable(sc); 377 psc->sc_state = WI_PCMCIA_ATTACHED; 378 return; 379 380 fail2: 381 wi_pcmcia_disable(sc); 382 fail: 383 pcmcia_function_unconfigure(pa->pf); 384 } 385 386 static int 387 wi_pcmcia_detach(self, flags) 388 struct device *self; 389 int flags; 390 { 391 struct wi_pcmcia_softc *psc = (struct wi_pcmcia_softc *)self; 392 int error; 393 394 if (psc->sc_state != WI_PCMCIA_ATTACHED) 395 return (0); 396 397 if (psc->sc_powerhook) 398 powerhook_disestablish(psc->sc_powerhook); 399 if (psc->sc_sdhook) 400 shutdownhook_disestablish(psc->sc_sdhook); 401 402 error = wi_detach(&psc->sc_wi); 403 if (error != 0) 404 return (error); 405 406 pcmcia_function_unconfigure(psc->sc_pf); 407 408 return (0); 409 } 410 411 static void 412 wi_pcmcia_powerhook(why, arg) 413 int why; 414 void *arg; 415 { 416 struct wi_pcmcia_softc *psc = arg; 417 struct wi_softc *sc = &psc->sc_wi; 418 419 wi_power(sc, why); 420 } 421 422 static void 423 wi_pcmcia_shutdown(arg) 424 void *arg; 425 { 426 struct wi_pcmcia_softc *psc = arg; 427 struct wi_softc *sc = &psc->sc_wi; 428 429 wi_shutdown(sc); 430 } 431 432 /* 433 * Special routines to download firmware for Symbol CF card. 434 * XXX: This should be modified generic into any PRISM-2 based card. 435 */ 436 437 #define WI_SBCF_PDIADDR 0x3100 438 439 /* unaligned load little endian */ 440 #define GETLE32(p) ((p)[0] | ((p)[1]<<8) | ((p)[2]<<16) | ((p)[3]<<24)) 441 #define GETLE16(p) ((p)[0] | ((p)[1]<<8)) 442 443 static int 444 wi_pcmcia_load_firm(sc, primsym, primlen, secsym, seclen) 445 struct wi_softc *sc; 446 const void *primsym, *secsym; 447 int primlen, seclen; 448 { 449 u_int8_t ebuf[256]; 450 int i; 451 452 /* load primary code and run it */ 453 wi_pcmcia_set_hcr(sc, WI_HCR_EEHOLD); 454 if (wi_pcmcia_write_firm(sc, primsym, primlen, NULL, 0)) 455 return EIO; 456 wi_pcmcia_set_hcr(sc, WI_HCR_RUN); 457 for (i = 0; ; i++) { 458 if (i == 10) 459 return ETIMEDOUT; 460 tsleep(sc, PWAIT, "wiinit", 1); 461 if (CSR_READ_2(sc, WI_CNTL) == WI_CNTL_AUX_ENA_STAT) 462 break; 463 /* write the magic key value to unlock aux port */ 464 CSR_WRITE_2(sc, WI_PARAM0, WI_AUX_KEY0); 465 CSR_WRITE_2(sc, WI_PARAM1, WI_AUX_KEY1); 466 CSR_WRITE_2(sc, WI_PARAM2, WI_AUX_KEY2); 467 CSR_WRITE_2(sc, WI_CNTL, WI_CNTL_AUX_ENA_CNTL); 468 } 469 470 /* issue read EEPROM command: XXX copied from wi_cmd() */ 471 CSR_WRITE_2(sc, WI_PARAM0, 0); 472 CSR_WRITE_2(sc, WI_PARAM1, 0); 473 CSR_WRITE_2(sc, WI_PARAM2, 0); 474 CSR_WRITE_2(sc, WI_COMMAND, WI_CMD_READEE); 475 for (i = 0; i < WI_TIMEOUT; i++) { 476 if (CSR_READ_2(sc, WI_EVENT_STAT) & WI_EV_CMD) 477 break; 478 DELAY(1); 479 } 480 CSR_WRITE_2(sc, WI_EVENT_ACK, WI_EV_CMD); 481 482 CSR_WRITE_2(sc, WI_AUX_PAGE, WI_SBCF_PDIADDR / WI_AUX_PGSZ); 483 CSR_WRITE_2(sc, WI_AUX_OFFSET, WI_SBCF_PDIADDR % WI_AUX_PGSZ); 484 CSR_READ_MULTI_STREAM_2(sc, WI_AUX_DATA, 485 (u_int16_t *)ebuf, sizeof(ebuf) / 2); 486 if (GETLE16(ebuf) > sizeof(ebuf)) 487 return EIO; 488 if (wi_pcmcia_write_firm(sc, secsym, seclen, ebuf + 4, GETLE16(ebuf))) 489 return EIO; 490 return 0; 491 } 492 493 static int 494 wi_pcmcia_write_firm(sc, buf, buflen, ebuf, ebuflen) 495 struct wi_softc *sc; 496 const void *buf, *ebuf; 497 int buflen, ebuflen; 498 { 499 const u_int8_t *p, *ep, *q, *eq; 500 char *endp; 501 u_int32_t addr, id, eid; 502 int i, len, elen, nblk, pdrlen; 503 504 /* 505 * Parse the header of the firmware image. 506 */ 507 p = buf; 508 ep = p + buflen; 509 while (p < ep && *p++ != ' '); /* FILE: */ 510 while (p < ep && *p++ != ' '); /* filename */ 511 while (p < ep && *p++ != ' '); /* type of the firmware */ 512 nblk = strtoul(p, &endp, 10); 513 p = (void *)endp; 514 pdrlen = strtoul(p + 1, &endp, 10); 515 p = (void *)endp; 516 while (p < ep && *p++ != 0x1a); /* skip rest of header */ 517 518 /* 519 * Block records: address[4], length[2], data[length]; 520 */ 521 for (i = 0; i < nblk; i++) { 522 addr = GETLE32(p); p += 4; 523 len = GETLE16(p); p += 2; 524 CSR_WRITE_2(sc, WI_AUX_PAGE, addr / WI_AUX_PGSZ); 525 CSR_WRITE_2(sc, WI_AUX_OFFSET, addr % WI_AUX_PGSZ); 526 CSR_WRITE_MULTI_STREAM_2(sc, WI_AUX_DATA, 527 (const u_int16_t *)p, len / 2); 528 p += len; 529 } 530 531 /* 532 * PDR: id[4], address[4], length[4]; 533 */ 534 for (i = 0; i < pdrlen; ) { 535 id = GETLE32(p); p += 4; i += 4; 536 addr = GETLE32(p); p += 4; i += 4; 537 len = GETLE32(p); p += 4; i += 4; 538 /* replace PDR entry with the values from EEPROM, if any */ 539 for (q = ebuf, eq = q + ebuflen; q < eq; q += elen * 2) { 540 elen = GETLE16(q); q += 2; 541 eid = GETLE16(q); q += 2; 542 elen--; /* elen includes eid */ 543 if (eid == 0) 544 break; 545 if (eid != id) 546 continue; 547 CSR_WRITE_2(sc, WI_AUX_PAGE, addr / WI_AUX_PGSZ); 548 CSR_WRITE_2(sc, WI_AUX_OFFSET, addr % WI_AUX_PGSZ); 549 CSR_WRITE_MULTI_STREAM_2(sc, WI_AUX_DATA, 550 (const u_int16_t *)q, len / 2); 551 break; 552 } 553 } 554 return 0; 555 } 556 557 static int 558 wi_pcmcia_set_hcr(sc, mode) 559 struct wi_softc *sc; 560 int mode; 561 { 562 u_int16_t hcr; 563 564 CSR_WRITE_2(sc, WI_COR, WI_COR_RESET); 565 tsleep(sc, PWAIT, "wiinit", 1); 566 hcr = CSR_READ_2(sc, WI_HCR); 567 hcr = (hcr & WI_HCR_4WIRE) | (mode & ~WI_HCR_4WIRE); 568 CSR_WRITE_2(sc, WI_HCR, hcr); 569 tsleep(sc, PWAIT, "wiinit", 1); 570 CSR_WRITE_2(sc, WI_COR, WI_COR_IOMODE); 571 tsleep(sc, PWAIT, "wiinit", 1); 572 return 0; 573 } 574
Indexes created Mon Sep 29 21:09:56 GMT 2025