#include <sys/stdint.h>
#include <sys/stddef.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/mutex.h>
#include <sys/condvar.h>
#include <sys/sysctl.h>
#include <sys/sx.h>
#include <sys/unistd.h>
#include <sys/callout.h>
#include <sys/malloc.h>
#include <sys/priv.h>
#include <net/if.h>
#include <net/if_var.h>
#include <net/if_media.h>
#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 "usbdevs.h"
#define USB_DEBUG_VAR rue_debug
#include <dev/usb/usb_debug.h>
#include <dev/usb/usb_process.h>
#include <dev/usb/net/usb_ethernet.h>
#include <dev/usb/net/if_ruereg.h>
#include "miibus_if.h"
#ifdef USB_DEBUG
static int rue_debug = 0;
static SYSCTL_NODE(_hw_usb, OID_AUTO, rue, CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
"USB rue");
SYSCTL_INT(_hw_usb_rue, OID_AUTO, debug, CTLFLAG_RWTUN,
&rue_debug, 0, "Debug level");
#endif
static const STRUCT_USB_HOST_ID rue_devs[] = {
{USB_VPI(USB_VENDOR_MELCO, USB_PRODUCT_MELCO_LUAKTX, 0)},
{USB_VPI(USB_VENDOR_REALTEK, USB_PRODUCT_REALTEK_USBKR100, 0)},
{USB_VPI(USB_VENDOR_OQO, USB_PRODUCT_OQO_ETHER01, 0)},
};
static device_probe_t rue_probe;
static device_attach_t rue_attach;
static device_detach_t rue_detach;
static miibus_readreg_t rue_miibus_readreg;
static miibus_writereg_t rue_miibus_writereg;
static miibus_statchg_t rue_miibus_statchg;
static usb_callback_t rue_intr_callback;
static usb_callback_t rue_bulk_read_callback;
static usb_callback_t rue_bulk_write_callback;
static uether_fn_t rue_attach_post;
static uether_fn_t rue_init;
static uether_fn_t rue_stop;
static uether_fn_t rue_start;
static uether_fn_t rue_tick;
static uether_fn_t rue_setmulti;
static uether_fn_t rue_setpromisc;
static int rue_read_mem(struct rue_softc *, uint16_t, void *, int);
static int rue_write_mem(struct rue_softc *, uint16_t, void *, int);
static uint8_t rue_csr_read_1(struct rue_softc *, uint16_t);
static uint16_t rue_csr_read_2(struct rue_softc *, uint16_t);
static int rue_csr_write_1(struct rue_softc *, uint16_t, uint8_t);
static int rue_csr_write_2(struct rue_softc *, uint16_t, uint16_t);
static int rue_csr_write_4(struct rue_softc *, int, uint32_t);
static void rue_reset(struct rue_softc *);
static int rue_ifmedia_upd(if_t);
static void rue_ifmedia_sts(if_t, struct ifmediareq *);
static const struct usb_config rue_config[RUE_N_TRANSFER] = {
[RUE_BULK_DT_WR] = {
.type = UE_BULK,
.endpoint = UE_ADDR_ANY,
.direction = UE_DIR_OUT,
.bufsize = MCLBYTES,
.flags = {.pipe_bof = 1,.force_short_xfer = 1,},
.callback = rue_bulk_write_callback,
.timeout = 10000,
},
[RUE_BULK_DT_RD] = {
.type = UE_BULK,
.endpoint = UE_ADDR_ANY,
.direction = UE_DIR_IN,
.bufsize = (MCLBYTES + 4),
.flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
.callback = rue_bulk_read_callback,
.timeout = 0,
},
[RUE_INTR_DT_RD] = {
.type = UE_INTERRUPT,
.endpoint = UE_ADDR_ANY,
.direction = UE_DIR_IN,
.flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
.bufsize = 0,
.callback = rue_intr_callback,
},
};
static device_method_t rue_methods[] = {
DEVMETHOD(device_probe, rue_probe),
DEVMETHOD(device_attach, rue_attach),
DEVMETHOD(device_detach, rue_detach),
DEVMETHOD(miibus_readreg, rue_miibus_readreg),
DEVMETHOD(miibus_writereg, rue_miibus_writereg),
DEVMETHOD(miibus_statchg, rue_miibus_statchg),
DEVMETHOD_END
};
static driver_t rue_driver = {
.name = "rue",
.methods = rue_methods,
.size = sizeof(struct rue_softc),
};
DRIVER_MODULE_ORDERED(rue, uhub, rue_driver, NULL, NULL, SI_ORDER_ANY);
DRIVER_MODULE(miibus, rue, miibus_driver, NULL, NULL);
MODULE_DEPEND(rue, uether, 1, 1, 1);
MODULE_DEPEND(rue, usb, 1, 1, 1);
MODULE_DEPEND(rue, ether, 1, 1, 1);
MODULE_DEPEND(rue, miibus, 1, 1, 1);
MODULE_VERSION(rue, 1);
USB_PNP_HOST_INFO(rue_devs);
static const struct usb_ether_methods rue_ue_methods = {
.ue_attach_post = rue_attach_post,
.ue_start = rue_start,
.ue_init = rue_init,
.ue_stop = rue_stop,
.ue_tick = rue_tick,
.ue_setmulti = rue_setmulti,
.ue_setpromisc = rue_setpromisc,
.ue_mii_upd = rue_ifmedia_upd,
.ue_mii_sts = rue_ifmedia_sts,
};
#define RUE_SETBIT(sc, reg, x) \
rue_csr_write_1(sc, reg, rue_csr_read_1(sc, reg) | (x))
#define RUE_CLRBIT(sc, reg, x) \
rue_csr_write_1(sc, reg, rue_csr_read_1(sc, reg) & ~(x))
static int
rue_read_mem(struct rue_softc *sc, uint16_t addr, void *buf, int len)
{
struct usb_device_request req;
req.bmRequestType = UT_READ_VENDOR_DEVICE;
req.bRequest = UR_SET_ADDRESS;
USETW(req.wValue, addr);
USETW(req.wIndex, 0);
USETW(req.wLength, len);
return (uether_do_request(&sc->sc_ue, &req, buf, 1000));
}
static int
rue_write_mem(struct rue_softc *sc, uint16_t addr, void *buf, int len)
{
struct usb_device_request req;
req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
req.bRequest = UR_SET_ADDRESS;
USETW(req.wValue, addr);
USETW(req.wIndex, 0);
USETW(req.wLength, len);
return (uether_do_request(&sc->sc_ue, &req, buf, 1000));
}
static uint8_t
rue_csr_read_1(struct rue_softc *sc, uint16_t reg)
{
uint8_t val;
rue_read_mem(sc, reg, &val, 1);
return (val);
}
static uint16_t
rue_csr_read_2(struct rue_softc *sc, uint16_t reg)
{
uint8_t val[2];
rue_read_mem(sc, reg, &val, 2);
return (UGETW(val));
}
static int
rue_csr_write_1(struct rue_softc *sc, uint16_t reg, uint8_t val)
{
return (rue_write_mem(sc, reg, &val, 1));
}
static int
rue_csr_write_2(struct rue_softc *sc, uint16_t reg, uint16_t val)
{
uint8_t temp[2];
USETW(temp, val);
return (rue_write_mem(sc, reg, &temp, 2));
}
static int
rue_csr_write_4(struct rue_softc *sc, int reg, uint32_t val)
{
uint8_t temp[4];
USETDW(temp, val);
return (rue_write_mem(sc, reg, &temp, 4));
}
static int
rue_miibus_readreg(device_t dev, int phy, int reg)
{
struct rue_softc *sc = device_get_softc(dev);
uint16_t rval;
uint16_t ruereg;
int locked;
if (phy != 0)
return (0);
locked = mtx_owned(&sc->sc_mtx);
if (!locked)
RUE_LOCK(sc);
switch (reg) {
case MII_BMCR:
ruereg = RUE_BMCR;
break;
case MII_BMSR:
ruereg = RUE_BMSR;
break;
case MII_ANAR:
ruereg = RUE_ANAR;
break;
case MII_ANER:
ruereg = RUE_AER;
break;
case MII_ANLPAR:
ruereg = RUE_ANLP;
break;
case MII_PHYIDR1:
case MII_PHYIDR2:
rval = 0;
goto done;
default:
if (RUE_REG_MIN <= reg && reg <= RUE_REG_MAX) {
rval = rue_csr_read_1(sc, reg);
goto done;
}
device_printf(sc->sc_ue.ue_dev, "bad phy register\n");
rval = 0;
goto done;
}
rval = rue_csr_read_2(sc, ruereg);
done:
if (!locked)
RUE_UNLOCK(sc);
return (rval);
}
static int
rue_miibus_writereg(device_t dev, int phy, int reg, int data)
{
struct rue_softc *sc = device_get_softc(dev);
uint16_t ruereg;
int locked;
if (phy != 0)
return (0);
locked = mtx_owned(&sc->sc_mtx);
if (!locked)
RUE_LOCK(sc);
switch (reg) {
case MII_BMCR:
ruereg = RUE_BMCR;
break;
case MII_BMSR:
ruereg = RUE_BMSR;
break;
case MII_ANAR:
ruereg = RUE_ANAR;
break;
case MII_ANER:
ruereg = RUE_AER;
break;
case MII_ANLPAR:
ruereg = RUE_ANLP;
break;
case MII_PHYIDR1:
case MII_PHYIDR2:
goto done;
default:
if (RUE_REG_MIN <= reg && reg <= RUE_REG_MAX) {
rue_csr_write_1(sc, reg, data);
goto done;
}
device_printf(sc->sc_ue.ue_dev, " bad phy register\n");
goto done;
}
rue_csr_write_2(sc, ruereg, data);
done:
if (!locked)
RUE_UNLOCK(sc);
return (0);
}
static void
rue_miibus_statchg(device_t dev)
{
#if 0
struct rue_softc *sc = device_get_softc(dev);
struct mii_data *mii = GET_MII(sc);
uint16_t bmcr;
int locked;
locked = mtx_owned(&sc->sc_mtx);
if (!locked)
RUE_LOCK(sc);
RUE_CLRBIT(sc, RUE_CR, (RUE_CR_RE | RUE_CR_TE));
bmcr = rue_csr_read_2(sc, RUE_BMCR);
if (IFM_SUBTYPE(mii->mii_media_active) == IFM_100_TX)
bmcr |= RUE_BMCR_SPD_SET;
else
bmcr &= ~RUE_BMCR_SPD_SET;
if ((mii->mii_media_active & IFM_GMASK) == IFM_FDX)
bmcr |= RUE_BMCR_DUPLEX;
else
bmcr &= ~RUE_BMCR_DUPLEX;
rue_csr_write_2(sc, RUE_BMCR, bmcr);
RUE_SETBIT(sc, RUE_CR, (RUE_CR_RE | RUE_CR_TE));
if (!locked)
RUE_UNLOCK(sc);
#endif
}
static void
rue_setpromisc(struct usb_ether *ue)
{
struct rue_softc *sc = uether_getsc(ue);
if_t ifp = uether_getifp(ue);
RUE_LOCK_ASSERT(sc, MA_OWNED);
if (if_getflags(ifp) & IFF_PROMISC)
RUE_SETBIT(sc, RUE_RCR, RUE_RCR_AAP);
else
RUE_CLRBIT(sc, RUE_RCR, RUE_RCR_AAP);
}
static u_int
rue_hash_maddr(void *arg, struct sockaddr_dl *sdl, u_int cnt)
{
uint32_t *hashes = arg;
int h;
h = ether_crc32_be(LLADDR(sdl), ETHER_ADDR_LEN) >> 26;
if (h < 32)
hashes[0] |= (1 << h);
else
hashes[1] |= (1 << (h - 32));
return (1);
}
static void
rue_setmulti(struct usb_ether *ue)
{
struct rue_softc *sc = uether_getsc(ue);
if_t ifp = uether_getifp(ue);
uint16_t rxcfg;
uint32_t hashes[2] = { 0, 0 };
int mcnt;
RUE_LOCK_ASSERT(sc, MA_OWNED);
rxcfg = rue_csr_read_2(sc, RUE_RCR);
if (if_getflags(ifp) & IFF_ALLMULTI || if_getflags(ifp) & IFF_PROMISC) {
rxcfg |= (RUE_RCR_AAM | RUE_RCR_AAP);
rxcfg &= ~RUE_RCR_AM;
rue_csr_write_2(sc, RUE_RCR, rxcfg);
rue_csr_write_4(sc, RUE_MAR0, 0xFFFFFFFF);
rue_csr_write_4(sc, RUE_MAR4, 0xFFFFFFFF);
return;
}
rue_csr_write_4(sc, RUE_MAR0, 0);
rue_csr_write_4(sc, RUE_MAR4, 0);
mcnt = if_foreach_llmaddr(ifp, rue_hash_maddr, &hashes);
if (mcnt)
rxcfg |= RUE_RCR_AM;
else
rxcfg &= ~RUE_RCR_AM;
rxcfg &= ~(RUE_RCR_AAM | RUE_RCR_AAP);
rue_csr_write_2(sc, RUE_RCR, rxcfg);
rue_csr_write_4(sc, RUE_MAR0, hashes[0]);
rue_csr_write_4(sc, RUE_MAR4, hashes[1]);
}
static void
rue_reset(struct rue_softc *sc)
{
int i;
rue_csr_write_1(sc, RUE_CR, RUE_CR_SOFT_RST);
for (i = 0; i != RUE_TIMEOUT; i++) {
if (uether_pause(&sc->sc_ue, hz / 1000))
break;
if (!(rue_csr_read_1(sc, RUE_CR) & RUE_CR_SOFT_RST))
break;
}
if (i == RUE_TIMEOUT)
device_printf(sc->sc_ue.ue_dev, "reset never completed\n");
uether_pause(&sc->sc_ue, hz / 100);
}
static void
rue_attach_post(struct usb_ether *ue)
{
struct rue_softc *sc = uether_getsc(ue);
rue_reset(sc);
rue_read_mem(sc, RUE_EEPROM_IDR0, ue->ue_eaddr, ETHER_ADDR_LEN);
}
static int
rue_probe(device_t dev)
{
struct usb_attach_arg *uaa = device_get_ivars(dev);
if (uaa->usb_mode != USB_MODE_HOST)
return (ENXIO);
if (uaa->info.bConfigIndex != RUE_CONFIG_IDX)
return (ENXIO);
if (uaa->info.bIfaceIndex != RUE_IFACE_IDX)
return (ENXIO);
return (usbd_lookup_id_by_uaa(rue_devs, sizeof(rue_devs), uaa));
}
static int
rue_attach(device_t dev)
{
struct usb_attach_arg *uaa = device_get_ivars(dev);
struct rue_softc *sc = device_get_softc(dev);
struct usb_ether *ue = &sc->sc_ue;
uint8_t iface_index;
int error;
device_set_usb_desc(dev);
mtx_init(&sc->sc_mtx, device_get_nameunit(dev), NULL, MTX_DEF);
iface_index = RUE_IFACE_IDX;
error = usbd_transfer_setup(uaa->device, &iface_index,
sc->sc_xfer, rue_config, RUE_N_TRANSFER,
sc, &sc->sc_mtx);
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_mtx = &sc->sc_mtx;
ue->ue_methods = &rue_ue_methods;
error = uether_ifattach(ue);
if (error) {
device_printf(dev, "could not attach interface\n");
goto detach;
}
return (0);
detach:
rue_detach(dev);
return (ENXIO);
}
static int
rue_detach(device_t dev)
{
struct rue_softc *sc = device_get_softc(dev);
struct usb_ether *ue = &sc->sc_ue;
usbd_transfer_unsetup(sc->sc_xfer, RUE_N_TRANSFER);
uether_ifdetach(ue);
mtx_destroy(&sc->sc_mtx);
return (0);
}
static void
rue_intr_callback(struct usb_xfer *xfer, usb_error_t error)
{
struct rue_softc *sc = usbd_xfer_softc(xfer);
if_t ifp = uether_getifp(&sc->sc_ue);
struct rue_intrpkt pkt;
struct usb_page_cache *pc;
int actlen;
usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
switch (USB_GET_STATE(xfer)) {
case USB_ST_TRANSFERRED:
if (ifp && (if_getdrvflags(ifp) & IFF_DRV_RUNNING) &&
actlen >= (int)sizeof(pkt)) {
pc = usbd_xfer_get_frame(xfer, 0);
usbd_copy_out(pc, 0, &pkt, sizeof(pkt));
if_inc_counter(ifp, IFCOUNTER_IERRORS, pkt.rue_rxlost_cnt);
if_inc_counter(ifp, IFCOUNTER_IERRORS, pkt.rue_crcerr_cnt);
if_inc_counter(ifp, IFCOUNTER_COLLISIONS, pkt.rue_col_cnt);
}
case USB_ST_SETUP:
tr_setup:
usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
usbd_transfer_submit(xfer);
return;
default:
if (error != USB_ERR_CANCELLED) {
usbd_xfer_set_stall(xfer);
goto tr_setup;
}
return;
}
}
static void
rue_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error)
{
struct rue_softc *sc = usbd_xfer_softc(xfer);
struct usb_ether *ue = &sc->sc_ue;
if_t ifp = uether_getifp(ue);
struct usb_page_cache *pc;
uint16_t status;
int actlen;
usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
switch (USB_GET_STATE(xfer)) {
case USB_ST_TRANSFERRED:
if (actlen < 4) {
if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
goto tr_setup;
}
pc = usbd_xfer_get_frame(xfer, 0);
usbd_copy_out(pc, actlen - 4, &status, sizeof(status));
actlen -= 4;
status = le16toh(status);
if ((status & RUE_RXSTAT_VALID) == 0) {
if_inc_counter(ifp, IFCOUNTER_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:
DPRINTF("bulk read error, %s\n",
usbd_errstr(error));
if (error != USB_ERR_CANCELLED) {
usbd_xfer_set_stall(xfer);
goto tr_setup;
}
return;
}
}
static void
rue_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error)
{
struct rue_softc *sc = usbd_xfer_softc(xfer);
if_t ifp = uether_getifp(&sc->sc_ue);
struct usb_page_cache *pc;
struct mbuf *m;
int temp_len;
switch (USB_GET_STATE(xfer)) {
case USB_ST_TRANSFERRED:
DPRINTFN(11, "transfer complete\n");
if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1);
case USB_ST_SETUP:
tr_setup:
if ((sc->sc_flags & RUE_FLAG_LINK) == 0) {
return;
}
m = if_dequeue(ifp);
if (m == NULL)
return;
if (m->m_pkthdr.len > MCLBYTES)
m->m_pkthdr.len = MCLBYTES;
temp_len = m->m_pkthdr.len;
pc = usbd_xfer_get_frame(xfer, 0);
usbd_m_copy_in(pc, 0, m, 0, m->m_pkthdr.len);
if (temp_len < RUE_MIN_FRAMELEN) {
usbd_frame_zero(pc, temp_len,
RUE_MIN_FRAMELEN - temp_len);
temp_len = RUE_MIN_FRAMELEN;
}
usbd_xfer_set_frame_len(xfer, 0, temp_len);
BPF_MTAP(ifp, m);
m_freem(m);
usbd_transfer_submit(xfer);
return;
default:
DPRINTFN(11, "transfer error, %s\n",
usbd_errstr(error));
if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
if (error != USB_ERR_CANCELLED) {
usbd_xfer_set_stall(xfer);
goto tr_setup;
}
return;
}
}
static void
rue_tick(struct usb_ether *ue)
{
struct rue_softc *sc = uether_getsc(ue);
struct mii_data *mii = GET_MII(sc);
RUE_LOCK_ASSERT(sc, MA_OWNED);
mii_tick(mii);
if ((sc->sc_flags & RUE_FLAG_LINK) == 0
&& mii->mii_media_status & IFM_ACTIVE &&
IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) {
sc->sc_flags |= RUE_FLAG_LINK;
rue_start(ue);
}
}
static void
rue_start(struct usb_ether *ue)
{
struct rue_softc *sc = uether_getsc(ue);
usbd_transfer_start(sc->sc_xfer[RUE_INTR_DT_RD]);
usbd_transfer_start(sc->sc_xfer[RUE_BULK_DT_RD]);
usbd_transfer_start(sc->sc_xfer[RUE_BULK_DT_WR]);
}
static void
rue_init(struct usb_ether *ue)
{
struct rue_softc *sc = uether_getsc(ue);
if_t ifp = uether_getifp(ue);
RUE_LOCK_ASSERT(sc, MA_OWNED);
rue_reset(sc);
rue_write_mem(sc, RUE_IDR0, if_getlladdr(ifp), ETHER_ADDR_LEN);
rue_stop(ue);
rue_csr_write_1(sc, RUE_TCR, RUE_TCR_CONFIG);
rue_csr_write_2(sc, RUE_RCR, RUE_RCR_CONFIG|RUE_RCR_AB);
rue_setpromisc(ue);
rue_setmulti(ue);
rue_csr_write_1(sc, RUE_CR, (RUE_CR_TE | RUE_CR_RE | RUE_CR_EP3CLREN));
usbd_xfer_set_stall(sc->sc_xfer[RUE_BULK_DT_WR]);
if_setdrvflagbits(ifp, IFF_DRV_RUNNING, 0);
rue_start(ue);
}
static int
rue_ifmedia_upd(if_t ifp)
{
struct rue_softc *sc = if_getsoftc(ifp);
struct mii_data *mii = GET_MII(sc);
struct mii_softc *miisc;
int error;
RUE_LOCK_ASSERT(sc, MA_OWNED);
sc->sc_flags &= ~RUE_FLAG_LINK;
LIST_FOREACH(miisc, &mii->mii_phys, mii_list)
PHY_RESET(miisc);
error = mii_mediachg(mii);
return (error);
}
static void
rue_ifmedia_sts(if_t ifp, struct ifmediareq *ifmr)
{
struct rue_softc *sc = if_getsoftc(ifp);
struct mii_data *mii = GET_MII(sc);
RUE_LOCK(sc);
mii_pollstat(mii);
ifmr->ifm_active = mii->mii_media_active;
ifmr->ifm_status = mii->mii_media_status;
RUE_UNLOCK(sc);
}
static void
rue_stop(struct usb_ether *ue)
{
struct rue_softc *sc = uether_getsc(ue);
if_t ifp = uether_getifp(ue);
RUE_LOCK_ASSERT(sc, MA_OWNED);
if_setdrvflagbits(ifp, 0, IFF_DRV_RUNNING);
sc->sc_flags &= ~RUE_FLAG_LINK;
usbd_transfer_stop(sc->sc_xfer[RUE_BULK_DT_WR]);
usbd_transfer_stop(sc->sc_xfer[RUE_BULK_DT_RD]);
usbd_transfer_stop(sc->sc_xfer[RUE_INTR_DT_RD]);
rue_csr_write_1(sc, RUE_CR, 0x00);
rue_reset(sc);
}