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