Aren
/
NetBSD
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
NetBSD/sys/dev/pcmcia/if_wi_pcmcia.c

648 lines
18 KiB
C
Raw Blame History

/* $NetBSD: if_wi_pcmcia.c,v 1.47 2004/08/07 17:18:09 mycroft Exp $ */
/*-
* Copyright (c) 2001 The NetBSD Foundation, Inc.
* All rights reserved.
*
* This code is derived from software contributed to The NetBSD Foundation
* by Ichiro FUKUHARA (ichiro@ichiro.org).
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by the NetBSD
* Foundation, Inc. and its contributors.
* 4. Neither the name of The NetBSD Foundation nor the names of its
* contributors may be used to endorse or promote products derived
* from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*/
/*
* PCMCIA attachment for Lucent & Intersil WaveLAN PCMCIA card
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: if_wi_pcmcia.c,v 1.47 2004/08/07 17:18:09 mycroft Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/callout.h>
#include <sys/device.h>
#include <sys/proc.h>
#include <sys/socket.h>
#include <net/if.h>
#include <net/if_ether.h>
#include <net/if_media.h>
#include <net80211/ieee80211_var.h>
#include <net80211/ieee80211_compat.h>
#include <net80211/ieee80211_radiotap.h>
#include <net80211/ieee80211_rssadapt.h>
#include <machine/cpu.h>
#include <machine/bus.h>
#include <machine/intr.h>
#include <dev/ic/wi_ieee.h>
#include <dev/ic/wireg.h>
#include <dev/ic/wivar.h>
#include <dev/pcmcia/pcmciareg.h>
#include <dev/pcmcia/pcmciavar.h>
#include <dev/pcmcia/pcmciadevs.h>
#include <dev/microcode/wi/spectrum24t_cf.h>
static int wi_pcmcia_match __P((struct device *, struct cfdata *, void *));
static void wi_pcmcia_attach __P((struct device *, struct device *, void *));
static int wi_pcmcia_detach __P((struct device *, int));
static int wi_pcmcia_enable __P((struct wi_softc *));
static void wi_pcmcia_disable __P((struct wi_softc *));
static void wi_pcmcia_powerhook __P((int, void *));
static void wi_pcmcia_shutdown __P((void *));
/* support to download firmware for symbol CF card */
static int wi_pcmcia_load_firm __P((struct wi_softc *, const void *, int, const void *, int));
static int wi_pcmcia_write_firm __P((struct wi_softc *, const void *, int, const void *, int));
static int wi_pcmcia_set_hcr __P((struct wi_softc *, int));
static const struct wi_pcmcia_product
*wi_pcmcia_lookup __P((struct pcmcia_attach_args *pa));
struct wi_pcmcia_softc {
struct wi_softc sc_wi;
/* PCMCIA-specific */
struct pcmcia_io_handle sc_pcioh; /* PCMCIA i/o space info */
int sc_io_window; /* our i/o window */
struct pcmcia_function *sc_pf; /* PCMCIA function */
void *sc_powerhook; /* power hook descriptor */
void *sc_sdhook; /* shutdown hook */
int sc_symbol_cf; /* Spectrum24t CF card */
};
static int wi_pcmcia_find __P((struct wi_pcmcia_softc *,
struct pcmcia_attach_args *, struct pcmcia_config_entry *));
CFATTACH_DECL(wi_pcmcia, sizeof(struct wi_pcmcia_softc),
wi_pcmcia_match, wi_pcmcia_attach, wi_pcmcia_detach, wi_activate);
static const struct wi_pcmcia_product {
u_int32_t pp_vendor; /* vendor ID */
u_int32_t pp_product; /* product ID */
const char *pp_cisinfo[4]; /* CIS information */
} wi_pcmcia_products[] = {
{ PCMCIA_VENDOR_INVALID, PCMCIA_PRODUCT_INVALID,
PCMCIA_CIS_SMC_2632W },
{ PCMCIA_VENDOR_INVALID, PCMCIA_PRODUCT_INVALID,
PCMCIA_CIS_NANOSPEED_PRISM2 },
{ PCMCIA_VENDOR_INVALID, PCMCIA_PRODUCT_INVALID,
PCMCIA_CIS_NEC_CMZ_RT_WP },
{ PCMCIA_VENDOR_INVALID, PCMCIA_PRODUCT_INVALID,
PCMCIA_CIS_NTT_ME_WLAN },
{ PCMCIA_VENDOR_LUCENT, PCMCIA_PRODUCT_LUCENT_HERMES,
PCMCIA_CIS_INVALID },
{ PCMCIA_VENDOR_LUCENT, PCMCIA_PRODUCT_LUCENT_HERMES2,
PCMCIA_CIS_INVALID },
{ PCMCIA_VENDOR_3COM, PCMCIA_PRODUCT_3COM_3CRWE737A,
PCMCIA_CIS_3COM_3CRWE737A },
{ PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_PCC_11,
PCMCIA_CIS_COREGA_WIRELESS_LAN_PCC_11 },
{ PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_PCCA_11,
PCMCIA_CIS_COREGA_WIRELESS_LAN_PCCA_11 },
{ PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_PCCB_11,
PCMCIA_CIS_COREGA_WIRELESS_LAN_PCCB_11 },
{ PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_PCCL_11,
PCMCIA_CIS_COREGA_WIRELESS_LAN_PCCL_11 },
{ PCMCIA_VENDOR_COREGA, PCMCIA_PRODUCT_COREGA_WIRELESS_LAN_WLCFL_11,
PCMCIA_CIS_COREGA_WIRELESS_LAN_WLCFL_11 },
{ PCMCIA_VENDOR_INTEL, PCMCIA_PRODUCT_INTEL_PRO_WLAN_2011,
PCMCIA_CIS_INTEL_PRO_WLAN_2011 },
{ PCMCIA_VENDOR_INTERSIL, PCMCIA_PRODUCT_INTERSIL_PRISM2,
PCMCIA_CIS_INTERSIL_PRISM2 },
{ PCMCIA_VENDOR_INTERSIL, PCMCIA_PRODUCT_GEMTEK_WLAN,
PCMCIA_CIS_GEMTEK_WLAN },
{ PCMCIA_VENDOR_SAMSUNG, PCMCIA_PRODUCT_SAMSUNG_SWL_2000N,
PCMCIA_CIS_SAMSUNG_SWL_2000N },
{ PCMCIA_VENDOR_ELSA, PCMCIA_PRODUCT_ELSA_XI300_IEEE,
PCMCIA_CIS_ELSA_XI300_IEEE },
{ PCMCIA_VENDOR_ELSA, PCMCIA_PRODUCT_ELSA_XI325_IEEE,
PCMCIA_CIS_ELSA_XI325_IEEE },
{ PCMCIA_VENDOR_ELSA, PCMCIA_PRODUCT_ELSA_XI800_IEEE,
PCMCIA_CIS_ELSA_XI800_IEEE },
{ PCMCIA_VENDOR_COMPAQ, PCMCIA_PRODUCT_COMPAQ_NC5004,
PCMCIA_CIS_COMPAQ_NC5004 },
{ PCMCIA_VENDOR_CONTEC, PCMCIA_PRODUCT_CONTEC_FX_DS110_PCC,
PCMCIA_CIS_CONTEC_FX_DS110_PCC },
{ PCMCIA_VENDOR_TDK, PCMCIA_PRODUCT_TDK_LAK_CD011WL,
PCMCIA_CIS_TDK_LAK_CD011WL },
{ PCMCIA_VENDOR_IODATA2, PCMCIA_PRODUCT_IODATA2_WNB11PCM,
PCMCIA_CIS_IODATA2_WNB11PCM },
{ PCMCIA_VENDOR_IODATA2, PCMCIA_PRODUCT_IODATA2_WCF12,
PCMCIA_CIS_IODATA2_WCF12 },
{ PCMCIA_VENDOR_BUFFALO, PCMCIA_PRODUCT_BUFFALO_WLI_PCM_S11,
PCMCIA_CIS_BUFFALO_WLI_PCM_S11 },
{ PCMCIA_VENDOR_BUFFALO, PCMCIA_PRODUCT_BUFFALO_WLI_CF_S11G,
PCMCIA_CIS_BUFFALO_WLI_CF_S11G },
{ PCMCIA_VENDOR_EMTAC, PCMCIA_PRODUCT_EMTAC_WLAN,
PCMCIA_CIS_EMTAC_WLAN },
{ PCMCIA_VENDOR_NETGEAR_2, PCMCIA_PRODUCT_NETGEAR_2_MA401,
PCMCIA_CIS_NETGEAR_2_MA401 },
{ PCMCIA_VENDOR_SIMPLETECH, PCMCIA_PRODUCT_SIMPLETECH_SPECTRUM24,
PCMCIA_CIS_SIMPLETECH_SPECTRUM24 },
{ PCMCIA_VENDOR_ERICSSON, PCMCIA_PRODUCT_ERICSSON_WIRELESSLAN,
PCMCIA_CIS_ERICSSON_WIRELESSLAN },
{ PCMCIA_VENDOR_SYMBOL, PCMCIA_PRODUCT_SYMBOL_LA4100,
PCMCIA_CIS_SYMBOL_LA4100 },
{ PCMCIA_VENDOR_LINKSYS2, PCMCIA_PRODUCT_LINKSYS2_IWN,
PCMCIA_CIS_NANOSPEED_PRISM2 },
{ PCMCIA_VENDOR_LINKSYS2, PCMCIA_PRODUCT_LINKSYS2_IWN3,
PCMCIA_CIS_LINKSYS2_IWN3 },
{ PCMCIA_VENDOR_LINKSYS2, PCMCIA_PRODUCT_LINKSYS2_WCF11,
PCMCIA_CIS_LINKSYS2_WCF11 },
{ PCMCIA_VENDOR_PLANEX, PCMCIA_PRODUCT_PLANEX_GWNS11H,
PCMCIA_CIS_PLANEX_GWNS11H },
{ PCMCIA_VENDOR_BAY, PCMCIA_PRODUCT_BAY_EMOBILITY_11B,
PCMCIA_CIS_BAY_EMOBILITY_11B },
{ PCMCIA_VENDOR_ACTIONTEC, PCMCIA_PRODUCT_ACTIONTEC_PRISM,
PCMCIA_CIS_ACTIONTEC_PRISM },
{ PCMCIA_VENDOR_DLINK_2, PCMCIA_PRODUCT_DLINK_DWL650H,
PCMCIA_CIS_DLINK_DWL650H },
{ PCMCIA_VENDOR_FUJITSU, PCMCIA_PRODUCT_FUJITSU_WL110,
PCMCIA_CIS_FUJITSU_WL110 },
{ PCMCIA_VENDOR_ARTEM, PCMCIA_PRODUCT_ARTEM_ONAIR,
PCMCIA_CIS_ARTEM_ONAIR },
{ PCMCIA_VENDOR_ASUSTEK, PCMCIA_PRODUCT_ASUSTEK_WL_100,
PCMCIA_CIS_ASUSTEK_WL_100 },
};
static const struct wi_pcmcia_product *
wi_pcmcia_lookup(pa)
struct pcmcia_attach_args *pa;
{
const struct wi_pcmcia_product *pp;
int n;
/* match by CIS information */
for (pp = wi_pcmcia_products,
n = sizeof(wi_pcmcia_products) / sizeof(wi_pcmcia_products[0]);
n; pp++, n--) {
if (pa->card->cis1_info[0] != NULL &&
pp->pp_cisinfo[0] != NULL &&
strcmp(pa->card->cis1_info[0], pp->pp_cisinfo[0]) == 0 &&
pa->card->cis1_info[1] != NULL &&
pp->pp_cisinfo[1] != NULL &&
strcmp(pa->card->cis1_info[1], pp->pp_cisinfo[1]) == 0)
return pp;
if (pa->manufacturer != PCMCIA_VENDOR_INVALID &&
pa->manufacturer == pp->pp_vendor &&
pa->product != PCMCIA_PRODUCT_INVALID &&
pa->product == pp->pp_product)
return pp;
}
return (NULL);
}
static int
wi_pcmcia_match(parent, match, aux)
struct device *parent;
struct cfdata *match;
void *aux;
{
struct pcmcia_attach_args *pa = aux;
if (wi_pcmcia_lookup(pa) != NULL)
return (1);
return (0);
}
static int
wi_pcmcia_enable(sc)
struct wi_softc *sc;
{
struct wi_pcmcia_softc *psc = (struct wi_pcmcia_softc *)sc;
struct pcmcia_function *pf = psc->sc_pf;
/* establish the interrupt. */
sc->sc_ih = pcmcia_intr_establish(pf, IPL_NET, wi_intr, sc);
if (sc->sc_ih == NULL) {
printf("%s: couldn't establish interrupt\n",
sc->sc_dev.dv_xname);
return (EIO);
}
if (pcmcia_function_enable(pf) != 0) {
printf("%s: couldn't enable card\n", sc->sc_dev.dv_xname);
pcmcia_intr_disestablish(pf, sc->sc_ih);
return (EIO);
}
DELAY(1000);
if (psc->sc_symbol_cf) {
if (wi_pcmcia_load_firm(sc,
spectrum24t_primsym, sizeof(spectrum24t_primsym),
spectrum24t_secsym, sizeof(spectrum24t_secsym))) {
printf("%s: couldn't load firmware\n",
sc->sc_dev.dv_xname);
wi_pcmcia_disable(sc);
return (EIO);
}
}
return (0);
}
static void
wi_pcmcia_disable(sc)
struct wi_softc *sc;
{
struct wi_pcmcia_softc *psc = (struct wi_pcmcia_softc *)sc;
pcmcia_intr_disestablish(psc->sc_pf, sc->sc_ih);
pcmcia_function_disable(psc->sc_pf);
}
static int
wi_pcmcia_find(psc, pa, cfe)
struct wi_pcmcia_softc *psc;
struct pcmcia_attach_args *pa;
struct pcmcia_config_entry *cfe;
{
struct wi_softc *sc = &psc->sc_wi;
/* Allocate/map I/O space. */
if (pcmcia_io_alloc(psc->sc_pf, cfe->iospace[0].start,
cfe->iospace[0].length, WI_IOSIZE, &psc->sc_pcioh) != 0) {
printf("%s: can't allocate i/o space\n", sc->sc_dev.dv_xname);
goto fail1;
}
if (pcmcia_io_map(psc->sc_pf, PCMCIA_WIDTH_AUTO, 0,
psc->sc_pcioh.size, &psc->sc_pcioh, &psc->sc_io_window) != 0) {
printf("%s: can't map i/o space\n", sc->sc_dev.dv_xname);
goto fail2;
}
/* Enable the card */
pcmcia_function_init(psc->sc_pf, cfe);
if (pcmcia_function_enable(psc->sc_pf)) {
printf("%s: function enable failed\n", sc->sc_dev.dv_xname);
goto fail3;
}
sc->sc_iot = psc->sc_pcioh.iot;
sc->sc_ioh = psc->sc_pcioh.ioh;
DELAY(1000);
return(0);
fail3:
pcmcia_io_unmap(psc->sc_pf, psc->sc_io_window);
fail2:
pcmcia_io_free(psc->sc_pf, &psc->sc_pcioh);
fail1:
psc->sc_io_window = -1;
return(1);
}
static void
wi_pcmcia_attach(parent, self, aux)
struct device *parent, *self;
void *aux;
{
struct wi_pcmcia_softc *psc = (void *)self;
struct wi_softc *sc = &psc->sc_wi;
const struct wi_pcmcia_product *pp;
struct pcmcia_attach_args *pa = aux;
struct pcmcia_config_entry *cfe;
int haveaddr;
aprint_normal("\n");
psc->sc_pf = pa->pf;
SIMPLEQ_FOREACH(cfe, &pa->pf->cfe_head, cfe_list) {
if (cfe->iftype != PCMCIA_IFTYPE_IO)
continue;
if (cfe->iospace[0].length < WI_IOSIZE)
continue;
if (wi_pcmcia_find(psc, pa, cfe) == 0)
break;
}
if (cfe == NULL) {
aprint_error("%s: no suitable CIS info found\n", self->dv_xname);
goto no_config_entry;
}
pp = wi_pcmcia_lookup(pa);
if (pp == NULL)
panic("wi_pcmcia_attach: impossible");
sc->sc_pci = 0;
sc->sc_enabled = 1;
sc->sc_enable = wi_pcmcia_enable;
sc->sc_disable = wi_pcmcia_disable;
if (pp->pp_vendor == PCMCIA_VENDOR_SYMBOL &&
pp->pp_product == PCMCIA_PRODUCT_SYMBOL_LA4100)
psc->sc_symbol_cf = 1;
/*
* XXX: Sony PEGA-WL100 CF card has a same vendor/product id as
* Intel PCMCIA card. It may be incorrect to detect by the
* initial value of COR register.
*/
if (pp->pp_vendor == PCMCIA_VENDOR_INTEL &&
pp->pp_product == PCMCIA_PRODUCT_INTEL_PRO_WLAN_2011 &&
CSR_READ_2(sc, WI_COR) == WI_COR_IOMODE)
psc->sc_symbol_cf = 1;
if (psc->sc_symbol_cf) {
if (wi_pcmcia_load_firm(sc,
spectrum24t_primsym, sizeof(spectrum24t_primsym),
spectrum24t_secsym, sizeof(spectrum24t_secsym))) {
aprint_error("%s: couldn't load firmware\n",
self->dv_xname);
goto no_interrupt;
}
}
/* establish the interrupt. */
sc->sc_ih = pcmcia_intr_establish(psc->sc_pf, IPL_NET, wi_intr, sc);
if (sc->sc_ih == NULL) {
aprint_error("%s: couldn't establish interrupt\n", self->dv_xname);
goto no_interrupt;
}
printf("%s:", self->dv_xname);
haveaddr = pa->pf->pf_funce_lan_nidlen == IEEE80211_ADDR_LEN;
if (wi_attach(sc, haveaddr ? pa->pf->pf_funce_lan_nid : 0) != 0) {
aprint_error("%s: failed to attach controller\n", self->dv_xname);
goto attach_failed;
}
psc->sc_sdhook = shutdownhook_establish(wi_pcmcia_shutdown, psc);
psc->sc_powerhook = powerhook_establish(wi_pcmcia_powerhook, psc);
/* disable the card */
sc->sc_enabled = 0;
wi_pcmcia_disable(sc);
return;
attach_failed:
pcmcia_intr_disestablish(psc->sc_pf, sc->sc_ih);
no_interrupt:
pcmcia_function_disable(psc->sc_pf);
pcmcia_io_unmap(psc->sc_pf, psc->sc_io_window);
pcmcia_io_free(psc->sc_pf, &psc->sc_pcioh);
no_config_entry:
psc->sc_io_window = -1;
}
static int
wi_pcmcia_detach(self, flags)
struct device *self;
int flags;
{
struct wi_pcmcia_softc *psc = (struct wi_pcmcia_softc *)self;
int error;
if (psc->sc_io_window == -1)
/* Nothing to detach. */
return (0);
if (psc->sc_powerhook != NULL)
powerhook_disestablish(psc->sc_powerhook);
if (psc->sc_sdhook != NULL)
shutdownhook_disestablish(psc->sc_sdhook);
error = wi_detach(&psc->sc_wi);
if (error != 0)
return (error);
/* Unmap our i/o window. */
pcmcia_io_unmap(psc->sc_pf, psc->sc_io_window);
/* Free our i/o space. */
pcmcia_io_free(psc->sc_pf, &psc->sc_pcioh);
return (0);
}
static void
wi_pcmcia_powerhook(why, arg)
int why;
void *arg;
{
struct wi_pcmcia_softc *psc = arg;
struct wi_softc *sc = &psc->sc_wi;
wi_power(sc, why);
}
static void
wi_pcmcia_shutdown(arg)
void *arg;
{
struct wi_pcmcia_softc *psc = arg;
struct wi_softc *sc = &psc->sc_wi;
wi_shutdown(sc);
}
/*
* Special routines to download firmware for Symbol CF card.
* XXX: This should be modified generic into any PRISM-2 based card.
*/
#define WI_SBCF_PDIADDR 0x3100
/* unaligned load little endian */
#define GETLE32(p) ((p)[0] | ((p)[1]<<8) | ((p)[2]<<16) | ((p)[3]<<24))
#define GETLE16(p) ((p)[0] | ((p)[1]<<8))
static int
wi_pcmcia_load_firm(sc, primsym, primlen, secsym, seclen)
struct wi_softc *sc;
const void *primsym, *secsym;
int primlen, seclen;
{
u_int8_t ebuf[256];
int i;
/* load primary code and run it */
wi_pcmcia_set_hcr(sc, WI_HCR_EEHOLD);
if (wi_pcmcia_write_firm(sc, primsym, primlen, NULL, 0))
return EIO;
wi_pcmcia_set_hcr(sc, WI_HCR_RUN);
for (i = 0; ; i++) {
if (i == 10)
return ETIMEDOUT;
tsleep(sc, PWAIT, "wiinit", 1);
if (CSR_READ_2(sc, WI_CNTL) == WI_CNTL_AUX_ENA_STAT)
break;
/* write the magic key value to unlock aux port */
CSR_WRITE_2(sc, WI_PARAM0, WI_AUX_KEY0);
CSR_WRITE_2(sc, WI_PARAM1, WI_AUX_KEY1);
CSR_WRITE_2(sc, WI_PARAM2, WI_AUX_KEY2);
CSR_WRITE_2(sc, WI_CNTL, WI_CNTL_AUX_ENA_CNTL);
}
/* issue read EEPROM command: XXX copied from wi_cmd() */
CSR_WRITE_2(sc, WI_PARAM0, 0);
CSR_WRITE_2(sc, WI_PARAM1, 0);
CSR_WRITE_2(sc, WI_PARAM2, 0);
CSR_WRITE_2(sc, WI_COMMAND, WI_CMD_READEE);
for (i = 0; i < WI_TIMEOUT; i++) {
if (CSR_READ_2(sc, WI_EVENT_STAT) & WI_EV_CMD)
break;
DELAY(1);
}
CSR_WRITE_2(sc, WI_EVENT_ACK, WI_EV_CMD);
CSR_WRITE_2(sc, WI_AUX_PAGE, WI_SBCF_PDIADDR / WI_AUX_PGSZ);
CSR_WRITE_2(sc, WI_AUX_OFFSET, WI_SBCF_PDIADDR % WI_AUX_PGSZ);
CSR_READ_MULTI_STREAM_2(sc, WI_AUX_DATA,
(u_int16_t *)ebuf, sizeof(ebuf) / 2);
if (GETLE16(ebuf) > sizeof(ebuf))
return EIO;
if (wi_pcmcia_write_firm(sc, secsym, seclen, ebuf + 4, GETLE16(ebuf)))
return EIO;
return 0;
}
static int
wi_pcmcia_write_firm(sc, buf, buflen, ebuf, ebuflen)
struct wi_softc *sc;
const void *buf, *ebuf;
int buflen, ebuflen;
{
const u_int8_t *p, *ep, *q, *eq;
u_int32_t addr, id, eid;
int i, len, elen, nblk, pdrlen;
/*
* Parse the header of the firmware image.
*/
p = buf;
ep = p + buflen;
while (p < ep && *p++ != ' '); /* FILE: */
while (p < ep && *p++ != ' '); /* filename */
while (p < ep && *p++ != ' '); /* type of the firmware */
nblk = strtoul(p, (void *)&p, 10);
pdrlen = strtoul(p + 1, (void *)&p, 10);
while (p < ep && *p++ != 0x1a); /* skip rest of header */
/*
* Block records: address[4], length[2], data[length];
*/
for (i = 0; i < nblk; i++) {
addr = GETLE32(p); p += 4;
len = GETLE16(p); p += 2;
CSR_WRITE_2(sc, WI_AUX_PAGE, addr / WI_AUX_PGSZ);
CSR_WRITE_2(sc, WI_AUX_OFFSET, addr % WI_AUX_PGSZ);
CSR_WRITE_MULTI_STREAM_2(sc, WI_AUX_DATA,
(const u_int16_t *)p, len / 2);
p += len;
}
/*
* PDR: id[4], address[4], length[4];
*/
for (i = 0; i < pdrlen; ) {
id = GETLE32(p); p += 4; i += 4;
addr = GETLE32(p); p += 4; i += 4;
len = GETLE32(p); p += 4; i += 4;
/* replace PDR entry with the values from EEPROM, if any */
for (q = ebuf, eq = q + ebuflen; q < eq; q += elen * 2) {
elen = GETLE16(q); q += 2;
eid = GETLE16(q); q += 2;
elen--; /* elen includes eid */
if (eid == 0)
break;
if (eid != id)
continue;
CSR_WRITE_2(sc, WI_AUX_PAGE, addr / WI_AUX_PGSZ);
CSR_WRITE_2(sc, WI_AUX_OFFSET, addr % WI_AUX_PGSZ);
CSR_WRITE_MULTI_STREAM_2(sc, WI_AUX_DATA,
(const u_int16_t *)q, len / 2);
break;
}
}
return 0;
}
static int
wi_pcmcia_set_hcr(sc, mode)
struct wi_softc *sc;
int mode;
{
u_int16_t hcr;
CSR_WRITE_2(sc, WI_COR, WI_COR_RESET);
tsleep(sc, PWAIT, "wiinit", 1);
hcr = CSR_READ_2(sc, WI_HCR);
hcr = (hcr & WI_HCR_4WIRE) | (mode & ~WI_HCR_4WIRE);
CSR_WRITE_2(sc, WI_HCR, hcr);
tsleep(sc, PWAIT, "wiinit", 1);
CSR_WRITE_2(sc, WI_COR, WI_COR_IOMODE);
tsleep(sc, PWAIT, "wiinit", 1);
return 0;
}
Reference in New Issue View Git Blame Copy Permalink