#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: if_sip.c,v 1.193 2024/07/05 04:31:51 rin Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/callout.h>
#include <sys/mbuf.h>
#include <sys/kernel.h>
#include <sys/socket.h>
#include <sys/ioctl.h>
#include <sys/errno.h>
#include <sys/device.h>
#include <sys/queue.h>
#include <sys/rndsource.h>
#include <net/if.h>
#include <net/if_dl.h>
#include <net/if_media.h>
#include <net/if_ether.h>
#include <net/bpf.h>
#include <sys/bus.h>
#include <sys/intr.h>
#include <machine/endian.h>
#include <dev/mii/mii.h>
#include <dev/mii/miivar.h>
#include <dev/mii/mii_bitbang.h>
#include <dev/pci/pcireg.h>
#include <dev/pci/pcivar.h>
#include <dev/pci/pcidevs.h>
#include <dev/pci/if_sipreg.h>
#define GSIP_NTXSEGS_ALLOC 16
#define SIP_NTXSEGS_ALLOC 8
#define SIP_TXQUEUELEN 256
#define MAX_SIP_NTXDESC \
(SIP_TXQUEUELEN * MAX(SIP_NTXSEGS_ALLOC, GSIP_NTXSEGS_ALLOC))
#define GSIP_NRXDESC 256
#define SIP_NRXDESC 128
#define MAX_SIP_NRXDESC MAX(GSIP_NRXDESC, SIP_NRXDESC)
static int gsip_disable_data64 = 0;
struct sip_control_data {
struct sip_desc scd_txdescs[MAX_SIP_NTXDESC];
struct sip_desc scd_rxdescs[MAX_SIP_NRXDESC];
};
#define SIP_CDOFF(x) offsetof(struct sip_control_data, x)
#define SIP_CDTXOFF(x) SIP_CDOFF(scd_txdescs[(x)])
#define SIP_CDRXOFF(x) SIP_CDOFF(scd_rxdescs[(x)])
struct sip_txsoft {
struct mbuf *txs_mbuf;
bus_dmamap_t txs_dmamap;
int txs_firstdesc;
int txs_lastdesc;
SIMPLEQ_ENTRY(sip_txsoft) txs_q;
};
SIMPLEQ_HEAD(sip_txsq, sip_txsoft);
struct sip_rxsoft {
struct mbuf *rxs_mbuf;
bus_dmamap_t rxs_dmamap;
};
enum sip_attach_stage {
SIP_ATTACH_FIN = 0
, SIP_ATTACH_CREATE_RXMAP
, SIP_ATTACH_CREATE_TXMAP
, SIP_ATTACH_LOAD_MAP
, SIP_ATTACH_CREATE_MAP
, SIP_ATTACH_MAP_MEM
, SIP_ATTACH_ALLOC_MEM
, SIP_ATTACH_INTR
, SIP_ATTACH_MAP
};
struct sip_softc {
device_t sc_dev;
device_suspensor_t sc_suspensor;
pmf_qual_t sc_qual;
bus_space_tag_t sc_st;
bus_space_handle_t sc_sh;
bus_size_t sc_sz;
bus_dma_tag_t sc_dmat;
pci_chipset_tag_t sc_pc;
bus_dma_segment_t sc_seg;
struct ethercom sc_ethercom;
const struct sip_product *sc_model;
bool sc_gigabit;
bool sc_dma64;
int sc_rev;
unsigned int sc_bufptr_idx;
unsigned int sc_cmdsts_idx;
unsigned int sc_extsts_idx;
void *sc_ih;
struct mii_data sc_mii;
callout_t sc_tick_ch;
bus_dmamap_t sc_cddmamap;
#define sc_cddma sc_cddmamap->dm_segs[0].ds_addr
struct sip_txsoft sc_txsoft[SIP_TXQUEUELEN];
struct sip_rxsoft sc_rxsoft[MAX_SIP_NRXDESC];
struct sip_control_data *sc_control_data;
#define sc_txdescs sc_control_data->scd_txdescs
#define sc_rxdescs sc_control_data->scd_rxdescs
#ifdef SIP_EVENT_COUNTERS
struct evcnt sc_ev_txdstall;
struct evcnt sc_ev_txforceintr;
struct evcnt sc_ev_txdintr;
struct evcnt sc_ev_txiintr;
struct evcnt sc_ev_rxintr;
struct evcnt sc_ev_hiberr;
struct evcnt sc_ev_rxpause;
struct evcnt sc_ev_txpause;
struct evcnt sc_ev_rxipsum;
struct evcnt sc_ev_rxtcpsum;
struct evcnt sc_ev_rxudpsum;
struct evcnt sc_ev_txipsum;
struct evcnt sc_ev_txtcpsum;
struct evcnt sc_ev_txudpsum;
#endif
uint32_t sc_txcfg;
uint32_t sc_rxcfg;
uint32_t sc_imr;
uint32_t sc_rfcr;
uint32_t sc_cfg;
uint32_t sc_gpior;
uint32_t sc_tx_fill_thresh;
uint32_t sc_tx_drain_thresh;
uint32_t sc_rx_drain_thresh;
int sc_flowflags;
int sc_rx_flow_thresh;
int sc_paused;
int sc_txfree;
int sc_txnext;
int sc_txwin;
struct sip_txsq sc_txfreeq;
struct sip_txsq sc_txdirtyq;
struct {
uint64_t if_capenable;
int ec_capenable;
int is_vlan;
} sc_prev;
u_short sc_if_flags;
int sc_rxptr;
int sc_rxdiscard;
int sc_rxlen;
struct mbuf *sc_rxhead;
struct mbuf *sc_rxtail;
struct mbuf **sc_rxtailp;
int sc_ntxdesc;
int sc_ntxdesc_mask;
int sc_nrxdesc_mask;
const struct sip_parm {
const struct sip_regs {
int r_rxcfg;
int r_txcfg;
} p_regs;
const struct sip_bits {
uint32_t b_txcfg_mxdma_8;
uint32_t b_txcfg_mxdma_16;
uint32_t b_txcfg_mxdma_32;
uint32_t b_txcfg_mxdma_64;
uint32_t b_txcfg_mxdma_128;
uint32_t b_txcfg_mxdma_256;
uint32_t b_txcfg_mxdma_512;
uint32_t b_txcfg_flth_mask;
uint32_t b_txcfg_drth_mask;
uint32_t b_rxcfg_mxdma_8;
uint32_t b_rxcfg_mxdma_16;
uint32_t b_rxcfg_mxdma_32;
uint32_t b_rxcfg_mxdma_64;
uint32_t b_rxcfg_mxdma_128;
uint32_t b_rxcfg_mxdma_256;
uint32_t b_rxcfg_mxdma_512;
uint32_t b_isr_txrcmp;
uint32_t b_isr_rxrcmp;
uint32_t b_isr_dperr;
uint32_t b_isr_sserr;
uint32_t b_isr_rmabt;
uint32_t b_isr_rtabt;
uint32_t b_cmdsts_size_mask;
} p_bits;
int p_filtmem;
int p_rxbuf_len;
bus_size_t p_tx_dmamap_size;
int p_ntxsegs;
int p_ntxsegs_alloc;
int p_nrxdesc;
} *sc_parm;
void (*sc_rxintr)(struct sip_softc *);
krndsource_t rnd_source;
};
#define sc_bits sc_parm->p_bits
#define sc_regs sc_parm->p_regs
static const struct sip_parm sip_parm = {
.p_filtmem = OTHER_RFCR_NS_RFADDR_FILTMEM
, .p_rxbuf_len = MCLBYTES - 1
, .p_tx_dmamap_size = MCLBYTES
, .p_ntxsegs = 16
, .p_ntxsegs_alloc = SIP_NTXSEGS_ALLOC
, .p_nrxdesc = SIP_NRXDESC
, .p_bits = {
.b_txcfg_mxdma_8 = 0x00200000
, .b_txcfg_mxdma_16 = 0x00300000
, .b_txcfg_mxdma_32 = 0x00400000
, .b_txcfg_mxdma_64 = 0x00500000
, .b_txcfg_mxdma_128 = 0x00600000
, .b_txcfg_mxdma_256 = 0x00700000
, .b_txcfg_mxdma_512 = 0x00000000
, .b_txcfg_flth_mask = 0x00003f00
, .b_txcfg_drth_mask = 0x0000003f
, .b_rxcfg_mxdma_8 = 0x00200000
, .b_rxcfg_mxdma_16 = 0x00300000
, .b_rxcfg_mxdma_32 = 0x00400000
, .b_rxcfg_mxdma_64 = 0x00500000
, .b_rxcfg_mxdma_128 = 0x00600000
, .b_rxcfg_mxdma_256 = 0x00700000
, .b_rxcfg_mxdma_512 = 0x00000000
, .b_isr_txrcmp = 0x02000000
, .b_isr_rxrcmp = 0x01000000
, .b_isr_dperr = 0x00800000
, .b_isr_sserr = 0x00400000
, .b_isr_rmabt = 0x00200000
, .b_isr_rtabt = 0x00100000
, .b_cmdsts_size_mask = OTHER_CMDSTS_SIZE_MASK
}
, .p_regs = {
.r_rxcfg = OTHER_SIP_RXCFG,
.r_txcfg = OTHER_SIP_TXCFG
}
}, gsip_parm = {
.p_filtmem = DP83820_RFCR_NS_RFADDR_FILTMEM
, .p_rxbuf_len = MCLBYTES - 8
, .p_tx_dmamap_size = ETHER_MAX_LEN_JUMBO
, .p_ntxsegs = 64
, .p_ntxsegs_alloc = GSIP_NTXSEGS_ALLOC
, .p_nrxdesc = GSIP_NRXDESC
, .p_bits = {
.b_txcfg_mxdma_8 = 0x00100000
, .b_txcfg_mxdma_16 = 0x00200000
, .b_txcfg_mxdma_32 = 0x00300000
, .b_txcfg_mxdma_64 = 0x00400000
, .b_txcfg_mxdma_128 = 0x00500000
, .b_txcfg_mxdma_256 = 0x00600000
, .b_txcfg_mxdma_512 = 0x00700000
, .b_txcfg_flth_mask = 0x0000ff00
, .b_txcfg_drth_mask = 0x000000ff
, .b_rxcfg_mxdma_8 = 0x00100000
, .b_rxcfg_mxdma_16 = 0x00200000
, .b_rxcfg_mxdma_32 = 0x00300000
, .b_rxcfg_mxdma_64 = 0x00400000
, .b_rxcfg_mxdma_128 = 0x00500000
, .b_rxcfg_mxdma_256 = 0x00600000
, .b_rxcfg_mxdma_512 = 0x00700000
, .b_isr_txrcmp = 0x00400000
, .b_isr_rxrcmp = 0x00200000
, .b_isr_dperr = 0x00100000
, .b_isr_sserr = 0x00080000
, .b_isr_rmabt = 0x00040000
, .b_isr_rtabt = 0x00020000
, .b_cmdsts_size_mask = DP83820_CMDSTS_SIZE_MASK
}
, .p_regs = {
.r_rxcfg = DP83820_SIP_RXCFG,
.r_txcfg = DP83820_SIP_TXCFG
}
};
static inline int
sip_nexttx(const struct sip_softc *sc, int x)
{
return (x + 1) & sc->sc_ntxdesc_mask;
}
static inline int
sip_nextrx(const struct sip_softc *sc, int x)
{
return (x + 1) & sc->sc_nrxdesc_mask;
}
static inline void
sip_rxchain_reset(struct sip_softc *sc)
{
sc->sc_rxtailp = &sc->sc_rxhead;
*sc->sc_rxtailp = NULL;
sc->sc_rxlen = 0;
}
static inline void
sip_rxchain_link(struct sip_softc *sc, struct mbuf *m)
{
*sc->sc_rxtailp = sc->sc_rxtail = m;
sc->sc_rxtailp = &m->m_next;
}
#ifdef SIP_EVENT_COUNTERS
#define SIP_EVCNT_INCR(ev) (ev)->ev_count++
#else
#define SIP_EVCNT_INCR(ev)
#endif
#define SIP_CDTXADDR(sc, x) ((sc)->sc_cddma + SIP_CDTXOFF((x)))
#define SIP_CDRXADDR(sc, x) ((sc)->sc_cddma + SIP_CDRXOFF((x)))
static inline void
sip_set_rxdp(struct sip_softc *sc, bus_addr_t addr)
{
if (sc->sc_gigabit)
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_RXDP_HI,
BUS_ADDR_HI32(addr));
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_RXDP, BUS_ADDR_LO32(addr));
}
static inline void
sip_set_txdp(struct sip_softc *sc, bus_addr_t addr)
{
if (sc->sc_gigabit)
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_TXDP_HI,
BUS_ADDR_HI32(addr));
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_TXDP, BUS_ADDR_LO32(addr));
}
static inline void
sip_cdtxsync(struct sip_softc *sc, const int x0, const int n0, const int ops)
{
int x, n;
x = x0;
n = n0;
if (x + n > sc->sc_ntxdesc) {
bus_dmamap_sync(sc->sc_dmat, sc->sc_cddmamap,
SIP_CDTXOFF(x), sizeof(struct sip_desc) *
(sc->sc_ntxdesc - x), ops);
n -= (sc->sc_ntxdesc - x);
x = 0;
}
bus_dmamap_sync(sc->sc_dmat, sc->sc_cddmamap,
SIP_CDTXOFF(x), sizeof(struct sip_desc) * n, ops);
}
static inline void
sip_cdrxsync(struct sip_softc *sc, int x, int ops)
{
bus_dmamap_sync(sc->sc_dmat, sc->sc_cddmamap,
SIP_CDRXOFF(x), sizeof(struct sip_desc), ops);
}
static void
sip_init_txring(struct sip_softc *sc)
{
struct sip_desc *sipd;
bus_addr_t next_desc;
int i;
memset(sc->sc_txdescs, 0, sizeof(sc->sc_txdescs));
for (i = 0; i < sc->sc_ntxdesc; i++) {
sipd = &sc->sc_txdescs[i];
next_desc = SIP_CDTXADDR(sc, sip_nexttx(sc, i));
if (sc->sc_dma64) {
sipd->sipd_words[GSIP64_DESC_LINK_LO] =
htole32(BUS_ADDR_LO32(next_desc));
sipd->sipd_words[GSIP64_DESC_LINK_HI] =
htole32(BUS_ADDR_HI32(next_desc));
} else {
sipd->sipd_words[SIP_DESC_LINK] = htole32(next_desc);
}
}
sip_cdtxsync(sc, 0, sc->sc_ntxdesc,
BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
sc->sc_txfree = sc->sc_ntxdesc;
sc->sc_txnext = 0;
sc->sc_txwin = 0;
}
static inline void
sip_init_txdesc(struct sip_softc *sc, int x, bus_addr_t bufptr, uint32_t cmdsts)
{
struct sip_desc *sipd = &sc->sc_txdescs[x];
if (sc->sc_dma64) {
sipd->sipd_words[GSIP64_DESC_BUFPTR_LO] =
htole32(BUS_ADDR_LO32(bufptr));
sipd->sipd_words[GSIP64_DESC_BUFPTR_HI] =
htole32(BUS_ADDR_HI32(bufptr));
} else {
sipd->sipd_words[sc->sc_bufptr_idx] = htole32(bufptr);
}
sipd->sipd_words[sc->sc_extsts_idx] = 0;
sipd->sipd_words[sc->sc_cmdsts_idx] = htole32(cmdsts);
}
static inline void
sip_init_rxdesc(struct sip_softc *sc, int x)
{
struct sip_rxsoft *rxs = &sc->sc_rxsoft[x];
struct sip_desc *sipd = &sc->sc_rxdescs[x];
const bus_addr_t next_desc = SIP_CDRXADDR(sc, sip_nextrx(sc, x));
if (sc->sc_dma64) {
sipd->sipd_words[GSIP64_DESC_LINK_LO] =
htole32(BUS_ADDR_LO32(next_desc));
sipd->sipd_words[GSIP64_DESC_LINK_HI] =
htole32(BUS_ADDR_HI32(next_desc));
sipd->sipd_words[GSIP64_DESC_BUFPTR_LO] =
htole32(BUS_ADDR_LO32(rxs->rxs_dmamap->dm_segs[0].ds_addr));
sipd->sipd_words[GSIP64_DESC_BUFPTR_HI] =
htole32(BUS_ADDR_HI32(rxs->rxs_dmamap->dm_segs[0].ds_addr));
} else {
sipd->sipd_words[SIP_DESC_LINK] = htole32(next_desc);
sipd->sipd_words[sc->sc_bufptr_idx] =
htole32(rxs->rxs_dmamap->dm_segs[0].ds_addr);
}
sipd->sipd_words[sc->sc_extsts_idx] = 0;
sip_cdrxsync(sc, x, BUS_DMASYNC_PREWRITE);
sipd->sipd_words[sc->sc_cmdsts_idx] =
htole32(CMDSTS_INTR | (sc->sc_parm->p_rxbuf_len &
sc->sc_bits.b_cmdsts_size_mask));
sip_cdrxsync(sc, x, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
}
#define SIP_CHIP_VERS(sc, v, p, r) \
((sc)->sc_model->sip_vendor == (v) && \
(sc)->sc_model->sip_product == (p) && \
(sc)->sc_rev == (r))
#define SIP_CHIP_MODEL(sc, v, p) \
((sc)->sc_model->sip_vendor == (v) && \
(sc)->sc_model->sip_product == (p))
#define SIP_SIS900_REV(sc, rev) \
SIP_CHIP_VERS((sc), PCI_VENDOR_SIS, PCI_PRODUCT_SIS_900, (rev))
#define SIP_TIMEOUT 1000
static int sip_ifflags_cb(struct ethercom *);
static void sipcom_start(struct ifnet *);
static void sipcom_watchdog(struct ifnet *);
static int sipcom_ioctl(struct ifnet *, u_long, void *);
static int sipcom_init(struct ifnet *);
static void sipcom_stop(struct ifnet *, int);
static bool sipcom_reset(struct sip_softc *);
static void sipcom_rxdrain(struct sip_softc *);
static int sipcom_add_rxbuf(struct sip_softc *, int);
static void sipcom_read_eeprom(struct sip_softc *, int, int,
uint16_t *);
static void sipcom_tick(void *);
static void sipcom_sis900_set_filter(struct sip_softc *);
static void sipcom_dp83815_set_filter(struct sip_softc *);
static void sipcom_dp83820_read_macaddr(struct sip_softc *,
const struct pci_attach_args *, uint8_t *);
static void sipcom_sis900_eeprom_delay(struct sip_softc *sc);
static void sipcom_sis900_read_macaddr(struct sip_softc *,
const struct pci_attach_args *, uint8_t *);
static void sipcom_dp83815_read_macaddr(struct sip_softc *,
const struct pci_attach_args *, uint8_t *);
static int sipcom_intr(void *);
static void sipcom_txintr(struct sip_softc *);
static void sip_rxintr(struct sip_softc *);
static void gsip_rxintr(struct sip_softc *);
static int sipcom_dp83820_mii_readreg(device_t, int, int, uint16_t *);
static int sipcom_dp83820_mii_writereg(device_t, int, int, uint16_t);
static void sipcom_dp83820_mii_statchg(struct ifnet *);
static int sipcom_sis900_mii_readreg(device_t, int, int, uint16_t *);
static int sipcom_sis900_mii_writereg(device_t, int, int, uint16_t);
static void sipcom_sis900_mii_statchg(struct ifnet *);
static int sipcom_dp83815_mii_readreg(device_t, int, int, uint16_t *);
static int sipcom_dp83815_mii_writereg(device_t, int, int, uint16_t);
static void sipcom_dp83815_mii_statchg(struct ifnet *);
static void sipcom_mediastatus(struct ifnet *, struct ifmediareq *);
static int sipcom_match(device_t, cfdata_t, void *);
static void sipcom_attach(device_t, device_t, void *);
static void sipcom_do_detach(device_t, enum sip_attach_stage);
static int sipcom_detach(device_t, int);
static bool sipcom_resume(device_t, const pmf_qual_t *);
static bool sipcom_suspend(device_t, const pmf_qual_t *);
int gsip_copy_small = 0;
int sip_copy_small = 0;
CFATTACH_DECL3_NEW(gsip, sizeof(struct sip_softc),
sipcom_match, sipcom_attach, sipcom_detach, NULL, NULL, NULL,
DVF_DETACH_SHUTDOWN);
CFATTACH_DECL3_NEW(sip, sizeof(struct sip_softc),
sipcom_match, sipcom_attach, sipcom_detach, NULL, NULL, NULL,
DVF_DETACH_SHUTDOWN);
struct sip_variant {
int (*sipv_mii_readreg)(device_t, int, int, uint16_t *);
int (*sipv_mii_writereg)(device_t, int, int, uint16_t);
void (*sipv_mii_statchg)(struct ifnet *);
void (*sipv_set_filter)(struct sip_softc *);
void (*sipv_read_macaddr)(struct sip_softc *,
const struct pci_attach_args *, uint8_t *);
};
static uint32_t sipcom_mii_bitbang_read(device_t);
static void sipcom_mii_bitbang_write(device_t, uint32_t);
static const struct mii_bitbang_ops sipcom_mii_bitbang_ops = {
sipcom_mii_bitbang_read,
sipcom_mii_bitbang_write,
{
EROMAR_MDIO,
EROMAR_MDIO,
EROMAR_MDC,
EROMAR_MDDIR,
0,
}
};
static const struct sip_variant sipcom_variant_dp83820 = {
sipcom_dp83820_mii_readreg,
sipcom_dp83820_mii_writereg,
sipcom_dp83820_mii_statchg,
sipcom_dp83815_set_filter,
sipcom_dp83820_read_macaddr,
};
static const struct sip_variant sipcom_variant_sis900 = {
sipcom_sis900_mii_readreg,
sipcom_sis900_mii_writereg,
sipcom_sis900_mii_statchg,
sipcom_sis900_set_filter,
sipcom_sis900_read_macaddr,
};
static const struct sip_variant sipcom_variant_dp83815 = {
sipcom_dp83815_mii_readreg,
sipcom_dp83815_mii_writereg,
sipcom_dp83815_mii_statchg,
sipcom_dp83815_set_filter,
sipcom_dp83815_read_macaddr,
};
static const struct sip_product {
pci_vendor_id_t sip_vendor;
pci_product_id_t sip_product;
const char *sip_name;
const struct sip_variant *sip_variant;
bool sip_gigabit;
} sipcom_products[] = {
{ PCI_VENDOR_NS, PCI_PRODUCT_NS_DP83820,
"NatSemi DP83820 Gigabit Ethernet",
&sipcom_variant_dp83820, true },
{ PCI_VENDOR_SIS, PCI_PRODUCT_SIS_900,
"SiS 900 10/100 Ethernet",
&sipcom_variant_sis900, false },
{ PCI_VENDOR_SIS, PCI_PRODUCT_SIS_7016,
"SiS 7016 10/100 Ethernet",
&sipcom_variant_sis900, false },
{ PCI_VENDOR_NS, PCI_PRODUCT_NS_DP83815,
"NatSemi DP83815 10/100 Ethernet",
&sipcom_variant_dp83815, false },
{ 0, 0,
NULL,
NULL, false },
};
static const struct sip_product *
sipcom_lookup(const struct pci_attach_args *pa, bool gigabit)
{
const struct sip_product *sip;
for (sip = sipcom_products; sip->sip_name != NULL; sip++) {
if (PCI_VENDOR(pa->pa_id) == sip->sip_vendor &&
PCI_PRODUCT(pa->pa_id) == sip->sip_product &&
sip->sip_gigabit == gigabit)
return sip;
}
return NULL;
}
static int
sipcom_check_64bit(const struct pci_attach_args *pa)
{
static const struct {
pci_vendor_id_t c64_vendor;
pci_product_id_t c64_product;
} card64[] = {
{ 0x128a, 0x0002 },
{ 0x1113, 0x1407 },
{ 0x1385, 0x621a },
{ 0x1385, 0x622a },
{ 0x10b8, 0x9462 },
{ 0, 0}
};
pcireg_t subsys;
int i;
subsys = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_SUBSYS_ID_REG);
for (i = 0; card64[i].c64_vendor != 0; i++) {
if (PCI_VENDOR(subsys) == card64[i].c64_vendor &&
PCI_PRODUCT(subsys) == card64[i].c64_product)
return 1;
}
return 0;
}
static int
sipcom_match(device_t parent, cfdata_t cf, void *aux)
{
struct pci_attach_args *pa = aux;
if (sipcom_lookup(pa, strcmp(cf->cf_name, "gsip") == 0) != NULL)
return 1;
return 0;
}
static void
sipcom_dp83820_attach(struct sip_softc *sc, struct pci_attach_args *pa)
{
uint32_t reg;
int i;
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_PTSCR, PTSCR_EELOAD_EN);
for (i = 0; i < 10000; i++) {
delay(10);
if ((bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_PTSCR) &
PTSCR_EELOAD_EN) == 0)
break;
}
if (bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_PTSCR) &
PTSCR_EELOAD_EN) {
printf("%s: timeout loading configuration from EEPROM\n",
device_xname(sc->sc_dev));
return;
}
sc->sc_gpior = bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_GPIOR);
reg = bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_CFG);
if (reg & CFG_PCI64_DET) {
const char *using64 = NULL;
if (reg & CFG_DATA64_EN) {
if (gsip_disable_data64)
using64 = "force-disabled";
else if (sipcom_check_64bit(pa)) {
sc->sc_cfg |= CFG_DATA64_EN;
using64 = "enabled";
} else
using64 = "disabled (32-bit card)";
} else {
using64 = "disabled in EEPROM";
}
printf("%s: 64-bit slot detected, 64-bit transfers %s\n",
device_xname(sc->sc_dev), using64);
}
if (reg & CFG_T64ADDR)
sc->sc_cfg |= CFG_T64ADDR;
if (pci_dma64_available(pa)) {
sc->sc_dmat = pa->pa_dmat64;
sc->sc_cfg |= CFG_M64ADDR;
sc->sc_dma64 = true;
}
if (reg & (CFG_TBI_EN | CFG_EXT_125)) {
const char *sep = "";
printf("%s: using ", device_xname(sc->sc_dev));
if (reg & CFG_EXT_125) {
sc->sc_cfg |= CFG_EXT_125;
printf("%sexternal 125MHz clock", sep);
sep = ", ";
}
if (reg & CFG_TBI_EN) {
sc->sc_cfg |= CFG_TBI_EN;
printf("%sten-bit interface", sep);
sep = ", ";
}
printf("\n");
}
if ((pa->pa_flags & PCI_FLAGS_MRM_OKAY) == 0 ||
(reg & CFG_MRM_DIS) != 0)
sc->sc_cfg |= CFG_MRM_DIS;
if ((pa->pa_flags & PCI_FLAGS_MWI_OKAY) == 0 ||
(reg & CFG_MWI_DIS) != 0)
sc->sc_cfg |= CFG_MWI_DIS;
sc->sc_cfg |= CFG_EXTSTS_EN;
}
static int
sipcom_detach(device_t self, int flags)
{
int s;
s = splnet();
sipcom_do_detach(self, SIP_ATTACH_FIN);
splx(s);
return 0;
}
static void
sipcom_do_detach(device_t self, enum sip_attach_stage stage)
{
int i;
struct sip_softc *sc = device_private(self);
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
switch (stage) {
case SIP_ATTACH_FIN:
sipcom_stop(ifp, 1);
pmf_device_deregister(self);
#ifdef SIP_EVENT_COUNTERS
evcnt_detach(&sc->sc_ev_txforceintr);
evcnt_detach(&sc->sc_ev_txdstall);
evcnt_detach(&sc->sc_ev_hiberr);
evcnt_detach(&sc->sc_ev_rxintr);
evcnt_detach(&sc->sc_ev_txiintr);
evcnt_detach(&sc->sc_ev_txdintr);
if (!sc->sc_gigabit) {
evcnt_detach(&sc->sc_ev_rxpause);
} else {
evcnt_detach(&sc->sc_ev_txudpsum);
evcnt_detach(&sc->sc_ev_txtcpsum);
evcnt_detach(&sc->sc_ev_txipsum);
evcnt_detach(&sc->sc_ev_rxudpsum);
evcnt_detach(&sc->sc_ev_rxtcpsum);
evcnt_detach(&sc->sc_ev_rxipsum);
evcnt_detach(&sc->sc_ev_txpause);
evcnt_detach(&sc->sc_ev_rxpause);
}
#endif
rnd_detach_source(&sc->rnd_source);
ether_ifdetach(ifp);
if_detach(ifp);
mii_detach(&sc->sc_mii, MII_PHY_ANY, MII_OFFSET_ANY);
ifmedia_fini(&sc->sc_mii.mii_media);
case SIP_ATTACH_CREATE_RXMAP:
for (i = 0; i < sc->sc_parm->p_nrxdesc; i++) {
if (sc->sc_rxsoft[i].rxs_dmamap != NULL)
bus_dmamap_destroy(sc->sc_dmat,
sc->sc_rxsoft[i].rxs_dmamap);
}
case SIP_ATTACH_CREATE_TXMAP:
for (i = 0; i < SIP_TXQUEUELEN; i++) {
if (sc->sc_txsoft[i].txs_dmamap != NULL)
bus_dmamap_destroy(sc->sc_dmat,
sc->sc_txsoft[i].txs_dmamap);
}
case SIP_ATTACH_LOAD_MAP:
bus_dmamap_unload(sc->sc_dmat, sc->sc_cddmamap);
case SIP_ATTACH_CREATE_MAP:
bus_dmamap_destroy(sc->sc_dmat, sc->sc_cddmamap);
case SIP_ATTACH_MAP_MEM:
bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_control_data,
sizeof(struct sip_control_data));
case SIP_ATTACH_ALLOC_MEM:
bus_dmamem_free(sc->sc_dmat, &sc->sc_seg, 1);
case SIP_ATTACH_INTR:
pci_intr_disestablish(sc->sc_pc, sc->sc_ih);
case SIP_ATTACH_MAP:
bus_space_unmap(sc->sc_st, sc->sc_sh, sc->sc_sz);
break;
default:
break;
}
return;
}
static bool
sipcom_resume(device_t self, const pmf_qual_t *qual)
{
struct sip_softc *sc = device_private(self);
return sipcom_reset(sc);
}
static bool
sipcom_suspend(device_t self, const pmf_qual_t *qual)
{
struct sip_softc *sc = device_private(self);
sipcom_rxdrain(sc);
return true;
}
static void
sipcom_attach(device_t parent, device_t self, void *aux)
{
struct sip_softc *sc = device_private(self);
struct pci_attach_args *pa = aux;
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
struct mii_data * const mii = &sc->sc_mii;
pci_chipset_tag_t pc = pa->pa_pc;
pci_intr_handle_t ih;
const char *intrstr = NULL;
bus_space_tag_t iot, memt;
bus_space_handle_t ioh, memh;
bus_size_t iosz, memsz;
int ioh_valid, memh_valid;
int i, rseg, error;
const struct sip_product *sip;
uint8_t enaddr[ETHER_ADDR_LEN];
pcireg_t csr;
pcireg_t memtype;
bus_size_t tx_dmamap_size;
int ntxsegs_alloc;
cfdata_t cf = device_cfdata(self);
char intrbuf[PCI_INTRSTR_LEN];
callout_init(&sc->sc_tick_ch, 0);
callout_setfunc(&sc->sc_tick_ch, sipcom_tick, sc);
sip = sipcom_lookup(pa, strcmp(cf->cf_name, "gsip") == 0);
if (sip == NULL) {
aprint_error("\n");
panic("%s: impossible", __func__);
}
sc->sc_dev = self;
sc->sc_gigabit = sip->sip_gigabit;
sc->sc_dma64 = false;
pmf_self_suspensor_init(self, &sc->sc_suspensor, &sc->sc_qual);
sc->sc_pc = pc;
if (sc->sc_gigabit) {
if (sc->sc_dma64) {
sc->sc_bufptr_idx = GSIP64_DESC_BUFPTR_LO;
sc->sc_cmdsts_idx = GSIP64_DESC_CMDSTS;
sc->sc_extsts_idx = GSIP64_DESC_EXTSTS;
} else {
sc->sc_bufptr_idx = GSIP_DESC_BUFPTR;
sc->sc_cmdsts_idx = GSIP_DESC_CMDSTS;
sc->sc_extsts_idx = GSIP_DESC_EXTSTS;
}
sc->sc_rxintr = gsip_rxintr;
sc->sc_parm = &gsip_parm;
} else {
sc->sc_rxintr = sip_rxintr;
sc->sc_parm = &sip_parm;
sc->sc_bufptr_idx = SIP_DESC_BUFPTR;
sc->sc_cmdsts_idx = SIP_DESC_CMDSTS;
sc->sc_extsts_idx = GSIP_DESC_EXTSTS;
}
tx_dmamap_size = sc->sc_parm->p_tx_dmamap_size;
ntxsegs_alloc = sc->sc_parm->p_ntxsegs_alloc;
sc->sc_ntxdesc = SIP_TXQUEUELEN * ntxsegs_alloc;
sc->sc_ntxdesc_mask = sc->sc_ntxdesc - 1;
sc->sc_nrxdesc_mask = sc->sc_parm->p_nrxdesc - 1;
sc->sc_rev = PCI_REVISION(pa->pa_class);
aprint_naive("\n");
aprint_normal(": %s, rev %#02x\n", sip->sip_name, sc->sc_rev);
sc->sc_model = sip;
pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_MAPREG_ROM,
pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_MAPREG_ROM) &
~PCI_MAPREG_ROM_ENABLE);
ioh_valid = (pci_mapreg_map(pa, SIP_PCI_CFGIOA,
PCI_MAPREG_TYPE_IO, 0,
&iot, &ioh, NULL, &iosz) == 0);
if (sc->sc_gigabit) {
memtype = pci_mapreg_type(pa->pa_pc, pa->pa_tag, SIP_PCI_CFGMA);
switch (memtype) {
case PCI_MAPREG_TYPE_MEM | PCI_MAPREG_MEM_TYPE_32BIT:
case PCI_MAPREG_TYPE_MEM | PCI_MAPREG_MEM_TYPE_64BIT:
memh_valid = (pci_mapreg_map(pa, SIP_PCI_CFGMA,
memtype, 0, &memt, &memh, NULL, &memsz) == 0);
break;
default:
memh_valid = 0;
}
} else {
memh_valid = (pci_mapreg_map(pa, SIP_PCI_CFGMA,
PCI_MAPREG_TYPE_MEM | PCI_MAPREG_MEM_TYPE_32BIT, 0,
&memt, &memh, NULL, &memsz) == 0);
}
if (memh_valid) {
sc->sc_st = memt;
sc->sc_sh = memh;
sc->sc_sz = memsz;
} else if (ioh_valid) {
sc->sc_st = iot;
sc->sc_sh = ioh;
sc->sc_sz = iosz;
} else {
aprint_error_dev(self, "unable to map device registers\n");
return;
}
sc->sc_dmat = pa->pa_dmat;
csr = pci_conf_read(pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
if (pa->pa_flags & PCI_FLAGS_MWI_OKAY)
csr |= PCI_COMMAND_INVALIDATE_ENABLE;
pci_conf_write(pc, pa->pa_tag, PCI_COMMAND_STATUS_REG,
csr | PCI_COMMAND_MASTER_ENABLE);
error = pci_activate(pa->pa_pc, pa->pa_tag, self, pci_activate_null);
if (error != 0 && error != EOPNOTSUPP) {
aprint_error_dev(sc->sc_dev, "cannot activate %d\n", error);
return;
}
if (pci_intr_map(pa, &ih)) {
aprint_error_dev(sc->sc_dev, "unable to map interrupt\n");
return;
}
intrstr = pci_intr_string(pc, ih, intrbuf, sizeof(intrbuf));
sc->sc_ih = pci_intr_establish_xname(pc, ih, IPL_NET, sipcom_intr, sc,
device_xname(self));
if (sc->sc_ih == NULL) {
aprint_error_dev(sc->sc_dev, "unable to establish interrupt");
if (intrstr != NULL)
aprint_error(" at %s", intrstr);
aprint_error("\n");
sipcom_do_detach(self, SIP_ATTACH_MAP);
return;
}
aprint_normal_dev(sc->sc_dev, "interrupting at %s\n", intrstr);
SIMPLEQ_INIT(&sc->sc_txfreeq);
SIMPLEQ_INIT(&sc->sc_txdirtyq);
if ((error = bus_dmamem_alloc(sc->sc_dmat,
sizeof(struct sip_control_data), PAGE_SIZE, 0, &sc->sc_seg, 1,
&rseg, 0)) != 0) {
aprint_error_dev(sc->sc_dev,
"unable to allocate control data, error = %d\n", error);
sipcom_do_detach(self, SIP_ATTACH_INTR);
return;
}
if ((error = bus_dmamem_map(sc->sc_dmat, &sc->sc_seg, rseg,
sizeof(struct sip_control_data), (void **)&sc->sc_control_data,
BUS_DMA_COHERENT)) != 0) {
aprint_error_dev(sc->sc_dev,
"unable to map control data, error = %d\n", error);
sipcom_do_detach(self, SIP_ATTACH_ALLOC_MEM);
}
if ((error = bus_dmamap_create(sc->sc_dmat,
sizeof(struct sip_control_data), 1,
sizeof(struct sip_control_data), 0, 0, &sc->sc_cddmamap)) != 0) {
aprint_error_dev(self, "unable to create control data DMA map"
", error = %d\n", error);
sipcom_do_detach(self, SIP_ATTACH_MAP_MEM);
}
if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_cddmamap,
sc->sc_control_data, sizeof(struct sip_control_data), NULL,
0)) != 0) {
aprint_error_dev(self, "unable to load control data DMA map"
", error = %d\n", error);
sipcom_do_detach(self, SIP_ATTACH_CREATE_MAP);
}
for (i = 0; i < SIP_TXQUEUELEN; i++) {
if ((error = bus_dmamap_create(sc->sc_dmat, tx_dmamap_size,
sc->sc_parm->p_ntxsegs, MCLBYTES, 0, 0,
&sc->sc_txsoft[i].txs_dmamap)) != 0) {
aprint_error_dev(self, "unable to create tx DMA map %d"
", error = %d\n", i, error);
sipcom_do_detach(self, SIP_ATTACH_CREATE_TXMAP);
}
}
for (i = 0; i < sc->sc_parm->p_nrxdesc; i++) {
if ((error = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1,
MCLBYTES, 0, 0, &sc->sc_rxsoft[i].rxs_dmamap)) != 0) {
aprint_error_dev(self, "unable to create rx DMA map %d"
", error = %d\n", i, error);
sipcom_do_detach(self, SIP_ATTACH_CREATE_RXMAP);
}
sc->sc_rxsoft[i].rxs_mbuf = NULL;
}
sipcom_reset(sc);
sc->sc_cfg = 0;
if (!sc->sc_gigabit) {
if (SIP_SIS900_REV(sc, SIS_REV_635) ||
SIP_SIS900_REV(sc, SIS_REV_900B))
sc->sc_cfg |= (CFG_PESEL | CFG_RNDCNT);
if (SIP_SIS900_REV(sc, SIS_REV_635) ||
SIP_SIS900_REV(sc, SIS_REV_960) ||
SIP_SIS900_REV(sc, SIS_REV_900B))
sc->sc_cfg |=
(bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_CFG) &
CFG_EDBMASTEN);
}
(*sip->sip_variant->sipv_read_macaddr)(sc, pa, enaddr);
aprint_normal_dev(self, "Ethernet address %s\n",ether_sprintf(enaddr));
if (sc->sc_gigabit)
sipcom_dp83820_attach(sc, pa);
mii->mii_ifp = ifp;
mii->mii_readreg = sip->sip_variant->sipv_mii_readreg;
mii->mii_writereg = sip->sip_variant->sipv_mii_writereg;
mii->mii_statchg = sip->sip_variant->sipv_mii_statchg;
sc->sc_ethercom.ec_mii = mii;
ifmedia_init(&mii->mii_media, IFM_IMASK, ether_mediachange,
sipcom_mediastatus);
if (SIP_CHIP_MODEL(sc, PCI_VENDOR_NS, PCI_PRODUCT_NS_DP83815))
mii_attach(sc->sc_dev, mii, 0xffffffff, MII_PHY_ANY,
MII_OFFSET_ANY, 0);
else
mii_attach(sc->sc_dev, mii, 0xffffffff, MII_PHY_ANY,
MII_OFFSET_ANY, MIIF_DOPAUSE);
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);
ifp = &sc->sc_ethercom.ec_if;
strlcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
ifp->if_softc = sc;
ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
sc->sc_if_flags = ifp->if_flags;
ifp->if_ioctl = sipcom_ioctl;
ifp->if_start = sipcom_start;
ifp->if_watchdog = sipcom_watchdog;
ifp->if_init = sipcom_init;
ifp->if_stop = sipcom_stop;
IFQ_SET_READY(&ifp->if_snd);
sc->sc_ethercom.ec_capabilities |= ETHERCAP_VLAN_MTU;
if (sc->sc_gigabit) {
sc->sc_ethercom.ec_capabilities |=
ETHERCAP_VLAN_HWTAGGING | ETHERCAP_JUMBO_MTU;
sc->sc_ethercom.ec_capenable |= ETHERCAP_VLAN_HWTAGGING;
ifp->if_capabilities |=
IFCAP_CSUM_IPv4_Tx | IFCAP_CSUM_IPv4_Rx |
IFCAP_CSUM_TCPv4_Tx | IFCAP_CSUM_TCPv4_Rx |
IFCAP_CSUM_UDPv4_Tx | IFCAP_CSUM_UDPv4_Rx;
}
if_attach(ifp);
if_deferred_start_init(ifp, NULL);
ether_ifattach(ifp, enaddr);
ether_set_ifflags_cb(&sc->sc_ethercom, sip_ifflags_cb);
sc->sc_prev.ec_capenable = sc->sc_ethercom.ec_capenable;
sc->sc_prev.is_vlan = VLAN_ATTACHED(&(sc)->sc_ethercom);
sc->sc_prev.if_capenable = ifp->if_capenable;
rnd_attach_source(&sc->rnd_source, device_xname(sc->sc_dev),
RND_TYPE_NET, RND_FLAG_DEFAULT);
sc->sc_tx_fill_thresh = 64 / 32;
if (sc->sc_gigabit)
sc->sc_tx_drain_thresh = 6400 / 32;
else
sc->sc_tx_drain_thresh = 1504 / 32;
sc->sc_rx_drain_thresh = 128 / 8;
#ifdef SIP_EVENT_COUNTERS
evcnt_attach_dynamic(&sc->sc_ev_txdstall, EVCNT_TYPE_MISC,
NULL, device_xname(sc->sc_dev), "txdstall");
evcnt_attach_dynamic(&sc->sc_ev_txforceintr, EVCNT_TYPE_INTR,
NULL, device_xname(sc->sc_dev), "txforceintr");
evcnt_attach_dynamic(&sc->sc_ev_txdintr, EVCNT_TYPE_INTR,
NULL, device_xname(sc->sc_dev), "txdintr");
evcnt_attach_dynamic(&sc->sc_ev_txiintr, EVCNT_TYPE_INTR,
NULL, device_xname(sc->sc_dev), "txiintr");
evcnt_attach_dynamic(&sc->sc_ev_rxintr, EVCNT_TYPE_INTR,
NULL, device_xname(sc->sc_dev), "rxintr");
evcnt_attach_dynamic(&sc->sc_ev_hiberr, EVCNT_TYPE_INTR,
NULL, device_xname(sc->sc_dev), "hiberr");
if (!sc->sc_gigabit) {
evcnt_attach_dynamic(&sc->sc_ev_rxpause, EVCNT_TYPE_INTR,
NULL, device_xname(sc->sc_dev), "rxpause");
} else {
evcnt_attach_dynamic(&sc->sc_ev_rxpause, EVCNT_TYPE_MISC,
NULL, device_xname(sc->sc_dev), "rxpause");
evcnt_attach_dynamic(&sc->sc_ev_txpause, EVCNT_TYPE_MISC,
NULL, device_xname(sc->sc_dev), "txpause");
evcnt_attach_dynamic(&sc->sc_ev_rxipsum, EVCNT_TYPE_MISC,
NULL, device_xname(sc->sc_dev), "rxipsum");
evcnt_attach_dynamic(&sc->sc_ev_rxtcpsum, EVCNT_TYPE_MISC,
NULL, device_xname(sc->sc_dev), "rxtcpsum");
evcnt_attach_dynamic(&sc->sc_ev_rxudpsum, EVCNT_TYPE_MISC,
NULL, device_xname(sc->sc_dev), "rxudpsum");
evcnt_attach_dynamic(&sc->sc_ev_txipsum, EVCNT_TYPE_MISC,
NULL, device_xname(sc->sc_dev), "txipsum");
evcnt_attach_dynamic(&sc->sc_ev_txtcpsum, EVCNT_TYPE_MISC,
NULL, device_xname(sc->sc_dev), "txtcpsum");
evcnt_attach_dynamic(&sc->sc_ev_txudpsum, EVCNT_TYPE_MISC,
NULL, device_xname(sc->sc_dev), "txudpsum");
}
#endif
if (pmf_device_register(self, sipcom_suspend, sipcom_resume))
pmf_class_network_register(self, ifp);
else
aprint_error_dev(self, "couldn't establish power handler\n");
}
static inline void
sipcom_set_extsts(struct sip_softc *sc, int lasttx, struct mbuf *m0,
uint64_t capenable)
{
uint32_t extsts = 0;
#ifdef DEBUG
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
#endif
if (vlan_has_tag(m0)) {
sc->sc_txdescs[lasttx].sipd_words[sc->sc_extsts_idx] |=
htole32(EXTSTS_VPKT |
(bswap16(vlan_get_tag(m0)) &
EXTSTS_VTCI));
}
if (m0->m_pkthdr.csum_flags & M_CSUM_IPv4) {
KDASSERT(ifp->if_capenable & IFCAP_CSUM_IPv4_Tx);
SIP_EVCNT_INCR(&sc->sc_ev_txipsum);
extsts |= htole32(EXTSTS_IPPKT);
}
if (m0->m_pkthdr.csum_flags & M_CSUM_TCPv4) {
KDASSERT(ifp->if_capenable & IFCAP_CSUM_TCPv4_Tx);
SIP_EVCNT_INCR(&sc->sc_ev_txtcpsum);
extsts |= htole32(EXTSTS_TCPPKT);
} else if (m0->m_pkthdr.csum_flags & M_CSUM_UDPv4) {
KDASSERT(ifp->if_capenable & IFCAP_CSUM_UDPv4_Tx);
SIP_EVCNT_INCR(&sc->sc_ev_txudpsum);
extsts |= htole32(EXTSTS_UDPPKT);
}
sc->sc_txdescs[sc->sc_txnext].sipd_words[sc->sc_extsts_idx] |= extsts;
}
static void
sipcom_start(struct ifnet *ifp)
{
struct sip_softc *sc = ifp->if_softc;
struct mbuf *m0;
struct mbuf *m;
struct sip_txsoft *txs;
bus_dmamap_t dmamap;
int error, nexttx, lasttx, seg;
int ofree = sc->sc_txfree;
uint32_t cmdsts;
#if 0
int firsttx = sc->sc_txnext;
#endif
if (!sc->sc_gigabit && sc->sc_paused)
return;
if ((ifp->if_flags & IFF_RUNNING) != IFF_RUNNING)
return;
while ((txs = SIMPLEQ_FIRST(&sc->sc_txfreeq)) != NULL) {
IFQ_POLL(&ifp->if_snd, m0);
if (m0 == NULL)
break;
m = NULL;
dmamap = txs->txs_dmamap;
error = bus_dmamap_load_mbuf(sc->sc_dmat, dmamap, m0,
BUS_DMA_WRITE | BUS_DMA_NOWAIT);
if (error != 0 && !sc->sc_gigabit) {
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == NULL) {
printf("%s: unable to allocate Tx mbuf\n",
device_xname(sc->sc_dev));
break;
}
MCLAIM(m, &sc->sc_ethercom.ec_tx_mowner);
if (m0->m_pkthdr.len > MHLEN) {
MCLGET(m, M_DONTWAIT);
if ((m->m_flags & M_EXT) == 0) {
printf("%s: unable to allocate Tx "
"cluster\n",
device_xname(sc->sc_dev));
m_freem(m);
break;
}
}
m_copydata(m0, 0, m0->m_pkthdr.len, mtod(m, void *));
m->m_pkthdr.len = m->m_len = m0->m_pkthdr.len;
error = bus_dmamap_load_mbuf(sc->sc_dmat, dmamap,
m, BUS_DMA_WRITE | BUS_DMA_NOWAIT);
if (error) {
printf("%s: unable to load Tx buffer, error = "
"%d\n", device_xname(sc->sc_dev), error);
break;
}
} else if (error == EFBIG) {
printf("%s: Tx packet consumes too many DMA segments, "
"dropping...\n", device_xname(sc->sc_dev));
IFQ_DEQUEUE(&ifp->if_snd, m0);
m_freem(m0);
continue;
} else if (error != 0) {
break;
}
if (dmamap->dm_nsegs > (sc->sc_txfree - 1)) {
bus_dmamap_unload(sc->sc_dmat, dmamap);
m_freem(m);
SIP_EVCNT_INCR(&sc->sc_ev_txdstall);
break;
}
IFQ_DEQUEUE(&ifp->if_snd, m0);
if (m != NULL) {
m_freem(m0);
m0 = m;
}
bus_dmamap_sync(sc->sc_dmat, dmamap, 0, dmamap->dm_mapsize,
BUS_DMASYNC_PREWRITE);
for (nexttx = lasttx = sc->sc_txnext, seg = 0;
seg < dmamap->dm_nsegs;
seg++, nexttx = sip_nexttx(sc, nexttx)) {
cmdsts = dmamap->dm_segs[seg].ds_len;
if (nexttx != sc->sc_txnext)
cmdsts |= CMDSTS_OWN;
if (seg < dmamap->dm_nsegs - 1)
cmdsts |= CMDSTS_MORE;
sip_init_txdesc(sc, nexttx,
dmamap->dm_segs[seg].ds_addr, cmdsts);
lasttx = nexttx;
}
if (++sc->sc_txwin >= (SIP_TXQUEUELEN * 2 / 3)) {
SIP_EVCNT_INCR(&sc->sc_ev_txforceintr);
sc->sc_txdescs[lasttx].sipd_words[sc->sc_cmdsts_idx] |=
htole32(CMDSTS_INTR);
sc->sc_txwin = 0;
}
if (sc->sc_gigabit)
sipcom_set_extsts(sc, lasttx, m0, ifp->if_capenable);
sip_cdtxsync(sc, sc->sc_txnext, dmamap->dm_nsegs,
BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
sc->sc_txdescs[sc->sc_txnext].sipd_words[sc->sc_cmdsts_idx] |=
htole32(CMDSTS_OWN);
sip_cdtxsync(sc, sc->sc_txnext, 1,
BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
txs->txs_mbuf = m0;
txs->txs_firstdesc = sc->sc_txnext;
txs->txs_lastdesc = lasttx;
sc->sc_txfree -= dmamap->dm_nsegs;
sc->sc_txnext = nexttx;
SIMPLEQ_REMOVE_HEAD(&sc->sc_txfreeq, txs_q);
SIMPLEQ_INSERT_TAIL(&sc->sc_txdirtyq, txs, txs_q);
bpf_mtap(ifp, m0, BPF_D_OUT);
}
if (sc->sc_txfree != ofree) {
#if 0
if ((bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_CR) &
CR_TXE) == 0) {
sip_set_txdp(sc, SIP_CDTXADDR(sc, firsttx));
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_CR, CR_TXE);
}
#else
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_CR, CR_TXE);
#endif
ifp->if_timer = (sc->sc_gigabit) ? 10 : 5;
}
}
static void
sipcom_watchdog(struct ifnet *ifp)
{
struct sip_softc *sc = ifp->if_softc;
sipcom_txintr(sc);
if (sc->sc_txfree != sc->sc_ntxdesc) {
printf("%s: device timeout\n", device_xname(sc->sc_dev));
if_statinc(ifp, if_oerrors);
(void) sipcom_init(ifp);
} else if (ifp->if_flags & IFF_DEBUG)
printf("%s: recovered from device timeout\n",
device_xname(sc->sc_dev));
sipcom_start(ifp);
}
static int
sip_ifflags_cb(struct ethercom *ec)
{
#define COMPARE_EC(sc) (((sc)->sc_prev.ec_capenable \
== (sc)->sc_ethercom.ec_capenable) \
&& ((sc)->sc_prev.is_vlan == \
VLAN_ATTACHED(&(sc)->sc_ethercom) ))
#define COMPARE_IC(sc, ifp) ((sc)->sc_prev.if_capenable == (ifp)->if_capenable)
struct ifnet *ifp = &ec->ec_if;
struct sip_softc *sc = ifp->if_softc;
u_short change = ifp->if_flags ^ sc->sc_if_flags;
if ((change & ~(IFF_CANTCHANGE | IFF_DEBUG)) != 0 || !COMPARE_EC(sc) ||
!COMPARE_IC(sc, ifp))
return ENETRESET;
(*sc->sc_model->sip_variant->sipv_set_filter)(sc);
return 0;
}
static int
sipcom_ioctl(struct ifnet *ifp, u_long cmd, void *data)
{
struct sip_softc *sc = ifp->if_softc;
struct ifreq *ifr = (struct ifreq *)data;
int s, error;
s = splnet();
switch (cmd) {
case SIOCSIFMEDIA:
if (IFM_SUBTYPE(ifr->ifr_media) == IFM_AUTO ||
(ifr->ifr_media & IFM_FDX) == 0)
ifr->ifr_media &= ~IFM_ETH_FMASK;
if (SIP_CHIP_MODEL(sc, PCI_VENDOR_NS, PCI_PRODUCT_NS_DP83815))
ifr->ifr_media &= ~IFM_ETH_FMASK;
if (IFM_SUBTYPE(ifr->ifr_media) != IFM_AUTO) {
if (sc->sc_gigabit &&
(ifr->ifr_media & IFM_ETH_FMASK) == IFM_FLOW) {
ifr->ifr_media |=
IFM_ETH_TXPAUSE | IFM_ETH_RXPAUSE;
} else if (ifr->ifr_media & IFM_FLOW) {
ifr->ifr_media |=
IFM_ETH_TXPAUSE | IFM_ETH_RXPAUSE;
}
sc->sc_flowflags = ifr->ifr_media & IFM_ETH_FMASK;
}
default:
if ((error = ether_ioctl(ifp, cmd, data)) != ENETRESET)
break;
error = 0;
if (cmd == SIOCSIFCAP)
error = if_init(ifp);
else if (cmd != SIOCADDMULTI && cmd != SIOCDELMULTI)
;
else if (ifp->if_flags & IFF_RUNNING) {
(*sc->sc_model->sip_variant->sipv_set_filter)(sc);
}
break;
}
sipcom_start(ifp);
sc->sc_if_flags = ifp->if_flags;
splx(s);
return error;
}
static int
sipcom_intr(void *arg)
{
struct sip_softc *sc = arg;
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
uint32_t isr;
int handled = 0;
if (!device_activation(sc->sc_dev, DEVACT_LEVEL_DRIVER))
return 0;
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_IER, 0);
for (;;) {
isr = bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_ISR);
if ((isr & sc->sc_imr) == 0)
break;
rnd_add_uint32(&sc->rnd_source, isr);
handled = 1;
if ((ifp->if_flags & IFF_RUNNING) == 0)
break;
if (isr & (ISR_RXORN | ISR_RXIDLE | ISR_RXDESC)) {
SIP_EVCNT_INCR(&sc->sc_ev_rxintr);
(*sc->sc_rxintr)(sc);
if (isr & ISR_RXORN) {
printf("%s: receive FIFO overrun\n",
device_xname(sc->sc_dev));
}
if (isr & ISR_RXIDLE) {
printf("%s: receive ring overrun\n",
device_xname(sc->sc_dev));
sip_set_rxdp(sc,
SIP_CDRXADDR(sc, sc->sc_rxptr));
bus_space_write_4(sc->sc_st, sc->sc_sh,
SIP_CR, CR_RXE);
}
}
if (isr & (ISR_TXURN | ISR_TXDESC | ISR_TXIDLE)) {
#ifdef SIP_EVENT_COUNTERS
if (isr & ISR_TXDESC)
SIP_EVCNT_INCR(&sc->sc_ev_txdintr);
else if (isr & ISR_TXIDLE)
SIP_EVCNT_INCR(&sc->sc_ev_txiintr);
#endif
sipcom_txintr(sc);
if (isr & ISR_TXURN) {
uint32_t thresh;
int txfifo_size = (sc->sc_gigabit)
? DP83820_SIP_TXFIFO_SIZE
: OTHER_SIP_TXFIFO_SIZE;
printf("%s: transmit FIFO underrun",
device_xname(sc->sc_dev));
thresh = sc->sc_tx_drain_thresh + 1;
if (thresh <= __SHIFTOUT_MASK(sc->sc_bits.b_txcfg_drth_mask)
&& (thresh * 32) <= (txfifo_size -
(sc->sc_tx_fill_thresh * 32))) {
printf("; increasing Tx drain "
"threshold to %u bytes\n",
thresh * 32);
sc->sc_tx_drain_thresh = thresh;
(void) sipcom_init(ifp);
} else {
(void) sipcom_init(ifp);
printf("\n");
}
}
}
if (sc->sc_imr & (ISR_PAUSE_END | ISR_PAUSE_ST)) {
if (isr & ISR_PAUSE_ST) {
sc->sc_paused = 1;
SIP_EVCNT_INCR(&sc->sc_ev_rxpause);
}
if (isr & ISR_PAUSE_END) {
sc->sc_paused = 0;
}
}
if (isr & ISR_HIBERR) {
int want_init = 0;
SIP_EVCNT_INCR(&sc->sc_ev_hiberr);
#define PRINTERR(bit, str) \
do { \
if ((isr & (bit)) != 0) { \
if ((ifp->if_flags & IFF_DEBUG) != 0) \
printf("%s: %s\n", \
device_xname(sc->sc_dev), str); \
want_init = 1; \
} \
} while (0)
PRINTERR(sc->sc_bits.b_isr_dperr, "parity error");
PRINTERR(sc->sc_bits.b_isr_sserr, "system error");
PRINTERR(sc->sc_bits.b_isr_rmabt, "master abort");
PRINTERR(sc->sc_bits.b_isr_rtabt, "target abort");
PRINTERR(ISR_RXSOVR, "receive status FIFO overrun");
if (want_init)
(void) sipcom_init(ifp);
#undef PRINTERR
}
}
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_IER, IER_IE);
if_schedule_deferred_start(ifp);
return handled;
}
static void
sipcom_txintr(struct sip_softc *sc)
{
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
struct sip_txsoft *txs;
uint32_t cmdsts;
while ((txs = SIMPLEQ_FIRST(&sc->sc_txdirtyq)) != NULL) {
sip_cdtxsync(sc, txs->txs_firstdesc, txs->txs_dmamap->dm_nsegs,
BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
cmdsts = le32toh(sc->sc_txdescs[
txs->txs_lastdesc].sipd_words[sc->sc_cmdsts_idx]);
if (cmdsts & CMDSTS_OWN)
break;
SIMPLEQ_REMOVE_HEAD(&sc->sc_txdirtyq, txs_q);
sc->sc_txfree += txs->txs_dmamap->dm_nsegs;
bus_dmamap_sync(sc->sc_dmat, txs->txs_dmamap,
0, txs->txs_dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE);
bus_dmamap_unload(sc->sc_dmat, txs->txs_dmamap);
m_freem(txs->txs_mbuf);
txs->txs_mbuf = NULL;
SIMPLEQ_INSERT_TAIL(&sc->sc_txfreeq, txs, txs_q);
net_stat_ref_t nsr = IF_STAT_GETREF(ifp);
if (cmdsts & (CMDSTS_Tx_TXA | CMDSTS_Tx_TFU | CMDSTS_Tx_ED |
CMDSTS_Tx_EC)) {
if_statinc_ref(ifp, nsr, if_oerrors);
if (cmdsts & CMDSTS_Tx_EC)
if_statadd_ref(ifp, nsr, if_collisions, 16);
if (ifp->if_flags & IFF_DEBUG) {
if (cmdsts & CMDSTS_Tx_ED)
printf("%s: excessive deferral\n",
device_xname(sc->sc_dev));
if (cmdsts & CMDSTS_Tx_EC)
printf("%s: excessive collisions\n",
device_xname(sc->sc_dev));
}
} else {
if_statinc_ref(ifp, nsr, if_opackets);
if (CMDSTS_COLLISIONS(cmdsts))
if_statadd_ref(ifp, nsr, if_collisions,
CMDSTS_COLLISIONS(cmdsts));
}
IF_STAT_PUTREF(ifp);
}
if (txs == NULL) {
ifp->if_timer = 0;
sc->sc_txwin = 0;
}
}
static void
gsip_rxintr(struct sip_softc *sc)
{
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
struct sip_rxsoft *rxs;
struct mbuf *m;
uint32_t cmdsts, extsts;
int i, len;
for (i = sc->sc_rxptr;; i = sip_nextrx(sc, i)) {
rxs = &sc->sc_rxsoft[i];
sip_cdrxsync(sc, i,
BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
cmdsts =
le32toh(sc->sc_rxdescs[i].sipd_words[sc->sc_cmdsts_idx]);
if ((cmdsts & CMDSTS_OWN) == 0) {
break;
}
sip_cdrxsync(sc, i, BUS_DMASYNC_POSTREAD);
extsts =
le32toh(sc->sc_rxdescs[i].sipd_words[sc->sc_extsts_idx]);
len = CMDSTS_SIZE(sc, cmdsts);
if (__predict_false(sc->sc_rxdiscard)) {
sip_init_rxdesc(sc, i);
if ((cmdsts & CMDSTS_MORE) == 0) {
sc->sc_rxdiscard = 0;
}
continue;
}
bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD);
m = rxs->rxs_mbuf;
if (sipcom_add_rxbuf(sc, i) != 0) {
if_statinc(ifp, if_ierrors);
bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
sip_init_rxdesc(sc, i);
if (cmdsts & CMDSTS_MORE)
sc->sc_rxdiscard = 1;
m_freem(sc->sc_rxhead);
sip_rxchain_reset(sc);
continue;
}
sip_rxchain_link(sc, m);
m->m_len = len;
if (cmdsts & CMDSTS_MORE) {
sc->sc_rxlen += len;
continue;
}
m->m_len -= ETHER_CRC_LEN;
*sc->sc_rxtailp = NULL;
len = m->m_len + sc->sc_rxlen;
m = sc->sc_rxhead;
sip_rxchain_reset(sc);
if (cmdsts & (CMDSTS_Rx_RXA | CMDSTS_Rx_LONG | CMDSTS_Rx_RUNT |
CMDSTS_Rx_ISE | CMDSTS_Rx_CRCE | CMDSTS_Rx_FAE)) {
if_statinc(ifp, if_ierrors);
if ((cmdsts & CMDSTS_Rx_RXA) != 0 &&
(cmdsts & CMDSTS_Rx_RXO) == 0) {
printf("%s: receive descriptor error\n",
device_xname(sc->sc_dev));
}
#define PRINTERR(bit, str) \
if ((ifp->if_flags & IFF_DEBUG) != 0 && \
(cmdsts & (bit)) != 0) \
printf("%s: %s\n", device_xname(sc->sc_dev), str)
PRINTERR(CMDSTS_Rx_LONG, "Too long packet");
PRINTERR(CMDSTS_Rx_RUNT, "runt packet");
PRINTERR(CMDSTS_Rx_ISE, "invalid symbol error");
PRINTERR(CMDSTS_Rx_CRCE, "CRC error");
PRINTERR(CMDSTS_Rx_FAE, "frame alignment error");
#undef PRINTERR
m_freem(m);
continue;
}
if (gsip_copy_small != 0 && len <= (MHLEN - 2)) {
struct mbuf *nm;
MGETHDR(nm, M_DONTWAIT, MT_DATA);
if (nm == NULL) {
if_statinc(ifp, if_ierrors);
m_freem(m);
continue;
}
MCLAIM(m, &sc->sc_ethercom.ec_rx_mowner);
nm->m_data += 2;
nm->m_pkthdr.len = nm->m_len = len;
m_copydata(m, 0, len, mtod(nm, void *));
m_freem(m);
m = nm;
}
#ifndef __NO_STRICT_ALIGNMENT
else {
memmove(mtod(m, char *) + 2, mtod(m, void *),
m->m_len);
m->m_data += 2;
}
#endif
if ((extsts & EXTSTS_VPKT) != 0) {
vlan_set_tag(m, bswap16(extsts & EXTSTS_VTCI));
}
if ((extsts & EXTSTS_IPPKT) != 0) {
SIP_EVCNT_INCR(&sc->sc_ev_rxipsum);
m->m_pkthdr.csum_flags |= M_CSUM_IPv4;
if (extsts & EXTSTS_Rx_IPERR)
m->m_pkthdr.csum_flags |= M_CSUM_IPv4_BAD;
if (extsts & EXTSTS_TCPPKT) {
SIP_EVCNT_INCR(&sc->sc_ev_rxtcpsum);
m->m_pkthdr.csum_flags |= M_CSUM_TCPv4;
if (extsts & EXTSTS_Rx_TCPERR)
m->m_pkthdr.csum_flags |=
M_CSUM_TCP_UDP_BAD;
} else if (extsts & EXTSTS_UDPPKT) {
SIP_EVCNT_INCR(&sc->sc_ev_rxudpsum);
m->m_pkthdr.csum_flags |= M_CSUM_UDPv4;
if (extsts & EXTSTS_Rx_UDPERR)
m->m_pkthdr.csum_flags |=
M_CSUM_TCP_UDP_BAD;
}
}
m_set_rcvif(m, ifp);
m->m_pkthdr.len = len;
if_percpuq_enqueue(ifp->if_percpuq, m);
}
sc->sc_rxptr = i;
}
static void
sip_rxintr(struct sip_softc *sc)
{
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
struct sip_rxsoft *rxs;
struct mbuf *m;
uint32_t cmdsts;
int i, len;
for (i = sc->sc_rxptr;; i = sip_nextrx(sc, i)) {
rxs = &sc->sc_rxsoft[i];
sip_cdrxsync(sc, i,
BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
cmdsts =
le32toh(sc->sc_rxdescs[i].sipd_words[sc->sc_cmdsts_idx]);
if ((cmdsts & CMDSTS_OWN) == 0) {
break;
}
if (cmdsts & CMDSTS_Rx_COL)
if_statinc(ifp, if_collisions);
if (cmdsts & (CMDSTS_Rx_RXA | CMDSTS_Rx_LONG | CMDSTS_Rx_RUNT |
CMDSTS_Rx_ISE | CMDSTS_Rx_CRCE | CMDSTS_Rx_FAE)) {
if_statinc(ifp, if_ierrors);
if ((cmdsts & CMDSTS_Rx_RXA) != 0 &&
(cmdsts & CMDSTS_Rx_RXO) == 0) {
printf("%s: receive descriptor error\n",
device_xname(sc->sc_dev));
}
#define PRINTERR(bit, str) \
if ((ifp->if_flags & IFF_DEBUG) != 0 && \
(cmdsts & (bit)) != 0) \
printf("%s: %s\n", device_xname(sc->sc_dev), str)
PRINTERR(CMDSTS_Rx_LONG, "Too long packet");
PRINTERR(CMDSTS_Rx_RUNT, "runt packet");
PRINTERR(CMDSTS_Rx_ISE, "invalid symbol error");
PRINTERR(CMDSTS_Rx_CRCE, "CRC error");
PRINTERR(CMDSTS_Rx_FAE, "frame alignment error");
#undef PRINTERR
sip_init_rxdesc(sc, i);
continue;
}
bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD);
len = CMDSTS_SIZE(sc, cmdsts) - ETHER_CRC_LEN;
#ifdef __NO_STRICT_ALIGNMENT
if (sip_copy_small != 0 && len <= MHLEN) {
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == NULL)
goto dropit;
MCLAIM(m, &sc->sc_ethercom.ec_rx_mowner);
memcpy(mtod(m, void *),
mtod(rxs->rxs_mbuf, void *), len);
sip_init_rxdesc(sc, i);
bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
rxs->rxs_dmamap->dm_mapsize,
BUS_DMASYNC_PREREAD);
} else {
m = rxs->rxs_mbuf;
if (sipcom_add_rxbuf(sc, i) != 0) {
dropit:
if_statinc(ifp, if_ierrors);
sip_init_rxdesc(sc, i);
bus_dmamap_sync(sc->sc_dmat,
rxs->rxs_dmamap, 0,
rxs->rxs_dmamap->dm_mapsize,
BUS_DMASYNC_PREREAD);
continue;
}
}
#else
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == NULL) {
dropit:
if_statinc(ifp, if_ierrors);
sip_init_rxdesc(sc, i);
bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
continue;
}
MCLAIM(m, &sc->sc_ethercom.ec_rx_mowner);
if (len > (MHLEN - 2)) {
MCLGET(m, M_DONTWAIT);
if ((m->m_flags & M_EXT) == 0) {
m_freem(m);
goto dropit;
}
}
m->m_data += 2;
memcpy(mtod(m, void *), mtod(rxs->rxs_mbuf, void *), len);
sip_init_rxdesc(sc, i);
bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
#endif
m_set_rcvif(m, ifp);
m->m_pkthdr.len = m->m_len = len;
if_percpuq_enqueue(ifp->if_percpuq, m);
}
sc->sc_rxptr = i;
}
static void
sipcom_tick(void *arg)
{
struct sip_softc *sc = arg;
int s;
s = splnet();
#ifdef SIP_EVENT_COUNTERS
if (sc->sc_gigabit) {
sc->sc_ev_rxpause.ev_count +=
bus_space_read_4(sc->sc_st, sc->sc_sh,
SIP_NS_MIB(MIB_RXPauseFrames)) & 0xffff;
sc->sc_ev_txpause.ev_count +=
bus_space_read_4(sc->sc_st, sc->sc_sh,
SIP_NS_MIB(MIB_TXPauseFrames)) & 0xffff;
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_NS_MIBC, MIBC_ACLR);
}
#endif
mii_tick(&sc->sc_mii);
splx(s);
callout_schedule(&sc->sc_tick_ch, hz);
}
static bool
sipcom_reset(struct sip_softc *sc)
{
bus_space_tag_t st = sc->sc_st;
bus_space_handle_t sh = sc->sc_sh;
int i;
bus_space_write_4(st, sh, SIP_IER, 0);
bus_space_write_4(st, sh, SIP_IMR, 0);
bus_space_write_4(st, sh, SIP_RFCR, 0);
bus_space_write_4(st, sh, SIP_CR, CR_RST);
for (i = 0; i < SIP_TIMEOUT; i++) {
if ((bus_space_read_4(st, sh, SIP_CR) & CR_RST) == 0)
break;
delay(2);
}
if (i == SIP_TIMEOUT) {
printf("%s: reset failed to complete\n",
device_xname(sc->sc_dev));
return false;
}
delay(1000);
if (sc->sc_gigabit) {
bus_space_write_4(st, sh, SIP_GPIOR, sc->sc_gpior);
delay(1000);
}
return true;
}
static void
sipcom_dp83820_init(struct sip_softc *sc, uint64_t capenable)
{
uint32_t reg;
bus_space_tag_t st = sc->sc_st;
bus_space_handle_t sh = sc->sc_sh;
reg = 0;
if (capenable &
(IFCAP_CSUM_IPv4_Rx | IFCAP_CSUM_TCPv4_Rx | IFCAP_CSUM_UDPv4_Rx))
reg |= VRCR_IPEN;
if (VLAN_ATTACHED(&sc->sc_ethercom))
reg |= VRCR_VTDEN | VRCR_VTREN;
bus_space_write_4(st, sh, SIP_VRCR, reg);
reg = 0;
if (capenable &
(IFCAP_CSUM_IPv4_Tx | IFCAP_CSUM_TCPv4_Tx | IFCAP_CSUM_UDPv4_Tx))
reg |= VTCR_PPCHK;
if (VLAN_ATTACHED(&sc->sc_ethercom))
reg |= VTCR_VPPTI;
bus_space_write_4(st, sh, SIP_VTCR, reg);
if (VLAN_ATTACHED(&sc->sc_ethercom))
bus_space_write_4(st, sh, SIP_VDR, bswap16(ETHERTYPE_VLAN));
}
static int
sipcom_init(struct ifnet *ifp)
{
struct sip_softc *sc = ifp->if_softc;
bus_space_tag_t st = sc->sc_st;
bus_space_handle_t sh = sc->sc_sh;
struct sip_txsoft *txs;
struct sip_rxsoft *rxs;
int i, error = 0;
if (device_is_active(sc->sc_dev)) {
sipcom_stop(ifp, 0);
} else if (!pmf_device_subtree_resume(sc->sc_dev, &sc->sc_qual) ||
!device_is_active(sc->sc_dev))
return 0;
if (!sipcom_reset(sc))
return EBUSY;
if (SIP_CHIP_MODEL(sc, PCI_VENDOR_NS, PCI_PRODUCT_NS_DP83815)) {
bus_space_write_4(st, sh, 0x00cc, 0x0001);
bus_space_write_4(st, sh, 0x00e4, 0x189C);
bus_space_write_4(st, sh, 0x00fc, 0x0000);
bus_space_write_4(st, sh, 0x00f4, 0x5040);
bus_space_write_4(st, sh, 0x00f8, 0x008c);
bus_space_write_4(st, sh, 0x00cc, 0x0000);
}
sip_init_txring(sc);
SIMPLEQ_INIT(&sc->sc_txfreeq);
SIMPLEQ_INIT(&sc->sc_txdirtyq);
for (i = 0; i < SIP_TXQUEUELEN; i++) {
txs = &sc->sc_txsoft[i];
txs->txs_mbuf = NULL;
SIMPLEQ_INSERT_TAIL(&sc->sc_txfreeq, txs, txs_q);
}
for (i = 0; i < sc->sc_parm->p_nrxdesc; i++) {
rxs = &sc->sc_rxsoft[i];
if (rxs->rxs_mbuf == NULL) {
if ((error = sipcom_add_rxbuf(sc, i)) != 0) {
printf("%s: unable to allocate or map rx "
"buffer %d, error = %d\n",
device_xname(sc->sc_dev), i, error);
sipcom_rxdrain(sc);
goto out;
}
} else
sip_init_rxdesc(sc, i);
}
sc->sc_rxptr = 0;
sc->sc_rxdiscard = 0;
sip_rxchain_reset(sc);
bus_space_write_4(st, sh, SIP_CFG, sc->sc_cfg);
if (sc->sc_gigabit) {
sc->sc_txcfg = sc->sc_bits.b_txcfg_mxdma_512;
sc->sc_rxcfg = sc->sc_bits.b_rxcfg_mxdma_512;
} else if ((SIP_SIS900_REV(sc, SIS_REV_635) ||
SIP_SIS900_REV(sc, SIS_REV_960) ||
SIP_SIS900_REV(sc, SIS_REV_900B)) &&
(sc->sc_cfg & CFG_EDBMASTEN)) {
sc->sc_txcfg = sc->sc_bits.b_txcfg_mxdma_64;
sc->sc_rxcfg = sc->sc_bits.b_rxcfg_mxdma_64;
} else {
sc->sc_txcfg = sc->sc_bits.b_txcfg_mxdma_512;
sc->sc_rxcfg = sc->sc_bits.b_rxcfg_mxdma_512;
}
sc->sc_txcfg |= TXCFG_ATP |
__SHIFTIN(sc->sc_tx_fill_thresh, sc->sc_bits.b_txcfg_flth_mask) |
sc->sc_tx_drain_thresh;
bus_space_write_4(st, sh, sc->sc_regs.r_txcfg, sc->sc_txcfg);
if (sc->sc_rx_drain_thresh == 0) {
sc->sc_rx_drain_thresh = __SHIFTOUT_MASK(RXCFG_DRTH_MASK);
}
sc->sc_rxcfg |= __SHIFTIN(sc->sc_rx_drain_thresh, RXCFG_DRTH_MASK);
if ((sc->sc_gigabit && ifp->if_mtu > ETHERMTU) ||
(sc->sc_ethercom.ec_capenable & ETHERCAP_VLAN_MTU))
sc->sc_rxcfg |= RXCFG_ALP;
if (sc->sc_gigabit && ifp->if_mtu > 8109 &&
(ifp->if_capenable &
(IFCAP_CSUM_IPv4_Tx | IFCAP_CSUM_IPv4_Rx |
IFCAP_CSUM_TCPv4_Tx | IFCAP_CSUM_TCPv4_Rx |
IFCAP_CSUM_UDPv4_Tx | IFCAP_CSUM_UDPv4_Rx))) {
printf("%s: Checksum offloading does not work if MTU > 8109 - "
"disabled.\n", device_xname(sc->sc_dev));
ifp->if_capenable &=
~(IFCAP_CSUM_IPv4_Tx | IFCAP_CSUM_IPv4_Rx |
IFCAP_CSUM_TCPv4_Tx | IFCAP_CSUM_TCPv4_Rx |
IFCAP_CSUM_UDPv4_Tx | IFCAP_CSUM_UDPv4_Rx);
ifp->if_csum_flags_tx = 0;
ifp->if_csum_flags_rx = 0;
}
bus_space_write_4(st, sh, sc->sc_regs.r_rxcfg, sc->sc_rxcfg);
if (sc->sc_gigabit)
sipcom_dp83820_init(sc, ifp->if_capenable);
sip_set_txdp(sc, SIP_CDTXADDR(sc, sc->sc_txnext));
sip_set_rxdp(sc, SIP_CDRXADDR(sc, sc->sc_rxptr));
sc->sc_imr = sc->sc_bits.b_isr_dperr |
sc->sc_bits.b_isr_sserr |
sc->sc_bits.b_isr_rmabt |
sc->sc_bits.b_isr_rtabt |
ISR_RXSOVR | ISR_TXURN | ISR_TXDESC | ISR_TXIDLE | ISR_RXORN |
ISR_RXIDLE | ISR_RXDESC;
bus_space_write_4(st, sh, SIP_IMR, sc->sc_imr);
(*sc->sc_model->sip_variant->sipv_set_filter)(sc);
sc->sc_rx_flow_thresh = (PCR_PS_STHI_8 | PCR_PS_STLO_4 |
PCR_PS_FFHI_8 | PCR_PS_FFLO_4 |
(PCR_PAUSE_CNT & PCR_PAUSE_CNT_MASK));
if ((error = ether_mediachange(ifp)) != 0)
goto out;
if (sc->sc_gigabit)
bus_space_write_4(st, sh, SIP_IHR, 0x01);
bus_space_write_4(st, sh, SIP_IER, IER_IE);
bus_space_write_4(st, sh, SIP_CR, CR_RXE | CR_TXE);
callout_schedule(&sc->sc_tick_ch, hz);
ifp->if_flags |= IFF_RUNNING;
sc->sc_if_flags = ifp->if_flags;
sc->sc_prev.ec_capenable = sc->sc_ethercom.ec_capenable;
sc->sc_prev.is_vlan = VLAN_ATTACHED(&(sc)->sc_ethercom);
sc->sc_prev.if_capenable = ifp->if_capenable;
out:
if (error)
printf("%s: interface not running\n", device_xname(sc->sc_dev));
return error;
}
static void
sipcom_rxdrain(struct sip_softc *sc)
{
struct sip_rxsoft *rxs;
int i;
for (i = 0; i < sc->sc_parm->p_nrxdesc; i++) {
rxs = &sc->sc_rxsoft[i];
if (rxs->rxs_mbuf != NULL) {
bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmamap);
m_freem(rxs->rxs_mbuf);
rxs->rxs_mbuf = NULL;
}
}
}
static void
sipcom_stop(struct ifnet *ifp, int disable)
{
struct sip_softc *sc = ifp->if_softc;
bus_space_tag_t st = sc->sc_st;
bus_space_handle_t sh = sc->sc_sh;
struct sip_txsoft *txs;
uint32_t cmdsts = 0;
callout_stop(&sc->sc_tick_ch);
mii_down(&sc->sc_mii);
if (device_is_active(sc->sc_dev)) {
bus_space_write_4(st, sh, SIP_IER, 0);
bus_space_write_4(st, sh, SIP_CR, CR_RXD | CR_TXD);
}
while ((txs = SIMPLEQ_FIRST(&sc->sc_txdirtyq)) != NULL) {
if ((ifp->if_flags & IFF_DEBUG) != 0 &&
SIMPLEQ_NEXT(txs, txs_q) == NULL &&
(sc->sc_txdescs[
txs->txs_lastdesc].sipd_words[
sc->sc_cmdsts_idx] & htole32(CMDSTS_INTR)) == 0)
printf("%s: sip_stop: last descriptor does not "
"have INTR bit set\n", device_xname(sc->sc_dev));
SIMPLEQ_REMOVE_HEAD(&sc->sc_txdirtyq, txs_q);
#ifdef DIAGNOSTIC
if (txs->txs_mbuf == NULL) {
printf("%s: dirty txsoft with no mbuf chain\n",
device_xname(sc->sc_dev));
panic("sip_stop");
}
#endif
cmdsts |=
le32toh(sc->sc_txdescs[
txs->txs_lastdesc].sipd_words[sc->sc_cmdsts_idx]);
bus_dmamap_unload(sc->sc_dmat, txs->txs_dmamap);
m_freem(txs->txs_mbuf);
txs->txs_mbuf = NULL;
SIMPLEQ_INSERT_TAIL(&sc->sc_txfreeq, txs, txs_q);
}
ifp->if_flags &= ~IFF_RUNNING;
ifp->if_timer = 0;
if (disable)
pmf_device_recursive_suspend(sc->sc_dev, &sc->sc_qual);
if ((ifp->if_flags & IFF_DEBUG) != 0 &&
(cmdsts & CMDSTS_INTR) == 0 && sc->sc_txfree != sc->sc_ntxdesc)
printf("%s: sip_stop: no INTR bits set in dirty tx "
"descriptors\n", device_xname(sc->sc_dev));
}
static void
sipcom_read_eeprom(struct sip_softc *sc, int word, int wordcnt,
uint16_t *data)
{
bus_space_tag_t st = sc->sc_st;
bus_space_handle_t sh = sc->sc_sh;
uint16_t reg;
int i, x;
for (i = 0; i < wordcnt; i++) {
reg = EROMAR_EECS;
bus_space_write_4(st, sh, SIP_EROMAR, reg);
for (x = 3; x > 0; x--) {
if (SIP_EEPROM_OPC_READ & (1 << (x - 1)))
reg |= EROMAR_EEDI;
else
reg &= ~EROMAR_EEDI;
bus_space_write_4(st, sh, SIP_EROMAR, reg);
bus_space_write_4(st, sh, SIP_EROMAR,
reg | EROMAR_EESK);
delay(4);
bus_space_write_4(st, sh, SIP_EROMAR, reg);
delay(4);
}
for (x = 6; x > 0; x--) {
if ((word + i) & (1 << (x - 1)))
reg |= EROMAR_EEDI;
else
reg &= ~EROMAR_EEDI;
bus_space_write_4(st, sh, SIP_EROMAR, reg);
bus_space_write_4(st, sh, SIP_EROMAR,
reg | EROMAR_EESK);
delay(4);
bus_space_write_4(st, sh, SIP_EROMAR, reg);
delay(4);
}
reg = EROMAR_EECS;
data[i] = 0;
for (x = 16; x > 0; x--) {
bus_space_write_4(st, sh, SIP_EROMAR,
reg | EROMAR_EESK);
delay(4);
if (bus_space_read_4(st, sh, SIP_EROMAR) & EROMAR_EEDO)
data[i] |= (1 << (x - 1));
bus_space_write_4(st, sh, SIP_EROMAR, reg);
delay(4);
}
bus_space_write_4(st, sh, SIP_EROMAR, 0);
delay(4);
}
}
static int
sipcom_add_rxbuf(struct sip_softc *sc, int idx)
{
struct sip_rxsoft *rxs = &sc->sc_rxsoft[idx];
struct mbuf *m;
int error;
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == NULL)
return ENOBUFS;
MCLAIM(m, &sc->sc_ethercom.ec_rx_mowner);
MCLGET(m, M_DONTWAIT);
if ((m->m_flags & M_EXT) == 0) {
m_freem(m);
return ENOBUFS;
}
if (sc->sc_gigabit)
m->m_len = sc->sc_parm->p_rxbuf_len;
if (rxs->rxs_mbuf != NULL)
bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmamap);
rxs->rxs_mbuf = m;
error = bus_dmamap_load(sc->sc_dmat, rxs->rxs_dmamap,
m->m_ext.ext_buf, m->m_ext.ext_size, NULL,
BUS_DMA_READ | BUS_DMA_NOWAIT);
if (error) {
printf("%s: can't load rx DMA map %d, error = %d\n",
device_xname(sc->sc_dev), idx, error);
panic("%s", __func__);
}
bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
sip_init_rxdesc(sc, idx);
return 0;
}
static void
sipcom_sis900_set_filter(struct sip_softc *sc)
{
bus_space_tag_t st = sc->sc_st;
bus_space_handle_t sh = sc->sc_sh;
struct ethercom *ec = &sc->sc_ethercom;
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
struct ether_multi *enm;
const uint8_t *cp;
struct ether_multistep step;
uint32_t crc, mchash[16];
sc->sc_rfcr = RFCR_RFEN;
if (ifp->if_flags & IFF_BROADCAST)
sc->sc_rfcr |= RFCR_AAB;
if (ifp->if_flags & IFF_PROMISC) {
sc->sc_rfcr |= RFCR_AAP;
goto allmulti;
}
memset(mchash, 0, sizeof(mchash));
crc = 0x0ed423f9;
if (SIP_SIS900_REV(sc, SIS_REV_635) ||
SIP_SIS900_REV(sc, SIS_REV_960) ||
SIP_SIS900_REV(sc, SIS_REV_900B)) {
crc >>= 24;
} else {
crc >>= 25;
}
mchash[crc >> 4] |= 1 << (crc & 0xf);
ETHER_LOCK(ec);
ETHER_FIRST_MULTI(step, ec, enm);
while (enm != NULL) {
if (memcmp(enm->enm_addrlo, enm->enm_addrhi, ETHER_ADDR_LEN)) {
ETHER_UNLOCK(ec);
goto allmulti;
}
crc = ether_crc32_be(enm->enm_addrlo, ETHER_ADDR_LEN);
if (SIP_SIS900_REV(sc, SIS_REV_635) ||
SIP_SIS900_REV(sc, SIS_REV_960) ||
SIP_SIS900_REV(sc, SIS_REV_900B)) {
crc >>= 24;
} else {
crc >>= 25;
}
mchash[crc >> 4] |= 1 << (crc & 0xf);
ETHER_NEXT_MULTI(step, enm);
}
ETHER_UNLOCK(ec);
ifp->if_flags &= ~IFF_ALLMULTI;
goto setit;
allmulti:
ifp->if_flags |= IFF_ALLMULTI;
sc->sc_rfcr |= RFCR_AAM;
setit:
#define FILTER_EMIT(addr, data) \
bus_space_write_4(st, sh, SIP_RFCR, (addr)); \
delay(1); \
bus_space_write_4(st, sh, SIP_RFDR, (data)); \
delay(1)
cp = CLLADDR(ifp->if_sadl);
FILTER_EMIT(RFCR_RFADDR_NODE0, (cp[1] << 8) | cp[0]);
FILTER_EMIT(RFCR_RFADDR_NODE2, (cp[3] << 8) | cp[2]);
FILTER_EMIT(RFCR_RFADDR_NODE4, (cp[5] << 8) | cp[4]);
if ((ifp->if_flags & IFF_ALLMULTI) == 0) {
FILTER_EMIT(RFCR_RFADDR_MC0, mchash[0]);
FILTER_EMIT(RFCR_RFADDR_MC1, mchash[1]);
FILTER_EMIT(RFCR_RFADDR_MC2, mchash[2]);
FILTER_EMIT(RFCR_RFADDR_MC3, mchash[3]);
FILTER_EMIT(RFCR_RFADDR_MC4, mchash[4]);
FILTER_EMIT(RFCR_RFADDR_MC5, mchash[5]);
FILTER_EMIT(RFCR_RFADDR_MC6, mchash[6]);
FILTER_EMIT(RFCR_RFADDR_MC7, mchash[7]);
if (SIP_SIS900_REV(sc, SIS_REV_635) ||
SIP_SIS900_REV(sc, SIS_REV_960) ||
SIP_SIS900_REV(sc, SIS_REV_900B)) {
FILTER_EMIT(RFCR_RFADDR_MC8, mchash[8]);
FILTER_EMIT(RFCR_RFADDR_MC9, mchash[9]);
FILTER_EMIT(RFCR_RFADDR_MC10, mchash[10]);
FILTER_EMIT(RFCR_RFADDR_MC11, mchash[11]);
FILTER_EMIT(RFCR_RFADDR_MC12, mchash[12]);
FILTER_EMIT(RFCR_RFADDR_MC13, mchash[13]);
FILTER_EMIT(RFCR_RFADDR_MC14, mchash[14]);
FILTER_EMIT(RFCR_RFADDR_MC15, mchash[15]);
}
}
#undef FILTER_EMIT
bus_space_write_4(st, sh, SIP_RFCR, sc->sc_rfcr);
}
static void
sipcom_dp83815_set_filter(struct sip_softc *sc)
{
bus_space_tag_t st = sc->sc_st;
bus_space_handle_t sh = sc->sc_sh;
struct ethercom *ec = &sc->sc_ethercom;
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
struct ether_multi *enm;
const uint8_t *cp;
struct ether_multistep step;
uint32_t crc, hash, slot, bit;
#define MCHASH_NWORDS_83820 128
#define MCHASH_NWORDS_83815 32
#define MCHASH_NWORDS MAX(MCHASH_NWORDS_83820, MCHASH_NWORDS_83815)
uint16_t mchash[MCHASH_NWORDS];
int i;
sc->sc_rfcr = RFCR_RFEN | RFCR_APM;
if (ifp->if_flags & IFF_BROADCAST)
sc->sc_rfcr |= RFCR_AAB;
if (ifp->if_flags & IFF_PROMISC) {
sc->sc_rfcr |= RFCR_AAP;
goto allmulti;
}
memset(mchash, 0, sizeof(mchash));
ifp->if_flags &= ~IFF_ALLMULTI;
ETHER_FIRST_MULTI(step, ec, enm);
if (enm == NULL)
goto setit;
while (enm != NULL) {
if (memcmp(enm->enm_addrlo, enm->enm_addrhi, ETHER_ADDR_LEN)) {
goto allmulti;
}
crc = ether_crc32_be(enm->enm_addrlo, ETHER_ADDR_LEN);
if (sc->sc_gigabit) {
hash = crc >> 21;
} else {
hash = crc >> 23;
}
slot = hash >> 4;
bit = hash & 0xf;
mchash[slot] |= 1 << bit;
ETHER_NEXT_MULTI(step, enm);
}
sc->sc_rfcr |= RFCR_MHEN;
goto setit;
allmulti:
ifp->if_flags |= IFF_ALLMULTI;
sc->sc_rfcr |= RFCR_AAM;
setit:
#define FILTER_EMIT(addr, data) \
bus_space_write_4(st, sh, SIP_RFCR, (addr)); \
delay(1); \
bus_space_write_4(st, sh, SIP_RFDR, (data)); \
delay(1)
cp = CLLADDR(ifp->if_sadl);
FILTER_EMIT(RFCR_NS_RFADDR_PMATCH0, (cp[1] << 8) | cp[0]);
FILTER_EMIT(RFCR_NS_RFADDR_PMATCH2, (cp[3] << 8) | cp[2]);
FILTER_EMIT(RFCR_NS_RFADDR_PMATCH4, (cp[5] << 8) | cp[4]);
if ((ifp->if_flags & IFF_ALLMULTI) == 0) {
int nwords =
sc->sc_gigabit ? MCHASH_NWORDS_83820 : MCHASH_NWORDS_83815;
for (i = 0; i < nwords; i++) {
FILTER_EMIT(sc->sc_parm->p_filtmem + (i * 2), mchash[i]);
}
}
#undef FILTER_EMIT
#undef MCHASH_NWORDS
#undef MCHASH_NWORDS_83815
#undef MCHASH_NWORDS_83820
bus_space_write_4(st, sh, SIP_RFCR, sc->sc_rfcr);
}
static int
sipcom_dp83820_mii_readreg(device_t self, int phy, int reg, uint16_t *val)
{
struct sip_softc *sc = device_private(self);
if (sc->sc_cfg & CFG_TBI_EN) {
bus_addr_t tbireg;
if (phy != 0)
return -1;
switch (reg) {
case MII_BMCR: tbireg = SIP_TBICR; break;
case MII_BMSR: tbireg = SIP_TBISR; break;
case MII_ANAR: tbireg = SIP_TANAR; break;
case MII_ANLPAR: tbireg = SIP_TANLPAR; break;
case MII_ANER: tbireg = SIP_TANER; break;
case MII_EXTSR:
*val = (EXTSR_1000XFDX | EXTSR_1000XHDX);
return 0;
default:
return 0;
}
*val = bus_space_read_4(sc->sc_st, sc->sc_sh, tbireg) & 0xffff;
if (tbireg == SIP_TBISR) {
int sr = *val;
*val = 0;
if (sr & TBISR_MR_LINK_STATUS)
*val |= BMSR_LINK;
if (sr & TBISR_MR_AN_COMPLETE)
*val |= BMSR_ACOMP;
*val |= BMSR_ANEG | BMSR_EXTSTAT;
}
return 0;
}
return mii_bitbang_readreg(self, &sipcom_mii_bitbang_ops, phy, reg,
val);
}
static int
sipcom_dp83820_mii_writereg(device_t self, int phy, int reg, uint16_t val)
{
struct sip_softc *sc = device_private(self);
if (sc->sc_cfg & CFG_TBI_EN) {
bus_addr_t tbireg;
if (phy != 0)
return -1;
switch (reg) {
case MII_BMCR: tbireg = SIP_TBICR; break;
case MII_ANAR: tbireg = SIP_TANAR; break;
case MII_ANLPAR: tbireg = SIP_TANLPAR; break;
default:
return 0;
}
bus_space_write_4(sc->sc_st, sc->sc_sh, tbireg, val);
return 0;
}
return mii_bitbang_writereg(self, &sipcom_mii_bitbang_ops, phy, reg,
val);
}
static void
sipcom_dp83820_mii_statchg(struct ifnet *ifp)
{
struct sip_softc *sc = ifp->if_softc;
struct mii_data *mii = &sc->sc_mii;
uint32_t cfg, pcr;
if (IFM_SUBTYPE(mii->mii_media.ifm_cur->ifm_media) == IFM_AUTO &&
(mii->mii_media_active & IFM_ETH_FMASK) != sc->sc_flowflags) {
sc->sc_flowflags = mii->mii_media_active & IFM_ETH_FMASK;
mii->mii_media_active &= ~IFM_ETH_FMASK;
}
if ((mii->mii_media_active & IFM_FDX) != 0)
sc->sc_txcfg |= (TXCFG_CSI | TXCFG_HBI);
else
sc->sc_txcfg &= ~(TXCFG_CSI | TXCFG_HBI);
if ((mii->mii_media_active & IFM_FDX) != 0 ||
IFM_SUBTYPE(mii->mii_media_active) == IFM_LOOP)
sc->sc_rxcfg |= RXCFG_ATX;
else
sc->sc_rxcfg &= ~RXCFG_ATX;
if (sc->sc_ethercom.ec_if.if_baudrate == IF_Mbps(1000))
cfg = sc->sc_cfg | CFG_MODE_1000;
else
cfg = sc->sc_cfg;
pcr = 0;
if (sc->sc_flowflags & IFM_FLOW) {
if (sc->sc_flowflags & IFM_ETH_TXPAUSE)
pcr |= sc->sc_rx_flow_thresh;
if (sc->sc_flowflags & IFM_ETH_RXPAUSE)
pcr |= PCR_PSEN | PCR_PS_MCAST;
}
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_CFG, cfg);
bus_space_write_4(sc->sc_st, sc->sc_sh, sc->sc_regs.r_txcfg,
sc->sc_txcfg);
bus_space_write_4(sc->sc_st, sc->sc_sh, sc->sc_regs.r_rxcfg,
sc->sc_rxcfg);
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_NS_PCR, pcr);
}
static uint32_t
sipcom_mii_bitbang_read(device_t self)
{
struct sip_softc *sc = device_private(self);
return (bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_EROMAR));
}
static void
sipcom_mii_bitbang_write(device_t self, uint32_t val)
{
struct sip_softc *sc = device_private(self);
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_EROMAR, val);
}
static int
sipcom_sis900_mii_readreg(device_t self, int phy, int reg, uint16_t *val)
{
struct sip_softc *sc = device_private(self);
uint32_t enphy;
if (sc->sc_model->sip_product == PCI_PRODUCT_SIS_900)
return mii_bitbang_readreg(self, &sipcom_mii_bitbang_ops,
phy, reg, val);
#ifndef SIS900_MII_RESTRICT
if (sc->sc_model->sip_product == PCI_PRODUCT_SIS_900 && phy != 0)
return -1;
#endif
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_ENPHY,
(phy << ENPHY_PHYADDR_SHIFT) | (reg << ENPHY_REGADDR_SHIFT) |
ENPHY_RWCMD | ENPHY_ACCESS);
do {
enphy = bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_ENPHY);
} while (enphy & ENPHY_ACCESS);
*val = (enphy & ENPHY_PHYDATA) >> ENPHY_DATA_SHIFT;
return 0;
}
static int
sipcom_sis900_mii_writereg(device_t self, int phy, int reg, uint16_t val)
{
struct sip_softc *sc = device_private(self);
uint32_t enphy;
if (sc->sc_model->sip_product == PCI_PRODUCT_SIS_900) {
return mii_bitbang_writereg(self, &sipcom_mii_bitbang_ops,
phy, reg, val);
}
#ifndef SIS900_MII_RESTRICT
if (sc->sc_model->sip_product == PCI_PRODUCT_SIS_900 && phy != 0)
return -1;
#endif
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_ENPHY,
(val << ENPHY_DATA_SHIFT) | (phy << ENPHY_PHYADDR_SHIFT) |
(reg << ENPHY_REGADDR_SHIFT) | ENPHY_ACCESS);
do {
enphy = bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_ENPHY);
} while (enphy & ENPHY_ACCESS);
return 0;
}
static void
sipcom_sis900_mii_statchg(struct ifnet *ifp)
{
struct sip_softc *sc = ifp->if_softc;
struct mii_data *mii = &sc->sc_mii;
uint32_t flowctl;
if (IFM_SUBTYPE(mii->mii_media.ifm_cur->ifm_media) == IFM_AUTO &&
(mii->mii_media_active & IFM_ETH_FMASK) != sc->sc_flowflags) {
sc->sc_flowflags = mii->mii_media_active & IFM_ETH_FMASK;
mii->mii_media_active &= ~IFM_ETH_FMASK;
}
if ((mii->mii_media_active & IFM_FDX) != 0)
sc->sc_txcfg |= (TXCFG_CSI | TXCFG_HBI);
else
sc->sc_txcfg &= ~(TXCFG_CSI | TXCFG_HBI);
if ((mii->mii_media_active & IFM_FDX) != 0 ||
IFM_SUBTYPE(mii->mii_media_active) == IFM_LOOP)
sc->sc_rxcfg |= RXCFG_ATX;
else
sc->sc_rxcfg &= ~RXCFG_ATX;
if (sc->sc_flowflags & IFM_FLOW) {
sc->sc_imr |= (ISR_PAUSE_END | ISR_PAUSE_ST);
flowctl = FLOWCTL_FLOWEN;
} else {
sc->sc_imr &= ~(ISR_PAUSE_END | ISR_PAUSE_ST);
flowctl = 0;
}
bus_space_write_4(sc->sc_st, sc->sc_sh, sc->sc_regs.r_txcfg,
sc->sc_txcfg);
bus_space_write_4(sc->sc_st, sc->sc_sh, sc->sc_regs.r_rxcfg,
sc->sc_rxcfg);
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_IMR, sc->sc_imr);
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_FLOWCTL, flowctl);
}
static int
sipcom_dp83815_mii_readreg(device_t self, int phy, int reg, uint16_t *val)
{
struct sip_softc *sc = device_private(self);
uint32_t data;
if (phy != 0)
return -1;
do {
data = bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_NS_PHY(reg));
} while (reg == MII_BMSR && data == 0);
*val = data & 0xffff;
return 0;
}
static int
sipcom_dp83815_mii_writereg(device_t self, int phy, int reg, uint16_t val)
{
struct sip_softc *sc = device_private(self);
if (phy != 0)
return -1;
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_NS_PHY(reg), val);
return 0;
}
static void
sipcom_dp83815_mii_statchg(struct ifnet *ifp)
{
struct sip_softc *sc = ifp->if_softc;
if ((sc->sc_mii.mii_media_active & IFM_FDX) != 0)
sc->sc_txcfg |= (TXCFG_CSI | TXCFG_HBI);
else
sc->sc_txcfg &= ~(TXCFG_CSI | TXCFG_HBI);
if ((sc->sc_mii.mii_media_active & IFM_FDX) != 0 ||
IFM_SUBTYPE(sc->sc_mii.mii_media_active) == IFM_LOOP)
sc->sc_rxcfg |= RXCFG_ATX;
else
sc->sc_rxcfg &= ~RXCFG_ATX;
bus_space_write_4(sc->sc_st, sc->sc_sh, sc->sc_regs.r_txcfg,
sc->sc_txcfg);
bus_space_write_4(sc->sc_st, sc->sc_sh, sc->sc_regs.r_rxcfg,
sc->sc_rxcfg);
if (IFM_SUBTYPE(sc->sc_mii.mii_media_active) == IFM_100_TX) {
uint32_t reg;
bus_space_write_4(sc->sc_st, sc->sc_sh, 0x00cc, 0x0001);
reg = bus_space_read_4(sc->sc_st, sc->sc_sh, 0x00f4);
reg &= 0x0fff;
bus_space_write_4(sc->sc_st, sc->sc_sh, 0x00f4, reg | 0x1000);
delay(100);
reg = bus_space_read_4(sc->sc_st, sc->sc_sh, 0x00fc);
reg &= 0x00ff;
if ((reg & 0x0080) == 0 || (reg >= 0x00d8)) {
bus_space_write_4(sc->sc_st, sc->sc_sh, 0x00fc,
0x00e8);
reg = bus_space_read_4(sc->sc_st, sc->sc_sh, 0x00f4);
bus_space_write_4(sc->sc_st, sc->sc_sh, 0x00f4,
reg | 0x20);
}
bus_space_write_4(sc->sc_st, sc->sc_sh, 0x00cc, 0);
}
}
static void
sipcom_dp83820_read_macaddr(struct sip_softc *sc,
const struct pci_attach_args *pa, uint8_t *enaddr)
{
uint16_t eeprom_data[SIP_DP83820_EEPROM_LENGTH / 2];
uint8_t cksum, *e, match;
int i;
sipcom_read_eeprom(sc, 0, __arraycount(eeprom_data), eeprom_data);
match = eeprom_data[SIP_DP83820_EEPROM_CHECKSUM / 2] >> 8;
match = ~(match - 1);
cksum = 0x55;
e = (uint8_t *)eeprom_data;
for (i = 0; i < SIP_DP83820_EEPROM_CHECKSUM; i++)
cksum += *e++;
if (cksum != match)
printf("%s: Checksum (%x) mismatch (%x)",
device_xname(sc->sc_dev), cksum, match);
enaddr[0] = eeprom_data[SIP_DP83820_EEPROM_PMATCH2 / 2] & 0xff;
enaddr[1] = eeprom_data[SIP_DP83820_EEPROM_PMATCH2 / 2] >> 8;
enaddr[2] = eeprom_data[SIP_DP83820_EEPROM_PMATCH1 / 2] & 0xff;
enaddr[3] = eeprom_data[SIP_DP83820_EEPROM_PMATCH1 / 2] >> 8;
enaddr[4] = eeprom_data[SIP_DP83820_EEPROM_PMATCH0 / 2] & 0xff;
enaddr[5] = eeprom_data[SIP_DP83820_EEPROM_PMATCH0 / 2] >> 8;
}
static void
sipcom_sis900_eeprom_delay(struct sip_softc *sc)
{
int i;
for (i = 0; i < 10; i++)
bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_CR);
}
static void
sipcom_sis900_read_macaddr(struct sip_softc *sc,
const struct pci_attach_args *pa, uint8_t *enaddr)
{
uint16_t myea[ETHER_ADDR_LEN / 2];
switch (sc->sc_rev) {
case SIS_REV_630S:
case SIS_REV_630E:
case SIS_REV_630EA1:
case SIS_REV_630ET:
case SIS_REV_635:
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_CR, CR_RLD);
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_RFCR,
RFCR_RFADDR_NODE0);
myea[0] = bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_RFDR) &
0xffff;
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_RFCR,
RFCR_RFADDR_NODE2);
myea[1] = bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_RFDR) &
0xffff;
bus_space_write_4(sc->sc_st, sc->sc_sh, SIP_RFCR,
RFCR_RFADDR_NODE4);
myea[2] = bus_space_read_4(sc->sc_st, sc->sc_sh, SIP_RFDR) &
0xffff;
break;
case SIS_REV_960:
{
#define SIS_SET_EROMAR(x, y) \
bus_space_write_4(x->sc_st, x->sc_sh, SIP_EROMAR, \
bus_space_read_4(x->sc_st, x->sc_sh, SIP_EROMAR) | (y))
#define SIS_CLR_EROMAR(x, y) \
bus_space_write_4(x->sc_st, x->sc_sh, SIP_EROMAR, \
bus_space_read_4(x->sc_st, x->sc_sh, SIP_EROMAR) & ~(y))
int waittime, i;
SIS_SET_EROMAR(sc, EROMAR_REQ);
for (waittime = 0; waittime < 1000; waittime++) {
SIS_SET_EROMAR(sc, EROMAR_EECS);
sipcom_sis900_eeprom_delay(sc);
for (i = 0; i <= 25; i++) {
SIS_SET_EROMAR(sc, EROMAR_EESK);
sipcom_sis900_eeprom_delay(sc);
SIS_CLR_EROMAR(sc, EROMAR_EESK);
sipcom_sis900_eeprom_delay(sc);
}
SIS_CLR_EROMAR(sc, EROMAR_EECS);
sipcom_sis900_eeprom_delay(sc);
bus_space_write_4(sc->sc_st, sc->sc_sh,
SIP_EROMAR, 0);
if (bus_space_read_4(sc->sc_st, sc->sc_sh,
SIP_EROMAR) & EROMAR_GNT) {
sipcom_read_eeprom(sc,
SIP_EEPROM_ETHERNET_ID0 >> 1,
sizeof(myea) / sizeof(myea[0]),
myea);
break;
}
DELAY(1);
}
SIS_SET_EROMAR(sc, EROMAR_EESK);
SIS_SET_EROMAR(sc, EROMAR_DONE);
} break;
default:
sipcom_read_eeprom(sc, SIP_EEPROM_ETHERNET_ID0 >> 1,
sizeof(myea) / sizeof(myea[0]), myea);
}
enaddr[0] = myea[0] & 0xff;
enaddr[1] = myea[0] >> 8;
enaddr[2] = myea[1] & 0xff;
enaddr[3] = myea[1] >> 8;
enaddr[4] = myea[2] & 0xff;
enaddr[5] = myea[2] >> 8;
}
static const uint8_t bbr4[] = {0,8,4,12,2,10,6,14,1,9,5,13,3,11,7,15};
#define bbr(v) ((bbr4[(v)&0xf] << 4) | bbr4[((v)>>4) & 0xf])
static void
sipcom_dp83815_read_macaddr(struct sip_softc *sc,
const struct pci_attach_args *pa, uint8_t *enaddr)
{
uint16_t eeprom_data[SIP_DP83815_EEPROM_LENGTH / 2], *ea;
uint8_t cksum, *e, match;
int i;
sipcom_read_eeprom(sc, 0, sizeof(eeprom_data) /
sizeof(eeprom_data[0]), eeprom_data);
match = eeprom_data[SIP_DP83815_EEPROM_CHECKSUM/2] >> 8;
match = ~(match - 1);
cksum = 0x55;
e = (uint8_t *)eeprom_data;
for (i = 0; i < SIP_DP83815_EEPROM_CHECKSUM; i++)
cksum += *e++;
if (cksum != match)
printf("%s: Checksum (%x) mismatch (%x)",
device_xname(sc->sc_dev), cksum, match);
ea = &eeprom_data[6];
enaddr[0] = ((*ea & 0x1) << 7);
ea++;
enaddr[0] |= ((*ea & 0xFE00) >> 9);
enaddr[1] = ((*ea & 0x1FE) >> 1);
enaddr[2] = ((*ea & 0x1) << 7);
ea++;
enaddr[2] |= ((*ea & 0xFE00) >> 9);
enaddr[3] = ((*ea & 0x1FE) >> 1);
enaddr[4] = ((*ea & 0x1) << 7);
ea++;
enaddr[4] |= ((*ea & 0xFE00) >> 9);
enaddr[5] = ((*ea & 0x1FE) >> 1);
for (i = 0; i < 6 ;i++)
enaddr[i] = bbr(enaddr[i]);
}
static void
sipcom_mediastatus(struct ifnet *ifp, struct ifmediareq *ifmr)
{
struct sip_softc *sc = ifp->if_softc;
if (!device_is_active(sc->sc_dev)) {
ifmr->ifm_active = IFM_ETHER | IFM_NONE;
ifmr->ifm_status = 0;
return;
}
ether_mediastatus(ifp, ifmr);
ifmr->ifm_active = (ifmr->ifm_active & ~IFM_ETH_FMASK) |
sc->sc_flowflags;
}