1503 lines
35 KiB
C
1503 lines
35 KiB
C
/* $NetBSD: if_uax.c,v 1.12 2004/10/22 09:47:21 augustss Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 2003 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Lennart Augustsson (lennart@augustsson.net).
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
/*
|
|
* TODO:
|
|
* toggle link LED
|
|
* do something in interrupt routine
|
|
*/
|
|
|
|
/*
|
|
* Driver for the ASIX AX88172 Fast Ethernet USB 2.0 adapter.
|
|
* Data sheet at
|
|
* http://www.asix.com.tw/datasheet/mac/Ax88172.PDF
|
|
* There AX88170 datasheet contains RX control register definitions.
|
|
* http://www.asix.com.tw/datasheet/mac/Ax88170.PDF
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: if_uax.c,v 1.12 2004/10/22 09:47:21 augustss Exp $");
|
|
|
|
#include "opt_inet.h"
|
|
#include "opt_ns.h"
|
|
#include "bpfilter.h"
|
|
#include "rnd.h"
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/sockio.h>
|
|
#include <sys/mbuf.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/socket.h>
|
|
|
|
#include <sys/device.h>
|
|
#if NRND > 0
|
|
#include <sys/rnd.h>
|
|
#endif
|
|
|
|
#include <net/if.h>
|
|
#include <net/if_arp.h>
|
|
#include <net/if_dl.h>
|
|
#include <net/if_media.h>
|
|
|
|
#define BPF_MTAP(ifp, m) bpf_mtap((ifp)->if_bpf, (m))
|
|
|
|
#if NBPFILTER > 0
|
|
#include <net/bpf.h>
|
|
#endif
|
|
|
|
#include <net/if_ether.h>
|
|
#ifdef INET
|
|
#include <netinet/in.h>
|
|
#include <netinet/if_inarp.h>
|
|
#endif
|
|
|
|
#ifdef NS
|
|
#include <netns/ns.h>
|
|
#include <netns/ns_if.h>
|
|
#endif
|
|
|
|
#include <dev/mii/mii.h>
|
|
#include <dev/mii/miivar.h>
|
|
|
|
#include <dev/usb/usb.h>
|
|
#include <dev/usb/usbdi.h>
|
|
#include <dev/usb/usbdi_util.h>
|
|
#include <dev/usb/usbdevs.h>
|
|
|
|
#include <dev/usb/if_uaxreg.h>
|
|
|
|
#ifdef UAX_DEBUG
|
|
#define DPRINTF(x) if (uaxdebug) logprintf x
|
|
#define DPRINTFN(n,x) if (uaxdebug >= (n)) logprintf x
|
|
int uaxdebug = 0;
|
|
#else
|
|
#define DPRINTF(x)
|
|
#define DPRINTFN(n,x)
|
|
#endif
|
|
|
|
#define ETHER_ALIGN 2
|
|
|
|
/********** if_uaxvar.h ***********/
|
|
|
|
#define UAX_ENDPT_RX 0
|
|
#define UAX_ENDPT_TX 1
|
|
#define UAX_ENDPT_INTR 2
|
|
#define UAX_ENDPT_MAX 3
|
|
|
|
/* XXX Must be 1 for now */
|
|
#define UAX_TX_LIST_CNT 1
|
|
#define UAX_RX_LIST_CNT 2
|
|
|
|
struct uax_softc;
|
|
|
|
struct uax_chain {
|
|
struct uax_softc *uch_sc;
|
|
usbd_xfer_handle uch_xfer;
|
|
char *uch_buf;
|
|
struct mbuf *uch_mbuf;
|
|
int uch_idx;
|
|
};
|
|
|
|
struct uax_phy_info {
|
|
int phy;
|
|
int phy_type;
|
|
int phy_present;
|
|
};
|
|
|
|
struct uax_softc {
|
|
USBBASEDEVICE sc_dev;
|
|
|
|
struct ethercom sc_ec;
|
|
struct mii_data sc_mii;
|
|
#if NRND > 0
|
|
rndsource_element_t sc_rnd_source;
|
|
#endif
|
|
#define GET_IFP(sc) (&(sc)->sc_ec.ec_if)
|
|
#define GET_MII(sc) (&(sc)->sc_mii)
|
|
|
|
usb_callout_t sc_stat_ch;
|
|
|
|
usbd_device_handle sc_udev;
|
|
usbd_interface_handle sc_iface;
|
|
u_int16_t sc_vendor;
|
|
u_int16_t sc_product;
|
|
int sc_ed[UAX_ENDPT_MAX];
|
|
usbd_pipe_handle sc_ep[UAX_ENDPT_MAX];
|
|
|
|
u_int8_t sc_link;
|
|
|
|
int sc_chip_version;
|
|
struct uax_phy_info sc_phys[UAX_MAX_PHYS];
|
|
int sc_nphys;
|
|
int sc_pna; /* XXX never set */
|
|
|
|
u_int8_t sc_mcast[UAX_MULTI_FILTER_SIZE];
|
|
u_int8_t sc_packet_filter;
|
|
|
|
int sc_sw_mii;
|
|
|
|
/* Tx info */
|
|
struct uax_chain sc_tx_chain[UAX_TX_LIST_CNT];
|
|
#if 0
|
|
int sc_tx_prod;
|
|
int sc_tx_cons;
|
|
#endif
|
|
int sc_tx_cnt;
|
|
|
|
/* Rx info */
|
|
struct uax_chain sc_rx_chain[UAX_RX_LIST_CNT];
|
|
u_int sc_rx_errs;
|
|
struct timeval sc_rx_notice;
|
|
|
|
/* Interrupt info */
|
|
struct uax_intrpkt sc_ibuf;
|
|
u_int sc_intr_errs;
|
|
|
|
struct usb_task sc_tick_task;
|
|
struct usb_task sc_stop_task;
|
|
|
|
int sc_refcnt;
|
|
char sc_dying;
|
|
char sc_attached;
|
|
};
|
|
|
|
Static const struct usb_devno uax_devs[] = {
|
|
{ USB_VENDOR_ABOCOM, USB_PRODUCT_ABOCOM_UFE2000 },
|
|
{ USB_VENDOR_ASIX, USB_PRODUCT_ASIX_AX88172 },
|
|
{ USB_VENDOR_COREGA, USB_PRODUCT_COREGA_FETHER_USB2_TX },
|
|
{ USB_VENDOR_DLINK, USB_PRODUCT_DLINK_DUBE100},
|
|
{ USB_VENDOR_LINKSYS2, USB_PRODUCT_LINKSYS2_USB200M },
|
|
{ USB_VENDOR_MELCO, USB_PRODUCT_MELCO_LUAU2KTX },
|
|
{ USB_VENDOR_NETGEAR, USB_PRODUCT_NETGEAR_FA120 },
|
|
{ USB_VENDOR_SITECOM, USB_PRODUCT_SITECOM_LN029},
|
|
{ USB_VENDOR_SYSTEMTALKS, USB_PRODUCT_SYSTEMTALKS_SGCX2UL},
|
|
};
|
|
#define uax_lookup(v, p) ((struct uax_type *)usb_lookup(uax_devs, v, p))
|
|
|
|
Static void uax_start(struct ifnet *);
|
|
Static int uax_ioctl(struct ifnet *, u_long, caddr_t);
|
|
Static void uax_stop(struct ifnet *, int);
|
|
Static int uax_init(struct ifnet *);
|
|
Static void uax_watchdog(struct ifnet *);
|
|
|
|
Static void uax_stop_wrap(void *v);
|
|
Static void uax_tick(void *);
|
|
Static void uax_tick_task(void *);
|
|
|
|
Static int uax_miibus_readreg(device_ptr_t, int, int);
|
|
Static void uax_miibus_writereg(device_ptr_t, int, int, int);
|
|
Static void uax_miibus_statchg(device_ptr_t);
|
|
Static int uax_ifmedia_upd(struct ifnet *);
|
|
Static void uax_ifmedia_sts(struct ifnet *, struct ifmediareq *);
|
|
|
|
/*Static void uax_reset(struct uax_softc *sc);*/
|
|
Static void uax_setup(struct uax_softc *sc);
|
|
Static void uax_phy_init(struct uax_softc *sc, int i);
|
|
Static void uax_setup_phy(struct uax_softc *sc);
|
|
Static void uax_read_mac(struct uax_softc *, u_char *);
|
|
Static void uax_grab_mii(struct uax_softc *sc);
|
|
Static void uax_ungrab_mii(struct uax_softc *sc);
|
|
|
|
Static int uax_send(struct uax_softc *, struct mbuf *, int);
|
|
Static void uax_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
|
|
Static void uax_rxeof(usbd_xfer_handle, usbd_private_handle, usbd_status);
|
|
Static void uax_txeof(usbd_xfer_handle, usbd_private_handle, usbd_status);
|
|
Static int uax_tx_list_init(struct uax_softc *);
|
|
Static int uax_rx_list_init(struct uax_softc *);
|
|
Static int uax_newbuf(struct uax_softc *, struct uax_chain *, struct mbuf *);
|
|
Static int uax_openpipes(struct uax_softc *);
|
|
Static u_int32_t uax_crc(u_int8_t *eaddr);
|
|
Static void uax_setmulti(struct uax_softc *sc);
|
|
|
|
static inline usbd_status
|
|
uax_request(struct uax_softc *sc, uint type, uint req,
|
|
uint value, uint index, uint len, void *data);
|
|
static inline usbd_status
|
|
uax_request(struct uax_softc *sc, uint type, uint rq,
|
|
uint value, uint indx, uint len, void *data)
|
|
{
|
|
usb_device_request_t req;
|
|
|
|
req.bmRequestType = type;
|
|
req.bRequest = rq;
|
|
USETW(req.wValue, value);
|
|
USETW(req.wIndex, indx);
|
|
USETW(req.wLength, len);
|
|
|
|
return (usbd_do_request(sc->sc_udev, &req, data));
|
|
}
|
|
|
|
/*******/
|
|
|
|
USB_DECLARE_DRIVER(uax);
|
|
|
|
USB_MATCH(uax)
|
|
{
|
|
USB_MATCH_START(uax, uaa);
|
|
|
|
if (uaa->iface != NULL)
|
|
return (UMATCH_NONE);
|
|
|
|
return (uax_lookup(uaa->vendor, uaa->product) != NULL ?
|
|
UMATCH_VENDOR_PRODUCT : UMATCH_NONE);
|
|
}
|
|
|
|
/*
|
|
* Attach the interface. Allocate softc structures, do ifmedia
|
|
* setup and ethernet/BPF attach.
|
|
*/
|
|
USB_ATTACH(uax)
|
|
{
|
|
USB_ATTACH_START(uax, sc, uaa);
|
|
char devinfo[1024];
|
|
int s;
|
|
u_char eaddr[ETHER_ADDR_LEN];
|
|
struct ifnet *ifp;
|
|
struct mii_data *mii;
|
|
usbd_device_handle dev = uaa->device;
|
|
usbd_interface_handle iface;
|
|
usbd_status err;
|
|
usb_interface_descriptor_t *id;
|
|
usb_endpoint_descriptor_t *ed;
|
|
int i;
|
|
|
|
DPRINTFN(5,(" : uax_attach: sc=%p", sc));
|
|
|
|
usbd_devinfo(dev, 0, devinfo, sizeof(devinfo));
|
|
USB_ATTACH_SETUP;
|
|
printf("%s: %s\n", USBDEVNAME(sc->sc_dev), devinfo);
|
|
|
|
err = usbd_set_config_no(dev, UAX_CONFIG_NO, 1);
|
|
if (err) {
|
|
printf("%s: setting config no failed\n",
|
|
USBDEVNAME(sc->sc_dev));
|
|
USB_ATTACH_ERROR_RETURN;
|
|
}
|
|
|
|
ifp = GET_IFP(sc);
|
|
usb_init_task(&sc->sc_tick_task, uax_tick_task, sc);
|
|
usb_init_task(&sc->sc_stop_task, uax_stop_wrap, ifp);
|
|
|
|
err = usbd_device2interface_handle(dev, UAX_IFACE_IDX, &iface);
|
|
if (err) {
|
|
printf("%s: getting interface handle failed\n",
|
|
USBDEVNAME(sc->sc_dev));
|
|
USB_ATTACH_ERROR_RETURN;
|
|
}
|
|
|
|
sc->sc_udev = dev;
|
|
sc->sc_iface = iface;
|
|
sc->sc_product = uaa->product;
|
|
sc->sc_vendor = uaa->vendor;
|
|
|
|
id = usbd_get_interface_descriptor(iface);
|
|
|
|
/* Find endpoints. */
|
|
for (i = 0; i < id->bNumEndpoints; i++) {
|
|
ed = usbd_interface2endpoint_descriptor(iface, i);
|
|
if (ed == NULL) {
|
|
printf("%s: couldn't get endpoint descriptor %d\n",
|
|
USBDEVNAME(sc->sc_dev), i);
|
|
USB_ATTACH_ERROR_RETURN;
|
|
}
|
|
if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
|
|
UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
|
|
sc->sc_ed[UAX_ENDPT_RX] = ed->bEndpointAddress;
|
|
} else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
|
|
UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
|
|
sc->sc_ed[UAX_ENDPT_TX] = ed->bEndpointAddress;
|
|
} else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
|
|
UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
|
|
sc->sc_ed[UAX_ENDPT_INTR] = ed->bEndpointAddress;
|
|
}
|
|
}
|
|
|
|
if (sc->sc_ed[UAX_ENDPT_RX] == 0 || sc->sc_ed[UAX_ENDPT_TX] == 0 ||
|
|
sc->sc_ed[UAX_ENDPT_INTR] == 0) {
|
|
printf("%s: missing endpoint\n", USBDEVNAME(sc->sc_dev));
|
|
USB_ATTACH_ERROR_RETURN;
|
|
}
|
|
|
|
/* Get data from chip and set up hw. */
|
|
uax_setup(sc);
|
|
uax_setup_phy(sc);
|
|
printf("%s: chip version %d\n", USBDEVNAME(sc->sc_dev),
|
|
sc->sc_chip_version);
|
|
#if UAX_DEBUG
|
|
if (uaxdebug) {
|
|
for (i = 0; i < UAX_MAX_PHYS; i++) {
|
|
printf("%s: phy%d present=%d id=%d type=%d\n",
|
|
USBDEVNAME(sc->sc_dev), i,
|
|
sc->sc_phys[i].phy_present,
|
|
sc->sc_phys[i].phy,
|
|
sc->sc_phys[i].phy_type);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
s = splnet();
|
|
|
|
/*
|
|
* Get station address from the EEPROM.
|
|
*/
|
|
uax_read_mac(sc, eaddr);
|
|
|
|
/*
|
|
* A Pegasus chip was detected. Inform the world.
|
|
*/
|
|
printf("%s: Ethernet address %s\n", USBDEVNAME(sc->sc_dev),
|
|
ether_sprintf(eaddr));
|
|
|
|
/* Initialize interface info.*/
|
|
ifp->if_softc = sc;
|
|
ifp->if_mtu = ETHERMTU;
|
|
ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
|
|
ifp->if_ioctl = uax_ioctl;
|
|
ifp->if_start = uax_start;
|
|
ifp->if_watchdog = uax_watchdog;
|
|
ifp->if_init = uax_init;
|
|
ifp->if_stop = uax_stop;
|
|
strncpy(ifp->if_xname, USBDEVNAME(sc->sc_dev), IFNAMSIZ);
|
|
|
|
IFQ_SET_READY(&ifp->if_snd);
|
|
|
|
/* Initialize MII/media info. */
|
|
mii = &sc->sc_mii;
|
|
mii->mii_ifp = ifp;
|
|
mii->mii_readreg = uax_miibus_readreg;
|
|
mii->mii_writereg = uax_miibus_writereg;
|
|
mii->mii_statchg = uax_miibus_statchg;
|
|
mii->mii_flags = MIIF_AUTOTSLEEP;
|
|
ifmedia_init(&mii->mii_media, 0, uax_ifmedia_upd, uax_ifmedia_sts);
|
|
|
|
uax_grab_mii(sc);
|
|
mii_attach(self, mii, ~0, MII_PHY_ANY, MII_OFFSET_ANY, 0);
|
|
uax_ungrab_mii(sc);
|
|
|
|
if (LIST_FIRST(&mii->mii_phys) == NULL) {
|
|
ifmedia_add(&mii->mii_media, IFM_ETHER | IFM_NONE, 0, NULL);
|
|
ifmedia_set(&mii->mii_media, IFM_ETHER | IFM_NONE);
|
|
} else
|
|
ifmedia_set(&mii->mii_media, IFM_ETHER | IFM_AUTO);
|
|
|
|
/* Attach the interface. */
|
|
if_attach(ifp);
|
|
Ether_ifattach(ifp, eaddr);
|
|
#if NRND > 0
|
|
rnd_attach_source(&sc->sc_rnd_source, USBDEVNAME(sc->sc_dev),
|
|
RND_TYPE_NET, 0);
|
|
#endif
|
|
|
|
usb_callout_init(sc->sc_stat_ch);
|
|
|
|
sc->sc_attached = 1;
|
|
splx(s);
|
|
|
|
usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
|
|
USBDEV(sc->sc_dev));
|
|
|
|
USB_ATTACH_SUCCESS_RETURN;
|
|
}
|
|
|
|
USB_DETACH(uax)
|
|
{
|
|
USB_DETACH_START(uax, sc);
|
|
struct ifnet *ifp = GET_IFP(sc);
|
|
int s;
|
|
|
|
DPRINTFN(2,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__));
|
|
|
|
if (!sc->sc_attached) {
|
|
/* Detached before attached finished, so just bail out. */
|
|
return (0);
|
|
}
|
|
|
|
usb_uncallout(sc->sc_stat_ch, uax_tick, sc);
|
|
/*
|
|
* Remove any pending tasks. They cannot be executing because they run
|
|
* in the same thread as detach.
|
|
*/
|
|
usb_rem_task(sc->sc_udev, &sc->sc_tick_task);
|
|
usb_rem_task(sc->sc_udev, &sc->sc_stop_task);
|
|
|
|
s = splusb();
|
|
|
|
if (ifp->if_flags & IFF_RUNNING)
|
|
uax_stop(ifp, 1);
|
|
|
|
#if NRND > 0
|
|
rnd_detach_source(&sc->sc_rnd_source);
|
|
#endif
|
|
mii_detach(&sc->sc_mii, MII_PHY_ANY, MII_OFFSET_ANY);
|
|
ifmedia_delete_instance(&sc->sc_mii.mii_media, IFM_INST_ANY);
|
|
ether_ifdetach(ifp);
|
|
|
|
if_detach(ifp);
|
|
|
|
#ifdef DIAGNOSTIC
|
|
if (sc->sc_ep[UAX_ENDPT_TX] != NULL ||
|
|
sc->sc_ep[UAX_ENDPT_RX] != NULL ||
|
|
sc->sc_ep[UAX_ENDPT_INTR] != NULL)
|
|
printf("%s: detach has active endpoints\n",
|
|
USBDEVNAME(sc->sc_dev));
|
|
#endif
|
|
|
|
sc->sc_attached = 0;
|
|
|
|
if (--sc->sc_refcnt >= 0) {
|
|
/* Wait for processes to go away. */
|
|
usb_detach_wait(USBDEV(sc->sc_dev));
|
|
}
|
|
splx(s);
|
|
|
|
usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
|
|
USBDEV(sc->sc_dev));
|
|
|
|
return (0);
|
|
}
|
|
|
|
int
|
|
uax_activate(device_ptr_t self, enum devact act)
|
|
{
|
|
struct uax_softc *sc = (struct uax_softc *)self;
|
|
|
|
DPRINTFN(2,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__));
|
|
|
|
switch (act) {
|
|
case DVACT_ACTIVATE:
|
|
return (EOPNOTSUPP);
|
|
break;
|
|
|
|
case DVACT_DEACTIVATE:
|
|
if_deactivate(&sc->sc_ec.ec_if);
|
|
sc->sc_dying = 1;
|
|
break;
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
Static void
|
|
uax_setup(struct uax_softc *sc)
|
|
{
|
|
uByte version;
|
|
uByte mii_data[2];
|
|
|
|
/* Get chip version */
|
|
version = 0;
|
|
(void)uax_request(sc, UT_READ_VENDOR_DEVICE, UAX_GET_MONITOR_MODE,
|
|
0, 0, sizeof version, &version);
|
|
sc->sc_chip_version = version;
|
|
|
|
/* Get PHY id */
|
|
(void)uax_request(sc, UT_READ_VENDOR_DEVICE, UAX_READ_PHYID,
|
|
0, 0, sizeof mii_data, &mii_data);
|
|
sc->sc_phys[0].phy = UAX_GET_PHY(mii_data[1]);
|
|
sc->sc_phys[0].phy_type = UAX_GET_PHY_TYPE(mii_data[1]);
|
|
sc->sc_phys[1].phy = UAX_GET_PHY(mii_data[0]);
|
|
sc->sc_phys[1].phy_type = UAX_GET_PHY_TYPE(mii_data[0]);
|
|
|
|
/* Read multicast filter array */
|
|
(void)uax_request(sc, UT_READ_VENDOR_DEVICE, UAX_READ_MULTI_FILTER,
|
|
0, 0, sizeof sc->sc_mcast, &sc->sc_mcast);
|
|
|
|
sc->sc_packet_filter = UAX_RX_BROADCAST | UAX_RX_DIRECTED;
|
|
}
|
|
|
|
Static void
|
|
uax_phy_init(struct uax_softc *sc, int i)
|
|
{
|
|
struct uax_phy_info *p = &sc->sc_phys[i];
|
|
|
|
DPRINTF(("uax_phy_init: i=%d\n", i));
|
|
if (p->phy || p->phy_type != 7) {
|
|
u_int16_t v1, v2;
|
|
v1 = uax_miibus_readreg(&sc->sc_dev, p->phy, MII_BMSR);
|
|
v2 = uax_miibus_readreg(&sc->sc_dev, p->phy, MII_BMCR);
|
|
if ((v1 & v2) != 0xffff) {
|
|
#if 0
|
|
/*
|
|
* The data sheet and the Windows driver isolates and
|
|
* power down the PHY at this point, but doing so
|
|
* makes mii_attach() fail often.
|
|
*/
|
|
uax_miibus_writereg(&sc->sc_dev, p->phy, MII_BMCR,
|
|
BMCR_ISO | BMCR_PDOWN);
|
|
#endif
|
|
p->phy_present = 1;
|
|
sc->sc_nphys++;
|
|
}
|
|
}
|
|
DPRINTF(("uax_phy_init: i=%d done\n", i));
|
|
}
|
|
|
|
/* Switch to software PHY access mode. */
|
|
Static void
|
|
uax_grab_mii(struct uax_softc *sc)
|
|
{
|
|
if (sc->sc_sw_mii++ > 0)
|
|
return;
|
|
(void)uax_request(sc, UT_WRITE_VENDOR_DEVICE, UAX_SOFTWARE_MII,
|
|
0, 0, 0, NULL);
|
|
}
|
|
|
|
/* Switch to hardware PHY access mode. */
|
|
Static void
|
|
uax_ungrab_mii(struct uax_softc *sc)
|
|
{
|
|
if (--sc->sc_sw_mii > 0)
|
|
return;
|
|
(void)uax_request(sc, UT_WRITE_VENDOR_DEVICE, UAX_HARDWARE_MII,
|
|
0, 0, 0, NULL);
|
|
}
|
|
|
|
#define PHY_TIMEOUT 10000
|
|
|
|
/* Magic taken from the Windows driver. */
|
|
Static void
|
|
uax_setup_phy(struct uax_softc *sc)
|
|
{
|
|
uByte status;
|
|
int i;
|
|
|
|
uax_grab_mii(sc);
|
|
|
|
for (i = 0; i < PHY_TIMEOUT; i++) {
|
|
delay(50);
|
|
status = 0;
|
|
uax_request(sc, UT_READ_VENDOR_DEVICE, UAX_READ_MII_OPMODE,
|
|
0, 0, sizeof status, &status);
|
|
if (status & 1)
|
|
break;
|
|
}
|
|
if (i >= PHY_TIMEOUT)
|
|
printf("%s: mii status read timeout\n",USBDEVNAME(sc->sc_dev));
|
|
|
|
for (i = 0; i < UAX_MAX_PHYS; i++)
|
|
uax_phy_init(sc, i);
|
|
|
|
uax_ungrab_mii(sc);
|
|
|
|
(void)uax_request(sc, UT_WRITE_VENDOR_DEVICE, UAX_WRITE_IPG,
|
|
sc->sc_pna ? 0x17 : 0x15, 0, 0, NULL);
|
|
(void)uax_request(sc, UT_WRITE_VENDOR_DEVICE, UAX_WRITE_IPG1,
|
|
0x0c, 0, 0, NULL);
|
|
(void)uax_request(sc, UT_WRITE_VENDOR_DEVICE, UAX_WRITE_IPG2,
|
|
sc->sc_pna ? 0x14 : 0x12, 0, 0, NULL);
|
|
}
|
|
|
|
Static void
|
|
uax_read_mac(struct uax_softc *sc, u_char *dest)
|
|
{
|
|
usbd_status err;
|
|
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
err = uax_request(sc, UT_READ_VENDOR_DEVICE, UAX_READ_NODEID,
|
|
0, 0, ETHER_ADDR_LEN, dest);
|
|
if (err) {
|
|
DPRINTF(("%s: uax_read_mac error=%s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err)));
|
|
}
|
|
}
|
|
|
|
/*
|
|
* uax_ioctl: [ifnet interface function]
|
|
*
|
|
* Handle control requests from the operator.
|
|
*/
|
|
int
|
|
uax_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
|
|
{
|
|
struct uax_softc *sc = ifp->if_softc;
|
|
struct ifreq *ifr = (struct ifreq *)data;
|
|
int s, error;
|
|
|
|
s = splnet();
|
|
|
|
switch (cmd) {
|
|
case SIOCSIFMEDIA:
|
|
case SIOCGIFMEDIA:
|
|
error = ifmedia_ioctl(ifp, ifr, &sc->sc_mii.mii_media, cmd);
|
|
break;
|
|
|
|
default:
|
|
error = ether_ioctl(ifp, cmd, data);
|
|
if (error == ENETRESET) {
|
|
/*
|
|
* Multicast list has changed. Set the
|
|
* hardware filter accordingly.
|
|
*/
|
|
uax_setmulti(sc);
|
|
error = 0;
|
|
}
|
|
break;
|
|
}
|
|
|
|
/* Try to get more packets going. */
|
|
if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
|
|
uax_start(ifp);
|
|
|
|
splx(s);
|
|
return (error);
|
|
}
|
|
|
|
Static void
|
|
uax_watchdog(struct ifnet *ifp)
|
|
{
|
|
struct uax_softc *sc = ifp->if_softc;
|
|
struct uax_chain *c;
|
|
usbd_status stat;
|
|
int s;
|
|
|
|
DPRINTFN(5,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__));
|
|
|
|
ifp->if_oerrors++;
|
|
printf("%s: watchdog timeout\n", USBDEVNAME(sc->sc_dev));
|
|
|
|
s = splusb();
|
|
c = &sc->sc_tx_chain[0];
|
|
usbd_get_xfer_status(c->uch_xfer, NULL, NULL, NULL, &stat);
|
|
uax_txeof(c->uch_xfer, c, stat);
|
|
|
|
if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
|
|
uax_start(ifp);
|
|
splx(s);
|
|
}
|
|
|
|
/*
|
|
* Set media options.
|
|
*/
|
|
Static int
|
|
uax_ifmedia_upd(struct ifnet *ifp)
|
|
{
|
|
struct uax_softc *sc = ifp->if_softc;
|
|
struct mii_data *mii = GET_MII(sc);
|
|
|
|
DPRINTFN(5,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__));
|
|
|
|
if (sc->sc_dying)
|
|
return (0);
|
|
|
|
sc->sc_link = 0;
|
|
if (mii->mii_instance) {
|
|
struct mii_softc *miisc;
|
|
for (miisc = LIST_FIRST(&mii->mii_phys); miisc != NULL;
|
|
miisc = LIST_NEXT(miisc, mii_list))
|
|
mii_phy_reset(miisc);
|
|
}
|
|
mii_mediachg(mii);
|
|
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Report current media status.
|
|
*/
|
|
Static void
|
|
uax_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
|
|
{
|
|
struct uax_softc *sc = ifp->if_softc;
|
|
struct mii_data *mii = GET_MII(sc);
|
|
|
|
DPRINTFN(5,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__));
|
|
|
|
mii_pollstat(mii);
|
|
ifmr->ifm_active = mii->mii_media_active;
|
|
ifmr->ifm_status = mii->mii_media_status;
|
|
}
|
|
|
|
Static int
|
|
uax_miibus_readreg(device_ptr_t dev, int phy, int reg)
|
|
{
|
|
struct uax_softc *sc = USBGETSOFTC(dev);
|
|
uWord val;
|
|
usbd_status err;
|
|
|
|
if (sc->sc_dying)
|
|
return (0);
|
|
|
|
/* We must limit the PHY address to avoid false hits. */
|
|
if (phy >= sc->sc_nphys)
|
|
return (0);
|
|
|
|
uax_grab_mii(sc);
|
|
err = uax_request(sc, UT_READ_VENDOR_DEVICE, UAX_READ_MII_REG,
|
|
phy, reg, sizeof val, &val);
|
|
uax_ungrab_mii(sc);
|
|
if (err) {
|
|
DPRINTF(("%s: uax_miibus_readreg error=%s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err)));
|
|
return (0);
|
|
}
|
|
|
|
DPRINTFN(4,("uax_miibus_readreg: phy=%d reg=0x%x data=0x%08x\n", phy,
|
|
reg, UGETW(val)));
|
|
return (UGETW(val));
|
|
}
|
|
|
|
Static void
|
|
uax_miibus_writereg(device_ptr_t dev, int phy, int reg, int data)
|
|
{
|
|
struct uax_softc *sc = USBGETSOFTC(dev);
|
|
uWord val;
|
|
usbd_status err;
|
|
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
uax_grab_mii(sc);
|
|
err = uax_request(sc, UT_WRITE_VENDOR_DEVICE, UAX_WRITE_MII_REG,
|
|
phy, reg, sizeof val, &val);
|
|
uax_ungrab_mii(sc);
|
|
if (err) {
|
|
DPRINTF(("%s: uax_miibus_writereg error=%s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err)));
|
|
}
|
|
}
|
|
|
|
Static void
|
|
uax_miibus_statchg(device_ptr_t dev)
|
|
{
|
|
struct uax_softc *sc = USBGETSOFTC(dev);
|
|
/*struct mii_data *mii = GET_MII(sc);
|
|
uint val;*/
|
|
#if 0
|
|
usbd_status err;
|
|
#endif
|
|
|
|
DPRINTFN(5,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__));
|
|
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
#if 0
|
|
if ((mii->mii_media_active & IFM_GMASK) == IFM_FDX)
|
|
val = 0x02;
|
|
else
|
|
val = 0x00;
|
|
err = uax_request(sc, UT_WRITE_VENDOR_DEVICE, UAX_WRITE_MEDIUM_STATUS,
|
|
val, 0, 0, NULL);
|
|
if (err) {
|
|
DPRINTF(("%s: uax_miibus_statchg error=%s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err)));
|
|
}
|
|
#endif
|
|
/* Nothing to do */
|
|
}
|
|
|
|
Static int
|
|
uax_send(struct uax_softc *sc, struct mbuf *m, int idx)
|
|
{
|
|
struct uax_chain *c;
|
|
usbd_status err;
|
|
|
|
DPRINTFN(10,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev),__func__));
|
|
|
|
c = &sc->sc_tx_chain[idx];
|
|
|
|
/* Copy data to tx buffer. */
|
|
KASSERT(m->m_pkthdr.len <= UAX_BUFSZ);
|
|
m_copydata(m, 0, m->m_pkthdr.len, c->uch_buf);
|
|
c->uch_mbuf = m;
|
|
|
|
/* XXX Should we zero tail of buffer for short packets? */
|
|
|
|
usbd_setup_xfer(c->uch_xfer, sc->sc_ep[UAX_ENDPT_TX],
|
|
c, c->uch_buf, m->m_pkthdr.len,
|
|
USBD_FORCE_SHORT_XFER | USBD_NO_COPY,
|
|
UAX_TX_TIMEOUT, uax_txeof);
|
|
|
|
DPRINTF(("%s: sending %d bytes\n", USBDEVNAME(sc->sc_dev),
|
|
m->m_pkthdr.len));
|
|
/* Transmit */
|
|
err = usbd_transfer(c->uch_xfer);
|
|
if (err != USBD_IN_PROGRESS) {
|
|
printf("%s: uax_send error=%s\n", USBDEVNAME(sc->sc_dev),
|
|
usbd_errstr(err));
|
|
/* Stop the interface from process context. */
|
|
usb_add_task(sc->sc_udev, &sc->sc_stop_task);
|
|
return (EIO);
|
|
}
|
|
DPRINTFN(5,("%s: %s: send %d bytes\n", USBDEVNAME(sc->sc_dev),
|
|
__func__, m->m_pkthdr.len));
|
|
|
|
sc->sc_tx_cnt++;
|
|
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* A frame was downloaded to the chip. It's safe for us to clean up
|
|
* the list buffers.
|
|
*/
|
|
Static void
|
|
uax_txeof(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
|
|
{
|
|
struct uax_chain *c = priv;
|
|
struct uax_softc *sc = c->uch_sc;
|
|
struct ifnet *ifp = GET_IFP(sc);
|
|
int s;
|
|
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
DPRINTF(("uax_txoef: frame sent\n"));
|
|
|
|
s = splnet();
|
|
|
|
DPRINTFN(10,("%s: %s: enter status=%d\n", USBDEVNAME(sc->sc_dev),
|
|
__func__, status));
|
|
|
|
ifp->if_timer = 0;
|
|
ifp->if_flags &= ~IFF_OACTIVE;
|
|
|
|
if (status != USBD_NORMAL_COMPLETION) {
|
|
if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) {
|
|
splx(s);
|
|
return;
|
|
}
|
|
ifp->if_oerrors++;
|
|
printf("%s: usb error on tx: %s\n", USBDEVNAME(sc->sc_dev),
|
|
usbd_errstr(status));
|
|
if (status == USBD_STALLED)
|
|
usbd_clear_endpoint_stall(sc->sc_ep[UAX_ENDPT_TX]);
|
|
splx(s);
|
|
return;
|
|
}
|
|
|
|
ifp->if_opackets++;
|
|
|
|
m_freem(c->uch_mbuf);
|
|
c->uch_mbuf = NULL;
|
|
|
|
if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
|
|
uax_start(ifp);
|
|
|
|
splx(s);
|
|
}
|
|
|
|
Static void
|
|
uax_start(struct ifnet *ifp)
|
|
{
|
|
struct uax_softc *sc = ifp->if_softc;
|
|
struct mbuf *m_head = NULL;
|
|
|
|
DPRINTFN(5,("%s: %s: enter, link=%d\n", USBDEVNAME(sc->sc_dev),
|
|
__func__, sc->sc_link));
|
|
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
if (!sc->sc_link)
|
|
return;
|
|
|
|
if (ifp->if_flags & IFF_OACTIVE)
|
|
return;
|
|
|
|
IFQ_POLL(&ifp->if_snd, m_head);
|
|
if (m_head == NULL)
|
|
return;
|
|
|
|
if (uax_send(sc, m_head, 0)) {
|
|
ifp->if_flags |= IFF_OACTIVE;
|
|
return;
|
|
}
|
|
|
|
IFQ_DEQUEUE(&ifp->if_snd, m_head);
|
|
|
|
#if NBPFILTER > 0
|
|
/*
|
|
* If there's a BPF listener, bounce a copy of this frame
|
|
* to him.
|
|
*/
|
|
if (ifp->if_bpf)
|
|
BPF_MTAP(ifp, m_head);
|
|
#endif
|
|
|
|
ifp->if_flags |= IFF_OACTIVE;
|
|
|
|
/*
|
|
* Set a timeout in case the chip goes out to lunch.
|
|
*/
|
|
ifp->if_timer = 5;
|
|
}
|
|
|
|
Static void
|
|
uax_stop_wrap(void *v)
|
|
{
|
|
uax_stop(v, 0);
|
|
}
|
|
|
|
Static void
|
|
uax_stop(struct ifnet *ifp, int disable)
|
|
{
|
|
struct uax_softc *sc = ifp->if_softc;
|
|
usbd_status err;
|
|
int i;
|
|
|
|
DPRINTFN(5,("%s: %s: enter disable=%d\n", USBDEVNAME(sc->sc_dev),
|
|
__func__, disable));
|
|
|
|
ifp->if_timer = 0;
|
|
|
|
/* XXX How do we stop the chip? */
|
|
sc->sc_packet_filter &= ~UAX_RX_ALTERNATE;
|
|
(void)uax_request(sc, UT_WRITE_VENDOR_DEVICE, UAX_WRITE_RX_CTRL,
|
|
sc->sc_packet_filter, 0, 0, NULL);
|
|
/* XXX do more */
|
|
|
|
usb_uncallout(sc->sc_stat_ch, uax_tick, sc);
|
|
|
|
/* Stop transfers. */
|
|
if (sc->sc_ep[UAX_ENDPT_RX] != NULL) {
|
|
err = usbd_abort_pipe(sc->sc_ep[UAX_ENDPT_RX]);
|
|
if (err) {
|
|
printf("%s: abort rx pipe failed: %s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err));
|
|
}
|
|
err = usbd_close_pipe(sc->sc_ep[UAX_ENDPT_RX]);
|
|
if (err) {
|
|
printf("%s: close rx pipe failed: %s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err));
|
|
}
|
|
sc->sc_ep[UAX_ENDPT_RX] = NULL;
|
|
}
|
|
|
|
if (sc->sc_ep[UAX_ENDPT_TX] != NULL) {
|
|
err = usbd_abort_pipe(sc->sc_ep[UAX_ENDPT_TX]);
|
|
if (err) {
|
|
printf("%s: abort tx pipe failed: %s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err));
|
|
}
|
|
err = usbd_close_pipe(sc->sc_ep[UAX_ENDPT_TX]);
|
|
if (err) {
|
|
printf("%s: close tx pipe failed: %s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err));
|
|
}
|
|
sc->sc_ep[UAX_ENDPT_TX] = NULL;
|
|
}
|
|
|
|
if (sc->sc_ep[UAX_ENDPT_INTR] != NULL) {
|
|
err = usbd_abort_pipe(sc->sc_ep[UAX_ENDPT_INTR]);
|
|
if (err) {
|
|
printf("%s: abort intr pipe failed: %s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err));
|
|
}
|
|
err = usbd_close_pipe(sc->sc_ep[UAX_ENDPT_INTR]);
|
|
if (err) {
|
|
printf("%s: close intr pipe failed: %s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err));
|
|
}
|
|
sc->sc_ep[UAX_ENDPT_INTR] = NULL;
|
|
}
|
|
|
|
/* Free RX resources. */
|
|
for (i = 0; i < UAX_RX_LIST_CNT; i++) {
|
|
if (sc->sc_rx_chain[i].uch_mbuf != NULL) {
|
|
m_freem(sc->sc_rx_chain[i].uch_mbuf);
|
|
sc->sc_rx_chain[i].uch_mbuf = NULL;
|
|
}
|
|
if (sc->sc_rx_chain[i].uch_xfer != NULL) {
|
|
usbd_free_xfer(sc->sc_rx_chain[i].uch_xfer);
|
|
sc->sc_rx_chain[i].uch_xfer = NULL;
|
|
}
|
|
}
|
|
|
|
/* Free TX resources. */
|
|
for (i = 0; i < UAX_TX_LIST_CNT; i++) {
|
|
if (sc->sc_tx_chain[i].uch_mbuf != NULL) {
|
|
m_freem(sc->sc_tx_chain[i].uch_mbuf);
|
|
sc->sc_tx_chain[i].uch_mbuf = NULL;
|
|
}
|
|
if (sc->sc_tx_chain[i].uch_xfer != NULL) {
|
|
usbd_free_xfer(sc->sc_tx_chain[i].uch_xfer);
|
|
sc->sc_tx_chain[i].uch_xfer = NULL;
|
|
}
|
|
}
|
|
|
|
sc->sc_link = 0;
|
|
|
|
ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
|
|
}
|
|
|
|
/*
|
|
* A frame has been uploaded: pass the resulting mbuf chain up to
|
|
* the higher level protocols.
|
|
*/
|
|
Static void
|
|
uax_rxeof(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
|
|
{
|
|
struct uax_chain *c = priv;
|
|
struct uax_softc *sc = c->uch_sc;
|
|
struct ifnet *ifp = GET_IFP(sc);
|
|
struct mbuf *m;
|
|
u_int32_t total_len;
|
|
int s;
|
|
|
|
DPRINTFN(10,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__));
|
|
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
if (!(ifp->if_flags & IFF_RUNNING))
|
|
return;
|
|
|
|
if (status != USBD_NORMAL_COMPLETION) {
|
|
if (status == USBD_NOT_STARTED || status == USBD_CANCELLED)
|
|
return;
|
|
sc->sc_rx_errs++;
|
|
if (usbd_ratecheck(&sc->sc_rx_notice)) {
|
|
printf("%s: %u usb errors on rx: %s\n",
|
|
USBDEVNAME(sc->sc_dev), sc->sc_rx_errs,
|
|
usbd_errstr(status));
|
|
sc->sc_rx_errs = 0;
|
|
}
|
|
if (status == USBD_STALLED)
|
|
usbd_clear_endpoint_stall(sc->sc_ep[UAX_ENDPT_RX]);
|
|
goto done;
|
|
}
|
|
|
|
usbd_get_xfer_status(xfer, NULL, NULL, &total_len, NULL);
|
|
|
|
DPRINTF(("%s: got %d bytes\n", USBDEVNAME(sc->sc_dev), total_len));
|
|
memcpy(mtod(c->uch_mbuf, char *), c->uch_buf, total_len);
|
|
|
|
if (total_len == 0) {
|
|
ifp->if_ierrors++;
|
|
goto done;
|
|
}
|
|
|
|
/* No errors; receive the packet. */
|
|
m = c->uch_mbuf;
|
|
m->m_pkthdr.len = m->m_len = total_len;
|
|
ifp->if_ipackets++;
|
|
|
|
m->m_pkthdr.rcvif = ifp;
|
|
|
|
s = splnet();
|
|
|
|
/* XXX ugly */
|
|
if (uax_newbuf(sc, c, NULL) == ENOBUFS) {
|
|
ifp->if_ierrors++;
|
|
goto done1;
|
|
}
|
|
|
|
#if NBPFILTER > 0
|
|
/*
|
|
* Handle BPF listeners. Let the BPF user see the packet, but
|
|
* don't pass it up to the ether_input() layer unless it's
|
|
* a broadcast packet, multicast packet, matches our ethernet
|
|
* address or the interface is in promiscuous mode.
|
|
*/
|
|
if (ifp->if_bpf)
|
|
BPF_MTAP(ifp, m);
|
|
#endif
|
|
|
|
DPRINTFN(10,("%s: %s: deliver %d\n", USBDEVNAME(sc->sc_dev),
|
|
__func__, m->m_len));
|
|
IF_INPUT(ifp, m);
|
|
done1:
|
|
splx(s);
|
|
|
|
done:
|
|
|
|
/* Setup new transfer. */
|
|
usbd_setup_xfer(xfer, sc->sc_ep[UAX_ENDPT_RX],
|
|
c, c->uch_buf, UAX_BUFSZ,
|
|
USBD_SHORT_XFER_OK | USBD_NO_COPY,
|
|
USBD_NO_TIMEOUT, uax_rxeof);
|
|
usbd_transfer(xfer);
|
|
|
|
DPRINTFN(10,("%s: %s: start rx\n", USBDEVNAME(sc->sc_dev),
|
|
__func__));
|
|
}
|
|
|
|
/*
|
|
* Initialize an RX descriptor and attach an MBUF cluster.
|
|
*/
|
|
Static int
|
|
uax_newbuf(struct uax_softc *sc, struct uax_chain *c, struct mbuf *m)
|
|
{
|
|
struct mbuf *m_new = NULL;
|
|
|
|
DPRINTFN(10,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev),__func__));
|
|
|
|
if (m == NULL) {
|
|
MGETHDR(m_new, M_DONTWAIT, MT_DATA);
|
|
if (m_new == NULL) {
|
|
printf("%s: no memory for rx list "
|
|
"-- packet dropped!\n", USBDEVNAME(sc->sc_dev));
|
|
return (ENOBUFS);
|
|
}
|
|
|
|
MCLGET(m_new, M_DONTWAIT);
|
|
if (!(m_new->m_flags & M_EXT)) {
|
|
printf("%s: no memory for rx list "
|
|
"-- packet dropped!\n", USBDEVNAME(sc->sc_dev));
|
|
m_freem(m_new);
|
|
return (ENOBUFS);
|
|
}
|
|
m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
|
|
} else {
|
|
m_new = m;
|
|
m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
|
|
m_new->m_data = m_new->m_ext.ext_buf;
|
|
}
|
|
|
|
m_adj(m_new, ETHER_ALIGN);
|
|
c->uch_mbuf = m_new;
|
|
|
|
return (0);
|
|
}
|
|
|
|
Static int
|
|
uax_rx_list_init(struct uax_softc *sc)
|
|
{
|
|
struct uax_chain *c;
|
|
int i;
|
|
|
|
DPRINTFN(5,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__));
|
|
|
|
for (i = 0; i < UAX_RX_LIST_CNT; i++) {
|
|
c = &sc->sc_rx_chain[i];
|
|
c->uch_sc = sc;
|
|
c->uch_idx = i;
|
|
if (uax_newbuf(sc, c, NULL) == ENOBUFS)
|
|
return (ENOBUFS);
|
|
if (c->uch_xfer == NULL) {
|
|
c->uch_xfer = usbd_alloc_xfer(sc->sc_udev);
|
|
if (c->uch_xfer == NULL)
|
|
return (ENOBUFS);
|
|
c->uch_buf = usbd_alloc_buffer(c->uch_xfer, UAX_BUFSZ);
|
|
if (c->uch_buf == NULL) {
|
|
usbd_free_xfer(c->uch_xfer);
|
|
c->uch_xfer = NULL;
|
|
return (ENOBUFS);
|
|
}
|
|
}
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
Static int
|
|
uax_tx_list_init(struct uax_softc *sc)
|
|
{
|
|
struct uax_chain *c;
|
|
int i;
|
|
|
|
DPRINTFN(5,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__));
|
|
|
|
for (i = 0; i < UAX_TX_LIST_CNT; i++) {
|
|
c = &sc->sc_tx_chain[i];
|
|
c->uch_sc = sc;
|
|
c->uch_idx = i;
|
|
c->uch_mbuf = NULL;
|
|
if (c->uch_xfer == NULL) {
|
|
c->uch_xfer = usbd_alloc_xfer(sc->sc_udev);
|
|
if (c->uch_xfer == NULL)
|
|
return (ENOBUFS);
|
|
c->uch_buf = usbd_alloc_buffer(c->uch_xfer, UAX_BUFSZ);
|
|
if (c->uch_buf == NULL) {
|
|
usbd_free_xfer(c->uch_xfer);
|
|
c->uch_xfer = NULL;
|
|
return (ENOBUFS);
|
|
}
|
|
}
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
Static int
|
|
uax_init(struct ifnet *ifp)
|
|
{
|
|
struct uax_softc *sc = ifp->if_softc;
|
|
|
|
DPRINTFN(5,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__));
|
|
|
|
if (sc->sc_dying)
|
|
return (EIO);
|
|
|
|
uax_stop(ifp, 0);
|
|
|
|
/* Load the multicast filter. */
|
|
uax_setmulti(sc);
|
|
|
|
/* Init TX ring. */
|
|
if (uax_tx_list_init(sc) == ENOBUFS) {
|
|
printf("%s: tx list init failed\n", USBDEVNAME(sc->sc_dev));
|
|
return (EIO);
|
|
}
|
|
|
|
/* Init RX ring. */
|
|
if (uax_rx_list_init(sc) == ENOBUFS) {
|
|
printf("%s: rx list init failed\n", USBDEVNAME(sc->sc_dev));
|
|
return (EIO);
|
|
}
|
|
|
|
if (sc->sc_ep[UAX_ENDPT_RX] == NULL) {
|
|
if (uax_openpipes(sc)) {
|
|
return (EIO);
|
|
}
|
|
}
|
|
|
|
ifp->if_flags |= IFF_RUNNING;
|
|
ifp->if_flags &= ~IFF_OACTIVE;
|
|
|
|
usb_callout(sc->sc_stat_ch, hz, uax_tick, sc);
|
|
|
|
sc->sc_packet_filter |= UAX_RX_ALTERNATE;
|
|
(void)uax_request(sc, UT_WRITE_VENDOR_DEVICE, UAX_WRITE_RX_CTRL,
|
|
sc->sc_packet_filter, 0, 0, NULL);
|
|
|
|
return (0);
|
|
}
|
|
|
|
Static void
|
|
uax_tick(void *xsc)
|
|
{
|
|
struct uax_softc *sc = xsc;
|
|
|
|
DPRINTFN(15,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev),__func__));
|
|
|
|
if (sc == NULL)
|
|
return;
|
|
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
/* Perform periodic stuff in process context. */
|
|
usb_add_task(sc->sc_udev, &sc->sc_tick_task);
|
|
}
|
|
|
|
Static void
|
|
uax_tick_task(void *xsc)
|
|
{
|
|
struct uax_softc *sc = xsc;
|
|
struct ifnet *ifp;
|
|
struct mii_data *mii;
|
|
int s;
|
|
|
|
DPRINTFN(15,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev),__func__));
|
|
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
ifp = GET_IFP(sc);
|
|
mii = GET_MII(sc);
|
|
if (mii == NULL)
|
|
return;
|
|
|
|
s = splnet();
|
|
|
|
mii_tick(mii);
|
|
if (!sc->sc_link) {
|
|
mii_pollstat(mii); /* XXX FreeBSD has removed this call */
|
|
if (mii->mii_media_status & IFM_ACTIVE &&
|
|
IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) {
|
|
DPRINTFN(2,("%s: %s: got link\n",
|
|
USBDEVNAME(sc->sc_dev),__func__));
|
|
sc->sc_link++;
|
|
if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
|
|
uax_start(ifp);
|
|
}
|
|
}
|
|
|
|
usb_callout(sc->sc_stat_ch, hz, uax_tick, sc);
|
|
|
|
splx(s);
|
|
}
|
|
|
|
Static int
|
|
uax_openpipes(struct uax_softc *sc)
|
|
{
|
|
struct uax_chain *c;
|
|
usbd_status err;
|
|
int i;
|
|
|
|
/* Open RX and TX pipes. */
|
|
err = usbd_open_pipe(sc->sc_iface, sc->sc_ed[UAX_ENDPT_RX],
|
|
USBD_EXCLUSIVE_USE, &sc->sc_ep[UAX_ENDPT_RX]);
|
|
if (err) {
|
|
printf("%s: open rx pipe failed: %s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err));
|
|
return (EIO);
|
|
}
|
|
err = usbd_open_pipe(sc->sc_iface, sc->sc_ed[UAX_ENDPT_TX],
|
|
USBD_EXCLUSIVE_USE, &sc->sc_ep[UAX_ENDPT_TX]);
|
|
if (err) {
|
|
printf("%s: open tx pipe failed: %s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err));
|
|
return (EIO);
|
|
}
|
|
err = usbd_open_pipe_intr(sc->sc_iface, sc->sc_ed[UAX_ENDPT_INTR],
|
|
USBD_EXCLUSIVE_USE, &sc->sc_ep[UAX_ENDPT_INTR], sc,
|
|
&sc->sc_ibuf, UAX_INTR_PKTLEN, uax_intr,
|
|
UAX_INTR_INTERVAL);
|
|
if (err) {
|
|
printf("%s: open intr pipe failed: %s\n",
|
|
USBDEVNAME(sc->sc_dev), usbd_errstr(err));
|
|
return (EIO);
|
|
}
|
|
|
|
/* Start up the receive pipe. */
|
|
for (i = 0; i < UAX_RX_LIST_CNT; i++) {
|
|
c = &sc->sc_rx_chain[i];
|
|
usbd_setup_xfer(c->uch_xfer, sc->sc_ep[UAX_ENDPT_RX],
|
|
c, c->uch_buf, UAX_BUFSZ,
|
|
USBD_SHORT_XFER_OK | USBD_NO_COPY, USBD_NO_TIMEOUT,
|
|
uax_rxeof);
|
|
(void)usbd_transfer(c->uch_xfer); /* XXX */
|
|
DPRINTFN(5,("%s: %s: start read\n", USBDEVNAME(sc->sc_dev),
|
|
__func__));
|
|
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
Static void
|
|
uax_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
|
|
{
|
|
struct uax_softc *sc = priv;
|
|
struct ifnet *ifp = GET_IFP(sc);
|
|
/*struct uax_intrpkt *p = &sc->sc_ibuf;*/
|
|
|
|
DPRINTFN(15,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev),__func__));
|
|
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
if (!(ifp->if_flags & IFF_RUNNING))
|
|
return;
|
|
|
|
if (status != USBD_NORMAL_COMPLETION) {
|
|
if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) {
|
|
return;
|
|
}
|
|
sc->sc_intr_errs++;
|
|
if (usbd_ratecheck(&sc->sc_rx_notice)) {
|
|
printf("%s: %u usb errors on intr: %s\n",
|
|
USBDEVNAME(sc->sc_dev), sc->sc_intr_errs,
|
|
usbd_errstr(status));
|
|
sc->sc_intr_errs = 0;
|
|
}
|
|
if (status == USBD_STALLED)
|
|
usbd_clear_endpoint_stall(sc->sc_ep[UAX_ENDPT_RX]);
|
|
return;
|
|
}
|
|
|
|
}
|
|
|
|
/* Polynomial calculation taken from the Windows driver. */
|
|
Static u_int32_t
|
|
uax_crc(u_int8_t *eaddr)
|
|
{
|
|
u_int32_t crc32;
|
|
u_int8_t byte, carry;
|
|
int i, j;
|
|
|
|
crc32 = 0xffffffff;
|
|
for (i = 0; i < ETHER_ADDR_LEN; i++) {
|
|
byte = eaddr[i];
|
|
for (j = 0; j < 8; j++) {
|
|
carry = byte & 1;
|
|
if (crc32 & 0x80000000)
|
|
carry ^= 1;
|
|
crc32 <<= 1;
|
|
byte >>= 1;
|
|
if (carry)
|
|
crc32 ^= 0x04c11db7;
|
|
}
|
|
}
|
|
return (crc32);
|
|
}
|
|
|
|
Static void
|
|
uax_setmulti(struct uax_softc *sc)
|
|
{
|
|
struct ifnet *ifp;
|
|
struct ether_multi *enm;
|
|
struct ether_multistep step;
|
|
u_int32_t h;
|
|
int nmcast;
|
|
|
|
DPRINTFN(5,("%s: %s: enter\n", USBDEVNAME(sc->sc_dev), __func__));
|
|
|
|
ifp = GET_IFP(sc);
|
|
|
|
sc->sc_packet_filter &= ~(UAX_RX_PROMISCUOUS |
|
|
UAX_RX_ALL_MULTICAST |
|
|
UAX_RX_MULTICAST);
|
|
if (ifp->if_flags & IFF_PROMISC) {
|
|
sc->sc_packet_filter |= UAX_RX_PROMISCUOUS;
|
|
} else {
|
|
ifp->if_flags &= ~IFF_ALLMULTI;
|
|
|
|
memset(sc->sc_mcast, 0, sizeof sc->sc_mcast);
|
|
nmcast = 0;
|
|
ETHER_FIRST_MULTI(step, &sc->sc_ec, enm);
|
|
while (enm != NULL) {
|
|
if (memcmp(enm->enm_addrlo,
|
|
enm->enm_addrhi, ETHER_ADDR_LEN) != 0) {
|
|
ifp->if_flags |= IFF_ALLMULTI;
|
|
sc->sc_packet_filter |= UAX_RX_ALL_MULTICAST;
|
|
nmcast = 0;
|
|
break;
|
|
}
|
|
h = (uax_crc(enm->enm_addrlo) >> 26) & 0x3f;
|
|
sc->sc_mcast[h / 8] |= 1 << (h % 8);
|
|
|
|
ETHER_NEXT_MULTI(step, enm);
|
|
nmcast++;
|
|
}
|
|
if (nmcast > 0)
|
|
sc->sc_packet_filter |= UAX_RX_MULTICAST;
|
|
}
|
|
/* Set the multicast filter. */
|
|
(void)uax_request(sc, UT_WRITE_VENDOR_DEVICE, UAX_WRITE_MULTI_FILTER,
|
|
0, 0, sizeof sc->sc_mcast, &sc->sc_mcast);
|
|
/* And tell the chip which mode we want. */
|
|
(void)uax_request(sc, UT_WRITE_VENDOR_DEVICE, UAX_WRITE_RX_CTRL,
|
|
sc->sc_packet_filter, 0, 0, NULL);
|
|
}
|
|
|