#include <sys/stdint.h>
#include <sys/param.h>
#include <sys/queue.h>
#include <sys/types.h>
#include <sys/systm.h>
#include <sys/socket.h>
#include <sys/kernel.h>
#include <sys/bus.h>
#include <sys/module.h>
#include <sys/lock.h>
#include <sys/condvar.h>
#include <sys/sysctl.h>
#include <sys/unistd.h>
#include <sys/callout.h>
#include <sys/malloc.h>
#include <sys/caps.h>
#include <net/if.h>
#include <net/if_var.h>
#include <net/ifq_var.h>
#include <bus/u4b/usb.h>
#include <bus/u4b/usbdi.h>
#include <bus/u4b/usbdi_util.h>
#include "usbdevs.h"
#define USB_DEBUG_VAR mos_debug
#include <bus/u4b/usb_debug.h>
#include <bus/u4b/usb_process.h>
#include <bus/u4b/net/usb_ethernet.h>
#include "if_mosreg.h"
#ifdef USB_DEBUG
static int mos_debug = 0;
static SYSCTL_NODE(_hw_usb, OID_AUTO, mos, CTLFLAG_RW, 0, "USB mos");
SYSCTL_INT(_hw_usb_mos, OID_AUTO, debug, CTLFLAG_RW, &mos_debug, 0,
"Debug level");
#endif
#define MOS_DPRINTFN(fmt,...) \
DPRINTF("mos: %s: " fmt "\n",__func__,## __VA_ARGS__)
#define USB_PRODUCT_MOSCHIP_MCS7730 0x7730
#define USB_PRODUCT_SITECOMEU_LN030 0x0021
static const STRUCT_USB_HOST_ID mos_devs[] = {
{USB_VPI(USB_VENDOR_MOSCHIP, USB_PRODUCT_MOSCHIP_MCS7730, MCS7730)},
{USB_VPI(USB_VENDOR_MOSCHIP, USB_PRODUCT_MOSCHIP_MCS7830, MCS7830)},
{USB_VPI(USB_VENDOR_MOSCHIP, USB_PRODUCT_MOSCHIP_MCS7832, MCS7832)},
{USB_VPI(USB_VENDOR_SITECOMEU, USB_PRODUCT_SITECOMEU_LN030, MCS7830)},
};
static int mos_probe(device_t dev);
static int mos_attach(device_t dev);
static void mos_attach_post(struct usb_ether *ue);
static int mos_detach(device_t dev);
static void mos_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error);
static void mos_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error);
static void mos_intr_callback(struct usb_xfer *xfer, usb_error_t error);
static void mos_tick(struct usb_ether *);
static void mos_start(struct usb_ether *);
static void mos_init(struct usb_ether *);
static void mos_chip_init(struct mos_softc *);
static void mos_stop(struct usb_ether *);
static int mos_miibus_readreg(device_t, int, int);
static int mos_miibus_writereg(device_t, int, int, int);
static void mos_miibus_statchg(device_t);
static int mos_ifmedia_upd(struct ifnet *);
static void mos_ifmedia_sts(struct ifnet *, struct ifmediareq *);
static void mos_reset(struct mos_softc *sc);
static int mos_reg_read_1(struct mos_softc *, int);
static int mos_reg_read_2(struct mos_softc *, int);
static int mos_reg_write_1(struct mos_softc *, int, int);
static int mos_reg_write_2(struct mos_softc *, int, int);
static int mos_readmac(struct mos_softc *, uint8_t *);
static int mos_writemac(struct mos_softc *, uint8_t *);
static int mos_write_mcast(struct mos_softc *, u_char *);
static void mos_setmulti(struct usb_ether *);
static void mos_setpromisc(struct usb_ether *);
static const struct usb_config mos_config[MOS_ENDPT_MAX] = {
[MOS_ENDPT_TX] = {
.type = UE_BULK,
.endpoint = UE_ADDR_ANY,
.direction = UE_DIR_OUT,
.bufsize = (MCLBYTES + 2),
.flags = {.pipe_bof = 1,.force_short_xfer = 1,},
.callback = mos_bulk_write_callback,
.timeout = 10000,
},
[MOS_ENDPT_RX] = {
.type = UE_BULK,
.endpoint = UE_ADDR_ANY,
.direction = UE_DIR_IN,
.bufsize = (MCLBYTES + 4 + ETHER_CRC_LEN),
.flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
.callback = mos_bulk_read_callback,
},
[MOS_ENDPT_INTR] = {
.type = UE_INTERRUPT,
.endpoint = UE_ADDR_ANY,
.direction = UE_DIR_IN,
.flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
.bufsize = 0,
.callback = mos_intr_callback,
},
};
static device_method_t mos_methods[] = {
DEVMETHOD(device_probe, mos_probe),
DEVMETHOD(device_attach, mos_attach),
DEVMETHOD(device_detach, mos_detach),
DEVMETHOD(miibus_readreg, mos_miibus_readreg),
DEVMETHOD(miibus_writereg, mos_miibus_writereg),
DEVMETHOD(miibus_statchg, mos_miibus_statchg),
DEVMETHOD_END
};
static driver_t mos_driver = {
.name = "mos",
.methods = mos_methods,
.size = sizeof(struct mos_softc)
};
static devclass_t mos_devclass;
DRIVER_MODULE(mos, uhub, mos_driver, mos_devclass, NULL, NULL);
DRIVER_MODULE(miibus, mos, miibus_driver, miibus_devclass, NULL, NULL);
MODULE_DEPEND(mos, uether, 1, 1, 1);
MODULE_DEPEND(mos, usb, 1, 1, 1);
MODULE_DEPEND(mos, ether, 1, 1, 1);
MODULE_DEPEND(mos, miibus, 1, 1, 1);
static const struct usb_ether_methods mos_ue_methods = {
.ue_attach_post = mos_attach_post,
.ue_start = mos_start,
.ue_init = mos_init,
.ue_stop = mos_stop,
.ue_tick = mos_tick,
.ue_setmulti = mos_setmulti,
.ue_setpromisc = mos_setpromisc,
.ue_mii_upd = mos_ifmedia_upd,
.ue_mii_sts = mos_ifmedia_sts,
};
static int
mos_reg_read_1(struct mos_softc *sc, int reg)
{
struct usb_device_request req;
usb_error_t err;
uByte val = 0;
req.bmRequestType = UT_READ_VENDOR_DEVICE;
req.bRequest = MOS_UR_READREG;
USETW(req.wValue, 0);
USETW(req.wIndex, reg);
USETW(req.wLength, 1);
err = uether_do_request(&sc->sc_ue, &req, &val, 1000);
if (err) {
MOS_DPRINTFN("mos_reg_read_1 error, reg: %d\n", reg);
return (-1);
}
return (val);
}
static int
mos_reg_read_2(struct mos_softc *sc, int reg)
{
struct usb_device_request req;
usb_error_t err;
uWord val;
USETW(val, 0);
req.bmRequestType = UT_READ_VENDOR_DEVICE;
req.bRequest = MOS_UR_READREG;
USETW(req.wValue, 0);
USETW(req.wIndex, reg);
USETW(req.wLength, 2);
err = uether_do_request(&sc->sc_ue, &req, &val, 1000);
if (err) {
MOS_DPRINTFN("mos_reg_read_2 error, reg: %d", reg);
return (-1);
}
return (UGETW(val));
}
static int
mos_reg_write_1(struct mos_softc *sc, int reg, int aval)
{
struct usb_device_request req;
usb_error_t err;
uByte val;
val = aval;
req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
req.bRequest = MOS_UR_WRITEREG;
USETW(req.wValue, 0);
USETW(req.wIndex, reg);
USETW(req.wLength, 1);
err = uether_do_request(&sc->sc_ue, &req, &val, 1000);
if (err) {
MOS_DPRINTFN("mos_reg_write_1 error, reg: %d", reg);
return (-1);
}
return (0);
}
static int
mos_reg_write_2(struct mos_softc *sc, int reg, int aval)
{
struct usb_device_request req;
usb_error_t err;
uWord val;
USETW(val, aval);
req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
req.bRequest = MOS_UR_WRITEREG;
USETW(req.wValue, 0);
USETW(req.wIndex, reg);
USETW(req.wLength, 2);
err = uether_do_request(&sc->sc_ue, &req, &val, 1000);
if (err) {
MOS_DPRINTFN("mos_reg_write_2 error, reg: %d", reg);
return (-1);
}
return (0);
}
static int
mos_readmac(struct mos_softc *sc, u_char *mac)
{
struct usb_device_request req;
usb_error_t err;
req.bmRequestType = UT_READ_VENDOR_DEVICE;
req.bRequest = MOS_UR_READREG;
USETW(req.wValue, 0);
USETW(req.wIndex, MOS_MAC);
USETW(req.wLength, ETHER_ADDR_LEN);
err = uether_do_request(&sc->sc_ue, &req, mac, 1000);
if (err) {
return (-1);
}
return (0);
}
static int
mos_writemac(struct mos_softc *sc, uint8_t *mac)
{
struct usb_device_request req;
usb_error_t err;
req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
req.bRequest = MOS_UR_WRITEREG;
USETW(req.wValue, 0);
USETW(req.wIndex, MOS_MAC);
USETW(req.wLength, ETHER_ADDR_LEN);
err = uether_do_request(&sc->sc_ue, &req, mac, 1000);
if (err) {
MOS_DPRINTFN("mos_writemac error");
return (-1);
}
return (0);
}
static int
mos_write_mcast(struct mos_softc *sc, u_char *hashtbl)
{
struct usb_device_request req;
usb_error_t err;
req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
req.bRequest = MOS_UR_WRITEREG;
USETW(req.wValue, 0);
USETW(req.wIndex, MOS_MCAST_TABLE);
USETW(req.wLength, 8);
err = uether_do_request(&sc->sc_ue, &req, hashtbl, 1000);
if (err) {
MOS_DPRINTFN("mos_reg_mcast error");
return (-1);
}
return (0);
}
static int
mos_miibus_readreg(device_t dev, int phy, int reg)
{
struct mos_softc *sc = device_get_softc(dev);
uWord val;
int i, res, locked;
USETW(val, 0);
locked = lockowned(&sc->sc_lock);
if (!locked)
MOS_LOCK(sc);
mos_reg_write_2(sc, MOS_PHY_DATA, 0);
mos_reg_write_1(sc, MOS_PHY_CTL, (phy & MOS_PHYCTL_PHYADDR) |
MOS_PHYCTL_READ);
mos_reg_write_1(sc, MOS_PHY_STS, (reg & MOS_PHYSTS_PHYREG) |
MOS_PHYSTS_PENDING);
for (i = 0; i < MOS_TIMEOUT; i++) {
if (mos_reg_read_1(sc, MOS_PHY_STS) & MOS_PHYSTS_READY)
break;
}
if (i == MOS_TIMEOUT) {
MOS_DPRINTFN("MII read timeout");
}
res = mos_reg_read_2(sc, MOS_PHY_DATA);
if (!locked)
MOS_UNLOCK(sc);
return (res);
}
static int
mos_miibus_writereg(device_t dev, int phy, int reg, int val)
{
struct mos_softc *sc = device_get_softc(dev);
int i, locked;
locked = lockowned(&sc->sc_lock);
if (!locked)
MOS_LOCK(sc);
mos_reg_write_2(sc, MOS_PHY_DATA, val);
mos_reg_write_1(sc, MOS_PHY_CTL, (phy & MOS_PHYCTL_PHYADDR) |
MOS_PHYCTL_WRITE);
mos_reg_write_1(sc, MOS_PHY_STS, (reg & MOS_PHYSTS_PHYREG) |
MOS_PHYSTS_PENDING);
for (i = 0; i < MOS_TIMEOUT; i++) {
if (mos_reg_read_1(sc, MOS_PHY_STS) & MOS_PHYSTS_READY)
break;
}
if (i == MOS_TIMEOUT)
MOS_DPRINTFN("MII write timeout");
if (!locked)
MOS_UNLOCK(sc);
return 0;
}
static void
mos_miibus_statchg(device_t dev)
{
struct mos_softc *sc = device_get_softc(dev);
struct mii_data *mii = GET_MII(sc);
int val, err, locked;
locked = lockowned(&sc->sc_lock);
if (!locked)
MOS_LOCK(sc);
val = mos_reg_read_1(sc, MOS_CTL);
val &= ~(MOS_CTL_TX_ENB | MOS_CTL_RX_ENB);
mos_reg_write_1(sc, MOS_CTL, val);
mos_reg_write_1(sc, MOS_FRAME_DROP_CNT, 0);
if ((mii->mii_media_active & IFM_GMASK) == IFM_FDX)
val |= MOS_CTL_FDX_ENB;
else
val &= ~(MOS_CTL_FDX_ENB);
switch (IFM_SUBTYPE(mii->mii_media_active)) {
case IFM_100_TX:
val |= MOS_CTL_SPEEDSEL;
break;
case IFM_10_T:
val &= ~(MOS_CTL_SPEEDSEL);
break;
}
val |= (MOS_CTL_TX_ENB | MOS_CTL_RX_ENB);
err = mos_reg_write_1(sc, MOS_CTL, val);
if (err)
MOS_DPRINTFN("media change failed");
if (!locked)
MOS_UNLOCK(sc);
}
static int
mos_ifmedia_upd(struct ifnet *ifp)
{
struct mos_softc *sc = ifp->if_softc;
struct mii_data *mii = GET_MII(sc);
struct mii_softc *miisc;
int error;
MOS_LOCK_ASSERT(sc);
sc->mos_link = 0;
if (mii->mii_instance) {
LIST_FOREACH(miisc, &mii->mii_phys, mii_list)
mii_phy_reset(miisc);
}
error = mii_mediachg(mii);
return (error);
}
static void
mos_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
{
struct mos_softc *sc = ifp->if_softc;
struct mii_data *mii = GET_MII(sc);
MOS_LOCK(sc);
mii_pollstat(mii);
ifmr->ifm_active = mii->mii_media_active;
ifmr->ifm_status = mii->mii_media_status;
MOS_UNLOCK(sc);
}
static void
mos_setpromisc(struct usb_ether *ue)
{
struct mos_softc *sc = uether_getsc(ue);
struct ifnet *ifp = uether_getifp(ue);
uint8_t rxmode;
MOS_LOCK_ASSERT(sc);
rxmode = mos_reg_read_1(sc, MOS_CTL);
if (ifp->if_flags & IFF_PROMISC) {
rxmode |= MOS_CTL_RX_PROMISC;
} else {
rxmode &= ~MOS_CTL_RX_PROMISC;
}
mos_reg_write_1(sc, MOS_CTL, rxmode);
}
static void
mos_setmulti(struct usb_ether *ue)
{
struct mos_softc *sc = uether_getsc(ue);
struct ifnet *ifp = uether_getifp(ue);
struct ifmultiaddr *ifma;
uint32_t h = 0;
uint8_t rxmode;
uint8_t hashtbl[8] = {0, 0, 0, 0, 0, 0, 0, 0};
int allmulti = 0;
MOS_LOCK_ASSERT(sc);
rxmode = mos_reg_read_1(sc, MOS_CTL);
if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC)
allmulti = 1;
TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
if (ifma->ifma_addr->sa_family != AF_LINK) {
allmulti = 1;
continue;
}
h = ether_crc32_be(LLADDR((struct sockaddr_dl *)
ifma->ifma_addr), ETHER_ADDR_LEN) >> 26;
setbit(hashtbl, h);
}
if (allmulti == 1) {
rxmode |= MOS_CTL_ALLMULTI;
mos_reg_write_1(sc, MOS_CTL, rxmode);
} else {
rxmode &= ~MOS_CTL_ALLMULTI;
mos_write_mcast(sc, (void *)&hashtbl);
mos_reg_write_1(sc, MOS_CTL, rxmode);
}
}
static void
mos_reset(struct mos_softc *sc)
{
uint8_t ctl;
ctl = mos_reg_read_1(sc, MOS_CTL);
ctl &= ~(MOS_CTL_RX_PROMISC | MOS_CTL_ALLMULTI | MOS_CTL_TX_ENB |
MOS_CTL_RX_ENB);
mos_reg_write_1(sc, MOS_CTL, ctl);
mos_reg_write_1(sc, MOS_FRAME_DROP_CNT, 0);
usb_pause_mtx(&sc->sc_lock, hz / 128);
return;
}
static void
mos_chip_init(struct mos_softc *sc)
{
int i;
if (mos_reg_read_1(sc, MOS_PAUSE_TRHD) != -1) {
for (i = 0; i < MOS_PAUSE_REWRITES; i++)
mos_reg_write_1(sc, MOS_PAUSE_TRHD, 0);
}
sc->mos_phyaddrs[0] = 1;
sc->mos_phyaddrs[1] = 0xFF;
}
static int
mos_probe(device_t dev)
{
struct usb_attach_arg *uaa = device_get_ivars(dev);
int retval;
if (uaa->usb_mode != USB_MODE_HOST)
return (ENXIO);
if (uaa->info.bConfigIndex != MOS_CONFIG_IDX)
return (ENXIO);
if (uaa->info.bIfaceIndex != MOS_IFACE_IDX)
return (ENXIO);
retval = usbd_lookup_id_by_uaa(mos_devs, sizeof(mos_devs), uaa);
return (retval);
}
static int
mos_attach(device_t dev)
{
struct usb_attach_arg *uaa = device_get_ivars(dev);
struct mos_softc *sc = device_get_softc(dev);
struct usb_ether *ue = &sc->sc_ue;
uint8_t iface_index;
int error;
sc->mos_flags = USB_GET_DRIVER_INFO(uaa);
device_set_usb_desc(dev);
lockinit(&sc->sc_lock, device_get_nameunit(dev), 0, LK_CANRECURSE);
iface_index = MOS_IFACE_IDX;
error = usbd_transfer_setup(uaa->device, &iface_index,
sc->sc_xfer, mos_config, MOS_ENDPT_MAX,
sc, &sc->sc_lock);
if (error) {
device_printf(dev, "allocating USB transfers failed\n");
goto detach;
}
ue->ue_sc = sc;
ue->ue_dev = dev;
ue->ue_udev = uaa->device;
ue->ue_lock = &sc->sc_lock;
ue->ue_methods = &mos_ue_methods;
if (sc->mos_flags & MCS7730) {
MOS_DPRINTFN("model: MCS7730");
} else if (sc->mos_flags & MCS7830) {
MOS_DPRINTFN("model: MCS7830");
} else if (sc->mos_flags & MCS7832) {
MOS_DPRINTFN("model: MCS7832");
}
error = uether_ifattach(ue);
if (error) {
device_printf(dev, "could not attach interface\n");
goto detach;
}
return (0);
detach:
mos_detach(dev);
return (ENXIO);
}
static void
mos_attach_post(struct usb_ether *ue)
{
struct mos_softc *sc = uether_getsc(ue);
int err;
#ifdef USB_DEBUG
char ethstr[ETHER_ADDRSTRLEN + 1];
#endif
err = mos_readmac(sc, ue->ue_eaddr);
if (err)
MOS_DPRINTFN("couldn't get MAC address");
MOS_DPRINTFN("address: %s", kether_ntoa(ue->ue_eaddr, ethstr));
mos_chip_init(sc);
}
static int
mos_detach(device_t dev)
{
struct mos_softc *sc = device_get_softc(dev);
struct usb_ether *ue = &sc->sc_ue;
usbd_transfer_unsetup(sc->sc_xfer, MOS_ENDPT_MAX);
uether_ifdetach(ue);
lockuninit(&sc->sc_lock);
return (0);
}
static void
mos_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error)
{
struct mos_softc *sc = usbd_xfer_softc(xfer);
struct usb_ether *ue = &sc->sc_ue;
struct ifnet *ifp = uether_getifp(ue);
uint8_t rxstat = 0;
uint32_t actlen;
uint16_t pktlen = 0;
struct usb_page_cache *pc;
usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
pc = usbd_xfer_get_frame(xfer, 0);
switch (USB_GET_STATE(xfer)) {
case USB_ST_TRANSFERRED:
MOS_DPRINTFN("actlen : %d", actlen);
if (actlen <= 1) {
IFNET_STAT_INC(ifp, ierrors, 1);
goto tr_setup;
}
usbd_copy_out(pc, actlen - sizeof(rxstat), &rxstat,
sizeof(rxstat));
if (rxstat != MOS_RXSTS_VALID) {
MOS_DPRINTFN("erroneous frame received");
if (rxstat & MOS_RXSTS_SHORT_FRAME)
MOS_DPRINTFN("frame size less than 64 bytes");
if (rxstat & MOS_RXSTS_LARGE_FRAME) {
MOS_DPRINTFN("frame size larger than "
"1532 bytes");
}
if (rxstat & MOS_RXSTS_CRC_ERROR)
MOS_DPRINTFN("CRC error");
if (rxstat & MOS_RXSTS_ALIGN_ERROR)
MOS_DPRINTFN("alignment error");
IFNET_STAT_INC(ifp, ierrors, 1);
goto tr_setup;
}
pktlen = actlen - 1;
if (pktlen < sizeof(struct ether_header)) {
MOS_DPRINTFN("error: pktlen %d is smaller "
"than ether_header %zd", pktlen,
sizeof(struct ether_header));
IFNET_STAT_INC(ifp, ierrors, 1);
goto tr_setup;
}
uether_rxbuf(ue, pc, 0, actlen);
case USB_ST_SETUP:
tr_setup:
usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
usbd_transfer_submit(xfer);
uether_rxflush(ue);
return;
default:
MOS_DPRINTFN("bulk read error, %s", usbd_errstr(error));
if (error != USB_ERR_CANCELLED) {
usbd_xfer_set_stall(xfer);
goto tr_setup;
}
MOS_DPRINTFN("start rx %i", usbd_xfer_max_len(xfer));
return;
}
}
static void
mos_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error)
{
struct mos_softc *sc = usbd_xfer_softc(xfer);
struct ifnet *ifp = uether_getifp(&sc->sc_ue);
struct usb_page_cache *pc;
struct mbuf *m;
switch (USB_GET_STATE(xfer)) {
case USB_ST_TRANSFERRED:
MOS_DPRINTFN("transfer of complete");
IFNET_STAT_INC(ifp, opackets, 1);
case USB_ST_SETUP:
tr_setup:
m = ifq_dequeue(&ifp->if_snd);
if (m == NULL)
return;
pc = usbd_xfer_get_frame(xfer, 0);
usbd_m_copy_in(pc, 0, m, 0, m->m_pkthdr.len);
usbd_xfer_set_frame_len(xfer, 0, m->m_pkthdr.len);
BPF_MTAP(ifp, m);
m_freem(m);
usbd_transfer_submit(xfer);
IFNET_STAT_INC(ifp, opackets, 1);
return;
default:
MOS_DPRINTFN("usb error on tx: %s\n", usbd_errstr(error));
IFNET_STAT_INC(ifp, oerrors, 1);
if (error != USB_ERR_CANCELLED) {
usbd_xfer_set_stall(xfer);
goto tr_setup;
}
return;
}
}
static void
mos_tick(struct usb_ether *ue)
{
struct mos_softc *sc = uether_getsc(ue);
struct mii_data *mii = GET_MII(sc);
MOS_LOCK_ASSERT(sc);
mii_tick(mii);
if (!sc->mos_link && mii->mii_media_status & IFM_ACTIVE &&
IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) {
MOS_DPRINTFN("got link");
sc->mos_link++;
mos_start(ue);
}
}
static void
mos_start(struct usb_ether *ue)
{
struct mos_softc *sc = uether_getsc(ue);
usbd_transfer_start(sc->sc_xfer[MOS_ENDPT_TX]);
usbd_transfer_start(sc->sc_xfer[MOS_ENDPT_RX]);
usbd_transfer_start(sc->sc_xfer[MOS_ENDPT_INTR]);
}
static void
mos_init(struct usb_ether *ue)
{
struct mos_softc *sc = uether_getsc(ue);
struct ifnet *ifp = uether_getifp(ue);
uint8_t rxmode;
MOS_LOCK_ASSERT(sc);
mos_reset(sc);
mos_writemac(sc, IF_LLADDR(ifp));
sc->mos_ipgs[0] = mos_reg_read_1(sc, MOS_IPG0);
sc->mos_ipgs[1] = mos_reg_read_1(sc, MOS_IPG1);
mos_reg_write_1(sc, MOS_IPG0, sc->mos_ipgs[0]);
mos_reg_write_1(sc, MOS_IPG1, sc->mos_ipgs[1]);
rxmode = mos_reg_read_1(sc, MOS_CTL);
rxmode |= MOS_CTL_RX_ENB | MOS_CTL_TX_ENB | MOS_CTL_BS_ENB;
rxmode &= ~(MOS_CTL_SLEEP);
mos_setpromisc(ue);
mos_reg_write_1(sc, MOS_CTL, rxmode);
mos_setmulti(ue);
ifp->if_flags |= IFF_RUNNING;
mos_start(ue);
}
static void
mos_intr_callback(struct usb_xfer *xfer, usb_error_t error)
{
struct mos_softc *sc = usbd_xfer_softc(xfer);
struct ifnet *ifp = uether_getifp(&sc->sc_ue);
struct usb_page_cache *pc;
uint32_t pkt;
int actlen;
IFNET_STAT_INC(ifp, oerrors, 1);
usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
MOS_DPRINTFN("actlen %i", actlen);
switch (USB_GET_STATE(xfer)) {
case USB_ST_TRANSFERRED:
pc = usbd_xfer_get_frame(xfer, 0);
usbd_copy_out(pc, 0, &pkt, sizeof(pkt));
case USB_ST_SETUP:
tr_setup:
return;
default:
if (error != USB_ERR_CANCELLED) {
usbd_xfer_set_stall(xfer);
goto tr_setup;
}
return;
}
}
static void
mos_stop(struct usb_ether *ue)
{
struct mos_softc *sc = uether_getsc(ue);
struct ifnet *ifp = uether_getifp(ue);
mos_reset(sc);
MOS_LOCK_ASSERT(sc);
ifp->if_flags &= ~IFF_RUNNING;
usbd_transfer_stop(sc->sc_xfer[MOS_ENDPT_TX]);
usbd_transfer_stop(sc->sc_xfer[MOS_ENDPT_RX]);
usbd_transfer_stop(sc->sc_xfer[MOS_ENDPT_INTR]);
sc->mos_link = 0;
}