#include <sys/param.h>
#include <sys/bus.h>
#include <sys/callout.h>
#include <sys/condvar.h>
#include <sys/kernel.h>
#include <sys/lock.h>
#include <sys/malloc.h>
#include <sys/module.h>
#include <sys/mutex.h>
#include <sys/priv.h>
#include <sys/queue.h>
#include <sys/random.h>
#include <sys/socket.h>
#include <sys/stddef.h>
#include <sys/stdint.h>
#include <sys/sx.h>
#include <sys/sysctl.h>
#include <sys/systm.h>
#include <sys/unistd.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 <netinet/in.h>
#include <netinet/ip.h>
#include "opt_platform.h"
#ifdef FDT
#include <dev/fdt/fdt_common.h>
#include <dev/ofw/ofw_bus.h>
#include <dev/ofw/ofw_bus_subr.h>
#include <dev/usb/usb_fdt_support.h>
#endif
#include <dev/usb/usb.h>
#include <dev/usb/usbdi.h>
#include <dev/usb/usbdi_util.h>
#include "usbdevs.h"
#define USB_DEBUG_VAR lan78xx_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_mugereg.h>
#include "miibus_if.h"
#ifdef USB_DEBUG
static int muge_debug = 0;
SYSCTL_NODE(_hw_usb, OID_AUTO, muge, CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
"Microchip LAN78xx USB-GigE");
SYSCTL_INT(_hw_usb_muge, OID_AUTO, debug, CTLFLAG_RWTUN, &muge_debug, 0,
"Debug level");
#endif
#define MUGE_DEFAULT_TX_CSUM_ENABLE (false)
#define MUGE_DEFAULT_TSO_ENABLE (false)
static const struct usb_device_id lan78xx_devs[] = {
#define MUGE_DEV(p,i) { USB_VPI(USB_VENDOR_SMC2, USB_PRODUCT_SMC2_##p, i) }
MUGE_DEV(LAN7800_ETH, 0),
MUGE_DEV(LAN7801_ETH, 0),
MUGE_DEV(LAN7850_ETH, 0),
#undef MUGE_DEV
};
#ifdef USB_DEBUG
#define muge_dbg_printf(sc, fmt, args...) \
do { \
if (muge_debug > 0) \
device_printf((sc)->sc_ue.ue_dev, "debug: " fmt, ##args); \
} while(0)
#else
#define muge_dbg_printf(sc, fmt, args...) do { } while (0)
#endif
#define muge_warn_printf(sc, fmt, args...) \
device_printf((sc)->sc_ue.ue_dev, "warning: " fmt, ##args)
#define muge_err_printf(sc, fmt, args...) \
device_printf((sc)->sc_ue.ue_dev, "error: " fmt, ##args)
#define ETHER_IS_VALID(addr) \
(!ETHER_IS_MULTICAST(addr) && !ETHER_IS_ZERO(addr))
enum {
MUGE_BULK_DT_RD,
MUGE_BULK_DT_WR,
#if 0
MUGE_INTR_DT_WR,
MUGE_INTR_DT_RD,
#endif
MUGE_N_TRANSFER,
};
struct muge_softc {
struct usb_ether sc_ue;
struct mtx sc_mtx;
struct usb_xfer *sc_xfer[MUGE_N_TRANSFER];
int sc_phyno;
uint32_t sc_leds;
uint16_t sc_led_modes;
uint16_t sc_led_modes_mask;
uint32_t sc_rfe_ctl;
uint32_t sc_mdix_ctl;
uint16_t chipid;
uint16_t chiprev;
uint32_t sc_mchash_table[ETH_DP_SEL_VHF_HASH_LEN];
uint32_t sc_pfilter_table[MUGE_NUM_PFILTER_ADDRS_][2];
uint32_t sc_flags;
#define MUGE_FLAG_LINK 0x0001
#define MUGE_FLAG_INIT_DONE 0x0002
};
#define MUGE_IFACE_IDX 0
#define MUGE_LOCK(_sc) mtx_lock(&(_sc)->sc_mtx)
#define MUGE_UNLOCK(_sc) mtx_unlock(&(_sc)->sc_mtx)
#define MUGE_LOCK_ASSERT(_sc, t) mtx_assert(&(_sc)->sc_mtx, t)
static device_probe_t muge_probe;
static device_attach_t muge_attach;
static device_detach_t muge_detach;
static usb_callback_t muge_bulk_read_callback;
static usb_callback_t muge_bulk_write_callback;
static miibus_readreg_t lan78xx_miibus_readreg;
static miibus_writereg_t lan78xx_miibus_writereg;
static miibus_statchg_t lan78xx_miibus_statchg;
static int muge_attach_post_sub(struct usb_ether *ue);
static uether_fn_t muge_attach_post;
static uether_fn_t muge_init;
static uether_fn_t muge_stop;
static uether_fn_t muge_start;
static uether_fn_t muge_tick;
static uether_fn_t muge_setmulti;
static uether_fn_t muge_setpromisc;
static int muge_ifmedia_upd(if_t);
static void muge_ifmedia_sts(if_t, struct ifmediareq *);
static int lan78xx_chip_init(struct muge_softc *sc);
static int muge_ioctl(if_t ifp, u_long cmd, caddr_t data);
static const struct usb_config muge_config[MUGE_N_TRANSFER] = {
[MUGE_BULK_DT_WR] = {
.type = UE_BULK,
.endpoint = UE_ADDR_ANY,
.direction = UE_DIR_OUT,
.frames = 16,
.bufsize = 16 * (MCLBYTES + 16),
.flags = {.pipe_bof = 1,.force_short_xfer = 1,},
.callback = muge_bulk_write_callback,
.timeout = 10000,
},
[MUGE_BULK_DT_RD] = {
.type = UE_BULK,
.endpoint = UE_ADDR_ANY,
.direction = UE_DIR_IN,
.bufsize = 20480,
.flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
.callback = muge_bulk_read_callback,
.timeout = 0,
},
};
static const struct usb_ether_methods muge_ue_methods = {
.ue_attach_post = muge_attach_post,
.ue_attach_post_sub = muge_attach_post_sub,
.ue_start = muge_start,
.ue_ioctl = muge_ioctl,
.ue_init = muge_init,
.ue_stop = muge_stop,
.ue_tick = muge_tick,
.ue_setmulti = muge_setmulti,
.ue_setpromisc = muge_setpromisc,
.ue_mii_upd = muge_ifmedia_upd,
.ue_mii_sts = muge_ifmedia_sts,
};
static int
lan78xx_read_reg(struct muge_softc *sc, uint32_t off, uint32_t *data)
{
struct usb_device_request req;
uint32_t buf;
usb_error_t err;
MUGE_LOCK_ASSERT(sc, MA_OWNED);
req.bmRequestType = UT_READ_VENDOR_DEVICE;
req.bRequest = UVR_READ_REG;
USETW(req.wValue, 0);
USETW(req.wIndex, off);
USETW(req.wLength, 4);
err = uether_do_request(&sc->sc_ue, &req, &buf, 1000);
if (err != 0)
muge_warn_printf(sc, "Failed to read register 0x%0x\n", off);
*data = le32toh(buf);
return (err);
}
static int
lan78xx_write_reg(struct muge_softc *sc, uint32_t off, uint32_t data)
{
struct usb_device_request req;
uint32_t buf;
usb_error_t err;
MUGE_LOCK_ASSERT(sc, MA_OWNED);
buf = htole32(data);
req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
req.bRequest = UVR_WRITE_REG;
USETW(req.wValue, 0);
USETW(req.wIndex, off);
USETW(req.wLength, 4);
err = uether_do_request(&sc->sc_ue, &req, &buf, 1000);
if (err != 0)
muge_warn_printf(sc, "Failed to write register 0x%0x\n", off);
return (err);
}
static int
lan78xx_wait_for_bits(struct muge_softc *sc, uint32_t reg, uint32_t bits)
{
usb_ticks_t start_ticks;
const usb_ticks_t max_ticks = USB_MS_TO_TICKS(1000);
uint32_t val;
int err;
MUGE_LOCK_ASSERT(sc, MA_OWNED);
start_ticks = (usb_ticks_t)ticks;
do {
if ((err = lan78xx_read_reg(sc, reg, &val)) != 0)
return (err);
if (!(val & bits))
return (0);
uether_pause(&sc->sc_ue, hz / 100);
} while (((usb_ticks_t)(ticks - start_ticks)) < max_ticks);
return (USB_ERR_TIMEOUT);
}
static int
lan78xx_eeprom_read_raw(struct muge_softc *sc, uint16_t off, uint8_t *buf,
uint16_t buflen)
{
usb_ticks_t start_ticks;
const usb_ticks_t max_ticks = USB_MS_TO_TICKS(1000);
int err;
uint32_t val, saved;
uint16_t i;
bool locked;
locked = mtx_owned(&sc->sc_mtx);
if (!locked)
MUGE_LOCK(sc);
if (sc->chipid == ETH_ID_REV_CHIP_ID_7800_) {
err = lan78xx_read_reg(sc, ETH_HW_CFG, &val);
saved = val;
val &= ~(ETH_HW_CFG_LEDO_EN_ | ETH_HW_CFG_LED1_EN_);
err = lan78xx_write_reg(sc, ETH_HW_CFG, val);
}
err = lan78xx_wait_for_bits(sc, ETH_E2P_CMD, ETH_E2P_CMD_BUSY_);
if (err != 0) {
muge_warn_printf(sc, "eeprom busy, failed to read data\n");
goto done;
}
for (i = 0; i < buflen; i++) {
val = ETH_E2P_CMD_BUSY_ | ETH_E2P_CMD_READ_;
val |= (ETH_E2P_CMD_ADDR_MASK_ & (off + i));
if ((err = lan78xx_write_reg(sc, ETH_E2P_CMD, val)) != 0)
goto done;
start_ticks = (usb_ticks_t)ticks;
do {
if ((err = lan78xx_read_reg(sc, ETH_E2P_CMD, &val)) !=
0)
goto done;
if (!(val & ETH_E2P_CMD_BUSY_) ||
(val & ETH_E2P_CMD_TIMEOUT_))
break;
uether_pause(&sc->sc_ue, hz / 100);
} while (((usb_ticks_t)(ticks - start_ticks)) < max_ticks);
if (val & (ETH_E2P_CMD_BUSY_ | ETH_E2P_CMD_TIMEOUT_)) {
muge_warn_printf(sc, "eeprom command failed\n");
err = USB_ERR_IOERROR;
break;
}
if ((err = lan78xx_read_reg(sc, ETH_E2P_DATA, &val)) != 0)
goto done;
buf[i] = (val & 0xff);
}
done:
if (!locked)
MUGE_UNLOCK(sc);
if (sc->chipid == ETH_ID_REV_CHIP_ID_7800_) {
lan78xx_write_reg(sc, ETH_HW_CFG, saved);
}
return (err);
}
static bool
lan78xx_eeprom_present(struct muge_softc *sc)
{
int ret;
uint8_t sig;
ret = lan78xx_eeprom_read_raw(sc, ETH_E2P_INDICATOR_OFFSET, &sig, 1);
return (ret == 0 && sig == ETH_E2P_INDICATOR);
}
static int
lan78xx_otp_read_raw(struct muge_softc *sc, uint16_t off, uint8_t *buf,
uint16_t buflen)
{
int err;
uint32_t val;
uint16_t i;
bool locked;
locked = mtx_owned(&sc->sc_mtx);
if (!locked)
MUGE_LOCK(sc);
err = lan78xx_read_reg(sc, OTP_PWR_DN, &val);
if (val & OTP_PWR_DN_PWRDN_N) {
lan78xx_write_reg(sc, OTP_PWR_DN, 0);
err = lan78xx_wait_for_bits(sc, OTP_PWR_DN, OTP_PWR_DN_PWRDN_N);
if (err != 0) {
muge_warn_printf(sc, "OTP off? failed to read data\n");
goto done;
}
}
for (i = 0; i < buflen; i++) {
err = lan78xx_write_reg(sc, OTP_ADDR1,
((off + i) >> 8) & OTP_ADDR1_15_11);
err = lan78xx_write_reg(sc, OTP_ADDR2,
((off + i) & OTP_ADDR2_10_3));
err = lan78xx_write_reg(sc, OTP_FUNC_CMD, OTP_FUNC_CMD_READ_);
err = lan78xx_write_reg(sc, OTP_CMD_GO, OTP_CMD_GO_GO_);
err = lan78xx_wait_for_bits(sc, OTP_STATUS, OTP_STATUS_BUSY_);
if (err != 0) {
muge_warn_printf(sc, "OTP busy failed to read data\n");
goto done;
}
if ((err = lan78xx_read_reg(sc, OTP_RD_DATA, &val)) != 0)
goto done;
buf[i] = (uint8_t)(val & 0xff);
}
done:
if (!locked)
MUGE_UNLOCK(sc);
return (err);
}
static int
lan78xx_otp_read(struct muge_softc *sc, uint16_t off, uint8_t *buf,
uint16_t buflen)
{
uint8_t sig;
int err;
err = lan78xx_otp_read_raw(sc, OTP_INDICATOR_OFFSET, &sig, 1);
if (err == 0) {
if (sig == OTP_INDICATOR_1) {
} else if (sig == OTP_INDICATOR_2) {
off += 0x100;
} else {
err = -EINVAL;
}
if (!err)
err = lan78xx_otp_read_raw(sc, off, buf, buflen);
}
return (err);
}
static int
lan78xx_setmacaddress(struct muge_softc *sc, const uint8_t *addr)
{
int err;
uint32_t val;
muge_dbg_printf(sc,
"setting mac address to %02x:%02x:%02x:%02x:%02x:%02x\n",
addr[0], addr[1], addr[2], addr[3], addr[4], addr[5]);
MUGE_LOCK_ASSERT(sc, MA_OWNED);
val = (addr[3] << 24) | (addr[2] << 16) | (addr[1] << 8) | addr[0];
if ((err = lan78xx_write_reg(sc, ETH_RX_ADDRL, val)) != 0)
goto done;
val = (addr[5] << 8) | addr[4];
err = lan78xx_write_reg(sc, ETH_RX_ADDRH, val);
done:
return (err);
}
static int
lan78xx_set_rx_max_frame_length(struct muge_softc *sc, int size)
{
uint32_t buf;
bool rxenabled;
lan78xx_read_reg(sc, ETH_MAC_RX, &buf);
rxenabled = ((buf & ETH_MAC_RX_EN_) != 0);
if (rxenabled) {
buf &= ~ETH_MAC_RX_EN_;
lan78xx_write_reg(sc, ETH_MAC_RX, buf);
}
buf &= ~ETH_MAC_RX_MAX_FR_SIZE_MASK_;
buf |= (((size + 4) << ETH_MAC_RX_MAX_FR_SIZE_SHIFT_) &
ETH_MAC_RX_MAX_FR_SIZE_MASK_);
lan78xx_write_reg(sc, ETH_MAC_RX, buf);
if (rxenabled) {
buf |= ETH_MAC_RX_EN_;
lan78xx_write_reg(sc, ETH_MAC_RX, buf);
}
return (0);
}
static int
lan78xx_miibus_readreg(device_t dev, int phy, int reg)
{
struct muge_softc *sc = device_get_softc(dev);
uint32_t addr, val;
bool locked;
val = 0;
locked = mtx_owned(&sc->sc_mtx);
if (!locked)
MUGE_LOCK(sc);
if (lan78xx_wait_for_bits(sc, ETH_MII_ACC, ETH_MII_ACC_MII_BUSY_) !=
0) {
muge_warn_printf(sc, "MII is busy\n");
goto done;
}
addr = (phy << 11) | (reg << 6) |
ETH_MII_ACC_MII_READ_ | ETH_MII_ACC_MII_BUSY_;
lan78xx_write_reg(sc, ETH_MII_ACC, addr);
if (lan78xx_wait_for_bits(sc, ETH_MII_ACC, ETH_MII_ACC_MII_BUSY_) !=
0) {
muge_warn_printf(sc, "MII read timeout\n");
goto done;
}
lan78xx_read_reg(sc, ETH_MII_DATA, &val);
val = le32toh(val);
done:
if (!locked)
MUGE_UNLOCK(sc);
return (val & 0xFFFF);
}
static int
lan78xx_miibus_writereg(device_t dev, int phy, int reg, int val)
{
struct muge_softc *sc = device_get_softc(dev);
uint32_t addr;
bool locked;
if (sc->sc_phyno != phy)
return (0);
locked = mtx_owned(&sc->sc_mtx);
if (!locked)
MUGE_LOCK(sc);
if (lan78xx_wait_for_bits(sc, ETH_MII_ACC, ETH_MII_ACC_MII_BUSY_) !=
0) {
muge_warn_printf(sc, "MII is busy\n");
goto done;
}
val = htole32(val);
lan78xx_write_reg(sc, ETH_MII_DATA, val);
addr = (phy << 11) | (reg << 6) |
ETH_MII_ACC_MII_WRITE_ | ETH_MII_ACC_MII_BUSY_;
lan78xx_write_reg(sc, ETH_MII_ACC, addr);
if (lan78xx_wait_for_bits(sc, ETH_MII_ACC, ETH_MII_ACC_MII_BUSY_) != 0)
muge_warn_printf(sc, "MII write timeout\n");
done:
if (!locked)
MUGE_UNLOCK(sc);
return (0);
}
static void
lan78xx_miibus_statchg(device_t dev)
{
struct muge_softc *sc = device_get_softc(dev);
struct mii_data *mii = uether_getmii(&sc->sc_ue);
if_t ifp;
int err;
uint32_t flow = 0;
uint32_t fct_flow = 0;
bool locked;
locked = mtx_owned(&sc->sc_mtx);
if (!locked)
MUGE_LOCK(sc);
ifp = uether_getifp(&sc->sc_ue);
if (mii == NULL || ifp == NULL ||
(if_getdrvflags(ifp) & IFF_DRV_RUNNING) == 0)
goto done;
sc->sc_flags &= ~MUGE_FLAG_LINK;
if ((mii->mii_media_status & (IFM_ACTIVE | IFM_AVALID)) ==
(IFM_ACTIVE | IFM_AVALID)) {
muge_dbg_printf(sc, "media is active\n");
switch (IFM_SUBTYPE(mii->mii_media_active)) {
case IFM_10_T:
case IFM_100_TX:
sc->sc_flags |= MUGE_FLAG_LINK;
muge_dbg_printf(sc, "10/100 ethernet\n");
break;
case IFM_1000_T:
sc->sc_flags |= MUGE_FLAG_LINK;
muge_dbg_printf(sc, "Gigabit ethernet\n");
break;
default:
break;
}
}
if ((sc->sc_flags & MUGE_FLAG_LINK) == 0) {
muge_dbg_printf(sc, "link flag not set\n");
goto done;
}
err = lan78xx_read_reg(sc, ETH_FCT_FLOW, &fct_flow);
if (err) {
muge_warn_printf(sc,
"failed to read initial flow control thresholds, error %d\n",
err);
goto done;
}
if ((IFM_OPTIONS(mii->mii_media_active) & IFM_FDX) != 0) {
muge_dbg_printf(sc, "full duplex operation\n");
if ((IFM_OPTIONS(mii->mii_media_active) & IFM_ETH_TXPAUSE) != 0)
flow |= ETH_FLOW_CR_TX_FCEN_ | 0xFFFF;
if ((IFM_OPTIONS(mii->mii_media_active) & IFM_ETH_RXPAUSE) != 0)
flow |= ETH_FLOW_CR_RX_FCEN_;
}
switch(usbd_get_speed(sc->sc_ue.ue_udev)) {
case USB_SPEED_SUPER:
fct_flow = 0x817;
break;
case USB_SPEED_HIGH:
fct_flow = 0x211;
break;
default:
break;
}
err += lan78xx_write_reg(sc, ETH_FLOW, flow);
err += lan78xx_write_reg(sc, ETH_FCT_FLOW, fct_flow);
if (err)
muge_warn_printf(sc, "media change failed, error %d\n", err);
done:
if (!locked)
MUGE_UNLOCK(sc);
}
static void
lan78xx_set_mdix_auto(struct muge_softc *sc)
{
uint32_t buf, err;
err = lan78xx_miibus_writereg(sc->sc_ue.ue_dev, sc->sc_phyno,
MUGE_EXT_PAGE_ACCESS, MUGE_EXT_PAGE_SPACE_1);
buf = lan78xx_miibus_readreg(sc->sc_ue.ue_dev, sc->sc_phyno,
MUGE_EXT_MODE_CTRL);
buf &= ~MUGE_EXT_MODE_CTRL_MDIX_MASK_;
buf |= MUGE_EXT_MODE_CTRL_AUTO_MDIX_;
lan78xx_miibus_readreg(sc->sc_ue.ue_dev, sc->sc_phyno, MII_BMCR);
err += lan78xx_miibus_writereg(sc->sc_ue.ue_dev, sc->sc_phyno,
MUGE_EXT_MODE_CTRL, buf);
err += lan78xx_miibus_writereg(sc->sc_ue.ue_dev, sc->sc_phyno,
MUGE_EXT_PAGE_ACCESS, MUGE_EXT_PAGE_SPACE_0);
if (err != 0)
muge_warn_printf(sc, "error setting PHY's MDIX status\n");
sc->sc_mdix_ctl = buf;
}
static int
lan78xx_phy_init(struct muge_softc *sc)
{
muge_dbg_printf(sc, "Initializing PHY.\n");
uint16_t bmcr, lmsr;
usb_ticks_t start_ticks;
uint32_t hw_reg;
const usb_ticks_t max_ticks = USB_MS_TO_TICKS(1000);
MUGE_LOCK_ASSERT(sc, MA_OWNED);
lan78xx_miibus_writereg(sc->sc_ue.ue_dev, sc->sc_phyno, MII_BMCR,
BMCR_RESET);
start_ticks = ticks;
do {
uether_pause(&sc->sc_ue, hz / 100);
bmcr = lan78xx_miibus_readreg(sc->sc_ue.ue_dev, sc->sc_phyno,
MII_BMCR);
} while ((bmcr & BMCR_RESET) && ((ticks - start_ticks) < max_ticks));
if (((usb_ticks_t)(ticks - start_ticks)) >= max_ticks) {
muge_err_printf(sc, "PHY reset timed-out\n");
return (EIO);
}
lan78xx_miibus_readreg(sc->sc_ue.ue_dev, sc->sc_phyno,
MUGE_PHY_INTR_STAT);
lan78xx_miibus_writereg(sc->sc_ue.ue_dev, sc->sc_phyno,
MUGE_PHY_INTR_MASK,
(MUGE_PHY_INTR_ANEG_COMP | MUGE_PHY_INTR_LINK_CHANGE));
lan78xx_set_mdix_auto(sc);
lan78xx_miibus_writereg(sc->sc_ue.ue_dev, sc->sc_phyno, MII_ANAR,
ANAR_10 | ANAR_10_FD | ANAR_TX | ANAR_TX_FD |
ANAR_CSMA | ANAR_FC | ANAR_PAUSE_ASYM);
bmcr |= BMCR_STARTNEG;
bmcr |= BMCR_AUTOEN;
lan78xx_miibus_writereg(sc->sc_ue.ue_dev, sc->sc_phyno, MII_BMCR, bmcr);
bmcr = lan78xx_miibus_readreg(sc->sc_ue.ue_dev, sc->sc_phyno, MII_BMCR);
if (sc->sc_led_modes_mask != 0) {
lmsr = lan78xx_miibus_readreg(sc->sc_ue.ue_dev, sc->sc_phyno,
MUGE_PHY_LED_MODE);
lmsr &= ~sc->sc_led_modes_mask;
lmsr |= sc->sc_led_modes;
lan78xx_miibus_writereg(sc->sc_ue.ue_dev, sc->sc_phyno,
MUGE_PHY_LED_MODE, lmsr);
}
if (sc->sc_leds != 0 &&
lan78xx_read_reg(sc, ETH_HW_CFG, &hw_reg) == 0) {
hw_reg &= ~(ETH_HW_CFG_LEDO_EN_ | ETH_HW_CFG_LED1_EN_ |
ETH_HW_CFG_LED2_EN_ | ETH_HW_CFG_LED3_EN_ );
hw_reg |= sc->sc_leds;
lan78xx_write_reg(sc, ETH_HW_CFG, hw_reg);
}
return (0);
}
static int
lan78xx_chip_init(struct muge_softc *sc)
{
int err;
uint32_t buf;
uint32_t burst_cap;
MUGE_LOCK_ASSERT(sc, MA_OWNED);
lan78xx_write_reg(sc, ETH_HW_CFG, ETH_HW_CFG_LRST_);
if ((err = lan78xx_wait_for_bits(sc, ETH_HW_CFG, ETH_HW_CFG_LRST_)) !=
0) {
muge_warn_printf(sc,
"timed-out waiting for lite reset to complete\n");
goto init_failed;
}
if ((err = lan78xx_setmacaddress(sc, sc->sc_ue.ue_eaddr)) != 0) {
muge_warn_printf(sc, "failed to set the MAC address\n");
goto init_failed;
}
if ((err = lan78xx_read_reg(sc, ETH_ID_REV, &buf)) < 0) {
muge_warn_printf(sc, "failed to read ETH_ID_REV (err = %d)\n",
err);
goto init_failed;
}
sc->chipid = (buf & ETH_ID_REV_CHIP_ID_MASK_) >> 16;
sc->chiprev = buf & ETH_ID_REV_CHIP_REV_MASK_;
switch (sc->chipid) {
case ETH_ID_REV_CHIP_ID_7800_:
case ETH_ID_REV_CHIP_ID_7850_:
break;
default:
muge_warn_printf(sc, "Chip ID 0x%04x not yet supported\n",
sc->chipid);
goto init_failed;
}
device_printf(sc->sc_ue.ue_dev, "Chip ID 0x%04x rev %04x\n", sc->chipid,
sc->chiprev);
if ((err = lan78xx_read_reg(sc, ETH_USB_CFG0, &buf)) != 0) {
muge_warn_printf(sc, "failed to read ETH_USB_CFG0 (err=%d)\n", err);
goto init_failed;
}
buf |= ETH_USB_CFG_BIR_;
lan78xx_write_reg(sc, ETH_USB_CFG0, buf);
switch (usbd_get_speed(sc->sc_ue.ue_udev)) {
case USB_SPEED_SUPER:
burst_cap = MUGE_DEFAULT_BURST_CAP_SIZE/MUGE_SS_USB_PKT_SIZE;
break;
case USB_SPEED_HIGH:
burst_cap = MUGE_DEFAULT_BURST_CAP_SIZE/MUGE_HS_USB_PKT_SIZE;
break;
default:
burst_cap = MUGE_DEFAULT_BURST_CAP_SIZE/MUGE_FS_USB_PKT_SIZE;
}
lan78xx_write_reg(sc, ETH_BURST_CAP, burst_cap);
lan78xx_write_reg(sc, ETH_BULK_IN_DLY, MUGE_DEFAULT_BULK_IN_DELAY);
err = lan78xx_read_reg(sc, ETH_HW_CFG, &buf);
buf |= ETH_HW_CFG_MEF_;
err = lan78xx_write_reg(sc, ETH_HW_CFG, buf);
if ((err = lan78xx_read_reg(sc, ETH_USB_CFG0, &buf)) < 0) {
muge_warn_printf(sc, "failed to read ETH_USB_CFG0 (err=%d)\n",
err);
goto init_failed;
}
buf |= ETH_USB_CFG_BCE_;
err = lan78xx_write_reg(sc, ETH_USB_CFG0, buf);
buf = (MUGE_MAX_RX_FIFO_SIZE - 512) / 512;
err = lan78xx_write_reg(sc, ETH_FCT_RX_FIFO_END, buf);
buf = (MUGE_MAX_TX_FIFO_SIZE - 512) / 512;
err = lan78xx_write_reg(sc, ETH_FCT_TX_FIFO_END, buf);
err = lan78xx_write_reg(sc, ETH_INT_STS, ETH_INT_STS_CLEAR_ALL_);
err = lan78xx_write_reg(sc, ETH_FLOW, 0);
err = lan78xx_write_reg(sc, ETH_FCT_FLOW, 0);
err = lan78xx_read_reg(sc, ETH_RFE_CTL, &buf);
buf |= ETH_RFE_CTL_BCAST_EN_ | ETH_RFE_CTL_DA_PERFECT_;
err = lan78xx_write_reg(sc, ETH_RFE_CTL, buf);
lan78xx_write_reg(sc, ETH_PMT_CTL, ETH_PMT_CTL_PHY_RST_);
if ((err = lan78xx_wait_for_bits(sc, ETH_PMT_CTL,
ETH_PMT_CTL_PHY_RST_)) != 0) {
muge_warn_printf(sc,
"timed-out waiting for phy reset to complete\n");
goto init_failed;
}
err = lan78xx_read_reg(sc, ETH_MAC_CR, &buf);
if (sc->chipid == ETH_ID_REV_CHIP_ID_7800_ &&
!lan78xx_eeprom_present(sc)) {
buf |= ETH_MAC_CR_AUTO_DUPLEX_ | ETH_MAC_CR_AUTO_SPEED_;
}
err = lan78xx_write_reg(sc, ETH_MAC_CR, buf);
err = lan78xx_read_reg(sc, ETH_INT_EP_CTL, &buf);
buf |= ETH_INT_ENP_PHY_INT;
err = lan78xx_write_reg(sc, ETH_INT_EP_CTL, buf);
err = lan78xx_read_reg(sc, ETH_MAC_TX, &buf);
buf |= ETH_MAC_TX_TXEN_;
err = lan78xx_write_reg(sc, ETH_MAC_TX, buf);
err = lan78xx_read_reg(sc, ETH_FCT_TX_CTL, &buf);
buf |= ETH_FCT_TX_CTL_EN_;
err = lan78xx_write_reg(sc, ETH_FCT_TX_CTL, buf);
err = lan78xx_set_rx_max_frame_length(sc, ETHER_MAX_LEN);
if ((err = lan78xx_phy_init(sc)) != 0)
goto init_failed;
err = lan78xx_read_reg(sc, ETH_MAC_RX, &buf);
buf |= ETH_MAC_RX_EN_;
err = lan78xx_write_reg(sc, ETH_MAC_RX, buf);
err = lan78xx_read_reg(sc, ETH_FCT_RX_CTL, &buf);
buf |= ETH_FCT_TX_CTL_EN_;
err = lan78xx_write_reg(sc, ETH_FCT_RX_CTL, buf);
sc->sc_flags |= MUGE_FLAG_INIT_DONE;
return (0);
init_failed:
muge_err_printf(sc, "lan78xx_chip_init failed (err=%d)\n", err);
return (err);
}
static void
muge_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error)
{
struct muge_softc *sc = usbd_xfer_softc(xfer);
struct usb_ether *ue = &sc->sc_ue;
if_t ifp = uether_getifp(ue);
struct mbuf *m;
struct usb_page_cache *pc;
uint32_t rx_cmd_a, rx_cmd_b;
uint16_t rx_cmd_c;
int pktlen;
int off;
int actlen;
usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
muge_dbg_printf(sc, "rx : actlen %d\n", actlen);
switch (USB_GET_STATE(xfer)) {
case USB_ST_TRANSFERRED:
if (actlen < (sizeof(rx_cmd_a) + ETHER_CRC_LEN))
goto tr_setup;
pc = usbd_xfer_get_frame(xfer, 0);
off = 0;
while (off < actlen) {
off = ((off + 0x3) & ~0x3);
if (off + sizeof(rx_cmd_a) > actlen)
goto tr_setup;
usbd_copy_out(pc, off, &rx_cmd_a, sizeof(rx_cmd_a));
off += (sizeof(rx_cmd_a));
rx_cmd_a = le32toh(rx_cmd_a);
if (off + sizeof(rx_cmd_b) > actlen)
goto tr_setup;
usbd_copy_out(pc, off, &rx_cmd_b, sizeof(rx_cmd_b));
off += (sizeof(rx_cmd_b));
rx_cmd_b = le32toh(rx_cmd_b);
if (off + sizeof(rx_cmd_c) > actlen)
goto tr_setup;
usbd_copy_out(pc, off, &rx_cmd_c, sizeof(rx_cmd_c));
off += (sizeof(rx_cmd_c));
rx_cmd_c = le16toh(rx_cmd_c);
if (off > actlen)
goto tr_setup;
pktlen = (rx_cmd_a & RX_CMD_A_LEN_MASK_);
muge_dbg_printf(sc,
"rx_cmd_a 0x%08x rx_cmd_b 0x%08x rx_cmd_c 0x%04x "
" pktlen %d actlen %d off %d\n",
rx_cmd_a, rx_cmd_b, rx_cmd_c, pktlen, actlen, off);
if (rx_cmd_a & RX_CMD_A_RED_) {
muge_dbg_printf(sc,
"rx error (hdr 0x%08x)\n", rx_cmd_a);
if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
} else {
if ((pktlen < ETHER_HDR_LEN) ||
(pktlen > (actlen - off)))
goto tr_setup;
m = uether_newbuf();
if (m == NULL) {
muge_warn_printf(sc,
"failed to create new mbuf\n");
if_inc_counter(ifp, IFCOUNTER_IQDROPS,
1);
goto tr_setup;
}
if (pktlen > m->m_len) {
muge_dbg_printf(sc,
"buffer too small %d vs %d bytes",
pktlen, m->m_len);
if_inc_counter(ifp, IFCOUNTER_IQDROPS, 1);
m_freem(m);
goto tr_setup;
}
usbd_copy_out(pc, off, mtod(m, uint8_t *),
pktlen);
if ((if_getcapenable(ifp) & IFCAP_RXCSUM) &&
!(rx_cmd_a & RX_CMD_A_ICSM_)) {
if (pktlen > ETHER_MIN_LEN) {
m->m_pkthdr.csum_flags |=
CSUM_DATA_VALID |
CSUM_PSEUDO_HDR;
usbd_copy_out(pc,
(off + pktlen),
&m->m_pkthdr.csum_data, 2);
m->m_pkthdr.csum_data =
ntohs(0xffff);
muge_dbg_printf(sc,
"RX checksum offloaded (0x%04x)\n",
m->m_pkthdr.csum_data);
}
}
if (pktlen < (4 + ETHER_HDR_LEN)) {
m_freem(m);
goto tr_setup;
}
uether_rxmbuf(ue, m, pktlen - 4);
}
off += pktlen;
}
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:
if (error != USB_ERR_CANCELLED) {
muge_warn_printf(sc, "bulk read error, %s\n",
usbd_errstr(error));
usbd_xfer_set_stall(xfer);
goto tr_setup;
}
return;
}
}
static void
muge_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error)
{
struct muge_softc *sc = usbd_xfer_softc(xfer);
if_t ifp = uether_getifp(&sc->sc_ue);
struct usb_page_cache *pc;
struct mbuf *m;
int nframes;
uint32_t frm_len = 0, tx_cmd_a = 0, tx_cmd_b = 0;
switch (USB_GET_STATE(xfer)) {
case USB_ST_TRANSFERRED:
muge_dbg_printf(sc,
"USB TRANSFER status: USB_ST_TRANSFERRED\n");
if_setdrvflagbits(ifp, 0, IFF_DRV_OACTIVE);
case USB_ST_SETUP:
muge_dbg_printf(sc, "USB TRANSFER status: USB_ST_SETUP\n");
tr_setup:
if ((sc->sc_flags & MUGE_FLAG_LINK) == 0 ||
(if_getdrvflags(ifp) & IFF_DRV_OACTIVE) != 0) {
muge_dbg_printf(sc,
"sc->sc_flags & MUGE_FLAG_LINK: %d\n",
(sc->sc_flags & MUGE_FLAG_LINK));
muge_dbg_printf(sc,
"if_getdrvflags(ifp) & IFF_DRV_OACTIVE: %d",
(if_getdrvflags(ifp) & IFF_DRV_OACTIVE));
muge_dbg_printf(sc,
"USB TRANSFER not sending: no link or controller is busy \n");
return;
}
for (nframes = 0;
nframes < 16 && !if_sendq_empty(ifp);
nframes++) {
m = if_dequeue(ifp);
if (m == NULL)
break;
usbd_xfer_set_frame_offset(xfer, nframes * MCLBYTES,
nframes);
frm_len = 0;
pc = usbd_xfer_get_frame(xfer, nframes);
tx_cmd_a = (m->m_pkthdr.len & TX_CMD_A_LEN_MASK_) |
TX_CMD_A_FCS_;
tx_cmd_a = htole32(tx_cmd_a);
usbd_copy_in(pc, 0, &tx_cmd_a, sizeof(tx_cmd_a));
tx_cmd_b = 0;
tx_cmd_b = htole32(tx_cmd_b);
usbd_copy_in(pc, 4, &tx_cmd_b, sizeof(tx_cmd_b));
frm_len += 8;
usbd_m_copy_in(pc, frm_len, m, 0, m->m_pkthdr.len);
frm_len += m->m_pkthdr.len;
if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1);
BPF_MTAP(ifp, m);
m_freem(m);
usbd_xfer_set_frame_len(xfer, nframes, frm_len);
}
muge_dbg_printf(sc, "USB TRANSFER nframes: %d\n", nframes);
if (nframes != 0) {
muge_dbg_printf(sc, "USB TRANSFER submit attempt\n");
usbd_xfer_set_frames(xfer, nframes);
usbd_transfer_submit(xfer);
if_setdrvflagbits(ifp, IFF_DRV_OACTIVE, 0);
}
return;
default:
if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
if_setdrvflagbits(ifp, 0, IFF_DRV_OACTIVE);
if (error != USB_ERR_CANCELLED) {
muge_err_printf(sc,
"usb error on tx: %s\n", usbd_errstr(error));
usbd_xfer_set_stall(xfer);
goto tr_setup;
}
return;
}
}
static void
muge_set_mac_addr(struct usb_ether *ue)
{
struct muge_softc *sc = uether_getsc(ue);
uint32_t mac_h, mac_l;
memset(ue->ue_eaddr, 0xff, ETHER_ADDR_LEN);
uint32_t val;
lan78xx_read_reg(sc, 0, &val);
if ((lan78xx_read_reg(sc, ETH_RX_ADDRL, &mac_l) == 0) &&
(lan78xx_read_reg(sc, ETH_RX_ADDRH, &mac_h) == 0)) {
ue->ue_eaddr[5] = (uint8_t)((mac_h >> 8) & 0xff);
ue->ue_eaddr[4] = (uint8_t)((mac_h) & 0xff);
ue->ue_eaddr[3] = (uint8_t)((mac_l >> 24) & 0xff);
ue->ue_eaddr[2] = (uint8_t)((mac_l >> 16) & 0xff);
ue->ue_eaddr[1] = (uint8_t)((mac_l >> 8) & 0xff);
ue->ue_eaddr[0] = (uint8_t)((mac_l) & 0xff);
}
if (ETHER_IS_VALID(ue->ue_eaddr)) {
muge_dbg_printf(sc, "MAC assigned from registers\n");
} else if (lan78xx_eeprom_present(sc) && lan78xx_eeprom_read_raw(sc,
ETH_E2P_MAC_OFFSET, ue->ue_eaddr, ETHER_ADDR_LEN) == 0 &&
ETHER_IS_VALID(ue->ue_eaddr)) {
muge_dbg_printf(sc, "MAC assigned from EEPROM\n");
} else if (lan78xx_otp_read(sc, OTP_MAC_OFFSET, ue->ue_eaddr,
ETHER_ADDR_LEN) == 0 && ETHER_IS_VALID(ue->ue_eaddr)) {
muge_dbg_printf(sc, "MAC assigned from OTP\n");
}
#ifdef FDT
usb_fdt_get_mac_addr(ue->ue_dev, ue);
if (ETHER_IS_VALID(ue->ue_eaddr)) {
muge_dbg_printf(sc, "MAC assigned from FDT data\n");
}
#endif
if (!ETHER_IS_VALID(ue->ue_eaddr)) {
muge_dbg_printf(sc, "MAC assigned randomly\n");
arc4rand(ue->ue_eaddr, ETHER_ADDR_LEN, 0);
ue->ue_eaddr[0] &= ~0x01;
ue->ue_eaddr[0] |= 0x02;
}
}
static void
muge_set_leds(struct usb_ether *ue)
{
#ifdef FDT
struct muge_softc *sc = uether_getsc(ue);
phandle_t node;
pcell_t modes[4];
ssize_t proplen;
uint32_t count;
if ((node = usb_fdt_get_node(ue->ue_dev, ue->ue_udev)) != -1 &&
(proplen = OF_getencprop(node, "microchip,led-modes", modes,
sizeof(modes))) > 0) {
count = proplen / sizeof( uint32_t );
sc->sc_leds = (count > 0) * ETH_HW_CFG_LEDO_EN_ |
(count > 1) * ETH_HW_CFG_LED1_EN_ |
(count > 2) * ETH_HW_CFG_LED2_EN_ |
(count > 3) * ETH_HW_CFG_LED3_EN_;
while (count-- > 0) {
sc->sc_led_modes |= (modes[count] & 0xf) << (4 * count);
sc->sc_led_modes_mask |= 0xf << (4 * count);
}
muge_dbg_printf(sc, "LED modes set from FDT data\n");
}
#endif
}
static void
muge_attach_post(struct usb_ether *ue)
{
struct muge_softc *sc = uether_getsc(ue);
muge_dbg_printf(sc, "Calling muge_attach_post.\n");
sc->sc_phyno = 1;
muge_set_mac_addr(ue);
muge_set_leds(ue);
lan78xx_chip_init(sc);
}
static int
muge_attach_post_sub(struct usb_ether *ue)
{
struct muge_softc *sc;
if_t ifp;
sc = uether_getsc(ue);
muge_dbg_printf(sc, "Calling muge_attach_post_sub.\n");
ifp = ue->ue_ifp;
if_setflags(ifp, IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST);
if_setstartfn(ifp, uether_start);
if_setioctlfn(ifp, muge_ioctl);
if_setinitfn(ifp, uether_init);
if_setsendqlen(ifp, ifqmaxlen);
if_setsendqready(ifp);
if_setcapabilitiesbit(ifp, IFCAP_VLAN_MTU, 0);
if_sethwassist(ifp, 0);
if_setcapabilitiesbit(ifp, IFCAP_RXCSUM, 0);
if (MUGE_DEFAULT_TX_CSUM_ENABLE)
if_setcapabilitiesbit(ifp, IFCAP_TXCSUM, 0);
if (MUGE_DEFAULT_TSO_ENABLE)
if_setcapabilitiesbit(ifp, IFCAP_TSO4 | IFCAP_TSO6, 0);
#if 0
if_setcapabilitiesbit(ifp, IFCAP_TXCSUM, 0);
if_setcapenablebit(ifp, IFCAP_TXCSUM, 0);
if_sethwassist(ifp, CSUM_TCP | CSUM_UDP);
#endif
if_setcapenable(ifp, if_getcapabilities(ifp));
bus_topo_lock();
mii_attach(ue->ue_dev, &ue->ue_miibus, ifp, uether_ifmedia_upd,
ue->ue_methods->ue_mii_sts, BMSR_DEFCAPMASK, sc->sc_phyno,
MII_OFFSET_ANY, 0);
bus_topo_unlock();
return (0);
}
static void
muge_start(struct usb_ether *ue)
{
struct muge_softc *sc = uether_getsc(ue);
usbd_transfer_start(sc->sc_xfer[MUGE_BULK_DT_RD]);
usbd_transfer_start(sc->sc_xfer[MUGE_BULK_DT_WR]);
}
static int
muge_ioctl(if_t ifp, u_long cmd, caddr_t data)
{
struct usb_ether *ue = if_getsoftc(ifp);
struct muge_softc *sc;
struct ifreq *ifr;
int rc;
int mask;
int reinit;
if (cmd == SIOCSIFCAP) {
sc = uether_getsc(ue);
ifr = (struct ifreq *)data;
MUGE_LOCK(sc);
rc = 0;
reinit = 0;
mask = ifr->ifr_reqcap ^ if_getcapenable(ifp);
if ((mask & IFCAP_RXCSUM) != 0 &&
(if_getcapabilities(ifp) & IFCAP_RXCSUM) != 0) {
if_togglecapenable(ifp, IFCAP_RXCSUM);
if (if_getdrvflags(ifp) & IFF_DRV_RUNNING) {
if_setdrvflagbits(ifp, 0, IFF_DRV_RUNNING);
reinit = 1;
}
}
MUGE_UNLOCK(sc);
if (reinit)
uether_init(ue);
} else {
rc = uether_ioctl(ifp, cmd, data);
}
return (rc);
}
static void
muge_reset(struct muge_softc *sc)
{
struct usb_config_descriptor *cd;
usb_error_t err;
cd = usbd_get_config_descriptor(sc->sc_ue.ue_udev);
err = usbd_req_set_config(sc->sc_ue.ue_udev, &sc->sc_mtx,
cd->bConfigurationValue);
if (err)
muge_warn_printf(sc, "reset failed (ignored)\n");
uether_pause(&sc->sc_ue, hz / 100);
lan78xx_chip_init(sc);
}
static void
muge_set_addr_filter(struct muge_softc *sc, int index,
uint8_t addr[ETHER_ADDR_LEN])
{
uint32_t tmp;
if ((sc) && (index > 0) && (index < MUGE_NUM_PFILTER_ADDRS_)) {
tmp = addr[3];
tmp |= addr[2] | (tmp << 8);
tmp |= addr[1] | (tmp << 8);
tmp |= addr[0] | (tmp << 8);
sc->sc_pfilter_table[index][1] = tmp;
tmp = addr[5];
tmp |= addr[4] | (tmp << 8);
tmp |= ETH_MAF_HI_VALID_ | ETH_MAF_HI_TYPE_DST_;
sc->sc_pfilter_table[index][0] = tmp;
}
}
static int
lan78xx_dataport_write(struct muge_softc *sc, uint32_t ram_select,
uint32_t addr, uint32_t length, uint32_t *buf)
{
uint32_t dp_sel;
int i, ret;
MUGE_LOCK_ASSERT(sc, MA_OWNED);
ret = lan78xx_wait_for_bits(sc, ETH_DP_SEL, ETH_DP_SEL_DPRDY_);
if (ret < 0)
goto done;
ret = lan78xx_read_reg(sc, ETH_DP_SEL, &dp_sel);
dp_sel &= ~ETH_DP_SEL_RSEL_MASK_;
dp_sel |= ram_select;
ret = lan78xx_write_reg(sc, ETH_DP_SEL, dp_sel);
for (i = 0; i < length; i++) {
ret = lan78xx_write_reg(sc, ETH_DP_ADDR, addr + i);
ret = lan78xx_write_reg(sc, ETH_DP_DATA, buf[i]);
ret = lan78xx_write_reg(sc, ETH_DP_CMD, ETH_DP_CMD_WRITE_);
ret = lan78xx_wait_for_bits(sc, ETH_DP_SEL, ETH_DP_SEL_DPRDY_);
if (ret != 0)
goto done;
}
done:
return (ret);
}
static void
muge_multicast_write(struct muge_softc *sc)
{
int i;
lan78xx_dataport_write(sc, ETH_DP_SEL_RSEL_VLAN_DA_,
ETH_DP_SEL_VHF_VLAN_LEN, ETH_DP_SEL_VHF_HASH_LEN,
sc->sc_mchash_table);
for (i = 1; i < MUGE_NUM_PFILTER_ADDRS_; i++) {
lan78xx_write_reg(sc, PFILTER_HI(i), 0);
lan78xx_write_reg(sc, PFILTER_LO(i),
sc->sc_pfilter_table[i][1]);
lan78xx_write_reg(sc, PFILTER_HI(i),
sc->sc_pfilter_table[i][0]);
}
}
static inline uint32_t
muge_hash(uint8_t addr[ETHER_ADDR_LEN])
{
return (ether_crc32_be(addr, ETHER_ADDR_LEN) >> 23) & 0x1ff;
}
static u_int
muge_hash_maddr(void *arg, struct sockaddr_dl *sdl, u_int cnt)
{
struct muge_softc *sc = arg;
uint32_t bitnum;
if (cnt < 32 )
muge_set_addr_filter(sc, cnt + 1, LLADDR(sdl));
else {
bitnum = muge_hash(LLADDR(sdl));
sc->sc_mchash_table[bitnum / 32] |= (1 << (bitnum % 32));
sc->sc_rfe_ctl |= ETH_RFE_CTL_MCAST_HASH_;
}
return (1);
}
static void
muge_setmulti(struct usb_ether *ue)
{
struct muge_softc *sc = uether_getsc(ue);
if_t ifp = uether_getifp(ue);
uint8_t i;
MUGE_LOCK_ASSERT(sc, MA_OWNED);
sc->sc_rfe_ctl &= ~(ETH_RFE_CTL_UCAST_EN_ | ETH_RFE_CTL_MCAST_EN_ |
ETH_RFE_CTL_DA_PERFECT_ | ETH_RFE_CTL_MCAST_HASH_);
for (i = 0; i < ETH_DP_SEL_VHF_HASH_LEN; i++)
sc->sc_mchash_table[i] = 0;
for (i = 1; i < MUGE_NUM_PFILTER_ADDRS_; i++) {
sc->sc_pfilter_table[i][0] = sc->sc_pfilter_table[i][1] = 0;
}
sc->sc_rfe_ctl |= ETH_RFE_CTL_BCAST_EN_;
if (if_getflags(ifp) & IFF_PROMISC) {
muge_dbg_printf(sc, "promiscuous mode enabled\n");
sc->sc_rfe_ctl |= ETH_RFE_CTL_MCAST_EN_ | ETH_RFE_CTL_UCAST_EN_;
} else if (if_getflags(ifp) & IFF_ALLMULTI) {
muge_dbg_printf(sc, "receive all multicast enabled\n");
sc->sc_rfe_ctl |= ETH_RFE_CTL_MCAST_EN_;
} else {
if_foreach_llmaddr(ifp, muge_hash_maddr, sc);
muge_multicast_write(sc);
}
lan78xx_write_reg(sc, ETH_RFE_CTL, sc->sc_rfe_ctl);
}
static void
muge_setpromisc(struct usb_ether *ue)
{
struct muge_softc *sc = uether_getsc(ue);
if_t ifp = uether_getifp(ue);
muge_dbg_printf(sc, "promiscuous mode %sabled\n",
(if_getflags(ifp) & IFF_PROMISC) ? "en" : "dis");
MUGE_LOCK_ASSERT(sc, MA_OWNED);
if (if_getflags(ifp) & IFF_PROMISC)
sc->sc_rfe_ctl |= ETH_RFE_CTL_MCAST_EN_ | ETH_RFE_CTL_UCAST_EN_;
else
sc->sc_rfe_ctl &= ~(ETH_RFE_CTL_MCAST_EN_);
lan78xx_write_reg(sc, ETH_RFE_CTL, sc->sc_rfe_ctl);
}
static int
muge_sethwcsum(struct muge_softc *sc)
{
if_t ifp = uether_getifp(&sc->sc_ue);
int err;
if (!ifp)
return (-EIO);
MUGE_LOCK_ASSERT(sc, MA_OWNED);
if (if_getcapenable(ifp) & IFCAP_RXCSUM) {
sc->sc_rfe_ctl |= ETH_RFE_CTL_IGMP_COE_ | ETH_RFE_CTL_ICMP_COE_;
sc->sc_rfe_ctl |= ETH_RFE_CTL_TCPUDP_COE_ | ETH_RFE_CTL_IP_COE_;
} else {
sc->sc_rfe_ctl &=
~(ETH_RFE_CTL_IGMP_COE_ | ETH_RFE_CTL_ICMP_COE_);
sc->sc_rfe_ctl &=
~(ETH_RFE_CTL_TCPUDP_COE_ | ETH_RFE_CTL_IP_COE_);
}
sc->sc_rfe_ctl &= ~ETH_RFE_CTL_VLAN_FILTER_;
err = lan78xx_write_reg(sc, ETH_RFE_CTL, sc->sc_rfe_ctl);
if (err != 0) {
muge_warn_printf(sc, "failed to write ETH_RFE_CTL (err=%d)\n",
err);
return (err);
}
return (0);
}
static int
muge_ifmedia_upd(if_t ifp)
{
struct muge_softc *sc = if_getsoftc(ifp);
muge_dbg_printf(sc, "Calling muge_ifmedia_upd.\n");
struct mii_data *mii = uether_getmii(&sc->sc_ue);
struct mii_softc *miisc;
int err;
MUGE_LOCK_ASSERT(sc, MA_OWNED);
LIST_FOREACH(miisc, &mii->mii_phys, mii_list)
PHY_RESET(miisc);
err = mii_mediachg(mii);
return (err);
}
static void
muge_init(struct usb_ether *ue)
{
struct muge_softc *sc = uether_getsc(ue);
muge_dbg_printf(sc, "Calling muge_init.\n");
if_t ifp = uether_getifp(ue);
MUGE_LOCK_ASSERT(sc, MA_OWNED);
if (lan78xx_setmacaddress(sc, if_getlladdr(ifp)))
muge_dbg_printf(sc, "setting MAC address failed\n");
if ((if_getdrvflags(ifp) & IFF_DRV_RUNNING) != 0)
return;
muge_stop(ue);
muge_reset(sc);
muge_setmulti(ue);
muge_sethwcsum(sc);
usbd_xfer_set_stall(sc->sc_xfer[MUGE_BULK_DT_WR]);
if_setdrvflagbits(ifp, IFF_DRV_RUNNING, 0);
muge_ifmedia_upd(ifp);
muge_start(ue);
}
static void
muge_stop(struct usb_ether *ue)
{
struct muge_softc *sc = uether_getsc(ue);
if_t ifp = uether_getifp(ue);
MUGE_LOCK_ASSERT(sc, MA_OWNED);
if_setdrvflagbits(ifp, 0, (IFF_DRV_RUNNING | IFF_DRV_OACTIVE));
sc->sc_flags &= ~MUGE_FLAG_LINK;
usbd_transfer_stop(sc->sc_xfer[MUGE_BULK_DT_WR]);
usbd_transfer_stop(sc->sc_xfer[MUGE_BULK_DT_RD]);
}
static void
muge_tick(struct usb_ether *ue)
{
struct muge_softc *sc = uether_getsc(ue);
struct mii_data *mii = uether_getmii(&sc->sc_ue);
MUGE_LOCK_ASSERT(sc, MA_OWNED);
mii_tick(mii);
if ((sc->sc_flags & MUGE_FLAG_LINK) == 0) {
lan78xx_miibus_statchg(ue->ue_dev);
if ((sc->sc_flags & MUGE_FLAG_LINK) != 0)
muge_start(ue);
}
}
static void
muge_ifmedia_sts(if_t ifp, struct ifmediareq *ifmr)
{
struct muge_softc *sc = if_getsoftc(ifp);
struct mii_data *mii = uether_getmii(&sc->sc_ue);
MUGE_LOCK(sc);
mii_pollstat(mii);
ifmr->ifm_active = mii->mii_media_active;
ifmr->ifm_status = mii->mii_media_status;
MUGE_UNLOCK(sc);
}
static int
muge_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 != MUGE_CONFIG_INDEX)
return (ENXIO);
if (uaa->info.bIfaceIndex != MUGE_IFACE_IDX)
return (ENXIO);
return (usbd_lookup_id_by_uaa(lan78xx_devs, sizeof(lan78xx_devs), uaa));
}
static int
muge_attach(device_t dev)
{
struct usb_attach_arg *uaa = device_get_ivars(dev);
struct muge_softc *sc = device_get_softc(dev);
struct usb_ether *ue = &sc->sc_ue;
uint8_t iface_index;
int err;
sc->sc_flags = USB_GET_DRIVER_INFO(uaa);
device_set_usb_desc(dev);
mtx_init(&sc->sc_mtx, device_get_nameunit(dev), NULL, MTX_DEF);
iface_index = MUGE_IFACE_IDX;
err = usbd_transfer_setup(uaa->device, &iface_index, sc->sc_xfer,
muge_config, MUGE_N_TRANSFER, sc, &sc->sc_mtx);
if (err) {
device_printf(dev, "error: allocating USB transfers failed\n");
goto err;
}
ue->ue_sc = sc;
ue->ue_dev = dev;
ue->ue_udev = uaa->device;
ue->ue_mtx = &sc->sc_mtx;
ue->ue_methods = &muge_ue_methods;
err = uether_ifattach(ue);
if (err) {
device_printf(dev, "error: could not attach interface\n");
goto err_usbd;
}
uether_ifattach_wait(ue);
if (!(sc->sc_flags & MUGE_FLAG_INIT_DONE))
goto err_attached;
return (0);
err_attached:
uether_ifdetach(ue);
err_usbd:
usbd_transfer_unsetup(sc->sc_xfer, MUGE_N_TRANSFER);
err:
mtx_destroy(&sc->sc_mtx);
return (ENXIO);
}
static int
muge_detach(device_t dev)
{
struct muge_softc *sc = device_get_softc(dev);
struct usb_ether *ue = &sc->sc_ue;
usbd_transfer_unsetup(sc->sc_xfer, MUGE_N_TRANSFER);
uether_ifdetach(ue);
mtx_destroy(&sc->sc_mtx);
return (0);
}
static device_method_t muge_methods[] = {
DEVMETHOD(device_probe, muge_probe),
DEVMETHOD(device_attach, muge_attach),
DEVMETHOD(device_detach, muge_detach),
DEVMETHOD(bus_print_child, bus_generic_print_child),
DEVMETHOD(bus_driver_added, bus_generic_driver_added),
DEVMETHOD(miibus_readreg, lan78xx_miibus_readreg),
DEVMETHOD(miibus_writereg, lan78xx_miibus_writereg),
DEVMETHOD(miibus_statchg, lan78xx_miibus_statchg),
DEVMETHOD_END
};
static driver_t muge_driver = {
.name = "muge",
.methods = muge_methods,
.size = sizeof(struct muge_softc),
};
DRIVER_MODULE(muge, uhub, muge_driver, NULL, NULL);
DRIVER_MODULE(miibus, muge, miibus_driver, NULL, NULL);
MODULE_DEPEND(muge, uether, 1, 1, 1);
MODULE_DEPEND(muge, usb, 1, 1, 1);
MODULE_DEPEND(muge, ether, 1, 1, 1);
MODULE_DEPEND(muge, miibus, 1, 1, 1);
MODULE_VERSION(muge, 1);
USB_PNP_HOST_INFO(lan78xx_devs);