#define BUG_4010796
#include <sys/types.h>
#include <sys/errno.h>
#include <sys/param.h>
#include <sys/stropts.h>
#include <sys/stream.h>
#include <sys/kmem.h>
#include <sys/conf.h>
#include <sys/devops.h>
#include <sys/ksynch.h>
#include <sys/stat.h>
#include <sys/modctl.h>
#include <sys/debug.h>
#include <sys/dlpi.h>
#include <sys/ethernet.h>
#include <sys/vlan.h>
#include <sys/mac.h>
#include <sys/mac_ether.h>
#include <sys/mac_provider.h>
#include <sys/pci.h>
#include <sys/ddi.h>
#include <sys/sunddi.h>
#include <sys/strsun.h>
#include "dnet_mii.h"
#include "dnet.h"
#define IDENT "DNET 21x4x"
#ifdef DNETDEBUG
#ifdef DNET_NOISY
int dnetdebug = -1;
#else
int dnetdebug = 0;
#endif
#endif
struct free_ptr {
struct free_rtn free_rtn;
caddr_t buf;
};
struct rbuf_list {
struct rbuf_list *rbuf_next;
caddr_t rbuf_vaddr;
uint32_t rbuf_paddr;
uint32_t rbuf_endpaddr;
ddi_dma_handle_t rbuf_dmahdl;
ddi_acc_handle_t rbuf_acchdl;
};
static int dnet_probe(dev_info_t *);
static int dnet_attach(dev_info_t *, ddi_attach_cmd_t);
static int dnet_detach(dev_info_t *, ddi_detach_cmd_t);
static int dnet_quiesce(dev_info_t *);
static int dnet_m_start(void *);
static void dnet_m_stop(void *);
static int dnet_m_getstat(void *, uint_t, uint64_t *);
static int dnet_m_setpromisc(void *, boolean_t);
static int dnet_m_multicst(void *, boolean_t, const uint8_t *);
static int dnet_m_unicst(void *, const uint8_t *);
static mblk_t *dnet_m_tx(void *, mblk_t *);
static uint_t dnet_intr(caddr_t);
static void write_gpr(struct dnetinstance *dnetp, uint32_t val);
static void dnet_reset_board(struct dnetinstance *);
static void dnet_init_board(struct dnetinstance *);
static void dnet_chip_init(struct dnetinstance *);
static uint32_t hashindex(const uint8_t *);
static int dnet_start(struct dnetinstance *);
static int dnet_set_addr(struct dnetinstance *);
static boolean_t dnet_send(struct dnetinstance *, mblk_t *);
static void dnet_getp(struct dnetinstance *);
static void update_rx_stats(struct dnetinstance *, int);
static void update_tx_stats(struct dnetinstance *, int);
static void set_gpr(struct dnetinstance *);
static void set_opr(struct dnetinstance *);
static void set_sia(struct dnetinstance *);
static int dnet_alloc_bufs(struct dnetinstance *);
static void dnet_free_bufs(struct dnetinstance *);
static void dnet_init_txrx_bufs(struct dnetinstance *);
static int alloc_descriptor(struct dnetinstance *);
static void dnet_reclaim_Tx_desc(struct dnetinstance *);
static int dnet_rbuf_init(dev_info_t *, int);
static int dnet_rbuf_destroy();
static struct rbuf_list *dnet_rbuf_alloc(dev_info_t *, int);
static void dnet_rbuf_free(caddr_t);
static void dnet_freemsg_buf(struct free_ptr *);
static void setup_block(struct dnetinstance *);
static int dnet_read_srom(dev_info_t *, int, ddi_acc_handle_t, caddr_t,
uchar_t *, int);
static void dnet_read21040addr(dev_info_t *, ddi_acc_handle_t, caddr_t,
uchar_t *, int *);
static void dnet_read21140srom(ddi_acc_handle_t, caddr_t, uchar_t *, int);
static int get_alternative_srom_image(dev_info_t *, uchar_t *, int);
static void dnet_print_srom(SROM_FORMAT *sr);
static void dnet_dump_leaf(LEAF_FORMAT *leaf);
static void dnet_dump_block(media_block_t *block);
#ifdef BUG_4010796
static void set_alternative_srom_image(dev_info_t *, uchar_t *, int);
static int dnet_hack(dev_info_t *);
#endif
static int dnet_hack_interrupts(struct dnetinstance *, int);
static int dnet_detach_hacked_interrupt(dev_info_t *devinfo);
static void enable_interrupts(struct dnetinstance *);
static void dnet_parse_srom(struct dnetinstance *dnetp, SROM_FORMAT *sr,
uchar_t *vi);
static void parse_controller_leaf(struct dnetinstance *dnetp, LEAF_FORMAT *leaf,
uchar_t *vi);
static uchar_t *parse_media_block(struct dnetinstance *dnetp,
media_block_t *block, uchar_t *vi);
static int check_srom_valid(uchar_t *);
static void dnet_dumpbin(char *msg, uchar_t *, int size, int len);
static void setup_legacy_blocks();
static void find_active_media(struct dnetinstance *);
static int send_test_packet(struct dnetinstance *);
static int dnet_link_sense(struct dnetinstance *);
static ushort_t dnet_mii_read(dev_info_t *dip, int phy_addr, int reg_num);
static void dnet_mii_write(dev_info_t *dip, int phy_addr, int reg_num,
int reg_dat);
static void write_mii(struct dnetinstance *, uint32_t, int);
static void mii_tristate(struct dnetinstance *);
static void do_phy(struct dnetinstance *);
static void dnet_mii_link_cb(dev_info_t *, int, enum mii_phy_state);
static void set_leaf(SROM_FORMAT *sr, LEAF_FORMAT *leaf);
#ifdef DNETDEBUG
uint32_t dnet_usecelapsed(struct dnetinstance *dnetp);
void dnet_timestamp(struct dnetinstance *, char *);
void dnet_usectimeout(struct dnetinstance *, uint32_t, int, timercb_t);
#endif
static char *media_str[] = {
"10BaseT",
"10Base2",
"10Base5",
"100BaseTX",
"10BaseT FD",
"100BaseTX FD",
"100BaseT4",
"100BaseFX",
"100BaseFX FD",
"MII"
};
static LEAF_FORMAT leaf_default_100;
static LEAF_FORMAT leaf_asante;
static LEAF_FORMAT leaf_phylegacy;
static LEAF_FORMAT leaf_cogent_100;
static LEAF_FORMAT leaf_21041;
static LEAF_FORMAT leaf_21040;
int rx_buf_size = (ETHERMAX + ETHERFCSL + VLAN_TAGSZ + 3) & ~3;
int max_rx_desc_21040 = MAX_RX_DESC_21040;
int max_rx_desc_21140 = MAX_RX_DESC_21140;
int max_tx_desc = MAX_TX_DESC;
int dnet_xmit_threshold = MAX_TX_DESC >> 2;
static kmutex_t dnet_rbuf_lock;
static ddi_dma_attr_t dma_attr = {
DMA_ATTR_V0,
0,
(uint64_t)0xFFFFFFFF,
0x7FFFFFFF,
4,
0x3F,
1,
(uint64_t)0xFFFFFFFF,
(uint64_t)0xFFFFFFFF,
1,
1,
0,
};
static ddi_dma_attr_t dma_attr_rb = {
DMA_ATTR_V0,
0,
(uint64_t)0xFFFFFFFF,
0x7FFFFFFF,
4,
0x3F,
1,
(uint64_t)0xFFFFFFFF,
(uint64_t)0xFFFFFFFF,
2,
1,
0,
};
static ddi_dma_attr_t dma_attr_tx = {
DMA_ATTR_V0,
0,
(uint64_t)0xFFFFFFFF,
0x7FFFFFFF,
1,
0x3F,
1,
(uint64_t)0xFFFFFFFF,
(uint64_t)0xFFFFFFFF,
0x7FFF,
1,
0,
};
static ddi_device_acc_attr_t accattr = {
DDI_DEVICE_ATTR_V0,
DDI_NEVERSWAP_ACC,
DDI_STRICTORDER_ACC,
};
uchar_t dnet_broadcastaddr[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
extern struct mod_ops mod_driverops;
DDI_DEFINE_STREAM_OPS(dnet_devops, nulldev, dnet_probe, dnet_attach,
dnet_detach, nodev, NULL, D_MP, NULL, dnet_quiesce);
static struct modldrv dnet_modldrv = {
&mod_driverops,
IDENT,
&dnet_devops
};
static struct modlinkage dnet_modlinkage = {
MODREV_1,
{ &dnet_modldrv, NULL }
};
static mac_callbacks_t dnet_m_callbacks = {
0,
dnet_m_getstat,
dnet_m_start,
dnet_m_stop,
dnet_m_setpromisc,
dnet_m_multicst,
dnet_m_unicst,
dnet_m_tx,
NULL,
NULL,
NULL,
NULL,
NULL
};
#define MAX_INST 8
struct hackintr_inf
{
struct dnetinstance *dnetps[MAX_INST];
dev_info_t *devinfo;
kmutex_t lock;
};
static char hackintr_propname[] = "InterruptData";
static char macoffset_propname[] = "MAC_offset";
static char speed_propname[] = "speed";
static char ofloprob_propname[] = "dmaworkaround";
static char duplex_propname[] = "full-duplex";
static char printsrom_propname[] = "print-srom";
static uint_t dnet_hack_intr(struct hackintr_inf *);
int
_init(void)
{
int i;
mutex_init(&dnet_rbuf_lock, NULL, MUTEX_DRIVER, NULL);
setup_legacy_blocks();
mac_init_ops(&dnet_devops, "dnet");
if ((i = mod_install(&dnet_modlinkage)) != 0) {
mac_fini_ops(&dnet_devops);
mutex_destroy(&dnet_rbuf_lock);
}
return (i);
}
int
_fini(void)
{
int i;
if ((i = mod_remove(&dnet_modlinkage)) == 0) {
mac_fini_ops(&dnet_devops);
while (dnet_rbuf_destroy() != 0) {
delay(drv_usectohz(100000));
#ifdef DNETDEBUG
if (dnetdebug & DNETDDI)
cmn_err(CE_WARN, "dnet _fini delay");
#endif
}
mutex_destroy(&dnet_rbuf_lock);
}
return (i);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&dnet_modlinkage, modinfop));
}
static int
dnet_probe(dev_info_t *devinfo)
{
ddi_acc_handle_t handle;
uint16_t vendorid;
uint16_t deviceid;
if (pci_config_setup(devinfo, &handle) != DDI_SUCCESS)
return (DDI_PROBE_FAILURE);
vendorid = pci_config_get16(handle, PCI_CONF_VENID);
if (vendorid != DEC_VENDOR_ID) {
pci_config_teardown(&handle);
return (DDI_PROBE_FAILURE);
}
deviceid = pci_config_get16(handle, PCI_CONF_DEVID);
switch (deviceid) {
case DEVICE_ID_21040:
case DEVICE_ID_21041:
case DEVICE_ID_21140:
case DEVICE_ID_21143:
break;
default:
pci_config_teardown(&handle);
return (DDI_PROBE_FAILURE);
}
pci_config_teardown(&handle);
#ifndef BUG_4010796
return (DDI_PROBE_SUCCESS);
#else
return (dnet_hack(devinfo));
#endif
}
#ifdef BUG_4010796
static int
dnet_hack(dev_info_t *devinfo)
{
uchar_t vendor_info[SROM_SIZE];
uint32_t csr;
uint16_t deviceid;
ddi_acc_handle_t handle;
uint32_t retval;
int secondary;
ddi_acc_handle_t io_handle;
caddr_t io_reg;
#define DNET_PCI_RNUMBER 1
if (pci_config_setup(devinfo, &handle) != DDI_SUCCESS)
return (DDI_PROBE_FAILURE);
deviceid = pci_config_get16(handle, PCI_CONF_DEVID);
csr = pci_config_get32(handle, PCI_CONF_COMM);
pci_config_put32(handle, PCI_CONF_COMM, (csr |PCI_COMM_ME|PCI_COMM_IO));
pci_config_teardown(&handle);
if (ddi_regs_map_setup(devinfo, DNET_PCI_RNUMBER,
&io_reg, 0, 0, &accattr, &io_handle) != DDI_SUCCESS) {
return (DDI_PROBE_FAILURE);
}
ddi_put32(io_handle, REG32(io_reg, BUS_MODE_REG), SW_RESET);
drv_usecwait(3);
ddi_put32(io_handle, REG32(io_reg, BUS_MODE_REG), 0);
drv_usecwait(8);
secondary = dnet_read_srom(devinfo, deviceid, io_handle,
io_reg, vendor_info, sizeof (vendor_info));
switch (secondary) {
case -1:
retval = DDI_PROBE_PARTIAL;
break;
case 0:
retval = DDI_PROBE_SUCCESS;
break;
default:
retval = DDI_PROBE_SUCCESS;
}
ddi_regs_map_free(&io_handle);
return (retval);
}
#endif
static int
dnet_attach(dev_info_t *devinfo, ddi_attach_cmd_t cmd)
{
uint16_t revid;
struct dnetinstance *dnetp;
mac_register_t *macp;
uchar_t vendor_info[SROM_SIZE];
uint32_t csr;
uint16_t deviceid;
ddi_acc_handle_t handle;
int secondary;
#define DNET_PCI_RNUMBER 1
switch (cmd) {
case DDI_ATTACH:
break;
case DDI_RESUME:
dnetp = ddi_get_driver_private(devinfo);
mutex_enter(&dnetp->intrlock);
mutex_enter(&dnetp->txlock);
dnet_reset_board(dnetp);
dnet_init_board(dnetp);
dnetp->suspended = B_FALSE;
if (dnetp->running) {
dnetp->need_tx_update = B_FALSE;
mutex_exit(&dnetp->txlock);
(void) dnet_start(dnetp);
mutex_exit(&dnetp->intrlock);
mac_tx_update(dnetp->mac_handle);
} else {
mutex_exit(&dnetp->txlock);
mutex_exit(&dnetp->intrlock);
}
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
if (pci_config_setup(devinfo, &handle) != DDI_SUCCESS)
return (DDI_FAILURE);
deviceid = pci_config_get16(handle, PCI_CONF_DEVID);
switch (deviceid) {
case DEVICE_ID_21040:
case DEVICE_ID_21041:
case DEVICE_ID_21140:
case DEVICE_ID_21143:
break;
default:
pci_config_teardown(&handle);
return (DDI_FAILURE);
}
csr = pci_config_get32(handle, PCI_CONF_COMM);
pci_config_put32(handle, PCI_CONF_COMM, (csr |PCI_COMM_ME|PCI_COMM_IO));
csr = pci_config_get32(handle, PCI_DNET_CONF_CFDD);
pci_config_put32(handle, PCI_DNET_CONF_CFDD,
csr & ~(CFDD_SLEEP|CFDD_SNOOZE));
revid = pci_config_get8(handle, PCI_CONF_REVID);
pci_config_teardown(&handle);
dnetp = kmem_zalloc(sizeof (struct dnetinstance), KM_SLEEP);
ddi_set_driver_private(devinfo, dnetp);
if (ddi_regs_map_setup(devinfo, DNET_PCI_RNUMBER, &dnetp->io_reg,
0, 0, &accattr, &dnetp->io_handle) != DDI_SUCCESS) {
kmem_free(dnetp, sizeof (struct dnetinstance));
return (DDI_FAILURE);
}
dnetp->devinfo = devinfo;
dnetp->board_type = deviceid;
if (ddi_get_iblock_cookie(devinfo, 0, &dnetp->icookie)
!= DDI_SUCCESS)
goto fail;
mutex_init(&dnetp->txlock, NULL, MUTEX_DRIVER, dnetp->icookie);
mutex_init(&dnetp->intrlock, NULL, MUTEX_DRIVER, dnetp->icookie);
dnetp->bnc_indicator =
ddi_getprop(DDI_DEV_T_ANY, devinfo, DDI_PROP_DONTPASS,
"bncaui", -1);
dnetp->speed =
ddi_getprop(DDI_DEV_T_ANY, devinfo, DDI_PROP_DONTPASS,
speed_propname, 0);
dnetp->full_duplex =
ddi_getprop(DDI_DEV_T_ANY, devinfo, DDI_PROP_DONTPASS,
duplex_propname, -1);
if (dnetp->speed == 100) {
dnetp->disallowed_media |= (1UL<<MEDIA_TP) | (1UL<<MEDIA_TP_FD);
} else if (dnetp->speed == 10) {
dnetp->disallowed_media |=
(1UL<<MEDIA_SYM_SCR) | (1UL<<MEDIA_SYM_SCR_FD);
}
if (dnetp->full_duplex == 1) {
dnetp->disallowed_media |=
(1UL<<MEDIA_TP) | (1UL<<MEDIA_SYM_SCR);
} else if (dnetp->full_duplex == 0) {
dnetp->disallowed_media |=
(1UL<<MEDIA_TP_FD) | (1UL<<MEDIA_SYM_SCR_FD);
}
if (dnetp->bnc_indicator == 0)
dnetp->disallowed_media |= (1UL<<MEDIA_BNC) | (1UL<<MEDIA_AUI);
else if (dnetp->bnc_indicator == 1)
dnetp->disallowed_media = (uint32_t)~(1U<<MEDIA_BNC);
else if (dnetp->bnc_indicator == 2)
dnetp->disallowed_media = (uint32_t)~(1U<<MEDIA_AUI);
dnet_reset_board(dnetp);
secondary = dnet_read_srom(devinfo, dnetp->board_type, dnetp->io_handle,
dnetp->io_reg, vendor_info, sizeof (vendor_info));
if (secondary == -1)
goto fail1;
dnet_parse_srom(dnetp, &dnetp->sr, vendor_info);
if (ddi_getprop(DDI_DEV_T_ANY, devinfo, DDI_PROP_DONTPASS,
printsrom_propname, 0))
dnet_print_srom(&dnetp->sr);
dnetp->sr.netaddr[ETHERADDRL-1] += secondary;
BCOPY((caddr_t)dnetp->sr.netaddr,
(caddr_t)dnetp->vendor_addr, ETHERADDRL);
BCOPY((caddr_t)dnetp->sr.netaddr,
(caddr_t)dnetp->curr_macaddr, ETHERADDRL);
dnetp->overrun_workaround =
((dnetp->board_type == DEVICE_ID_21140 && revid >= 0x20) ||
(dnetp->board_type == DEVICE_ID_21143 && revid <= 0x30)) ? 1 : 0;
dnetp->overrun_workaround =
ddi_getprop(DDI_DEV_T_ANY, devinfo, DDI_PROP_DONTPASS,
ofloprob_propname, dnetp->overrun_workaround);
if (!dnet_hack_interrupts(dnetp, secondary)) {
(void) ddi_add_intr(devinfo, 0, NULL,
NULL, dnet_intr, (caddr_t)dnetp);
}
dnetp->max_tx_desc = max_tx_desc;
dnetp->max_rx_desc = max_rx_desc_21040;
if (dnetp->board_type != DEVICE_ID_21040 &&
dnetp->board_type != DEVICE_ID_21041 &&
dnetp->speed != 10)
dnetp->max_rx_desc = max_rx_desc_21140;
if (dnet_alloc_bufs(dnetp) == FAILURE) {
cmn_err(CE_WARN, "DNET: Not enough DMA memory for buffers.");
goto fail2;
}
if ((macp = mac_alloc(MAC_VERSION)) == NULL)
goto fail2;
macp->m_type_ident = MAC_PLUGIN_IDENT_ETHER;
macp->m_driver = dnetp;
macp->m_dip = devinfo;
macp->m_src_addr = dnetp->curr_macaddr;
macp->m_callbacks = &dnet_m_callbacks;
macp->m_min_sdu = 0;
macp->m_max_sdu = ETHERMTU;
macp->m_margin = VLAN_TAGSZ;
if (mac_register(macp, &dnetp->mac_handle) == 0) {
mac_free(macp);
mutex_enter(&dnetp->intrlock);
dnetp->phyaddr = -1;
if (dnetp->board_type == DEVICE_ID_21140 ||
dnetp->board_type == DEVICE_ID_21143)
do_phy(dnetp);
find_active_media(dnetp);
if (dnetp->selected_media_block->media_code != MEDIA_MII &&
dnetp->mii != NULL) {
mii_destroy(dnetp->mii);
dnetp->mii = NULL;
dnetp->phyaddr = -1;
}
#ifdef DNETDEBUG
if (dnetdebug & DNETSENSE)
cmn_err(CE_NOTE, "dnet: link configured : %s",
media_str[dnetp->selected_media_block->media_code]);
#endif
bzero(dnetp->setup_buf_vaddr, SETUPBUF_SIZE);
dnet_reset_board(dnetp);
dnet_init_board(dnetp);
mutex_exit(&dnetp->intrlock);
(void) dnet_m_unicst(dnetp, dnetp->curr_macaddr);
(void) dnet_m_multicst(dnetp, B_TRUE, dnet_broadcastaddr);
return (DDI_SUCCESS);
}
mac_free(macp);
fail2:
(void) dnet_detach_hacked_interrupt(devinfo);
dnet_free_bufs(dnetp);
fail1:
mutex_destroy(&dnetp->txlock);
mutex_destroy(&dnetp->intrlock);
fail:
ddi_regs_map_free(&dnetp->io_handle);
kmem_free(dnetp, sizeof (struct dnetinstance));
return (DDI_FAILURE);
}
static int
dnet_detach(dev_info_t *devinfo, ddi_detach_cmd_t cmd)
{
int32_t rc;
struct dnetinstance *dnetp;
int32_t proplen;
dnetp = ddi_get_driver_private(devinfo);
switch (cmd) {
case DDI_DETACH:
break;
case DDI_SUSPEND:
mutex_enter(&dnetp->intrlock);
mutex_enter(&dnetp->txlock);
dnetp->suspended = B_TRUE;
dnet_reset_board(dnetp);
mutex_exit(&dnetp->txlock);
mutex_exit(&dnetp->intrlock);
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
if (mac_unregister(dnetp->mac_handle) != 0)
return (DDI_FAILURE);
dnet_reset_board(dnetp);
if ((rc = dnet_detach_hacked_interrupt(devinfo)) != DDI_SUCCESS)
return (rc);
if (dnetp->mii != NULL)
mii_destroy(dnetp->mii);
set_leaf(&dnetp->sr, NULL);
ddi_regs_map_free(&dnetp->io_handle);
dnet_free_bufs(dnetp);
mutex_destroy(&dnetp->txlock);
mutex_destroy(&dnetp->intrlock);
kmem_free(dnetp, sizeof (struct dnetinstance));
#ifdef BUG_4010796
if (ddi_getproplen(DDI_DEV_T_ANY, devinfo, 0,
"DNET_HACK", &proplen) != DDI_PROP_SUCCESS)
return (DDI_SUCCESS);
(void) ddi_prop_remove(DDI_DEV_T_NONE, devinfo, "DNET_HACK");
(void) ddi_prop_remove(DDI_DEV_T_NONE, ddi_get_parent(devinfo),
"DNET_SROM");
(void) ddi_prop_remove(DDI_DEV_T_NONE, ddi_get_parent(devinfo),
"DNET_DEVNUM");
#endif
return (DDI_SUCCESS);
}
int
dnet_quiesce(dev_info_t *dip)
{
struct dnetinstance *dnetp = ddi_get_driver_private(dip);
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, INT_MASK_REG), 0);
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, BUS_MODE_REG), SW_RESET);
return (DDI_SUCCESS);
}
static void
dnet_reset_board(struct dnetinstance *dnetp)
{
uint32_t val;
val = ddi_get32(dnetp->io_handle, REG32(dnetp->io_reg, OPN_MODE_REG));
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, OPN_MODE_REG),
val & ~(START_TRANSMIT | START_RECEIVE));
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, INT_MASK_REG), 0);
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, BUS_MODE_REG), SW_RESET);
drv_usecwait(5);
}
static void
dnet_init_board(struct dnetinstance *dnetp)
{
set_opr(dnetp);
set_gpr(dnetp);
set_sia(dnetp);
dnet_chip_init(dnetp);
}
static void
dnet_chip_init(struct dnetinstance *dnetp)
{
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, BUS_MODE_REG),
CACHE_ALIGN | BURST_SIZE);
dnet_init_txrx_bufs(dnetp);
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, RX_BASE_ADDR_REG),
dnetp->rx_desc_paddr);
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, TX_BASE_ADDR_REG),
dnetp->tx_desc_paddr);
dnetp->tx_current_desc = dnetp->rx_current_desc = 0;
dnetp->transmitted_desc = 0;
dnetp->free_desc = dnetp->max_tx_desc;
enable_interrupts(dnetp);
}
static int
dnet_start(struct dnetinstance *dnetp)
{
uint32_t val;
ASSERT(MUTEX_HELD(&dnetp->intrlock));
val = ddi_get32(dnetp->io_handle, REG32(dnetp->io_reg, OPN_MODE_REG));
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, OPN_MODE_REG),
val | START_TRANSMIT);
(void) dnet_set_addr(dnetp);
val = ddi_get32(dnetp->io_handle, REG32(dnetp->io_reg, OPN_MODE_REG));
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, OPN_MODE_REG),
val | START_RECEIVE);
enable_interrupts(dnetp);
return (0);
}
static int
dnet_m_start(void *arg)
{
struct dnetinstance *dnetp = arg;
mutex_enter(&dnetp->intrlock);
dnetp->running = B_TRUE;
if (!dnetp->suspended)
(void) dnet_start(dnetp);
mutex_exit(&dnetp->intrlock);
return (0);
}
static void
dnet_m_stop(void *arg)
{
struct dnetinstance *dnetp = arg;
uint32_t val;
mutex_enter(&dnetp->intrlock);
if (!dnetp->suspended) {
val = ddi_get32(dnetp->io_handle,
REG32(dnetp->io_reg, OPN_MODE_REG));
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, OPN_MODE_REG),
val & ~(START_TRANSMIT | START_RECEIVE));
}
mac_link_update(dnetp->mac_handle, LINK_STATE_UNKNOWN);
dnetp->running = B_FALSE;
mutex_exit(&dnetp->intrlock);
}
static int
dnet_set_addr(struct dnetinstance *dnetp)
{
struct tx_desc_type *desc;
int current_desc;
uint32_t val;
ASSERT(MUTEX_HELD(&dnetp->intrlock));
val = ddi_get32(dnetp->io_handle, REG32(dnetp->io_reg, OPN_MODE_REG));
if (!(val & START_TRANSMIT))
return (0);
current_desc = dnetp->tx_current_desc;
desc = &dnetp->tx_desc[current_desc];
mutex_enter(&dnetp->txlock);
dnetp->need_saddr = 0;
mutex_exit(&dnetp->txlock);
if ((alloc_descriptor(dnetp)) == FAILURE) {
mutex_enter(&dnetp->txlock);
dnetp->need_saddr = 1;
mutex_exit(&dnetp->txlock);
#ifdef DNETDEBUG
if (dnetdebug & DNETTRACE)
cmn_err(CE_WARN, "DNET saddr:alloc descriptor failure");
#endif
return (0);
}
desc->buffer1 = dnetp->setup_buf_paddr;
desc->buffer2 = 0;
desc->desc1.buffer_size1 = SETUPBUF_SIZE;
desc->desc1.buffer_size2 = 0;
desc->desc1.setup_packet = 1;
desc->desc1.first_desc = 0;
desc->desc1.last_desc = 0;
desc->desc1.filter_type0 = 1;
desc->desc1.filter_type1 = 1;
desc->desc1.int_on_comp = 1;
desc->desc0.own = 1;
ddi_put8(dnetp->io_handle, REG8(dnetp->io_reg, TX_POLL_REG),
TX_POLL_DEMAND);
return (0);
}
static int
dnet_m_unicst(void *arg, const uint8_t *macaddr)
{
struct dnetinstance *dnetp = arg;
uint32_t index;
uint32_t *hashp;
mutex_enter(&dnetp->intrlock);
bcopy(macaddr, dnetp->curr_macaddr, ETHERADDRL);
hashp = (uint32_t *)dnetp->setup_buf_vaddr;
index = hashindex((uint8_t *)dnet_broadcastaddr);
hashp[ index / 16 ] |= 1 << (index % 16);
index = hashindex((uint8_t *)dnetp->curr_macaddr);
hashp[ index / 16 ] |= 1 << (index % 16);
if (!dnetp->suspended)
(void) dnet_set_addr(dnetp);
mutex_exit(&dnetp->intrlock);
return (0);
}
static int
dnet_m_multicst(void *arg, boolean_t add, const uint8_t *macaddr)
{
struct dnetinstance *dnetp = arg;
uint32_t index;
uint32_t *hashp;
uint32_t retval;
mutex_enter(&dnetp->intrlock);
index = hashindex(macaddr);
hashp = (uint32_t *)dnetp->setup_buf_vaddr;
if (add) {
if (dnetp->multicast_cnt[index]++) {
mutex_exit(&dnetp->intrlock);
return (0);
}
hashp[ index / 16 ] |= 1 << (index % 16);
} else {
if (--dnetp->multicast_cnt[index]) {
mutex_exit(&dnetp->intrlock);
return (0);
}
hashp[ index / 16 ] &= ~ (1 << (index % 16));
}
if (!dnetp->suspended)
retval = dnet_set_addr(dnetp);
else
retval = 0;
mutex_exit(&dnetp->intrlock);
return (retval);
}
static uint32_t
hashindex(const uint8_t *address)
{
uint32_t crc = (uint32_t)HASH_CRC;
uint32_t const POLY = HASH_POLY;
uint32_t msb;
int32_t byteslength;
uint8_t currentbyte;
uint32_t index;
int32_t bit;
int32_t shift;
for (byteslength = 0; byteslength < ETHERADDRL; byteslength++) {
currentbyte = address[byteslength];
for (bit = 0; bit < 8; bit++) {
msb = crc >> 31;
crc <<= 1;
if (msb ^ (currentbyte & 1)) {
crc ^= POLY;
crc |= 0x00000001;
}
currentbyte >>= 1;
}
}
for (index = 0, bit = 23, shift = 8; shift >= 0; bit++, shift--) {
index |= (((crc >> bit) & 1) << shift);
}
return (index);
}
static int
dnet_m_setpromisc(void *arg, boolean_t on)
{
struct dnetinstance *dnetp = arg;
uint32_t val;
mutex_enter(&dnetp->intrlock);
if (dnetp->promisc == on) {
mutex_exit(&dnetp->intrlock);
return (0);
}
dnetp->promisc = on;
if (!dnetp->suspended) {
val = ddi_get32(dnetp->io_handle,
REG32(dnetp->io_reg, OPN_MODE_REG));
if (on)
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, OPN_MODE_REG),
val | PROM_MODE);
else
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, OPN_MODE_REG),
val & (~PROM_MODE));
}
mutex_exit(&dnetp->intrlock);
return (0);
}
static int
dnet_m_getstat(void *arg, uint_t stat, uint64_t *val)
{
struct dnetinstance *dnetp = arg;
switch (stat) {
case MAC_STAT_IFSPEED:
if (!dnetp->running) {
*val = 0;
} else {
*val = (dnetp->mii_up ?
dnetp->mii_speed : dnetp->speed) * 1000000;
}
break;
case MAC_STAT_NORCVBUF:
*val = dnetp->stat_norcvbuf;
break;
case MAC_STAT_IERRORS:
*val = dnetp->stat_errrcv;
break;
case MAC_STAT_OERRORS:
*val = dnetp->stat_errxmt;
break;
case MAC_STAT_COLLISIONS:
*val = dnetp->stat_collisions;
break;
case ETHER_STAT_DEFER_XMTS:
*val = dnetp->stat_defer;
break;
case ETHER_STAT_CARRIER_ERRORS:
*val = dnetp->stat_nocarrier;
break;
case ETHER_STAT_TOOSHORT_ERRORS:
*val = dnetp->stat_short;
break;
case ETHER_STAT_LINK_DUPLEX:
if (!dnetp->running) {
*val = LINK_DUPLEX_UNKNOWN;
} else if (dnetp->mii_up) {
*val = dnetp->mii_duplex ?
LINK_DUPLEX_FULL : LINK_DUPLEX_HALF;
} else {
*val = dnetp->full_duplex ?
LINK_DUPLEX_FULL : LINK_DUPLEX_HALF;
}
break;
case ETHER_STAT_TX_LATE_COLLISIONS:
*val = dnetp->stat_xmtlatecoll;
break;
case ETHER_STAT_EX_COLLISIONS:
*val = dnetp->stat_excoll;
break;
case MAC_STAT_OVERFLOWS:
*val = dnetp->stat_overflow;
break;
case MAC_STAT_UNDERFLOWS:
*val = dnetp->stat_underflow;
break;
default:
return (ENOTSUP);
}
return (0);
}
#define NextTXIndex(index) (((index)+1) % dnetp->max_tx_desc)
#define PrevTXIndex(index) (((index)-1) < 0 ? dnetp->max_tx_desc - 1: (index)-1)
static mblk_t *
dnet_m_tx(void *arg, mblk_t *mp)
{
struct dnetinstance *dnetp = arg;
mutex_enter(&dnetp->txlock);
if (dnetp->suspended) {
mutex_exit(&dnetp->txlock);
freemsg(mp);
return (NULL);
}
if (dnetp->need_saddr) {
mutex_exit(&dnetp->txlock);
mutex_enter(&dnetp->intrlock);
(void) dnet_set_addr(dnetp);
mutex_exit(&dnetp->intrlock);
mutex_enter(&dnetp->txlock);
}
while (mp != NULL) {
if (!dnet_send(dnetp, mp)) {
mutex_exit(&dnetp->txlock);
return (mp);
}
mp = mp->b_next;
}
mutex_exit(&dnetp->txlock);
mutex_enter(&dnetp->intrlock);
enable_interrupts(dnetp);
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, TX_POLL_REG),
TX_POLL_DEMAND);
mutex_exit(&dnetp->intrlock);
return (NULL);
}
static boolean_t
dnet_send(struct dnetinstance *dnetp, mblk_t *mp)
{
struct tx_desc_type *ring = dnetp->tx_desc;
int mblen, totlen;
int index, end_index, start_index;
int avail;
int error;
int bufn;
int retval;
mblk_t *bp;
ASSERT(MUTEX_HELD(&dnetp->txlock));
end_index = 0;
dnet_reclaim_Tx_desc(dnetp);
error = 0;
totlen = 0;
bp = mp;
bufn = 0;
index = start_index = dnetp->tx_current_desc;
avail = dnetp->free_desc;
while (bp != NULL) {
uint_t ncookies;
ddi_dma_cookie_t dma_cookie;
mblen = MBLKL(bp);
if (!mblen) {
bp = bp->b_cont;
continue;
}
retval = ddi_dma_addr_bind_handle(dnetp->dma_handle_tx, NULL,
(caddr_t)bp->b_rptr, mblen,
DDI_DMA_WRITE | DDI_DMA_STREAMING, DDI_DMA_SLEEP, 0,
&dma_cookie, &ncookies);
switch (retval) {
case DDI_DMA_MAPPED:
break;
case DDI_DMA_NORESOURCES:
error = 1;
break;
case DDI_DMA_NOMAPPING:
case DDI_DMA_INUSE:
case DDI_DMA_TOOBIG:
default:
error = 2;
break;
}
if (((ncookies + 1) >> 1) > dnetp->free_desc) {
(void) ddi_dma_unbind_handle(dnetp->dma_handle_tx);
error = 1;
break;
}
while (ncookies) {
end_index = index;
if (bufn % 2) {
ring[index].buffer2 =
(uint32_t)dma_cookie.dmac_address;
ring[index].desc1.buffer_size2 =
dma_cookie.dmac_size;
index = NextTXIndex(index);
} else {
ASSERT(ring[index].desc0.own == 0);
*(uint32_t *)&ring[index].desc0 = 0;
*(uint32_t *)&ring[index].desc1 &=
DNET_END_OF_RING;
ring[index].buffer1 =
(uint32_t)dma_cookie.dmac_address;
ring[index].desc1.buffer_size1 =
dma_cookie.dmac_size;
ring[index].buffer2 = (uint32_t)(0);
dnetp->free_desc--;
ASSERT(dnetp->free_desc >= 0);
}
totlen += dma_cookie.dmac_size;
bufn++;
if (--ncookies)
ddi_dma_nextcookie(dnetp->dma_handle_tx,
&dma_cookie);
}
(void) ddi_dma_unbind_handle(dnetp->dma_handle_tx);
bp = bp->b_cont;
}
if (error == 1) {
dnetp->stat_defer++;
dnetp->free_desc = avail;
dnetp->need_tx_update = B_TRUE;
return (B_FALSE);
} else if (error) {
dnetp->free_desc = avail;
freemsg(mp);
return (B_TRUE);
}
if (totlen > ETHERMAX + VLAN_TAGSZ) {
cmn_err(CE_WARN, "DNET: tried to send large %d packet", totlen);
dnetp->free_desc = avail;
freemsg(mp);
return (B_TRUE);
}
dnetp->tx_msgbufp[end_index] = mp;
ring[end_index].desc1.last_desc = 1;
ring[end_index].desc1.int_on_comp = 1;
for (index = end_index; index != start_index;
index = PrevTXIndex(index))
ring[index].desc0.own = 1;
ring[start_index].desc1.first_desc = 1;
ring[start_index].desc0.own = 1;
dnetp->tx_current_desc = NextTXIndex(end_index);
ASSERT(ring[dnetp->max_tx_desc-1].desc1.end_of_ring != 0);
return (B_TRUE);
}
static uint_t
dnet_intr(caddr_t arg)
{
struct dnetinstance *dnetp = (struct dnetinstance *)arg;
uint32_t int_status;
mutex_enter(&dnetp->intrlock);
if (dnetp->suspended) {
mutex_exit(&dnetp->intrlock);
return (DDI_INTR_UNCLAIMED);
}
int_status = ddi_get32(dnetp->io_handle, REG32(dnetp->io_reg,
STATUS_REG));
if (!(int_status & (NORMAL_INTR_SUMM | ABNORMAL_INTR_SUMM))) {
mutex_exit(&dnetp->intrlock);
return (DDI_INTR_UNCLAIMED);
}
dnetp->stat_intr++;
if (int_status & GPTIMER_INTR) {
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, STATUS_REG), GPTIMER_INTR);
if (dnetp->timer.cb)
dnetp->timer.cb(dnetp);
else
cmn_err(CE_WARN, "dnet: unhandled timer interrupt");
}
if (int_status & TX_INTR) {
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, STATUS_REG), TX_INTR);
mutex_enter(&dnetp->txlock);
if (dnetp->need_tx_update) {
mutex_exit(&dnetp->txlock);
mutex_exit(&dnetp->intrlock);
mac_tx_update(dnetp->mac_handle);
mutex_enter(&dnetp->intrlock);
mutex_enter(&dnetp->txlock);
dnetp->need_tx_update = B_FALSE;
}
dnet_reclaim_Tx_desc(dnetp);
mutex_exit(&dnetp->txlock);
}
if (int_status & (RX_INTR | RX_UNAVAIL_INTR)) {
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, STATUS_REG),
int_status & (RX_INTR | RX_UNAVAIL_INTR));
dnet_getp(dnetp);
}
if (int_status & ABNORMAL_INTR_SUMM) {
if (int_status & SYS_ERR) {
if ((int_status & SYS_ERR_BITS) == MASTER_ABORT)
cmn_err(CE_WARN, "DNET: Bus Master Abort");
if ((int_status & SYS_ERR_BITS) == TARGET_ABORT)
cmn_err(CE_WARN, "DNET: Bus Target Abort");
if ((int_status & SYS_ERR_BITS) == PARITY_ERROR)
cmn_err(CE_WARN, "DNET: Parity error");
}
if (int_status & TX_JABBER_TIMEOUT)
cmn_err(CE_WARN, "DNET: Jabber timeout.");
if (int_status & TX_UNDERFLOW)
cmn_err(CE_WARN, "DNET: Tx Underflow.");
#ifdef DNETDEBUG
if (dnetdebug & DNETINT)
cmn_err(CE_NOTE, "Trying to reset...");
#endif
dnet_reset_board(dnetp);
dnet_init_board(dnetp);
(void) dnet_start(dnetp);
}
enable_interrupts(dnetp);
mutex_exit(&dnetp->intrlock);
return (DDI_INTR_CLAIMED);
}
static void
dnet_getp(struct dnetinstance *dnetp)
{
int packet_length, index;
mblk_t *mp;
caddr_t virtual_address;
struct rx_desc_type *desc = dnetp->rx_desc;
int marker = dnetp->rx_current_desc;
int misses;
if (!dnetp->overrun_workaround) {
misses = ddi_get32(dnetp->io_handle,
REG32(dnetp->io_reg, MISSED_FRAME_REG));
dnetp->stat_missed += (misses & MISSED_FRAME_MASK);
}
while (!(desc[dnetp->rx_current_desc].desc0.own)) {
struct free_ptr *frp;
caddr_t newbuf;
struct rbuf_list *rp;
index = dnetp->rx_current_desc;
ASSERT(desc[index].desc0.first_desc != 0);
if (dnetp->overrun_workaround &&
marker == dnetp->rx_current_desc) {
int opn;
do {
marker = (marker+1) % dnetp->max_rx_desc;
} while (!(dnetp->rx_desc[marker].desc0.own) &&
marker != index);
misses = ddi_get32(dnetp->io_handle,
REG32(dnetp->io_reg, MISSED_FRAME_REG));
dnetp->stat_missed +=
(misses & MISSED_FRAME_MASK);
if (misses & OVERFLOW_COUNTER_MASK) {
opn = ddi_get32(dnetp->io_handle,
REG32(dnetp->io_reg, OPN_MODE_REG));
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, OPN_MODE_REG),
opn & ~(START_RECEIVE));
do {
drv_usecwait(10);
} while ((ddi_get32(dnetp->io_handle,
REG32(dnetp->io_reg, STATUS_REG)) &
RECEIVE_PROCESS_STATE) != 0);
#ifdef DNETDEBUG
if (dnetdebug & DNETRECV)
cmn_err(CE_CONT, "^*");
#endif
while (!(dnetp->rx_desc[index].desc0.own)) {
dnetp->rx_desc[index].desc0.own = 1;
index = (index+1) % dnetp->max_rx_desc;
dnetp->stat_missed++;
}
opn = ddi_get32(dnetp->io_handle,
REG32(dnetp->io_reg, OPN_MODE_REG));
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, OPN_MODE_REG),
opn | START_RECEIVE);
marker = dnetp->rx_current_desc = index;
continue;
}
}
while (desc[index].desc0.last_desc == 0) {
index = (index + 1) % dnetp->max_rx_desc;
if (desc[index].desc0.own)
return;
}
while (dnetp->rx_current_desc != index) {
desc[dnetp->rx_current_desc].desc0.own = 1;
dnetp->rx_current_desc =
(dnetp->rx_current_desc + 1) % dnetp->max_rx_desc;
#ifdef DNETDEBUG
if (dnetdebug & DNETRECV)
cmn_err(CE_WARN, "dnet: received large packet");
#endif
}
packet_length = desc[index].desc0.frame_len;
packet_length -= ETHERFCSL;
virtual_address =
dnetp->rx_buf_vaddr[index];
frp = NULL;
rp = NULL;
newbuf = NULL;
mp = NULL;
if (!desc[index].desc0.err_summary ||
(desc[index].desc0.frame2long &&
packet_length < rx_buf_size)) {
ASSERT(packet_length < rx_buf_size);
rp = dnet_rbuf_alloc(dnetp->devinfo, 0);
if (rp != NULL) {
newbuf = rp->rbuf_vaddr;
frp = kmem_zalloc(sizeof (*frp), KM_NOSLEEP);
if (frp != NULL) {
frp->free_rtn.free_func =
dnet_freemsg_buf;
frp->free_rtn.free_arg = (char *)frp;
frp->buf = virtual_address;
mp = desballoc(
(uchar_t *)virtual_address,
packet_length, 0, &frp->free_rtn);
if (mp == NULL) {
kmem_free(frp, sizeof (*frp));
dnet_rbuf_free((caddr_t)newbuf);
frp = NULL;
newbuf = NULL;
}
}
}
if (mp == NULL) {
if (newbuf != NULL)
dnet_rbuf_free((caddr_t)newbuf);
mp = allocb(packet_length, 0);
}
}
if ((desc[index].desc0.err_summary &&
packet_length >= rx_buf_size) || mp == NULL) {
if (desc[index].desc0.err_summary)
update_rx_stats(dnetp, index);
else
dnetp->stat_norcvbuf++;
desc[index].desc0.own = 1;
dnetp->rx_current_desc =
(dnetp->rx_current_desc+1) % dnetp->max_rx_desc;
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, RX_POLL_REG), RX_POLL_DEMAND);
continue;
}
if (newbuf != NULL) {
uint32_t end_paddr;
dnetp->rx_buf_vaddr[index] = newbuf;
dnetp->rx_buf_paddr[index] = rp->rbuf_paddr;
desc[index].buffer1 = rp->rbuf_paddr;
desc[index].desc1.buffer_size1 = rx_buf_size;
desc[index].desc1.buffer_size2 = 0;
end_paddr = rp->rbuf_endpaddr;
if ((desc[index].buffer1 & ~dnetp->pgmask) !=
(end_paddr & ~dnetp->pgmask)) {
desc[index].buffer2 = end_paddr&~dnetp->pgmask;
desc[index].desc1.buffer_size2 =
(end_paddr & dnetp->pgmask) + 1;
desc[index].desc1.buffer_size1 =
rx_buf_size-desc[index].desc1.buffer_size2;
}
} else {
BCOPY((caddr_t)virtual_address, (caddr_t)mp->b_wptr,
packet_length);
}
mp->b_wptr += packet_length;
desc[dnetp->rx_current_desc].desc0.own = 1;
dnetp->rx_current_desc =
(dnetp->rx_current_desc+1) % dnetp->max_rx_desc;
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, RX_POLL_REG), RX_POLL_DEMAND);
mutex_exit(&dnetp->intrlock);
mac_rx(dnetp->mac_handle, NULL, mp);
mutex_enter(&dnetp->intrlock);
}
}
static void
update_rx_stats(struct dnetinstance *dnetp, int index)
{
struct rx_desc_type *descp = &(dnetp->rx_desc[index]);
dnetp->stat_errrcv++;
if (descp->desc0.overflow) {
dnetp->stat_overflow++;
}
if (descp->desc0.collision) {
}
if (descp->desc0.crc) {
dnetp->stat_crc++;
}
if (descp->desc0.runt_frame) {
dnetp->stat_short++;
}
if (descp->desc0.desc_err) {
}
if (descp->desc0.frame2long) {
dnetp->stat_frame++;
}
}
static void
update_tx_stats(struct dnetinstance *dnetp, int index)
{
struct tx_desc_type *descp = &(dnetp->tx_desc[index]);
int fd;
media_block_t *block = dnetp->selected_media_block;
dnetp->stat_errxmt++;
if (dnetp->mii_up) {
fd = dnetp->mii_duplex;
} else {
fd = block->media_code == MEDIA_TP_FD ||
block->media_code == MEDIA_SYM_SCR_FD;
}
if (descp->desc0.collision_count && !fd) {
dnetp->stat_collisions += descp->desc0.collision_count;
}
if (descp->desc0.late_collision && !fd) {
dnetp->stat_xmtlatecoll++;
}
if (descp->desc0.excess_collision && !fd) {
dnetp->stat_excoll++;
}
if (descp->desc0.underflow) {
dnetp->stat_underflow++;
}
#if 0
if (descp->desc0.tx_jabber_to) {
}
#endif
if (descp->desc0.carrier_loss && !fd) {
dnetp->stat_nocarrier++;
}
if (descp->desc0.no_carrier && !fd) {
dnetp->stat_nocarrier++;
}
}
static void
write_gpr(struct dnetinstance *dnetp, uint32_t val)
{
#ifdef DEBUG
if (dnetdebug & DNETREGCFG)
cmn_err(CE_NOTE, "GPR: %x", val);
#endif
switch (dnetp->board_type) {
case DEVICE_ID_21143:
if (val & GPR_CONTROL_WRITE)
val |= CWE_21143, val &= ~GPR_CONTROL_WRITE;
dnetp->gprsia = (dnetp->gprsia & 0xffff) | (val << 16);
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, SIA_GENERAL_REG), dnetp->gprsia);
break;
default:
if (val & GPR_CONTROL_WRITE)
val |= CWE_21140, val &= ~GPR_CONTROL_WRITE;
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, GP_REG), val);
break;
}
}
static uint32_t
read_gpr(struct dnetinstance *dnetp)
{
switch (dnetp->board_type) {
case DEVICE_ID_21143:
return (ddi_get32(dnetp->io_handle,
REG32(dnetp->io_reg, SIA_GENERAL_REG)) >> 16);
default:
return (ddi_get32(dnetp->io_handle,
REG32(dnetp->io_reg, GP_REG)));
}
}
static void
set_gpr(struct dnetinstance *dnetp)
{
uint32_t *sequence;
int len;
LEAF_FORMAT *leaf = &dnetp->sr.leaf[dnetp->leaf];
media_block_t *block = dnetp->selected_media_block;
int i;
if (ddi_getlongprop(DDI_DEV_T_ANY, dnetp->devinfo,
DDI_PROP_DONTPASS, "gpr-sequence", (caddr_t)&sequence,
&len) == DDI_PROP_SUCCESS) {
for (i = 0; i < len / sizeof (uint32_t); i++)
write_gpr(dnetp, sequence[i]);
kmem_free(sequence, len);
} else {
if (block->rstseqlen) {
for (i = 0; i < block->rstseqlen; i++)
write_gpr(dnetp, block->rstseq[i]);
block->rstseqlen = 0;
}
if (leaf->gpr)
write_gpr(dnetp, leaf->gpr | GPR_CONTROL_WRITE);
for (i = 0; i < block->gprseqlen; i++)
write_gpr(dnetp, block->gprseq[i]);
}
if (dnetp->phyaddr != -1)
(void) mii_sync(dnetp->mii, dnetp->phyaddr);
drv_usecwait(5);
}
static void
set_opr(struct dnetinstance *dnetp)
{
uint32_t fd, mb1, sf;
int opnmode_len;
uint32_t val;
media_block_t *block = dnetp->selected_media_block;
ASSERT(block);
opnmode_len = sizeof (val);
if (ddi_prop_op(DDI_DEV_T_ANY, dnetp->devinfo,
PROP_LEN_AND_VAL_BUF, DDI_PROP_DONTPASS, "opnmode_reg",
(caddr_t)&val, &opnmode_len) != DDI_PROP_SUCCESS)
opnmode_len = 0;
if (dnetp->board_type != DEVICE_ID_21040 &&
dnetp->board_type != DEVICE_ID_21041) {
mb1 = OPN_REG_MB1;
sf = STORE_AND_FORWARD;
} else {
mb1 = sf = 0;
mb1 = OPN_REG_MB1;
}
if (opnmode_len) {
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, OPN_MODE_REG), val);
dnet_reset_board(dnetp);
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, OPN_MODE_REG), val);
return;
}
val = HASH_FILTERING | HASH_ONLY | TX_THRESHOLD_160 | mb1 | sf;
val |= dnetp->promisc ? PROM_MODE : 0;
val |= ((block->command & CMD_SCR) && !dnetp->disable_scrambler) ?
SCRAMBLER_MODE : 0;
if (dnetp->mii_up) {
fd = dnetp->mii_duplex;
} else {
fd = block->media_code == MEDIA_TP_FD ||
block->media_code == MEDIA_SYM_SCR_FD;
}
val |= block->command & CMD_PS ? (PORT_SELECT | HEARTBEAT_DISABLE) : 0;
val |= (block->command) & CMD_PCS ? PCS_FUNCTION : 0;
val |= fd ? FULL_DUPLEX : 0;
#ifdef DNETDEBUG
if (dnetdebug & DNETREGCFG)
cmn_err(CE_NOTE, "OPN: %x", val);
#endif
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, OPN_MODE_REG), val);
dnet_reset_board(dnetp);
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, OPN_MODE_REG), val);
}
static void
set_sia(struct dnetinstance *dnetp)
{
media_block_t *block = dnetp->selected_media_block;
ASSERT(MUTEX_HELD(&dnetp->intrlock));
if (block->type == 2) {
int sia_delay;
#ifdef DNETDEBUG
if (dnetdebug & DNETREGCFG)
cmn_err(CE_NOTE,
"SIA: CSR13: %x, CSR14: %x, CSR15: %x",
block->un.sia.csr13,
block->un.sia.csr14,
block->un.sia.csr15);
#endif
sia_delay = ddi_getprop(DDI_DEV_T_ANY, dnetp->devinfo,
DDI_PROP_DONTPASS, "sia-delay", 10000);
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, SIA_CONNECT_REG), 0);
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, SIA_TXRX_REG),
block->un.sia.csr14);
dnetp->gprsia = (dnetp->gprsia&0xffff0000)|block->un.sia.csr15;
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, SIA_GENERAL_REG),
dnetp->gprsia);
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, SIA_CONNECT_REG),
block->un.sia.csr13);
drv_usecwait(sia_delay);
} else if (dnetp->board_type != DEVICE_ID_21140) {
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, SIA_CONNECT_REG), 0);
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, SIA_TXRX_REG), 0);
}
}
static int
dnet_alloc_bufs(struct dnetinstance *dnetp)
{
int i;
size_t len;
int page_size;
int realloc = 0;
int nrecv_desc_old = 0;
ddi_dma_cookie_t cookie;
uint_t ncookies;
if ((dnetp->tx_desc != NULL) &&
(dnetp->nxmit_desc != dnetp->max_tx_desc))
realloc = 1;
if ((dnetp->rx_desc != NULL) &&
(dnetp->nrecv_desc != dnetp->max_rx_desc))
realloc = 1;
if (realloc) {
nrecv_desc_old = dnetp->nrecv_desc;
dnet_free_bufs(dnetp);
}
if (dnetp->dma_handle == NULL)
if (ddi_dma_alloc_handle(dnetp->devinfo, &dma_attr,
DDI_DMA_SLEEP, 0, &dnetp->dma_handle) != DDI_SUCCESS)
return (FAILURE);
if (dnetp->dma_handle_tx == NULL)
if (ddi_dma_alloc_handle(dnetp->devinfo, &dma_attr_tx,
DDI_DMA_SLEEP, 0, &dnetp->dma_handle_tx) != DDI_SUCCESS)
return (FAILURE);
if (dnetp->dma_handle_txdesc == NULL)
if (ddi_dma_alloc_handle(dnetp->devinfo, &dma_attr,
DDI_DMA_SLEEP, 0, &dnetp->dma_handle_txdesc) != DDI_SUCCESS)
return (FAILURE);
if (dnetp->dma_handle_setbuf == NULL)
if (ddi_dma_alloc_handle(dnetp->devinfo, &dma_attr,
DDI_DMA_SLEEP, 0, &dnetp->dma_handle_setbuf) != DDI_SUCCESS)
return (FAILURE);
page_size = ddi_ptob(dnetp->devinfo, 1);
dnetp->pgmask = page_size - 1;
if (dnetp->setup_buf_vaddr == NULL) {
if (ddi_dma_mem_alloc(dnetp->dma_handle_setbuf,
SETUPBUF_SIZE, &accattr, DDI_DMA_STREAMING,
DDI_DMA_DONTWAIT, 0, (caddr_t *)&dnetp->setup_buf_vaddr,
&len, &dnetp->setup_buf_acchdl) != DDI_SUCCESS)
return (FAILURE);
if (ddi_dma_addr_bind_handle(dnetp->dma_handle_setbuf,
NULL, dnetp->setup_buf_vaddr, SETUPBUF_SIZE,
DDI_DMA_RDWR | DDI_DMA_STREAMING, DDI_DMA_SLEEP,
NULL, &cookie, &ncookies) != DDI_DMA_MAPPED)
return (FAILURE);
dnetp->setup_buf_paddr = cookie.dmac_address;
bzero(dnetp->setup_buf_vaddr, len);
}
if (dnetp->tx_desc == NULL) {
if (ddi_dma_mem_alloc(dnetp->dma_handle_txdesc,
sizeof (struct tx_desc_type) * dnetp->max_tx_desc,
&accattr, DDI_DMA_STREAMING, DDI_DMA_DONTWAIT, 0,
(caddr_t *)&dnetp->tx_desc, &len,
&dnetp->tx_desc_acchdl) != DDI_SUCCESS)
return (FAILURE);
if (ddi_dma_addr_bind_handle(dnetp->dma_handle_txdesc,
NULL, (caddr_t)dnetp->tx_desc,
sizeof (struct tx_desc_type) * dnetp->max_tx_desc,
DDI_DMA_RDWR | DDI_DMA_STREAMING, DDI_DMA_SLEEP,
NULL, &cookie, &ncookies) != DDI_DMA_MAPPED)
return (FAILURE);
dnetp->tx_desc_paddr = cookie.dmac_address;
bzero(dnetp->tx_desc, len);
dnetp->nxmit_desc = dnetp->max_tx_desc;
dnetp->tx_msgbufp =
kmem_zalloc(dnetp->max_tx_desc * sizeof (mblk_t **),
KM_SLEEP);
}
if (dnetp->rx_desc == NULL) {
int ndesc;
if (ddi_dma_mem_alloc(dnetp->dma_handle,
sizeof (struct rx_desc_type) * dnetp->max_rx_desc,
&accattr, DDI_DMA_STREAMING, DDI_DMA_DONTWAIT, 0,
(caddr_t *)&dnetp->rx_desc, &len,
&dnetp->rx_desc_acchdl) != DDI_SUCCESS)
return (FAILURE);
if (ddi_dma_addr_bind_handle(dnetp->dma_handle,
NULL, (caddr_t)dnetp->rx_desc,
sizeof (struct rx_desc_type) * dnetp->max_rx_desc,
DDI_DMA_RDWR | DDI_DMA_STREAMING, DDI_DMA_SLEEP,
NULL, &cookie, &ncookies) != DDI_DMA_MAPPED)
return (FAILURE);
dnetp->rx_desc_paddr = cookie.dmac_address;
bzero(dnetp->rx_desc, len);
dnetp->nrecv_desc = dnetp->max_rx_desc;
dnetp->rx_buf_vaddr =
kmem_zalloc(dnetp->max_rx_desc * sizeof (caddr_t),
KM_SLEEP);
dnetp->rx_buf_paddr =
kmem_zalloc(dnetp->max_rx_desc * sizeof (uint32_t),
KM_SLEEP);
ndesc = dnetp->max_rx_desc - nrecv_desc_old;
if ((ndesc > 0) &&
(dnet_rbuf_init(dnetp->devinfo, ndesc * 2) != 0))
return (FAILURE);
for (i = 0; i < dnetp->max_rx_desc; i++) {
struct rbuf_list *rp;
rp = dnet_rbuf_alloc(dnetp->devinfo, 1);
if (rp == NULL)
return (FAILURE);
dnetp->rx_buf_vaddr[i] = rp->rbuf_vaddr;
dnetp->rx_buf_paddr[i] = rp->rbuf_paddr;
}
}
return (SUCCESS);
}
static void
dnet_free_bufs(struct dnetinstance *dnetp)
{
int i;
if (dnetp->tx_desc != NULL) {
ddi_dma_mem_free(&dnetp->tx_desc_acchdl);
dnetp->tx_desc = NULL;
if (dnetp->tx_msgbufp != NULL) {
for (i = 0; i < dnetp->nxmit_desc; i++) {
if (dnetp->tx_msgbufp[i] != NULL) {
freemsg(dnetp->tx_msgbufp[i]);
}
}
kmem_free(dnetp->tx_msgbufp,
dnetp->nxmit_desc * sizeof (mblk_t **));
dnetp->tx_msgbufp = NULL;
}
dnetp->nxmit_desc = 0;
}
if (dnetp->rx_desc != NULL) {
ddi_dma_mem_free(&dnetp->rx_desc_acchdl);
dnetp->rx_desc = NULL;
if (dnetp->rx_buf_vaddr != NULL) {
for (i = 0; i < dnetp->nrecv_desc; i++) {
if (dnetp->rx_buf_vaddr[i])
dnet_rbuf_free(
(caddr_t)dnetp->rx_buf_vaddr[i]);
}
kmem_free(dnetp->rx_buf_vaddr,
dnetp->nrecv_desc * sizeof (caddr_t));
kmem_free(dnetp->rx_buf_paddr,
dnetp->nrecv_desc * sizeof (uint32_t));
dnetp->rx_buf_vaddr = NULL;
dnetp->rx_buf_paddr = NULL;
}
dnetp->nrecv_desc = 0;
}
if (dnetp->setup_buf_vaddr != NULL) {
ddi_dma_mem_free(&dnetp->setup_buf_acchdl);
dnetp->setup_buf_vaddr = NULL;
}
if (dnetp->dma_handle != NULL) {
(void) ddi_dma_unbind_handle(dnetp->dma_handle);
ddi_dma_free_handle(&dnetp->dma_handle);
dnetp->dma_handle = NULL;
}
if (dnetp->dma_handle_tx != NULL) {
(void) ddi_dma_unbind_handle(dnetp->dma_handle_tx);
ddi_dma_free_handle(&dnetp->dma_handle_tx);
dnetp->dma_handle_tx = NULL;
}
if (dnetp->dma_handle_txdesc != NULL) {
(void) ddi_dma_unbind_handle(dnetp->dma_handle_txdesc);
ddi_dma_free_handle(&dnetp->dma_handle_txdesc);
dnetp->dma_handle_txdesc = NULL;
}
if (dnetp->dma_handle_setbuf != NULL) {
(void) ddi_dma_unbind_handle(dnetp->dma_handle_setbuf);
ddi_dma_free_handle(&dnetp->dma_handle_setbuf);
dnetp->dma_handle_setbuf = NULL;
}
}
static void
dnet_init_txrx_bufs(struct dnetinstance *dnetp)
{
int i;
for (i = 0; i < dnetp->nxmit_desc; i++) {
if (dnetp->tx_msgbufp[i] != NULL) {
freemsg(dnetp->tx_msgbufp[i]);
dnetp->tx_msgbufp[i] = NULL;
}
*(uint32_t *)&dnetp->tx_desc[i].desc0 = 0;
*(uint32_t *)&dnetp->tx_desc[i].desc1 = 0;
dnetp->tx_desc[i].buffer1 = 0;
dnetp->tx_desc[i].buffer2 = 0;
}
dnetp->tx_desc[i - 1].desc1.end_of_ring = 1;
for (i = 0; i < dnetp->nrecv_desc; i++) {
uint32_t end_paddr;
*(uint32_t *)&dnetp->rx_desc[i].desc0 = 0;
*(uint32_t *)&dnetp->rx_desc[i].desc1 = 0;
dnetp->rx_desc[i].desc0.own = 1;
dnetp->rx_desc[i].desc1.buffer_size1 = rx_buf_size;
dnetp->rx_desc[i].buffer1 = dnetp->rx_buf_paddr[i];
dnetp->rx_desc[i].buffer2 = 0;
end_paddr = dnetp->rx_buf_paddr[i]+rx_buf_size-1;
if ((dnetp->rx_desc[i].buffer1 & ~dnetp->pgmask) !=
(end_paddr & ~dnetp->pgmask)) {
dnetp->rx_desc[i].buffer2 = end_paddr&~dnetp->pgmask;
dnetp->rx_desc[i].desc1.buffer_size2 =
(end_paddr & dnetp->pgmask) + 1;
dnetp->rx_desc[i].desc1.buffer_size1 =
rx_buf_size-dnetp->rx_desc[i].desc1.buffer_size2;
}
}
dnetp->rx_desc[i - 1].desc1.end_of_ring = 1;
}
static int
alloc_descriptor(struct dnetinstance *dnetp)
{
int index;
struct tx_desc_type *ring = dnetp->tx_desc;
ASSERT(MUTEX_HELD(&dnetp->intrlock));
alloctop:
mutex_enter(&dnetp->txlock);
index = dnetp->tx_current_desc;
dnet_reclaim_Tx_desc(dnetp);
if (dnetp->free_desc <= 0) {
#ifdef DNETDEBUG
if (dnetdebug & DNETRECV)
cmn_err(CE_NOTE, "dnet: Ring buffer is full");
#endif
mutex_exit(&dnetp->txlock);
return (FAILURE);
}
if (ring[index].desc0.own) {
#ifdef DNETDEBUG
if (dnetdebug & DNETRECV)
cmn_err(CE_WARN,
"dnet: next descriptor is not free for use");
#endif
mutex_exit(&dnetp->txlock);
return (FAILURE);
}
if (dnetp->need_saddr) {
mutex_exit(&dnetp->txlock);
if (!dnetp->suspended)
(void) dnet_set_addr(dnetp);
goto alloctop;
}
*(uint32_t *)&ring[index].desc0 = 0;
*(uint32_t *)&ring[index].desc1 &= DNET_END_OF_RING;
dnetp->free_desc--;
dnetp->tx_current_desc = NextTXIndex(index);
#ifdef DNET_NOISY
cmn_err(CE_WARN, "sfree 0x%x, transmitted 0x%x, tx_current 0x%x",
dnetp->free_desc, dnetp->transmitted_desc, dnetp->tx_current_desc);
#endif
mutex_exit(&dnetp->txlock);
return (SUCCESS);
}
static void
dnet_reclaim_Tx_desc(struct dnetinstance *dnetp)
{
struct tx_desc_type *desc = dnetp->tx_desc;
int index;
ASSERT(MUTEX_HELD(&dnetp->txlock));
index = dnetp->transmitted_desc;
while (((dnetp->free_desc == 0) || (index != dnetp->tx_current_desc)) &&
!(desc[index].desc0.own)) {
if (desc[index].desc1.setup_packet == 0 &&
desc[index].desc1.last_desc &&
desc[index].desc0.err_summary)
update_tx_stats(dnetp, index);
if (dnetp->tx_msgbufp[index] != NULL) {
freemsg(dnetp->tx_msgbufp[index]);
dnetp->tx_msgbufp[index] = NULL;
}
dnetp->free_desc++;
index = (index+1) % dnetp->max_tx_desc;
}
dnetp->transmitted_desc = index;
}
static struct rbuf_list *rbuf_usedlist_head;
static struct rbuf_list *rbuf_freelist_head;
static struct rbuf_list *rbuf_usedlist_end;
static int rbuf_freebufs;
static int rbuf_pool_size;
static int
dnet_rbuf_init(dev_info_t *dip, int nbufs)
{
int i;
struct rbuf_list *rp;
ddi_dma_cookie_t cookie;
uint_t ncookies;
size_t len;
mutex_enter(&dnet_rbuf_lock);
for (i = 0; i < nbufs; i++) {
rp = kmem_zalloc(sizeof (struct rbuf_list), KM_SLEEP);
if (ddi_dma_alloc_handle(dip, &dma_attr_rb, DDI_DMA_SLEEP,
0, &rp->rbuf_dmahdl) != DDI_SUCCESS)
goto fail_kfree;
if (ddi_dma_mem_alloc(rp->rbuf_dmahdl, rx_buf_size, &accattr,
DDI_DMA_STREAMING, DDI_DMA_DONTWAIT, 0,
&rp->rbuf_vaddr, &len,
&rp->rbuf_acchdl) != DDI_SUCCESS)
goto fail_freehdl;
if (ddi_dma_addr_bind_handle(rp->rbuf_dmahdl, NULL,
rp->rbuf_vaddr, len, DDI_DMA_RDWR | DDI_DMA_STREAMING,
DDI_DMA_SLEEP, NULL, &cookie,
&ncookies) != DDI_DMA_MAPPED)
goto fail_free;
if (ncookies > 2)
goto fail_unbind;
if (ncookies == 1) {
rp->rbuf_endpaddr =
cookie.dmac_address + rx_buf_size - 1;
} else {
ddi_dma_nextcookie(rp->rbuf_dmahdl, &cookie);
rp->rbuf_endpaddr =
cookie.dmac_address + cookie.dmac_size - 1;
}
rp->rbuf_paddr = cookie.dmac_address;
rp->rbuf_next = rbuf_freelist_head;
rbuf_freelist_head = rp;
rbuf_pool_size++;
rbuf_freebufs++;
}
mutex_exit(&dnet_rbuf_lock);
return (0);
fail_unbind:
(void) ddi_dma_unbind_handle(rp->rbuf_dmahdl);
fail_free:
ddi_dma_mem_free(&rp->rbuf_acchdl);
fail_freehdl:
ddi_dma_free_handle(&rp->rbuf_dmahdl);
fail_kfree:
kmem_free(rp, sizeof (struct rbuf_list));
mutex_exit(&dnet_rbuf_lock);
return (-1);
}
static int
dnet_rbuf_destroy()
{
struct rbuf_list *rp, *next;
mutex_enter(&dnet_rbuf_lock);
for (rp = rbuf_freelist_head; rp; rp = next) {
next = rp->rbuf_next;
ddi_dma_mem_free(&rp->rbuf_acchdl);
(void) ddi_dma_unbind_handle(rp->rbuf_dmahdl);
kmem_free(rp, sizeof (struct rbuf_list));
rbuf_pool_size--;
rbuf_freebufs--;
}
rbuf_freelist_head = NULL;
if (rbuf_pool_size) {
mutex_exit(&dnet_rbuf_lock);
return (-1);
}
mutex_exit(&dnet_rbuf_lock);
return (0);
}
static struct rbuf_list *
dnet_rbuf_alloc(dev_info_t *dip, int cansleep)
{
struct rbuf_list *rp;
size_t len;
ddi_dma_cookie_t cookie;
uint_t ncookies;
mutex_enter(&dnet_rbuf_lock);
if (rbuf_freelist_head == NULL) {
if (!cansleep) {
mutex_exit(&dnet_rbuf_lock);
return (NULL);
}
rp = kmem_zalloc(sizeof (struct rbuf_list), KM_SLEEP);
if (ddi_dma_alloc_handle(dip, &dma_attr_rb, DDI_DMA_SLEEP,
0, &rp->rbuf_dmahdl) != DDI_SUCCESS)
goto fail_kfree;
if (ddi_dma_mem_alloc(rp->rbuf_dmahdl, rx_buf_size, &accattr,
DDI_DMA_STREAMING, DDI_DMA_DONTWAIT, 0,
&rp->rbuf_vaddr, &len,
&rp->rbuf_acchdl) != DDI_SUCCESS)
goto fail_freehdl;
if (ddi_dma_addr_bind_handle(rp->rbuf_dmahdl, NULL,
rp->rbuf_vaddr, len, DDI_DMA_RDWR | DDI_DMA_STREAMING,
DDI_DMA_SLEEP, NULL, &cookie,
&ncookies) != DDI_DMA_MAPPED)
goto fail_free;
if (ncookies > 2)
goto fail_unbind;
if (ncookies == 1) {
rp->rbuf_endpaddr =
cookie.dmac_address + rx_buf_size - 1;
} else {
ddi_dma_nextcookie(rp->rbuf_dmahdl, &cookie);
rp->rbuf_endpaddr =
cookie.dmac_address + cookie.dmac_size - 1;
}
rp->rbuf_paddr = cookie.dmac_address;
rbuf_freelist_head = rp;
rbuf_pool_size++;
rbuf_freebufs++;
}
rp = rbuf_freelist_head;
rbuf_freelist_head = rbuf_freelist_head->rbuf_next;
if (rbuf_usedlist_head == NULL)
rbuf_usedlist_head = rp;
else
rbuf_usedlist_end->rbuf_next = rp;
rp->rbuf_next = NULL;
rbuf_usedlist_end = rp;
rbuf_freebufs--;
mutex_exit(&dnet_rbuf_lock);
return (rp);
fail_unbind:
(void) ddi_dma_unbind_handle(rp->rbuf_dmahdl);
fail_free:
ddi_dma_mem_free(&rp->rbuf_acchdl);
fail_freehdl:
ddi_dma_free_handle(&rp->rbuf_dmahdl);
fail_kfree:
kmem_free(rp, sizeof (struct rbuf_list));
mutex_exit(&dnet_rbuf_lock);
return (NULL);
}
static void
dnet_rbuf_free(caddr_t vaddr)
{
struct rbuf_list *rp, *prev;
ASSERT(vaddr != NULL);
ASSERT(rbuf_usedlist_head != NULL);
mutex_enter(&dnet_rbuf_lock);
for (prev = rp = rbuf_usedlist_head; rp; rp = rp->rbuf_next) {
if (rp->rbuf_vaddr == vaddr)
break;
prev = rp;
}
if (rp == NULL) {
cmn_err(CE_WARN, "DNET: rbuf_free: bad addr 0x%p",
(void *)vaddr);
mutex_exit(&dnet_rbuf_lock);
return;
}
if (rbuf_usedlist_head != rp) {
prev->rbuf_next = rp->rbuf_next;
if (rbuf_usedlist_end == rp)
rbuf_usedlist_end = prev;
} else {
rbuf_usedlist_head = rp->rbuf_next;
if (rbuf_usedlist_end == rp)
rbuf_usedlist_end = NULL;
}
rp->rbuf_next = rbuf_freelist_head;
rbuf_freelist_head = rp;
rbuf_freebufs++;
mutex_exit(&dnet_rbuf_lock);
}
static void
dnet_freemsg_buf(struct free_ptr *frp)
{
dnet_rbuf_free((caddr_t)frp->buf);
kmem_free(frp, sizeof (*frp));
}
static int
dnet_read_srom(dev_info_t *devinfo, int board_type, ddi_acc_handle_t io_handle,
caddr_t io_reg, uchar_t *vi, int maxlen)
{
int all_ones, zerocheck, i;
if (board_type == DEVICE_ID_21040)
dnet_read21040addr(devinfo, io_handle, io_reg, vi, &maxlen);
else
dnet_read21140srom(io_handle, io_reg, vi, maxlen);
if (ddi_getprop(DDI_DEV_T_ANY, devinfo, DDI_PROP_DONTPASS,
"dumpsrom", 0))
dnet_dumpbin("SROM", vi, 1, maxlen);
for (zerocheck = i = 0, all_ones = 0xff; i < maxlen; i++) {
zerocheck |= vi[i];
all_ones &= vi[i];
}
if (zerocheck == 0 || all_ones == 0xff) {
return (get_alternative_srom_image(devinfo, vi, maxlen));
} else {
#ifdef BUG_4010796
set_alternative_srom_image(devinfo, vi, maxlen);
#endif
return (0);
}
}
static void
dnet_read21040addr(dev_info_t *dip, ddi_acc_handle_t io_handle, caddr_t io_reg,
uchar_t *addr, int *len)
{
uint32_t val;
int i;
*len = ddi_getprop(DDI_DEV_T_ANY, dip,
DDI_PROP_DONTPASS, macoffset_propname, 0) + ETHERADDRL;
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG), 0);
for (i = 0; i < *len; i++) {
do {
val = ddi_get32(io_handle,
REG32(io_reg, ETHER_ROM_REG));
} while (val & 0x80000000);
addr[i] = val & 0xFF;
}
}
#define drv_nsecwait(x) drv_usecwait(((x)+999)/1000)
static void
dnet_read21140srom(ddi_acc_handle_t io_handle, caddr_t io_reg, uchar_t *addr,
int maxlen)
{
uint32_t i, j;
uint32_t dout;
uint16_t word;
uint8_t rom_addr;
uint8_t bit;
rom_addr = 0;
for (i = 0; i < maxlen; i += 2) {
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM);
drv_nsecwait(30);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP);
drv_nsecwait(50);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP | SEL_CLK);
drv_nsecwait(250);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP);
drv_nsecwait(100);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP | DATA_IN);
drv_nsecwait(150);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP | DATA_IN | SEL_CLK);
drv_nsecwait(250);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP | DATA_IN);
drv_nsecwait(250);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP | DATA_IN | SEL_CLK);
drv_nsecwait(250);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP | DATA_IN);
drv_nsecwait(100);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP);
drv_nsecwait(150);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP | SEL_CLK);
drv_nsecwait(250);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP);
drv_nsecwait(100);
for (j = HIGH_ADDRESS_BIT; j >= 1; j >>= 1) {
bit = (rom_addr & j) ? DATA_IN : 0;
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP | bit);
drv_nsecwait(150);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP | bit | SEL_CLK);
drv_nsecwait(250);
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP | bit);
drv_nsecwait(100);
}
drv_nsecwait(150);
word = 0;
for (j = 0x8000; j >= 1; j >>= 1) {
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP | SEL_CLK);
drv_nsecwait(100);
dout = ddi_get32(io_handle,
REG32(io_reg, ETHER_ROM_REG));
drv_nsecwait(150);
if (dout & DATA_OUT)
word |= j;
ddi_put32(io_handle,
REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM | SEL_CHIP);
drv_nsecwait(250);
}
addr[i] = (word & 0x0000FF);
addr[i + 1] = (word >> 8);
rom_addr++;
ddi_put32(io_handle, REG32(io_reg, ETHER_ROM_REG),
READ_OP | SEL_ROM);
drv_nsecwait(100);
}
}
static int
get_alternative_srom_image(dev_info_t *devinfo, uchar_t *vi, int len)
{
int l = len;
if (ddi_getlongprop_buf(DDI_DEV_T_ANY, devinfo, DDI_PROP_DONTPASS,
"DNET_SROM", (caddr_t)vi, &len) != DDI_PROP_SUCCESS &&
(len = l) && ddi_getlongprop_buf(DDI_DEV_T_ANY,
ddi_get_parent(devinfo), DDI_PROP_DONTPASS, "DNET_SROM",
(caddr_t)vi, &len) != DDI_PROP_SUCCESS)
return (-1);
#ifdef BUG_4010796
{
pci_regspec_t *assignp;
int assign_len;
int devnum;
int primary_devnum;
primary_devnum = ddi_getprop(DDI_DEV_T_ANY, devinfo, 0,
"DNET_DEVNUM", -1);
if (primary_devnum == -1)
return (1);
if ((ddi_getlongprop(DDI_DEV_T_ANY, devinfo, DDI_PROP_DONTPASS,
"assigned-addresses", (caddr_t)&assignp,
&assign_len)) != DDI_PROP_SUCCESS)
return (1);
devnum = PCI_REG_DEV_G(assignp->pci_phys_hi);
kmem_free(assignp, assign_len);
return (devnum - primary_devnum);
}
#else
return (1);
#endif
}
#ifdef BUG_4010796
static void
set_alternative_srom_image(dev_info_t *devinfo, uchar_t *vi, int len)
{
int proplen;
pci_regspec_t *assignp;
int assign_len;
int devnum;
if (ddi_getproplen(DDI_DEV_T_ANY, devinfo, DDI_PROP_DONTPASS,
"DNET_SROM", &proplen) == DDI_PROP_SUCCESS ||
ddi_getproplen(DDI_DEV_T_ANY, ddi_get_parent(devinfo),
DDI_PROP_DONTPASS, "DNET_SROM", &proplen) == DDI_PROP_SUCCESS)
return;
(void) ddi_prop_update_byte_array(DDI_DEV_T_NONE,
ddi_get_parent(devinfo), "DNET_SROM", (uchar_t *)vi, len);
(void) ddi_prop_update_string(DDI_DEV_T_NONE, devinfo,
"DNET_HACK", "hack");
if ((ddi_getlongprop(DDI_DEV_T_ANY, devinfo, DDI_PROP_DONTPASS,
"assigned-addresses", (caddr_t)&assignp,
&assign_len)) == DDI_PROP_SUCCESS) {
devnum = PCI_REG_DEV_G(assignp->pci_phys_hi);
kmem_free(assignp, assign_len);
(void) ddi_prop_update_int(DDI_DEV_T_NONE,
ddi_get_parent(devinfo), "DNET_DEVNUM", devnum);
}
}
#endif
static int
check_srom_valid(uchar_t *vi)
{
int word, bit;
uint8_t crc;
uint16_t *wvi;
uint16_t bitval;
if (vi[SROM_ADAPTER_CNT] < 1 || vi[SROM_ADAPTER_CNT] > MAX_ADAPTERS)
return (0);
switch (vi[SROM_VERSION]) {
case 1:
case 3:
return (vi[SROM_MBZ] == 0 &&
vi[SROM_MBZ2] == 0 &&
vi[SROM_MBZ3] == 0);
case 4:
wvi = (uint16_t *)vi;
crc = 0xff;
for (word = 0; word < 9; word++)
for (bit = 15; bit >= 0; bit--) {
if (word == 8 && bit == 7)
return (crc == vi[16]);
bitval =
((wvi[word] >> bit) & 1) ^ ((crc >> 7) & 1);
crc <<= 1;
if (bitval == 1) {
crc ^= 7;
}
}
default:
return (0);
}
}
static int
is_fdmedia(int media)
{
if (media == MEDIA_TP_FD || media == MEDIA_SYM_SCR_FD)
return (1);
else
return (0);
}
static void
linkset_add(uint32_t *set, int media)
{
if (media == MEDIA_TP_FD || media == MEDIA_TP)
*set |= (1UL<<MEDIA_TP_FD) | (1UL<<MEDIA_TP);
else if (media == MEDIA_SYM_SCR_FD || media == MEDIA_SYM_SCR)
*set |= (1UL<<MEDIA_SYM_SCR_FD) | (1UL<<MEDIA_SYM_SCR);
else *set |= 1UL<<media;
}
static int
linkset_isset(uint32_t linkset, int media)
{
return (((1UL<<media) & linkset) ? 1:0);
}
static void
find_active_media(struct dnetinstance *dnetp)
{
int i;
media_block_t *block;
media_block_t *best_allowed = NULL;
media_block_t *hd_found = NULL;
media_block_t *fd_found = NULL;
LEAF_FORMAT *leaf = &dnetp->sr.leaf[dnetp->leaf];
uint32_t checked = 0, links_up = 0;
ASSERT(MUTEX_HELD(&dnetp->intrlock));
dnetp->selected_media_block = leaf->default_block;
if (dnetp->phyaddr != -1) {
dnetp->selected_media_block = leaf->mii_block;
setup_block(dnetp);
if (ddi_getprop(DDI_DEV_T_ANY, dnetp->devinfo,
DDI_PROP_DONTPASS, "portmon", 1)) {
(void) mii_start_portmon(dnetp->mii, dnet_mii_link_cb,
&dnetp->intrlock);
if (dnetp->mii_up) {
return;
}
}
}
for (block = leaf->block + leaf->block_count - 1;
block >= leaf->block; block--) {
int media = block->media_code;
if (dnetp->disallowed_media & (1UL<<media))
continue;
if (best_allowed == NULL || block == leaf->default_block)
best_allowed = block;
#ifdef DEBUG
if (dnetdebug & DNETSENSE)
cmn_err(CE_NOTE, "Testing %s medium (block type %d)",
media_str[media], block->type);
#endif
dnetp->selected_media_block = block;
switch (block->type) {
case 2:
setup_block(dnetp);
if (send_test_packet(dnetp)) {
if (!is_fdmedia(media))
return;
if (!fd_found)
fd_found = block;
}
break;
case 0:
if (!linkset_isset(checked, media)) {
linkset_add(&checked, media);
if (((media == MEDIA_BNC ||
media == MEDIA_AUI) &&
send_test_packet(dnetp)) ||
dnet_link_sense(dnetp))
linkset_add(&links_up, media);
}
if (linkset_isset(links_up, media)) {
if (!is_fdmedia(media) &&
dnetp->selected_media_block ==
leaf->default_block) {
setup_block(dnetp);
return;
} else if (!is_fdmedia(media)) {
if (hd_found == NULL)
hd_found = block;
} else if (fd_found == NULL) {
fd_found = block;
}
}
break;
case 1: case 3:
setup_block(dnetp);
for (i = 0; ; i++) {
if (mii_linkup(dnetp->mii, dnetp->phyaddr)) {
(void) mii_getspeed(dnetp->mii,
dnetp->phyaddr,
&dnetp->mii_speed,
&dnetp->mii_duplex);
dnetp->mii_up = 1;
leaf->mii_block = block;
return;
}
if (i == 10)
break;
delay(drv_usectohz(150000));
}
dnetp->mii_up = 0;
break;
}
}
if (hd_found) {
dnetp->selected_media_block = hd_found;
} else if (fd_found) {
dnetp->selected_media_block = fd_found;
} else {
if (best_allowed == NULL)
best_allowed = leaf->default_block;
dnetp->selected_media_block = best_allowed;
cmn_err(CE_WARN, "!dnet: Default media selected\n");
}
setup_block(dnetp);
}
static void
setup_block(struct dnetinstance *dnetp)
{
dnet_reset_board(dnetp);
dnet_init_board(dnetp);
(void) dnet_start(dnetp);
}
static int
dnet_link_sense(struct dnetinstance *dnetp)
{
media_block_t *block = dnetp->selected_media_block;
uint32_t link, status, mask, polarity;
int settletime, stabletime, waittime, upsamples;
int delay_100, delay_10;
ASSERT(MUTEX_HELD(&dnetp->intrlock));
if (block->command & (1 << 15)) {
if (block->command & (1UL<<14))
dnetp->sr.leaf[dnetp->leaf].default_block = block;
return (0);
}
delay_100 = ddi_getprop(DDI_DEV_T_ANY, dnetp->devinfo,
DDI_PROP_DONTPASS, "autosense-delay-100", 2000);
delay_10 = ddi_getprop(DDI_DEV_T_ANY, dnetp->devinfo,
DDI_PROP_DONTPASS, "autosense-delay-10", 400);
dnetp->disable_scrambler = 1;
setup_block(dnetp);
dnetp->disable_scrambler = 0;
if (block->media_code == MEDIA_TP || block->media_code == MEDIA_TP_FD)
settletime = delay_10;
else
settletime = delay_100;
stabletime = settletime / 4;
mask = 1 << ((block->command & CMD_MEDIABIT_MASK) >> 1);
polarity = block->command & CMD_POL ? 0xffffffff : 0;
for (waittime = 0, upsamples = 0;
waittime <= settletime + stabletime && upsamples < 8;
waittime += stabletime/8) {
delay(drv_usectohz(stabletime*1000 / 8));
status = read_gpr(dnetp);
link = (status^polarity) & mask;
if (link)
upsamples++;
else
upsamples = 0;
}
#ifdef DNETDEBUG
if (dnetdebug & DNETSENSE)
cmn_err(CE_NOTE, "%s upsamples:%d stat:%x polarity:%x "
"mask:%x link:%x",
upsamples == 8 ? "UP":"DOWN",
upsamples, status, polarity, mask, link);
#endif
if (upsamples == 8)
return (1);
return (0);
}
static int
send_test_packet(struct dnetinstance *dnetp)
{
int packet_delay;
struct tx_desc_type *desc;
int bufindex;
int media_code = dnetp->selected_media_block->media_code;
uint32_t del;
ASSERT(MUTEX_HELD(&dnetp->intrlock));
if (media_code == MEDIA_TP || media_code == MEDIA_TP_FD) {
packet_delay = ddi_getprop(DDI_DEV_T_ANY, dnetp->devinfo,
DDI_PROP_DONTPASS, "test_packet_delay_tp", 1300000);
} else {
packet_delay = ddi_getprop(DDI_DEV_T_ANY, dnetp->devinfo,
DDI_PROP_DONTPASS, "test_packet_delay", 300000);
}
delay(drv_usectohz(packet_delay));
desc = dnetp->tx_desc;
bufindex = dnetp->tx_current_desc;
if (alloc_descriptor(dnetp) == FAILURE) {
cmn_err(CE_WARN, "DNET: send_test_packet: alloc_descriptor"
"failed");
return (0);
}
ASSERT(dnetp->setup_buf_vaddr != NULL);
BCOPY((caddr_t)dnetp->curr_macaddr,
(caddr_t)dnetp->setup_buf_vaddr, ETHERADDRL);
BCOPY((caddr_t)dnetp->curr_macaddr,
(caddr_t)dnetp->setup_buf_vaddr+ETHERADDRL, ETHERADDRL);
desc[bufindex].buffer1 = dnetp->setup_buf_paddr;
desc[bufindex].desc1.buffer_size1 = SETUPBUF_SIZE;
desc[bufindex].buffer2 = (uint32_t)(0);
desc[bufindex].desc1.first_desc = 1;
desc[bufindex].desc1.last_desc = 1;
desc[bufindex].desc1.int_on_comp = 1;
desc[bufindex].desc0.own = 1;
ddi_put8(dnetp->io_handle, REG8(dnetp->io_reg, TX_POLL_REG),
TX_POLL_DEMAND);
#if 1
del = 1000;
while (desc[bufindex].desc0.own && --del)
drv_usecwait(10);
if (desc[bufindex].desc0.own)
delay(drv_usectohz(200000));
#else
del = 0x10000;
while (desc[bufindex].desc0.own && --del)
drv_usecwait(10);
#endif
#ifdef DNETDEBUG
if (dnetdebug & DNETSENSE)
cmn_err(CE_NOTE, "desc0 bits = %u, %u, %u, %u, %u, %u",
desc[bufindex].desc0.own,
desc[bufindex].desc0.err_summary,
desc[bufindex].desc0.carrier_loss,
desc[bufindex].desc0.no_carrier,
desc[bufindex].desc0.late_collision,
desc[bufindex].desc0.link_fail);
#endif
if (desc[bufindex].desc0.own)
return (0);
return (!desc[bufindex].desc0.err_summary);
}
static void
enable_interrupts(struct dnetinstance *dnetp)
{
ASSERT(MUTEX_HELD(&dnetp->intrlock));
if (dnetp->interrupts_disabled)
return;
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, INT_MASK_REG),
ABNORMAL_INTR_MASK | NORMAL_INTR_MASK | SYSTEM_ERROR_MASK |
(dnetp->timer.cb ? GPTIMER_INTR : 0) |
RX_INTERRUPT_MASK |
TX_INTERRUPT_MASK | TX_JABBER_MASK | TX_UNDERFLOW_MASK);
}
static int
dnet_hack_interrupts(struct dnetinstance *dnetp, int secondary)
{
int i;
struct hackintr_inf *hackintr_inf;
dev_info_t *devinfo = dnetp->devinfo;
uint32_t oui = 0;
if (ddi_getprop(DDI_DEV_T_ANY, devinfo, DDI_PROP_DONTPASS,
"no_INTA_workaround", 0) != 0)
return (0);
for (i = 0; i < 3; i++)
oui = (oui << 8) | dnetp->vendor_addr[i];
switch (oui) {
case ZNYX_ETHER:
if (dnetp->board_type != DEVICE_ID_21040)
return (0);
break;
case COGENT_ETHER:
break;
case ADAPTEC_ETHER:
break;
default:
return (0);
}
if (!secondary) {
if (ddi_getprop(DDI_DEV_T_ANY, ddi_get_parent(devinfo),
DDI_PROP_DONTPASS, hackintr_propname, 0) != 0)
return (0);
#ifdef DNETDEBUG
if (dnetdebug & DNETTRACE)
cmn_err(CE_NOTE, "dnet: Implementing hardware "
"interrupt flaw workaround");
#endif
dnetp->hackintr_inf = hackintr_inf =
kmem_zalloc(sizeof (struct hackintr_inf), KM_SLEEP);
if (hackintr_inf == NULL)
goto fail;
hackintr_inf->dnetps[0] = dnetp;
hackintr_inf->devinfo = devinfo;
if (ddi_prop_update_byte_array(DDI_DEV_T_NONE,
ddi_get_parent(devinfo), hackintr_propname,
(uchar_t *)&dnetp->hackintr_inf,
sizeof (void *)) != DDI_PROP_SUCCESS)
goto fail;
if (ddi_add_intr(devinfo, 0, &dnetp->icookie, NULL,
(uint_t (*)(char *))dnet_hack_intr,
(caddr_t)hackintr_inf) != DDI_SUCCESS) {
(void) ddi_prop_remove(DDI_DEV_T_NONE,
ddi_get_parent(devinfo),
hackintr_propname);
goto fail;
}
mutex_init(&hackintr_inf->lock, NULL, MUTEX_DRIVER,
dnetp->icookie);
return (-1);
} else {
hackintr_inf = (struct hackintr_inf *)(uintptr_t)
ddi_getprop(DDI_DEV_T_ANY, ddi_get_parent(devinfo),
DDI_PROP_DONTPASS, hackintr_propname, 0);
if (hackintr_inf == NULL)
goto fail;
for (i = 0; i < MAX_INST; i++)
if (hackintr_inf->dnetps[i] == NULL)
break;
if (i == MAX_INST)
goto fail;
hackintr_inf->dnetps[i] = dnetp;
return (0);
}
fail:
cmn_err(CE_WARN, "dnet: Could not work around hardware interrupt"
" routing problem");
return (0);
}
static uint_t
dnet_hack_intr(struct hackintr_inf *hackintr_inf)
{
int i;
int claimed = DDI_INTR_UNCLAIMED;
mutex_enter(&hackintr_inf->lock);
for (i = 0; i < MAX_INST; i++) {
if (hackintr_inf->dnetps[i] &&
dnet_intr((caddr_t)hackintr_inf->dnetps[i]) ==
DDI_INTR_CLAIMED) {
claimed = DDI_INTR_CLAIMED;
}
}
mutex_exit(&hackintr_inf->lock);
return (claimed);
}
static int
dnet_detach_hacked_interrupt(dev_info_t *devinfo)
{
int i;
struct hackintr_inf *hackintr_inf;
struct dnetinstance *altdnetp, *dnetp =
ddi_get_driver_private(devinfo);
hackintr_inf = (struct hackintr_inf *)(uintptr_t)
ddi_getprop(DDI_DEV_T_ANY, ddi_get_parent(devinfo),
DDI_PROP_DONTPASS, hackintr_propname, 0);
if (!hackintr_inf) {
ddi_remove_intr(devinfo, 0, dnetp->icookie);
return (DDI_SUCCESS);
}
mutex_enter(&hackintr_inf->lock);
for (i = 0; i < MAX_INST; i++) {
if (hackintr_inf->dnetps[i] == dnetp) {
hackintr_inf->dnetps[i] = NULL;
break;
}
}
mutex_exit(&hackintr_inf->lock);
if (devinfo != hackintr_inf->devinfo)
return (DDI_SUCCESS);
for (i = 0; i < MAX_INST; i++) {
if ((altdnetp = hackintr_inf->dnetps[i]) != NULL) {
altdnetp->interrupts_disabled = 1;
ddi_put32(altdnetp->io_handle,
REG32(altdnetp->io_reg, INT_MASK_REG), 0);
}
}
ddi_remove_intr(devinfo, 0, dnetp->icookie);
mutex_destroy(&hackintr_inf->lock);
(void) ddi_prop_remove(DDI_DEV_T_NONE, ddi_get_parent(devinfo),
hackintr_propname);
kmem_free(hackintr_inf, sizeof (struct hackintr_inf));
return (DDI_SUCCESS);
}
static void
do_phy(struct dnetinstance *dnetp)
{
dev_info_t *dip;
LEAF_FORMAT *leaf = dnetp->sr.leaf + dnetp->leaf;
media_block_t *block;
int phy;
dip = dnetp->devinfo;
for (block = leaf->block + leaf->block_count -1;
block >= leaf->block; block --) {
if (block->type == 3 || block->type == 1) {
leaf->mii_block = block;
break;
}
}
dnetp->selected_media_block = leaf->mii_block ?
leaf->mii_block : leaf->default_block;
setup_block(dnetp);
(void) mii_create(dip, dnet_mii_write, dnet_mii_read, &dnetp->mii);
for (phy = 1; phy < 33; phy++)
if (mii_probe_phy(dnetp->mii, phy % 32) == MII_SUCCESS &&
mii_init_phy(dnetp->mii, phy % 32) == MII_SUCCESS) {
#ifdef DNETDEBUG
if (dnetdebug & DNETSENSE)
cmn_err(CE_NOTE, "dnet: "
"PHY at address %d", phy % 32);
#endif
dnetp->phyaddr = phy % 32;
if (!leaf->mii_block) {
set_leaf(&dnetp->sr, &leaf_phylegacy);
}
return;
}
#ifdef DNETDEBUG
if (dnetdebug & DNETSENSE)
cmn_err(CE_NOTE, "dnet: No PHY found");
#endif
}
static ushort_t
dnet_mii_read(dev_info_t *dip, int phy_addr, int reg_num)
{
struct dnetinstance *dnetp;
uint32_t command_word;
uint32_t tmp;
uint32_t data = 0;
int i;
int bits_in_ushort = ((sizeof (ushort_t))*8);
int turned_around = 0;
dnetp = ddi_get_driver_private(dip);
ASSERT(MUTEX_HELD(&dnetp->intrlock));
write_mii(dnetp, MII_PRE, 2*bits_in_ushort);
command_word = (uint32_t)phy_addr << MII_PHY_ADDR_ALIGN;
command_word |= (uint32_t)reg_num << MII_REG_ADDR_ALIGN;
command_word |= MII_READ_FRAME;
write_mii(dnetp, command_word, bits_in_ushort-2);
mii_tristate(dnetp);
tmp = ddi_get32(dnetp->io_handle, REG32(dnetp->io_reg, ETHER_ROM_REG));
turned_around = (tmp & MII_DATA_IN) ? 0 : 1;
for (i = 0; i < bits_in_ushort; i++) {
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, ETHER_ROM_REG), MII_READ);
drv_usecwait(MII_DELAY);
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, ETHER_ROM_REG), MII_READ | MII_CLOCK);
drv_usecwait(MII_DELAY);
tmp = ddi_get32(dnetp->io_handle,
REG32(dnetp->io_reg, ETHER_ROM_REG));
drv_usecwait(MII_DELAY);
data = (data << 1) | (tmp >> MII_DATA_IN_POSITION) & 0x0001;
}
mii_tristate(dnetp);
return (turned_around ? data: -1);
}
static void
dnet_mii_write(dev_info_t *dip, int phy_addr, int reg_num, int reg_dat)
{
struct dnetinstance *dnetp;
uint32_t command_word;
int bits_in_ushort = ((sizeof (ushort_t))*8);
dnetp = ddi_get_driver_private(dip);
ASSERT(MUTEX_HELD(&dnetp->intrlock));
write_mii(dnetp, MII_PRE, 2*bits_in_ushort);
command_word = ((uint32_t)phy_addr << MII_PHY_ADDR_ALIGN);
command_word |= ((uint32_t)reg_num << MII_REG_ADDR_ALIGN);
command_word |= (MII_WRITE_FRAME | (uint32_t)reg_dat);
write_mii(dnetp, command_word, 2*bits_in_ushort);
mii_tristate(dnetp);
}
static void
write_mii(struct dnetinstance *dnetp, uint32_t mii_data, int data_size)
{
int i;
uint32_t dbit;
ASSERT(MUTEX_HELD(&dnetp->intrlock));
for (i = data_size; i > 0; i--) {
dbit = ((mii_data >>
(31 - MII_WRITE_DATA_POSITION)) & MII_WRITE_DATA);
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, ETHER_ROM_REG),
MII_WRITE | dbit);
drv_usecwait(MII_DELAY);
ddi_put32(dnetp->io_handle,
REG32(dnetp->io_reg, ETHER_ROM_REG),
MII_WRITE | MII_CLOCK | dbit);
drv_usecwait(MII_DELAY);
mii_data <<= 1;
}
}
static void
mii_tristate(struct dnetinstance *dnetp)
{
ASSERT(MUTEX_HELD(&dnetp->intrlock));
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, ETHER_ROM_REG),
MII_WRITE_TS);
drv_usecwait(MII_DELAY);
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, ETHER_ROM_REG),
MII_WRITE_TS | MII_CLOCK);
drv_usecwait(MII_DELAY);
}
static void
set_leaf(SROM_FORMAT *sr, LEAF_FORMAT *leaf)
{
if (sr->leaf && !sr->leaf->is_static)
kmem_free(sr->leaf, sr->adapters * sizeof (LEAF_FORMAT));
sr->leaf = leaf;
}
static void
dnet_mii_link_cb(dev_info_t *dip, int phy, enum mii_phy_state state)
{
struct dnetinstance *dnetp = ddi_get_driver_private(dip);
LEAF_FORMAT *leaf;
ASSERT(MUTEX_HELD(&dnetp->intrlock));
leaf = dnetp->sr.leaf + dnetp->leaf;
if (state == phy_state_linkup) {
dnetp->mii_up = 1;
(void) mii_getspeed(dnetp->mii, dnetp->phyaddr,
&dnetp->mii_speed, &dnetp->mii_duplex);
dnetp->selected_media_block = leaf->mii_block;
setup_block(dnetp);
} else {
dnetp->mii_up = 0;
if (leaf->default_block->media_code == MEDIA_MII)
dnetp->selected_media_block = leaf->default_block;
setup_block(dnetp);
}
if (dnetp->running) {
mac_link_update(dnetp->mac_handle,
(dnetp->mii_up ? LINK_STATE_UP : LINK_STATE_DOWN));
}
}
static void
dnet_parse_srom(struct dnetinstance *dnetp, SROM_FORMAT *sr, uchar_t *vi)
{
uint32_t ether_mfg = 0;
int i;
uchar_t *p;
if (!ddi_getprop(DDI_DEV_T_ANY, dnetp->devinfo,
DDI_PROP_DONTPASS, "no_sromconfig", 0))
dnetp->sr.init_from_srom = check_srom_valid(vi);
if (dnetp->sr.init_from_srom && dnetp->board_type != DEVICE_ID_21040) {
p = vi+18;
sr->version = *p++;
sr->adapters = *p++;
sr->leaf =
kmem_zalloc(sr->adapters * sizeof (LEAF_FORMAT), KM_SLEEP);
for (i = 0; i < 6; i++)
sr->netaddr[i] = *p++;
for (i = 0; i < sr->adapters; i++) {
uchar_t devno = *p++;
uint16_t offset = *p++;
offset |= *p++ << 8;
sr->leaf[i].device_number = devno;
parse_controller_leaf(dnetp, sr->leaf+i, vi+offset);
}
for (i = 0; i < 3; i++)
ether_mfg = (ether_mfg << 8) | sr->netaddr[i];
if (ether_mfg == ADAPTEC_ETHER) {
static uint16_t cogent_gprseq[] = {0x821, 0};
switch (vi[COGENT_SROM_ID]) {
case COGENT_ANA6911A_C:
case COGENT_ANA6911AC_C:
#ifdef DNETDEBUG
if (dnetdebug & DNETTRACE)
cmn_err(CE_WARN,
"Suspected bad GPR sequence."
" Making a guess (821,0)");
#endif
(void) ddi_prop_update_byte_array(
DDI_DEV_T_NONE, dnetp->devinfo,
"gpr-sequence", (uchar_t *)cogent_gprseq,
sizeof (cogent_gprseq));
break;
}
}
} else {
uchar_t *mac = vi + ddi_getprop(DDI_DEV_T_ANY, dnetp->devinfo,
DDI_PROP_DONTPASS, macoffset_propname, 0);
for (i = 0; i < 6; i++)
sr->netaddr[i] = mac[i];
if (dnetp->board_type == DEVICE_ID_21140) {
for (i = 0; i < 3; i++)
ether_mfg = (ether_mfg << 8) | mac[i];
switch (ether_mfg) {
case ASANTE_ETHER:
dnetp->vendor_21140 = ASANTE_TYPE;
dnetp->vendor_revision = 0;
set_leaf(sr, &leaf_asante);
sr->adapters = 1;
break;
case COGENT_ETHER:
case ADAPTEC_ETHER:
dnetp->vendor_21140 = COGENT_EM_TYPE;
dnetp->vendor_revision =
vi[VENDOR_REVISION_OFFSET];
set_leaf(sr, &leaf_cogent_100);
sr->adapters = 1;
break;
default:
dnetp->vendor_21140 = DEFAULT_TYPE;
dnetp->vendor_revision = 0;
set_leaf(sr, &leaf_default_100);
sr->adapters = 1;
break;
}
} else if (dnetp->board_type == DEVICE_ID_21041) {
set_leaf(sr, &leaf_21041);
} else if (dnetp->board_type == DEVICE_ID_21040) {
set_leaf(sr, &leaf_21040);
}
}
}
static void
parse_controller_leaf(struct dnetinstance *dnetp, LEAF_FORMAT *leaf,
uchar_t *vi)
{
int i;
leaf->selected_contype = *vi++;
leaf->selected_contype |= *vi++ << 8;
if (dnetp->board_type == DEVICE_ID_21140)
leaf->gpr = *vi++;
leaf->block_count = *vi++;
if (leaf->block_count > MAX_MEDIA) {
cmn_err(CE_WARN, "dnet: Too many media in SROM!");
leaf->block_count = 1;
}
for (i = 0; i <= leaf->block_count; i++) {
vi = parse_media_block(dnetp, leaf->block + i, vi);
if (leaf->block[i].command & CMD_DEFAULT_MEDIUM)
leaf->default_block = leaf->block+i;
}
if (leaf->default_block == NULL)
leaf->default_block = leaf->block + leaf->block_count -1;
}
static uchar_t *
parse_media_block(struct dnetinstance *dnetp, media_block_t *block, uchar_t *vi)
{
int i;
if (dnetp->board_type == DEVICE_ID_21041) {
block->media_code = *vi & 0x3f;
block->type = 2;
if (*vi++ & 0x40) {
block->un.sia.csr13 = *vi++;
block->un.sia.csr13 |= *vi++ << 8;
block->un.sia.csr14 = *vi++;
block->un.sia.csr14 |= *vi++ << 8;
block->un.sia.csr15 = *vi++;
block->un.sia.csr15 |= *vi++ << 8;
} else {
switch (block->media_code) {
case MEDIA_TP:
block->un.sia.csr13 = 0xef01;
block->un.sia.csr14 = 0x7f3f;
block->un.sia.csr15 = 0x0008;
break;
case MEDIA_TP_FD:
block->un.sia.csr13 = 0xef01;
block->un.sia.csr14 = 0x7f3d;
block->un.sia.csr15 = 0x0008;
break;
case MEDIA_BNC:
block->un.sia.csr13 = 0xef09;
block->un.sia.csr14 = 0x0705;
block->un.sia.csr15 = 0x0006;
break;
case MEDIA_AUI:
block->un.sia.csr13 = 0xef09;
block->un.sia.csr14 = 0x0705;
block->un.sia.csr15 = 0x000e;
break;
}
}
} else if (*vi & 0x80) {
int blocklen = *vi++ & 0x7f;
block->type = *vi++;
switch (block->type) {
case 0:
block->media_code = (*vi++) & 0x3f;
block->gprseqlen = 1;
block->gprseq[0] = *vi++;
block->command = *vi++;
block->command |= *vi++ << 8;
break;
case 1:
block->command = CMD_PS;
block->media_code = MEDIA_MII;
block->un.mii.phy_num = *vi++;
block->gprseqlen = *vi++;
for (i = 0; i < block->gprseqlen; i++)
block->gprseq[i] = *vi++;
block->rstseqlen = *vi++;
for (i = 0; i < block->rstseqlen; i++)
block->rstseq[i] = *vi++;
block->un.mii.mediacaps = *vi++;
block->un.mii.mediacaps |= *vi++ << 8;
block->un.mii.nwayadvert = *vi++;
block->un.mii.nwayadvert |= *vi++ << 8;
block->un.mii.fdxmask = *vi++;
block->un.mii.fdxmask |= *vi++ << 8;
block->un.mii.ttmmask = *vi++;
block->un.mii.ttmmask |= *vi++ << 8;
break;
case 2:
block->media_code = *vi & 0x3f;
if (*vi++ & 0x40) {
block->un.sia.csr13 = *vi++;
block->un.sia.csr13 |= *vi++ << 8;
block->un.sia.csr14 = *vi++;
block->un.sia.csr14 |= *vi++ << 8;
block->un.sia.csr15 = *vi++;
block->un.sia.csr15 |= *vi++ << 8;
} else {
switch (block->media_code) {
case MEDIA_BNC:
block->un.sia.csr13 = 0x0009;
block->un.sia.csr14 = 0x0705;
block->un.sia.csr15 = 0x0000;
break;
case MEDIA_AUI:
block->un.sia.csr13 = 0x0009;
block->un.sia.csr14 = 0x0705;
block->un.sia.csr15 = 0x0008;
break;
case MEDIA_TP:
block->un.sia.csr13 = 0x0001;
block->un.sia.csr14 = 0x7f3f;
block->un.sia.csr15 = 0x0000;
break;
case MEDIA_TP_FD:
block->un.sia.csr13 = 0x0001;
block->un.sia.csr14 = 0x7f3d;
block->un.sia.csr15 = 0x0000;
break;
default:
block->un.sia.csr13 = 0x0000;
block->un.sia.csr14 = 0x0000;
block->un.sia.csr15 = 0x0000;
}
}
block->gprseqlen = 2;
block->gprseq[0] = *vi++;
block->gprseq[0] |= *vi++ << 8;
block->gprseq[0] |= GPR_CONTROL_WRITE;
block->gprseq[1] = *vi++;
block->gprseq[1] |= *vi++ << 8;
break;
case 3:
block->command = CMD_PS;
block->media_code = MEDIA_MII;
block->un.mii.phy_num = *vi++;
block->gprseqlen = *vi++;
for (i = 0; i < block->gprseqlen; i++) {
block->gprseq[i] = *vi++;
block->gprseq[i] |= *vi++ << 8;
}
block->rstseqlen = *vi++;
for (i = 0; i < block->rstseqlen; i++) {
block->rstseq[i] = *vi++;
block->rstseq[i] |= *vi++ << 8;
}
block->un.mii.mediacaps = *vi++;
block->un.mii.mediacaps |= *vi++ << 8;
block->un.mii.nwayadvert = *vi++;
block->un.mii.nwayadvert |= *vi++ << 8;
block->un.mii.fdxmask = *vi++;
block->un.mii.fdxmask |= *vi++ << 8;
block->un.mii.ttmmask = *vi++;
block->un.mii.ttmmask |= *vi++ << 8;
block->un.mii.miiintr |= *vi++;
break;
case 4:
block->media_code = *vi++ & 0x3f;
block->gprseqlen = 2;
block->gprseq[0] = *vi++;
block->gprseq[0] |= *vi++ << 8;
block->gprseq[0] |= GPR_CONTROL_WRITE;
block->gprseq[1] = *vi++;
block->gprseq[1] |= *vi++ << 8;
block->command = *vi++;
block->command |= *vi++ << 8;
break;
case 5:
block->rstseqlen = *vi++;
for (i = 0; i < block->rstseqlen; i++)
block->rstseq[i] = *vi++;
break;
default:
cmn_err(CE_WARN, "dnet: Unsupported SROM block.");
vi += blocklen;
break;
}
} else {
block->type = 0;
block->media_code = *vi++ & 0x3f;
block->gprseqlen = 1;
block->gprseq[0] = *vi++;
block->command = *vi++;
block->command |= (*vi++) << 8;
}
return (vi);
}
static void
setup_legacy_blocks()
{
LEAF_FORMAT *leaf;
media_block_t *block;
leaf = &leaf_default_100;
leaf->is_static = 1;
leaf->default_block = &leaf->block[3];
leaf->block_count = 4;
block = leaf->block;
block->media_code = MEDIA_TP_FD;
block->type = 0;
block->command = 0x8e;
block++;
block->media_code = MEDIA_TP;
block->type = 0;
block->command = 0x8e;
block++;
block->media_code = MEDIA_SYM_SCR_FD;
block->type = 0;
block->command = 0x6d;
block++;
block->media_code = MEDIA_SYM_SCR;
block->type = 0;
block->command = 0x406d;
leaf = &leaf_cogent_100;
leaf->is_static = 1;
leaf->default_block = &leaf->block[4];
leaf->block_count = 5;
block = leaf->block;
block->media_code = MEDIA_BNC;
block->type = 0;
block->command = 0x8000;
block->gprseqlen = 2;
block->rstseqlen = 0;
block->gprseq[0] = 0x13f;
block->gprseq[1] = 1;
block++;
block->media_code = MEDIA_TP_FD;
block->type = 0;
block->command = 0x8e;
block->gprseqlen = 2;
block->rstseqlen = 0;
block->gprseq[0] = 0x13f;
block->gprseq[1] = 0x26;
block++;
block->media_code = MEDIA_TP;
block->type = 0;
block->command = 0x8e;
block->gprseqlen = 2;
block->rstseqlen = 0;
block->gprseq[0] = 0x13f;
block->gprseq[1] = 0x3e;
block++;
block->media_code = MEDIA_SYM_SCR_FD;
block->type = 0;
block->command = 0x6d;
block->gprseqlen = 2;
block->rstseqlen = 0;
block->gprseq[0] = 0x13f;
block->gprseq[1] = 1;
block++;
block->media_code = MEDIA_SYM_SCR;
block->type = 0;
block->command = 0x406d;
block->gprseqlen = 2;
block->rstseqlen = 0;
block->gprseq[0] = 0x13f;
block->gprseq[1] = 1;
leaf = &leaf_phylegacy;
leaf->block_count = 1;
leaf->mii_block = leaf->block;
leaf->default_block = &leaf->block[0];
leaf->is_static = 1;
block = leaf->block;
block->media_code = MEDIA_MII;
block->type = 1;
block->command = 1;
block->gprseqlen = 0;
block->rstseqlen = 0;
leaf = &leaf_asante;
leaf->is_static = 1;
leaf->default_block = &leaf->block[0];
leaf->block_count = 1;
block = leaf->block;
block->media_code = MEDIA_MII;
block->type = 1;
block->command = 1;
block->gprseqlen = 3;
block->rstseqlen = 0;
block->gprseq[0] = 0x180;
block->gprseq[1] = 0x80;
block->gprseq[2] = 0x0;
leaf = &leaf_21041;
leaf->is_static = 1;
leaf->block_count = 4;
leaf->default_block = &leaf->block[3];
block = leaf->block;
block->media_code = MEDIA_AUI;
block->type = 2;
block->un.sia.csr13 = 0xef09;
block->un.sia.csr14 = 0x0705;
block->un.sia.csr15 = 0x000e;
block++;
block->media_code = MEDIA_TP_FD;
block->type = 2;
block->un.sia.csr13 = 0xef01;
block->un.sia.csr14 = 0x7f3d;
block->un.sia.csr15 = 0x0008;
block++;
block->media_code = MEDIA_BNC;
block->type = 2;
block->un.sia.csr13 = 0xef09;
block->un.sia.csr14 = 0x0705;
block->un.sia.csr15 = 0x0006;
block++;
block->media_code = MEDIA_TP;
block->type = 2;
block->un.sia.csr13 = 0xef01;
block->un.sia.csr14 = 0x7f3f;
block->un.sia.csr15 = 0x0008;
leaf = &leaf_21040;
leaf->is_static = 1;
leaf->block_count = 4;
block = leaf->block;
block->media_code = MEDIA_AUI;
block->type = 2;
block->un.sia.csr13 = 0x8f09;
block->un.sia.csr14 = 0x0705;
block->un.sia.csr15 = 0x000e;
block++;
block->media_code = MEDIA_TP_FD;
block->type = 2;
block->un.sia.csr13 = 0x0f01;
block->un.sia.csr14 = 0x7f3d;
block->un.sia.csr15 = 0x0008;
block++;
block->media_code = MEDIA_BNC;
block->type = 2;
block->un.sia.csr13 = 0xef09;
block->un.sia.csr14 = 0x0705;
block->un.sia.csr15 = 0x0006;
block++;
block->media_code = MEDIA_TP;
block->type = 2;
block->un.sia.csr13 = 0x8f01;
block->un.sia.csr14 = 0x7f3f;
block->un.sia.csr15 = 0x0008;
}
static void
dnet_print_srom(SROM_FORMAT *sr)
{
int i;
uchar_t *a = sr->netaddr;
cmn_err(CE_NOTE, "SROM Dump: %d. ver %d, Num adapters %d,"
"Addr:%x:%x:%x:%x:%x:%x",
sr->init_from_srom, sr->version, sr->adapters,
a[0], a[1], a[2], a[3], a[4], a[5]);
for (i = 0; i < sr->adapters; i++)
dnet_dump_leaf(sr->leaf+i);
}
static void
dnet_dump_leaf(LEAF_FORMAT *leaf)
{
int i;
cmn_err(CE_NOTE, "Leaf: Device %d, block_count %d, gpr: %x",
leaf->device_number, leaf->block_count, leaf->gpr);
for (i = 0; i < leaf->block_count; i++)
dnet_dump_block(leaf->block+i);
}
static void
dnet_dump_block(media_block_t *block)
{
cmn_err(CE_NOTE, "Block(%p): type %x, media %s, command: %x ",
(void *)block,
block->type, media_str[block->media_code], block->command);
dnet_dumpbin("\tGPR Seq", (uchar_t *)block->gprseq, 2,
block->gprseqlen *2);
dnet_dumpbin("\tGPR Reset", (uchar_t *)block->rstseq, 2,
block->rstseqlen *2);
switch (block->type) {
case 1: case 3:
cmn_err(CE_NOTE, "\tMII Info: phy %d, nway %x, fdx"
"%x, ttm %x, mediacap %x",
block->un.mii.phy_num, block->un.mii.nwayadvert,
block->un.mii.fdxmask, block->un.mii.ttmmask,
block->un.mii.mediacaps);
break;
case 2:
cmn_err(CE_NOTE, "\tSIA Regs: CSR13:%x, CSR14:%x, CSR15:%x",
block->un.sia.csr13, block->un.sia.csr14,
block->un.sia.csr15);
break;
}
}
static int
hexcode(unsigned val)
{
if (val <= 9)
return (val +'0');
if (val <= 15)
return (val + 'a' - 10);
return (-1);
}
static void
dnet_dumpbin(char *msg, unsigned char *data, int size, int len)
{
char hex[128], *p = hex;
char ascii[128], *q = ascii;
int i, j;
if (!len)
return;
for (i = 0; i < len; i += size) {
for (j = size - 1; j >= 0; j--) {
*p++ = hexcode(data[i+j] >> 4);
*p++ = hexcode(data[i+j] & 0xf);
*q++ = (data[i+j] < 32 || data[i+j] > 127) ?
'.' : data[i];
}
*p++ = ' ';
if (q-ascii >= 8) {
*p = *q = 0;
cmn_err(CE_NOTE, "%s: %s\t%s", msg, hex, ascii);
p = hex;
q = ascii;
}
}
if (p != hex) {
while ((p - hex) < 8*3)
*p++ = ' ';
*p = *q = 0;
cmn_err(CE_NOTE, "%s: %s\t%s", msg, hex, ascii);
}
}
#ifdef DNETDEBUG
void
dnet_usectimeout(struct dnetinstance *dnetp, uint32_t usecs, int contin,
timercb_t cback)
{
mutex_enter(&dnetp->intrlock);
dnetp->timer.start_ticks = (usecs * 100) / 8192;
dnetp->timer.cb = cback;
ddi_put32(dnetp->io_handle, REG32(dnetp->io_reg, GP_TIMER_REG),
dnetp->timer.start_ticks | (contin ? GPTIMER_CONT : 0));
if (dnetp->timer.cb)
enable_interrupts(dnetp);
mutex_exit(&dnetp->intrlock);
}
uint32_t
dnet_usecelapsed(struct dnetinstance *dnetp)
{
uint32_t ticks = dnetp->timer.start_ticks -
(ddi_get32(dnetp->io_handle, REG32(dnetp->io_reg, GP_TIMER_REG)) &
0xffff);
return ((ticks * 8192) / 100);
}
void
dnet_timestamp(struct dnetinstance *dnetp, char *buf)
{
uint32_t elapsed = dnet_usecelapsed(dnetp);
char loc[32], *p = loc;
int firstdigit = 1;
uint32_t divisor;
while (*p++ = *buf++)
;
p--;
for (divisor = 1000000000; divisor /= 10; ) {
int digit = (elapsed / divisor);
elapsed -= digit * divisor;
if (!firstdigit || digit) {
*p++ = digit + '0';
firstdigit = 0;
}
}
if (firstdigit)
*p++ = '0';
*p++ = '-';
*p++ = '>';
*p++ = 0;
printf(loc);
dnet_usectimeout(dnetp, 1000000, 0, 0);
}
#endif