NetBSD/sys/dev/pcmcia/mhzc.c
christos 097e6576ea - add const
- avoid variable shadow
- do proper UNCONST with XXXUNCONST
2005-05-30 04:28:49 +00:00

810 lines
19 KiB
C

/* $NetBSD: mhzc.c,v 1.32 2005/05/30 04:28:49 christos Exp $ */
/*-
* Copyright (c) 1999, 2000, 2004 The NetBSD Foundation, Inc.
* All rights reserved.
*
* This code is derived from software contributed to The NetBSD Foundation
* by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
* NASA Ames Research Center, and by Charles M. Hannum.
*
* 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.
*/
/*
* Device driver for the Megaherz X-JACK Ethernet/Modem combo cards.
*
* Many thanks to Chuck Cranor for having the patience to sift through
* the Linux smc91c92_cs.c driver to find the magic details to get this
* working!
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: mhzc.c,v 1.32 2005/05/30 04:28:49 christos Exp $");
#include "opt_inet.h"
#include "opt_ns.h"
#include "bpfilter.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/ioctl.h>
#include <sys/errno.h>
#include <sys/syslog.h>
#include <sys/select.h>
#include <sys/tty.h>
#include <sys/device.h>
#include <sys/kernel.h>
#include <sys/proc.h>
#include <net/if.h>
#include <net/if_dl.h>
#include <net/if_ether.h>
#include <net/if_media.h>
#ifdef INET
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <netinet/in_var.h>
#include <netinet/ip.h>
#include <netinet/if_inarp.h>
#endif
#ifdef NS
#include <netns/ns.h>
#include <netns/ns_if.h>
#endif
#if NBPFILTER > 0
#include <net/bpf.h>
#include <net/bpfdesc.h>
#endif
#include <machine/intr.h>
#include <machine/bus.h>
#include <dev/ic/comreg.h>
#include <dev/ic/comvar.h>
#include <dev/mii/mii.h>
#include <dev/mii/miivar.h>
#include <dev/ic/smc91cxxreg.h>
#include <dev/ic/smc91cxxvar.h>
#include <dev/pcmcia/pcmciareg.h>
#include <dev/pcmcia/pcmciavar.h>
#include <dev/pcmcia/pcmciadevs.h>
#include "mhzc.h"
struct mhzc_softc {
struct device sc_dev; /* generic device glue */
struct pcmcia_function *sc_pf; /* our PCMCIA function */
void *sc_ih; /* interrupt handle */
const struct mhzc_product *sc_product;
/*
* Data for the Modem portion.
*/
struct device *sc_modem;
struct pcmcia_io_handle sc_modem_pcioh;
int sc_modem_io_window;
/*
* Data for the Ethernet portion.
*/
struct device *sc_ethernet;
struct pcmcia_io_handle sc_ethernet_pcioh;
int sc_ethernet_io_window;
int sc_flags;
};
/* sc_flags */
#define MHZC_MODEM_MAPPED 0x01
#define MHZC_ETHERNET_MAPPED 0x02
#define MHZC_MODEM_ENABLED 0x04
#define MHZC_ETHERNET_ENABLED 0x08
#define MHZC_MODEM_ALLOCED 0x10
#define MHZC_ETHERNET_ALLOCED 0x20
int mhzc_match(struct device *, struct cfdata *, void *);
void mhzc_attach(struct device *, struct device *, void *);
int mhzc_detach(struct device *, int);
int mhzc_activate(struct device *, enum devact);
CFATTACH_DECL(mhzc, sizeof(struct mhzc_softc),
mhzc_match, mhzc_attach, mhzc_detach, mhzc_activate);
int mhzc_em3336_enaddr(struct mhzc_softc *, u_int8_t *);
int mhzc_em3336_enable(struct mhzc_softc *);
const struct mhzc_product {
struct pcmcia_product mp_product;
/* Get the Ethernet address for this card. */
int (*mp_enaddr)(struct mhzc_softc *, u_int8_t *);
/* Perform any special `enable' magic. */
int (*mp_enable)(struct mhzc_softc *);
} mhzc_products[] = {
{ { PCMCIA_VENDOR_MEGAHERTZ, PCMCIA_PRODUCT_MEGAHERTZ_EM3336,
PCMCIA_CIS_INVALID },
mhzc_em3336_enaddr, mhzc_em3336_enable },
};
static const size_t mhzc_nproducts =
sizeof(mhzc_products) / sizeof(mhzc_products[0]);
int mhzc_print(void *, const char *);
int mhzc_check_cfe(struct mhzc_softc *, struct pcmcia_config_entry *);
int mhzc_alloc_ethernet(struct mhzc_softc *, struct pcmcia_config_entry *);
int mhzc_enable(struct mhzc_softc *, int);
void mhzc_disable(struct mhzc_softc *, int);
int mhzc_intr(void *);
int
mhzc_match(parent, match, aux)
struct device *parent;
struct cfdata *match;
void *aux;
{
struct pcmcia_attach_args *pa = aux;
if (pcmcia_product_lookup(pa, mhzc_products, mhzc_nproducts,
sizeof(mhzc_products[0]), NULL))
return (2); /* beat `com' */
return (0);
}
void
mhzc_attach(parent, self, aux)
struct device *parent, *self;
void *aux;
{
struct mhzc_softc *sc = (void *)self;
struct pcmcia_attach_args *pa = aux;
struct pcmcia_config_entry *cfe;
int error;
sc->sc_pf = pa->pf;
sc->sc_product = pcmcia_product_lookup(pa, mhzc_products,
mhzc_nproducts, sizeof(mhzc_products[0]), NULL);
if (!sc->sc_product)
panic("mhzc_attach: impossible");
/*
* The address decoders on these cards are wacky. The configuration
* entries are set up to look like serial ports, and have no
* information about the Ethernet portion. In order to talk to
* the Modem portion, the I/O address must have bit 0x80 set.
* In order to talk to the Ethernet portion, the I/O address must
* have the 0x80 bit clear.
*
* The standard configuration entries conveniently have 0x80 set
* in them, and have a length of 8 (a 16550's size, convenient!),
* so we use those to set up the Modem portion.
*
* Once we have the Modem's address established, we search for
* an address suitable for the Ethernet portion. We do this by
* rounding up to the next 16-byte aligned address where 0x80
* isn't set (the SMC Ethernet chip has a 16-byte address size)
* and attemping to allocate a 16-byte region until we succeed.
*
* Sure would have been nice if Megahertz had made the card a
* proper multi-function device.
*/
SIMPLEQ_FOREACH(cfe, &pa->pf->cfe_head, cfe_list) {
if (mhzc_check_cfe(sc, cfe)) {
/* Found one! */
break;
}
}
if (cfe == NULL) {
aprint_error("%s: unable to find suitable config table entry\n",
self->dv_xname);
goto fail;
}
if (mhzc_alloc_ethernet(sc, cfe) == 0) {
aprint_error("%s: unable to allocate space for Ethernet portion\n",
self->dv_xname);
goto fail;
}
/* Enable the card. */
pcmcia_function_init(pa->pf, cfe);
if (pcmcia_io_map(sc->sc_pf, PCMCIA_WIDTH_IO8, &sc->sc_modem_pcioh,
&sc->sc_modem_io_window)) {
aprint_error("%s: unable to map I/O space\n",
sc->sc_dev.dv_xname);
goto fail;
}
sc->sc_flags |= MHZC_MODEM_MAPPED;
if (pcmcia_io_map(sc->sc_pf, PCMCIA_WIDTH_AUTO, &sc->sc_ethernet_pcioh,
&sc->sc_ethernet_io_window)) {
aprint_error("%s: unable to map I/O space\n",
sc->sc_dev.dv_xname);
goto fail;
}
sc->sc_flags |= MHZC_ETHERNET_MAPPED;
error = mhzc_enable(sc, MHZC_MODEM_ENABLED|MHZC_ETHERNET_ENABLED);
if (error)
goto fail;
/*XXXUNCONST*/
sc->sc_modem = config_found(self, __UNCONST("com"), mhzc_print);
/*XXXUNCONST*/
sc->sc_ethernet = config_found(self, __UNCONST("sm"), mhzc_print);
mhzc_disable(sc, MHZC_MODEM_ENABLED|MHZC_ETHERNET_ENABLED);
return;
fail:
/* I/O spaces will be freed by detach. */
;
}
int
mhzc_check_cfe(sc, cfe)
struct mhzc_softc *sc;
struct pcmcia_config_entry *cfe;
{
if (cfe->num_memspace != 0)
return (0);
if (cfe->num_iospace != 1)
return (0);
if (pcmcia_io_alloc(sc->sc_pf,
cfe->iospace[0].start,
cfe->iospace[0].length,
cfe->iospace[0].length,
&sc->sc_modem_pcioh) == 0) {
/* Found one for the modem! */
sc->sc_flags |= MHZC_MODEM_ALLOCED;
return (1);
}
return (0);
}
int
mhzc_alloc_ethernet(sc, cfe)
struct mhzc_softc *sc;
struct pcmcia_config_entry *cfe;
{
bus_addr_t addr, maxaddr;
addr = cfe->iospace[0].start + cfe->iospace[0].length;
maxaddr = 0x1000;
/*
* Now round it up so that it starts on a 16-byte boundary.
*/
addr = roundup(addr, 0x10);
for (; (addr + 0x10) < maxaddr; addr += 0x10) {
if (addr & 0x80)
continue;
if (pcmcia_io_alloc(sc->sc_pf, addr, 0x10, 0x10,
&sc->sc_ethernet_pcioh) == 0) {
/* Found one for the ethernet! */
sc->sc_flags |= MHZC_ETHERNET_ALLOCED;
return (1);
}
}
return (0);
}
int
mhzc_print(aux, pnp)
void *aux;
const char *pnp;
{
const char *name = aux;
if (pnp)
aprint_normal("%s at %s(*)", name, pnp);
return (UNCONF);
}
int
mhzc_detach(self, flags)
struct device *self;
int flags;
{
struct mhzc_softc *sc = (void *)self;
int rv;
if (sc->sc_ethernet != NULL) {
rv = config_detach(sc->sc_ethernet, flags);
if (rv != 0)
return (rv);
sc->sc_ethernet = NULL;
}
if (sc->sc_modem != NULL) {
rv = config_detach(sc->sc_modem, flags);
if (rv != 0)
return (rv);
sc->sc_modem = NULL;
}
/* Unmap our i/o windows. */
if (sc->sc_flags & MHZC_MODEM_MAPPED)
pcmcia_io_unmap(sc->sc_pf, sc->sc_modem_io_window);
if (sc->sc_flags & MHZC_ETHERNET_MAPPED)
pcmcia_io_unmap(sc->sc_pf, sc->sc_ethernet_io_window);
/* Free our i/o spaces. */
if (sc->sc_flags & MHZC_ETHERNET_ALLOCED)
pcmcia_io_free(sc->sc_pf, &sc->sc_modem_pcioh);
if (sc->sc_flags & MHZC_MODEM_ALLOCED)
pcmcia_io_free(sc->sc_pf, &sc->sc_ethernet_pcioh);
sc->sc_flags = 0;
return (0);
}
int
mhzc_activate(self, act)
struct device *self;
enum devact act;
{
struct mhzc_softc *sc = (void *)self;
int s, rv = 0;
s = splhigh();
switch (act) {
case DVACT_ACTIVATE:
rv = EOPNOTSUPP;
break;
case DVACT_DEACTIVATE:
if (sc->sc_ethernet != NULL) {
rv = config_deactivate(sc->sc_ethernet);
if (rv != 0)
goto out;
}
if (sc->sc_modem != NULL) {
rv = config_deactivate(sc->sc_modem);
if (rv != 0)
goto out;
}
break;
}
out:
splx(s);
return (rv);
}
int
mhzc_intr(arg)
void *arg;
{
struct mhzc_softc *sc = arg;
int rval = 0;
#if NCOM_MHZC > 0
if (sc->sc_modem != NULL &&
(sc->sc_flags & MHZC_MODEM_ENABLED) != 0)
rval |= comintr(sc->sc_modem);
#endif
#if NSM_MHZC > 0
if (sc->sc_ethernet != NULL &&
(sc->sc_flags & MHZC_ETHERNET_ENABLED) != 0)
rval |= smc91cxx_intr(sc->sc_ethernet);
#endif
return (rval);
}
int
mhzc_enable(sc, flag)
struct mhzc_softc *sc;
int flag;
{
int error;
if ((sc->sc_flags & flag) == flag) {
printf("%s: already enabled\n", sc->sc_dev.dv_xname);
return (0);
}
if ((sc->sc_flags & (MHZC_MODEM_ENABLED|MHZC_ETHERNET_ENABLED)) != 0) {
sc->sc_flags |= flag;
return (0);
}
/*
* Establish our interrupt handler.
*
* XXX Note, we establish this at IPL_NET. This is suboptimal
* XXX the Modem portion, but is necessary to make the Ethernet
* XXX portion have the correct interrupt level semantics.
*
* XXX Eventually we should use the `enabled' bits in the
* XXX flags word to determine which level we should be at.
*/
sc->sc_ih = pcmcia_intr_establish(sc->sc_pf, IPL_NET,
mhzc_intr, sc);
if (!sc->sc_ih)
return (EIO);
error = pcmcia_function_enable(sc->sc_pf);
if (error) {
pcmcia_intr_disestablish(sc->sc_pf, sc->sc_ih);
sc->sc_ih = 0;
return (error);
}
/*
* Perform any special enable magic necessary.
*/
if (sc->sc_product->mp_enable != NULL &&
(*sc->sc_product->mp_enable)(sc) != 0) {
pcmcia_function_disable(sc->sc_pf);
pcmcia_intr_disestablish(sc->sc_pf, sc->sc_ih);
return (1);
}
sc->sc_flags |= flag;
return (0);
}
void
mhzc_disable(sc, flag)
struct mhzc_softc *sc;
int flag;
{
if ((sc->sc_flags & flag) == 0) {
printf("%s: already disabled\n", sc->sc_dev.dv_xname);
return;
}
sc->sc_flags &= ~flag;
if ((sc->sc_flags & (MHZC_MODEM_ENABLED|MHZC_ETHERNET_ENABLED)) != 0)
return;
pcmcia_function_disable(sc->sc_pf);
pcmcia_intr_disestablish(sc->sc_pf, sc->sc_ih);
sc->sc_ih = 0;
}
/*****************************************************************************
* Megahertz EM3336 (and compatibles) support
*****************************************************************************/
int mhzc_em3336_lannid_ciscallback(struct pcmcia_tuple *, void *);
int mhzc_em3336_ascii_enaddr(const char *cisstr, u_int8_t *);
int
mhzc_em3336_enaddr(sc, myla)
struct mhzc_softc *sc;
u_int8_t *myla;
{
/* Get the station address from CIS tuple 0x81. */
if (pcmcia_scan_cis(sc->sc_dev.dv_parent,
mhzc_em3336_lannid_ciscallback, myla) != 1) {
printf("%s: unable to get Ethernet address from CIS\n",
sc->sc_dev.dv_xname);
return (0);
}
return (1);
}
int
mhzc_em3336_enable(sc)
struct mhzc_softc *sc;
{
struct pcmcia_mem_handle memh;
bus_addr_t memoff;
int memwin, reg;
/*
* Bring the chip to live by touching its registers in the correct
* way (as per my reference... the Linux smc91c92_cs.c driver by
* David A. Hinds).
*/
/* Map the ISRPOWEREG. */
if (pcmcia_mem_alloc(sc->sc_pf, 0x1000, &memh) != 0) {
printf("%s: unable to allocate memory space\n",
sc->sc_dev.dv_xname);
return (1);
}
if (pcmcia_mem_map(sc->sc_pf, PCMCIA_MEM_ATTR, 0, 0x1000,
&memh, &memoff, &memwin)) {
printf("%s: unable to map memory space\n",
sc->sc_dev.dv_xname);
pcmcia_mem_free(sc->sc_pf, &memh);
return (1);
}
/*
* The magic sequence:
*
* - read/write the CCR option register.
* - read the ISRPOWEREG 2 times.
* - read/write the CCR option register again.
*/
reg = pcmcia_ccr_read(sc->sc_pf, PCMCIA_CCR_OPTION);
pcmcia_ccr_write(sc->sc_pf, PCMCIA_CCR_OPTION, reg);
reg = bus_space_read_1(memh.memt, memh.memh, 0x380);
delay(5);
reg = bus_space_read_1(memh.memt, memh.memh, 0x380);
tsleep(&mhzc_em3336_enable, PWAIT, "mhz3en", hz * 200 / 1000);
reg = pcmcia_ccr_read(sc->sc_pf, PCMCIA_CCR_OPTION);
delay(5);
pcmcia_ccr_write(sc->sc_pf, PCMCIA_CCR_OPTION, reg);
pcmcia_mem_unmap(sc->sc_pf, memwin);
pcmcia_mem_free(sc->sc_pf, &memh);
return (0);
}
int
mhzc_em3336_lannid_ciscallback(tuple, arg)
struct pcmcia_tuple *tuple;
void *arg;
{
u_int8_t *myla = arg, addr_str[ETHER_ADDR_LEN * 2];
int i;
if (tuple->code == 0x81) {
/*
* We have a string-encoded address. Length includes
* terminating 0xff.
*/
if (tuple->length != (ETHER_ADDR_LEN * 2) + 1)
return (0);
for (i = 0; i < tuple->length - 1; i++)
addr_str[i] = pcmcia_tuple_read_1(tuple, i);
/*
* Decode the string into `myla'.
*/
return (mhzc_em3336_ascii_enaddr(addr_str, myla));
}
return (0);
}
/* XXX This should be shared w/ if_sm_pcmcia.c */
int
mhzc_em3336_ascii_enaddr(cisstr, myla)
const char *cisstr;
u_int8_t *myla;
{
u_int8_t digit;
int i;
memset(myla, 0, ETHER_ADDR_LEN);
for (i = 0, digit = 0; i < (ETHER_ADDR_LEN * 2); i++) {
if (cisstr[i] >= '0' && cisstr[i] <= '9')
digit |= cisstr[i] - '0';
else if (cisstr[i] >= 'a' && cisstr[i] <= 'f')
digit |= (cisstr[i] - 'a') + 10;
else if (cisstr[i] >= 'A' && cisstr[i] <= 'F')
digit |= (cisstr[i] - 'A') + 10;
else {
/* Bogus digit!! */
return (0);
}
/* Compensate for ordering of digits. */
if (i & 1) {
myla[i >> 1] = digit;
digit = 0;
} else
digit <<= 4;
}
return (1);
}
/****** Here begins the com attachment code. ******/
#if NCOM_MHZC > 0
int com_mhzc_match(struct device *, struct cfdata *, void *);
void com_mhzc_attach(struct device *, struct device *, void *);
int com_mhzc_detach(struct device *, int);
/* No mhzc-specific goo in the softc; it's all in the parent. */
CFATTACH_DECL(com_mhzc, sizeof(struct com_softc),
com_mhzc_match, com_mhzc_attach, com_detach, com_activate);
int com_mhzc_enable(struct com_softc *);
void com_mhzc_disable(struct com_softc *);
int
com_mhzc_match(parent, match, aux)
struct device *parent;
struct cfdata *match;
void *aux;
{
extern struct cfdriver com_cd;
const char *name = aux;
/* Device is always present. */
if (strcmp(name, com_cd.cd_name) == 0)
return (1);
return (0);
}
void
com_mhzc_attach(parent, self, aux)
struct device *parent, *self;
void *aux;
{
struct com_softc *sc = (void *)self;
struct mhzc_softc *msc = (void *)parent;
aprint_normal("\n");
sc->sc_iot = msc->sc_modem_pcioh.iot;
sc->sc_ioh = msc->sc_modem_pcioh.ioh;
sc->enabled = 1;
sc->sc_iobase = -1;
sc->sc_frequency = COM_FREQ;
sc->enable = com_mhzc_enable;
sc->disable = com_mhzc_disable;
aprint_normal("%s", sc->sc_dev.dv_xname);
com_attach_subr(sc);
sc->enabled = 0;
}
int
com_mhzc_enable(sc)
struct com_softc *sc;
{
return (mhzc_enable((struct mhzc_softc *)sc->sc_dev.dv_parent,
MHZC_MODEM_ENABLED));
}
void
com_mhzc_disable(sc)
struct com_softc *sc;
{
mhzc_disable((struct mhzc_softc *)sc->sc_dev.dv_parent,
MHZC_MODEM_ENABLED);
}
#endif /* NCOM_MHZC > 0 */
/****** Here begins the sm attachment code. ******/
#if NSM_MHZC > 0
int sm_mhzc_match(struct device *, struct cfdata *, void *);
void sm_mhzc_attach(struct device *, struct device *, void *);
/* No mhzc-specific goo in the softc; it's all in the parent. */
CFATTACH_DECL(sm_mhzc, sizeof(struct smc91cxx_softc),
sm_mhzc_match, sm_mhzc_attach, smc91cxx_detach, smc91cxx_activate);
int sm_mhzc_enable(struct smc91cxx_softc *);
void sm_mhzc_disable(struct smc91cxx_softc *);
int
sm_mhzc_match(parent, match, aux)
struct device *parent;
struct cfdata *match;
void *aux;
{
extern struct cfdriver sm_cd;
const char *name = aux;
/* Device is always present. */
if (strcmp(name, sm_cd.cd_name) == 0)
return (1);
return (0);
}
void
sm_mhzc_attach(parent, self, aux)
struct device *parent, *self;
void *aux;
{
struct smc91cxx_softc *sc = (void *)self;
struct mhzc_softc *msc = (void *)parent;
u_int8_t myla[ETHER_ADDR_LEN];
aprint_normal("\n");
sc->sc_bst = msc->sc_ethernet_pcioh.iot;
sc->sc_bsh = msc->sc_ethernet_pcioh.ioh;
sc->sc_enable = sm_mhzc_enable;
sc->sc_disable = sm_mhzc_disable;
if ((*msc->sc_product->mp_enaddr)(msc, myla) != 1)
return;
/* Perform generic initialization. */
smc91cxx_attach(sc, myla);
}
int
sm_mhzc_enable(sc)
struct smc91cxx_softc *sc;
{
return (mhzc_enable((struct mhzc_softc *)sc->sc_dev.dv_parent,
MHZC_ETHERNET_ENABLED));
}
void
sm_mhzc_disable(sc)
struct smc91cxx_softc *sc;
{
mhzc_disable((struct mhzc_softc *)sc->sc_dev.dv_parent,
MHZC_ETHERNET_ENABLED);
}
#endif /* NSM_MHZC > 0 */