#include <sys/types.h>
#include <sys/errno.h>
#include <sys/param.h>
#include <sys/callb.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/modhash.h>
#include <sys/debug.h>
#include <sys/ethernet.h>
#include <sys/dlpi.h>
#include <net/if.h>
#include <sys/mac_provider.h>
#include <sys/mac_client.h>
#include <sys/mac_client_priv.h>
#include <sys/mac_ether.h>
#include <sys/ddi.h>
#include <sys/sunddi.h>
#include <sys/strsun.h>
#include <sys/note.h>
#include <sys/atomic.h>
#include <sys/vnet.h>
#include <sys/vlan.h>
#include <sys/vnet_mailbox.h>
#include <sys/vnet_common.h>
#include <sys/dds.h>
#include <sys/strsubr.h>
#include <sys/taskq.h>
static int vnetdevinfo(dev_info_t *, ddi_info_cmd_t, void *, void **);
static int vnetattach(dev_info_t *, ddi_attach_cmd_t);
static int vnetdetach(dev_info_t *, ddi_detach_cmd_t);
static int vnet_m_stat(void *, uint_t, uint64_t *);
static int vnet_m_start(void *);
static void vnet_m_stop(void *);
static int vnet_m_promisc(void *, boolean_t);
static int vnet_m_multicst(void *, boolean_t, const uint8_t *);
static int vnet_m_unicst(void *, const uint8_t *);
mblk_t *vnet_m_tx(void *, mblk_t *);
static void vnet_m_ioctl(void *arg, queue_t *q, mblk_t *mp);
#ifdef VNET_IOC_DEBUG
static void vnet_force_link_state(vnet_t *vnetp, queue_t *q, mblk_t *mp);
#endif
static boolean_t vnet_m_capab(void *arg, mac_capab_t cap, void *cap_data);
static void vnet_get_ring(void *arg, mac_ring_type_t rtype, const int g_index,
const int r_index, mac_ring_info_t *infop, mac_ring_handle_t r_handle);
static void vnet_get_group(void *arg, mac_ring_type_t type, const int index,
mac_group_info_t *infop, mac_group_handle_t handle);
static int vnet_rx_ring_start(mac_ring_driver_t rdriver, uint64_t mr_gen_num);
static void vnet_rx_ring_stop(mac_ring_driver_t rdriver);
static int vnet_rx_ring_stat(mac_ring_driver_t rdriver, uint_t stat,
uint64_t *val);
static int vnet_tx_ring_start(mac_ring_driver_t rdriver, uint64_t mr_gen_num);
static void vnet_tx_ring_stop(mac_ring_driver_t rdriver);
static int vnet_tx_ring_stat(mac_ring_driver_t rdriver, uint_t stat,
uint64_t *val);
static int vnet_ring_enable_intr(void *arg);
static int vnet_ring_disable_intr(void *arg);
static mblk_t *vnet_rx_poll(void *arg, int bytes_to_pickup);
static int vnet_addmac(void *arg, const uint8_t *mac_addr);
static int vnet_remmac(void *arg, const uint8_t *mac_addr);
static int vnet_unattach(vnet_t *vnetp);
static void vnet_ring_grp_init(vnet_t *vnetp);
static void vnet_ring_grp_uninit(vnet_t *vnetp);
static int vnet_mac_register(vnet_t *);
static int vnet_read_mac_address(vnet_t *vnetp);
static int vnet_bind_vgenring(vnet_res_t *vresp);
static void vnet_unbind_vgenring(vnet_res_t *vresp);
static int vnet_bind_hwrings(vnet_t *vnetp);
static void vnet_unbind_hwrings(vnet_t *vnetp);
static int vnet_bind_rings(vnet_res_t *vresp);
static void vnet_unbind_rings(vnet_res_t *vresp);
static int vnet_hio_stat(void *, uint_t, uint64_t *);
static int vnet_hio_start(void *);
static void vnet_hio_stop(void *);
mblk_t *vnet_hio_tx(void *, mblk_t *);
static void vnet_fdb_create(vnet_t *vnetp);
static void vnet_fdb_destroy(vnet_t *vnetp);
static vnet_res_t *vnet_fdbe_find(vnet_t *vnetp, struct ether_addr *addrp);
static void vnet_fdbe_find_cb(mod_hash_key_t key, mod_hash_val_t val);
void vnet_fdbe_add(vnet_t *vnetp, vnet_res_t *vresp);
static void vnet_fdbe_del(vnet_t *vnetp, vnet_res_t *vresp);
static void vnet_rx_frames_untag(uint16_t pvid, mblk_t **mp);
static void vnet_rx(vio_net_handle_t vrh, mblk_t *mp);
static void vnet_tx_update(vio_net_handle_t vrh);
static void vnet_res_start_task(void *arg);
static void vnet_start_resources(vnet_t *vnetp);
static void vnet_stop_resources(vnet_t *vnetp);
static void vnet_dispatch_res_task(vnet_t *vnetp);
static void vnet_res_start_task(void *arg);
static void vnet_handle_res_err(vio_net_handle_t vrh, vio_net_err_val_t err);
static void vnet_add_resource(vnet_t *vnetp, vnet_res_t *vresp);
static vnet_res_t *vnet_rem_resource(vnet_t *vnetp, vnet_res_t *vresp);
static void vnet_tx_notify_thread(void *);
int vnet_mtu_update(vnet_t *vnetp, uint32_t mtu);
void vnet_link_update(vnet_t *vnetp, link_state_t link_state);
void vnet_dds_cleanup_hio(vnet_t *vnetp);
static kstat_t *vnet_hio_setup_kstats(char *ks_mod, char *ks_name,
vnet_res_t *vresp);
static int vnet_hio_update_kstats(kstat_t *ksp, int rw);
static void vnet_hio_get_stats(vnet_res_t *vresp, vnet_hio_stats_t *statsp);
static void vnet_hio_destroy_kstats(kstat_t *ksp);
int vnet_send_dds_msg(vnet_t *vnetp, void *dmsg);
int vnet_hio_mac_init(vnet_t *vnetp, char *ifname);
void vnet_hio_mac_cleanup(vnet_t *vnetp);
extern int vgen_init(void *vnetp, uint64_t regprop, dev_info_t *vnetdip,
const uint8_t *macaddr, void **vgenhdl);
extern int vgen_init_mdeg(void *arg);
extern void vgen_uninit(void *arg);
extern int vgen_dds_tx(void *arg, void *dmsg);
extern int vgen_enable_intr(void *arg);
extern int vgen_disable_intr(void *arg);
extern mblk_t *vgen_rx_poll(void *arg, int bytes_to_pickup);
extern void vdds_mod_init(void);
extern void vdds_mod_fini(void);
extern int vdds_init(vnet_t *vnetp);
extern void vdds_cleanup(vnet_t *vnetp);
extern void vdds_process_dds_msg(vnet_t *vnetp, vio_dds_msg_t *dmsg);
extern void vdds_cleanup_hybrid_res(void *arg);
extern void vdds_cleanup_hio(vnet_t *vnetp);
extern pri_t minclsyspri;
#define DRV_NAME "vnet"
#define VNET_FDBE_REFHOLD(p) \
{ \
atomic_inc_32(&(p)->refcnt); \
ASSERT((p)->refcnt != 0); \
}
#define VNET_FDBE_REFRELE(p) \
{ \
ASSERT((p)->refcnt != 0); \
atomic_dec_32(&(p)->refcnt); \
}
#ifdef VNET_IOC_DEBUG
#define VNET_M_CALLBACK_FLAGS (MC_IOCTL | MC_GETCAPAB)
#else
#define VNET_M_CALLBACK_FLAGS (MC_GETCAPAB)
#endif
static mac_callbacks_t vnet_m_callbacks = {
VNET_M_CALLBACK_FLAGS,
vnet_m_stat,
vnet_m_start,
vnet_m_stop,
vnet_m_promisc,
vnet_m_multicst,
NULL,
NULL,
NULL,
vnet_m_ioctl,
vnet_m_capab,
NULL
};
static mac_callbacks_t vnet_hio_res_callbacks = {
0,
vnet_hio_stat,
vnet_hio_start,
vnet_hio_stop,
NULL,
NULL,
NULL,
vnet_hio_tx,
NULL,
NULL,
NULL
};
static vnet_t *vnet_headp = NULL;
static krwlock_t vnet_rw;
uint32_t vnet_num_descriptors = VNET_NUM_DESCRIPTORS;
boolean_t vnet_mac_tx_serialize = B_FALSE;
boolean_t vnet_mac_rx_queuing = B_TRUE;
boolean_t vnet_jumbo_rxpools = B_FALSE;
uint32_t vnet_fdb_nchains = VNET_NFDB_HASH;
uint32_t vnet_ethermtu = 1500;
uint16_t vnet_default_vlan_id = 1;
uint32_t vnet_fdbe_refcnt_delay = 10;
static struct ether_addr etherbroadcastaddr = {
0xff, 0xff, 0xff, 0xff, 0xff, 0xff
};
uint32_t vnet_mac_open_delay = 100;
uint32_t vnet_mac_open_retries = 100;
static char macaddr_propname[] = "local-mac-address";
static char vnet_ident[] = "vnet driver";
extern struct mod_ops mod_driverops;
static struct cb_ops cb_vnetops = {
nulldev,
nulldev,
nodev,
nodev,
nodev,
nodev,
nodev,
nodev,
nodev,
nodev,
nodev,
nochpoll,
ddi_prop_op,
NULL,
(int)(D_MP)
};
static struct dev_ops vnetops = {
DEVO_REV,
0,
NULL,
nulldev,
nulldev,
vnetattach,
vnetdetach,
nodev,
&cb_vnetops,
(struct bus_ops *)NULL,
NULL,
ddi_quiesce_not_supported,
};
static struct modldrv modldrv = {
&mod_driverops,
vnet_ident,
&vnetops
};
static struct modlinkage modlinkage = {
MODREV_1, (void *)&modldrv, NULL
};
#ifdef DEBUG
#define DEBUG_PRINTF debug_printf
int vnet_dbglevel = 0x8;
static void
debug_printf(const char *fname, void *arg, const char *fmt, ...)
{
char buf[512];
va_list ap;
vnet_t *vnetp = (vnet_t *)arg;
char *bufp = buf;
if (vnetp == NULL) {
(void) sprintf(bufp, "%s: ", fname);
bufp += strlen(bufp);
} else {
(void) sprintf(bufp, "vnet%d:%s: ", vnetp->instance, fname);
bufp += strlen(bufp);
}
va_start(ap, fmt);
(void) vsprintf(bufp, fmt, ap);
va_end(ap);
cmn_err(CE_CONT, "%s\n", buf);
}
#endif
int
_init(void)
{
int status;
DBG1(NULL, "enter\n");
mac_init_ops(&vnetops, "vnet");
status = mod_install(&modlinkage);
if (status != 0) {
mac_fini_ops(&vnetops);
}
vdds_mod_init();
DBG1(NULL, "exit(%d)\n", status);
return (status);
}
int
_fini(void)
{
int status;
DBG1(NULL, "enter\n");
status = mod_remove(&modlinkage);
if (status != 0)
return (status);
mac_fini_ops(&vnetops);
vdds_mod_fini();
DBG1(NULL, "exit(%d)\n", status);
return (status);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&modlinkage, modinfop));
}
static int
vnetattach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
vnet_t *vnetp;
int status;
int instance;
uint64_t reg;
char qname[TASKQ_NAMELEN];
vnet_attach_progress_t attach_progress;
attach_progress = AST_init;
switch (cmd) {
case DDI_ATTACH:
break;
case DDI_RESUME:
case DDI_PM_RESUME:
default:
goto vnet_attach_fail;
}
instance = ddi_get_instance(dip);
DBG1(NULL, "instance(%d) enter\n", instance);
vnetp = kmem_zalloc(sizeof (vnet_t), KM_SLEEP);
vnetp->dip = dip;
vnetp->instance = instance;
rw_init(&vnetp->vrwlock, NULL, RW_DRIVER, NULL);
rw_init(&vnetp->vsw_fp_rw, NULL, RW_DRIVER, NULL);
attach_progress |= AST_vnet_alloc;
vnet_ring_grp_init(vnetp);
attach_progress |= AST_ring_init;
status = vdds_init(vnetp);
if (status != 0) {
goto vnet_attach_fail;
}
attach_progress |= AST_vdds_init;
ddi_set_driver_private(dip, (caddr_t)vnetp);
status = vnet_read_mac_address(vnetp);
if (status != DDI_SUCCESS) {
goto vnet_attach_fail;
}
attach_progress |= AST_read_macaddr;
reg = ddi_prop_get_int(DDI_DEV_T_ANY, dip,
DDI_PROP_DONTPASS, "reg", -1);
if (reg == -1) {
goto vnet_attach_fail;
}
vnetp->reg = reg;
vnet_fdb_create(vnetp);
attach_progress |= AST_fdbh_alloc;
(void) snprintf(qname, TASKQ_NAMELEN, "vres_taskq%d", instance);
if ((vnetp->taskqp = ddi_taskq_create(dip, qname, 1,
TASKQ_DEFAULTPRI, 0)) == NULL) {
cmn_err(CE_WARN, "!vnet%d: Unable to create task queue",
instance);
goto vnet_attach_fail;
}
attach_progress |= AST_taskq_create;
WRITE_ENTER(&vnet_rw);
vnetp->nextp = vnet_headp;
vnet_headp = vnetp;
RW_EXIT(&vnet_rw);
attach_progress |= AST_vnet_list;
status = vgen_init(vnetp, reg, vnetp->dip,
(uint8_t *)vnetp->curr_macaddr, &vnetp->vgenhdl);
if (status != DDI_SUCCESS) {
DERR(vnetp, "vgen_init() failed\n");
goto vnet_attach_fail;
}
attach_progress |= AST_vgen_init;
status = vnet_mac_register(vnetp);
if (status != DDI_SUCCESS) {
goto vnet_attach_fail;
}
vnetp->link_state = LINK_STATE_UNKNOWN;
attach_progress |= AST_macreg;
status = vgen_init_mdeg(vnetp->vgenhdl);
if (status != DDI_SUCCESS) {
goto vnet_attach_fail;
}
attach_progress |= AST_init_mdeg;
vnetp->attach_progress = attach_progress;
DBG1(NULL, "instance(%d) exit\n", instance);
return (DDI_SUCCESS);
vnet_attach_fail:
vnetp->attach_progress = attach_progress;
status = vnet_unattach(vnetp);
ASSERT(status == 0);
return (DDI_FAILURE);
}
static int
vnetdetach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
vnet_t *vnetp;
int instance;
instance = ddi_get_instance(dip);
DBG1(NULL, "instance(%d) enter\n", instance);
vnetp = ddi_get_driver_private(dip);
if (vnetp == NULL) {
goto vnet_detach_fail;
}
switch (cmd) {
case DDI_DETACH:
break;
case DDI_SUSPEND:
case DDI_PM_SUSPEND:
default:
goto vnet_detach_fail;
}
if (vnet_unattach(vnetp) != 0) {
goto vnet_detach_fail;
}
return (DDI_SUCCESS);
vnet_detach_fail:
return (DDI_FAILURE);
}
static int
vnet_unattach(vnet_t *vnetp)
{
vnet_attach_progress_t attach_progress;
attach_progress = vnetp->attach_progress;
if (attach_progress & AST_macreg) {
if (mac_disable(vnetp->mh) != 0) {
return (1);
}
}
if (attach_progress & AST_vdds_init) {
vdds_cleanup(vnetp);
attach_progress &= ~AST_vdds_init;
}
if (attach_progress & (AST_vgen_init|AST_init_mdeg)) {
vgen_uninit(vnetp->vgenhdl);
attach_progress &= ~AST_vgen_init;
attach_progress &= ~AST_init_mdeg;
}
if (attach_progress & AST_taskq_create) {
ddi_taskq_destroy(vnetp->taskqp);
attach_progress &= ~AST_taskq_create;
}
if (attach_progress & AST_fdbh_alloc) {
vnet_fdb_destroy(vnetp);
attach_progress &= ~AST_fdbh_alloc;
}
if (attach_progress & AST_vnet_list) {
vnet_t **vnetpp;
WRITE_ENTER(&vnet_rw);
for (vnetpp = &vnet_headp; *vnetpp;
vnetpp = &(*vnetpp)->nextp) {
if (*vnetpp == vnetp) {
*vnetpp = vnetp->nextp;
break;
}
}
RW_EXIT(&vnet_rw);
attach_progress &= ~AST_vnet_list;
}
if (attach_progress & AST_ring_init) {
vnet_ring_grp_uninit(vnetp);
attach_progress &= ~AST_ring_init;
}
if (attach_progress & AST_macreg) {
VERIFY(mac_unregister(vnetp->mh) == 0);
vnetp->mh = NULL;
attach_progress &= ~AST_macreg;
}
if (attach_progress & AST_vnet_alloc) {
rw_destroy(&vnetp->vrwlock);
rw_destroy(&vnetp->vsw_fp_rw);
attach_progress &= ~AST_vnet_list;
KMEM_FREE(vnetp);
}
return (0);
}
static int
vnet_m_start(void *arg)
{
vnet_t *vnetp = arg;
DBG1(vnetp, "enter\n");
WRITE_ENTER(&vnetp->vrwlock);
vnetp->flags |= VNET_STARTED;
vnet_start_resources(vnetp);
RW_EXIT(&vnetp->vrwlock);
DBG1(vnetp, "exit\n");
return (VNET_SUCCESS);
}
static void
vnet_m_stop(void *arg)
{
vnet_t *vnetp = arg;
DBG1(vnetp, "enter\n");
WRITE_ENTER(&vnetp->vrwlock);
if (vnetp->flags & VNET_STARTED) {
vnetp->flags &= ~VNET_STARTED;
vnetp->flags |= VNET_STOPPING;
vnet_stop_resources(vnetp);
vnetp->flags &= ~VNET_STOPPING;
}
RW_EXIT(&vnetp->vrwlock);
DBG1(vnetp, "exit\n");
}
static int
vnet_m_unicst(void *arg, const uint8_t *macaddr)
{
_NOTE(ARGUNUSED(macaddr))
vnet_t *vnetp = arg;
DBG1(vnetp, "enter\n");
DBG1(vnetp, "exit\n");
return (VNET_FAILURE);
}
static int
vnet_m_multicst(void *arg, boolean_t add, const uint8_t *mca)
{
_NOTE(ARGUNUSED(add, mca))
vnet_t *vnetp = arg;
vnet_res_t *vresp;
mac_register_t *macp;
mac_callbacks_t *cbp;
int rv = VNET_SUCCESS;
DBG1(vnetp, "enter\n");
READ_ENTER(&vnetp->vsw_fp_rw);
if (vnetp->vsw_fp == NULL) {
RW_EXIT(&vnetp->vsw_fp_rw);
return (EAGAIN);
}
VNET_FDBE_REFHOLD(vnetp->vsw_fp);
RW_EXIT(&vnetp->vsw_fp_rw);
vresp = vnetp->vsw_fp;
macp = &vresp->macreg;
cbp = macp->m_callbacks;
rv = cbp->mc_multicst(macp->m_driver, add, mca);
VNET_FDBE_REFRELE(vnetp->vsw_fp);
DBG1(vnetp, "exit(%d)\n", rv);
return (rv);
}
static int
vnet_m_promisc(void *arg, boolean_t on)
{
_NOTE(ARGUNUSED(on))
vnet_t *vnetp = arg;
DBG1(vnetp, "enter\n");
DBG1(vnetp, "exit\n");
return (VNET_SUCCESS);
}
mblk_t *
vnet_tx_ring_send(void *arg, mblk_t *mp)
{
vnet_pseudo_tx_ring_t *tx_ringp;
vnet_tx_ring_stats_t *statsp;
vnet_t *vnetp;
vnet_res_t *vresp;
mblk_t *next;
mblk_t *resid_mp;
mac_register_t *macp;
struct ether_header *ehp;
boolean_t is_unicast;
boolean_t is_pvid;
boolean_t hres;
void *tx_arg;
size_t size;
tx_ringp = (vnet_pseudo_tx_ring_t *)arg;
statsp = &tx_ringp->tx_ring_stats;
vnetp = (vnet_t *)tx_ringp->vnetp;
DBG1(vnetp, "enter\n");
ASSERT(mp != NULL);
is_pvid = (vnetp->pvid != vnetp->default_vlan_id) ? B_TRUE : B_FALSE;
while (mp != NULL) {
next = mp->b_next;
mp->b_next = NULL;
size = msgsize(mp);
ehp = (struct ether_header *)mp->b_rptr;
vresp = vnet_fdbe_find(vnetp, &ehp->ether_dhost);
if (vresp != NULL) {
macp = &vresp->macreg;
resid_mp = macp->m_callbacks->mc_tx(macp->m_driver, mp);
VNET_FDBE_REFRELE(vresp);
if (resid_mp != NULL) {
mp->b_next = next;
break;
}
} else {
is_unicast = !(IS_BROADCAST(ehp) ||
(IS_MULTICAST(ehp)));
READ_ENTER(&vnetp->vsw_fp_rw);
if ((is_unicast) && (vnetp->hio_fp != NULL)) {
vresp = vnetp->hio_fp;
hres = B_TRUE;
} else {
vresp = vnetp->vsw_fp;
hres = B_FALSE;
}
if (vresp == NULL) {
RW_EXIT(&vnetp->vsw_fp_rw);
freemsg(mp);
mp = next;
continue;
}
VNET_FDBE_REFHOLD(vresp);
RW_EXIT(&vnetp->vsw_fp_rw);
if (hres == B_TRUE) {
if (is_pvid == B_TRUE &&
ehp->ether_type != htons(ETHERTYPE_VLAN)) {
mp = vnet_vlan_insert_tag(mp,
vnetp->pvid);
if (mp == NULL) {
VNET_FDBE_REFRELE(vresp);
mp = next;
continue;
}
}
macp = &vresp->macreg;
tx_arg = tx_ringp;
} else {
macp = &vresp->macreg;
tx_arg = macp->m_driver;
}
resid_mp = macp->m_callbacks->mc_tx(tx_arg, mp);
VNET_FDBE_REFRELE(vresp);
if (resid_mp != NULL) {
mp->b_next = next;
break;
}
}
statsp->obytes += size;
statsp->opackets++;
mp = next;
}
DBG1(vnetp, "exit\n");
return (mp);
}
int
vnet_m_stat(void *arg, uint_t stat, uint64_t *val)
{
vnet_t *vnetp = arg;
vnet_res_t *vresp;
mac_register_t *macp;
mac_callbacks_t *cbp;
uint64_t val_total = 0;
DBG1(vnetp, "enter\n");
if ((IS_MAC_STAT(stat) && !MAC_STAT_ISACOUNTER(stat)) ||
(IS_MACTYPE_STAT(stat) && !ETHER_STAT_ISACOUNTER(stat))) {
return (ENOTSUP);
}
READ_ENTER(&vnetp->vrwlock);
for (vresp = vnetp->vres_list; vresp != NULL; vresp = vresp->nextp) {
macp = &vresp->macreg;
cbp = macp->m_callbacks;
if (cbp->mc_getstat(macp->m_driver, stat, val) == 0)
val_total += *val;
}
RW_EXIT(&vnetp->vrwlock);
*val = val_total;
DBG1(vnetp, "exit\n");
return (0);
}
static void
vnet_ring_grp_init(vnet_t *vnetp)
{
vnet_pseudo_rx_group_t *rx_grp;
vnet_pseudo_rx_ring_t *rx_ringp;
vnet_pseudo_tx_group_t *tx_grp;
vnet_pseudo_tx_ring_t *tx_ringp;
int i;
tx_grp = &vnetp->tx_grp[0];
tx_ringp = kmem_zalloc(sizeof (vnet_pseudo_tx_ring_t) *
VNET_NUM_PSEUDO_TXRINGS, KM_SLEEP);
for (i = 0; i < VNET_NUM_PSEUDO_TXRINGS; i++) {
tx_ringp[i].state |= VNET_TXRING_SHARED;
}
tx_grp->rings = tx_ringp;
tx_grp->ring_cnt = VNET_NUM_PSEUDO_TXRINGS;
mutex_init(&tx_grp->flowctl_lock, NULL, MUTEX_DRIVER, NULL);
cv_init(&tx_grp->flowctl_cv, NULL, CV_DRIVER, NULL);
tx_grp->flowctl_thread = thread_create(NULL, 0,
vnet_tx_notify_thread, tx_grp, 0, &p0, TS_RUN, minclsyspri);
rx_grp = &vnetp->rx_grp[0];
rx_grp->max_ring_cnt = MAX_RINGS_PER_GROUP;
rw_init(&rx_grp->lock, NULL, RW_DRIVER, NULL);
rx_ringp = kmem_zalloc(sizeof (vnet_pseudo_rx_ring_t) *
rx_grp->max_ring_cnt, KM_SLEEP);
rx_ringp[0].state |= VNET_RXRING_INUSE|VNET_RXRING_LDC_SERVICE;
rx_ringp[0].index = 0;
rx_ringp[1].state |= VNET_RXRING_INUSE|VNET_RXRING_HYBRID;
rx_ringp[1].index = 1;
rx_ringp[2].state |= VNET_RXRING_INUSE|VNET_RXRING_HYBRID;
rx_ringp[2].index = 2;
rx_grp->ring_cnt = VNET_NUM_PSEUDO_RXRINGS_DEFAULT;
rx_grp->rings = rx_ringp;
for (i = VNET_NUM_PSEUDO_RXRINGS_DEFAULT;
i < rx_grp->max_ring_cnt; i++) {
rx_ringp = &rx_grp->rings[i];
rx_ringp->state = VNET_RXRING_FREE;
rx_ringp->index = i;
}
}
static void
vnet_ring_grp_uninit(vnet_t *vnetp)
{
vnet_pseudo_rx_group_t *rx_grp;
vnet_pseudo_tx_group_t *tx_grp;
kt_did_t tid = 0;
tx_grp = &vnetp->tx_grp[0];
mutex_enter(&tx_grp->flowctl_lock);
if (tx_grp->flowctl_thread != NULL) {
tid = tx_grp->flowctl_thread->t_did;
tx_grp->flowctl_done = B_TRUE;
cv_signal(&tx_grp->flowctl_cv);
}
mutex_exit(&tx_grp->flowctl_lock);
if (tid != 0)
thread_join(tid);
if (tx_grp->rings != NULL) {
ASSERT(tx_grp->ring_cnt == VNET_NUM_PSEUDO_TXRINGS);
kmem_free(tx_grp->rings, sizeof (vnet_pseudo_tx_ring_t) *
tx_grp->ring_cnt);
tx_grp->rings = NULL;
}
rx_grp = &vnetp->rx_grp[0];
if (rx_grp->rings != NULL) {
ASSERT(rx_grp->max_ring_cnt == MAX_RINGS_PER_GROUP);
ASSERT(rx_grp->ring_cnt == VNET_NUM_PSEUDO_RXRINGS_DEFAULT);
kmem_free(rx_grp->rings, sizeof (vnet_pseudo_rx_ring_t) *
rx_grp->max_ring_cnt);
rx_grp->rings = NULL;
}
}
static vnet_pseudo_rx_ring_t *
vnet_alloc_pseudo_rx_ring(vnet_t *vnetp)
{
vnet_pseudo_rx_group_t *rx_grp;
vnet_pseudo_rx_ring_t *rx_ringp;
int index;
rx_grp = &vnetp->rx_grp[0];
WRITE_ENTER(&rx_grp->lock);
if (rx_grp->ring_cnt == rx_grp->max_ring_cnt) {
RW_EXIT(&rx_grp->lock);
return (NULL);
}
for (index = VNET_NUM_PSEUDO_RXRINGS_DEFAULT;
index < rx_grp->max_ring_cnt; index++) {
rx_ringp = &rx_grp->rings[index];
if (rx_ringp->state == VNET_RXRING_FREE) {
rx_ringp->state |= VNET_RXRING_INUSE;
rx_grp->ring_cnt++;
break;
}
}
RW_EXIT(&rx_grp->lock);
return (rx_ringp);
}
static void
vnet_free_pseudo_rx_ring(vnet_t *vnetp, vnet_pseudo_rx_ring_t *ringp)
{
vnet_pseudo_rx_group_t *rx_grp;
ASSERT(ringp->index >= VNET_NUM_PSEUDO_RXRINGS_DEFAULT);
rx_grp = &vnetp->rx_grp[0];
WRITE_ENTER(&rx_grp->lock);
if (ringp->state != VNET_RXRING_FREE) {
ringp->state = VNET_RXRING_FREE;
ringp->handle = NULL;
rx_grp->ring_cnt--;
}
RW_EXIT(&rx_grp->lock);
}
static int
vnet_mac_register(vnet_t *vnetp)
{
mac_register_t *macp;
int err;
if ((macp = mac_alloc(MAC_VERSION)) == NULL)
return (DDI_FAILURE);
macp->m_type_ident = MAC_PLUGIN_IDENT_ETHER;
macp->m_driver = vnetp;
macp->m_dip = vnetp->dip;
macp->m_src_addr = vnetp->curr_macaddr;
macp->m_callbacks = &vnet_m_callbacks;
macp->m_min_sdu = 0;
macp->m_max_sdu = vnetp->mtu;
macp->m_margin = VLAN_TAGSZ;
macp->m_v12n = MAC_VIRT_LEVEL1;
err = mac_register(macp, &vnetp->mh);
mac_free(macp);
return (err == 0 ? DDI_SUCCESS : DDI_FAILURE);
}
static int
vnet_read_mac_address(vnet_t *vnetp)
{
uchar_t *macaddr;
uint32_t size;
int rv;
rv = ddi_prop_lookup_byte_array(DDI_DEV_T_ANY, vnetp->dip,
DDI_PROP_DONTPASS, macaddr_propname, &macaddr, &size);
if ((rv != DDI_PROP_SUCCESS) || (size != ETHERADDRL)) {
DWARN(vnetp, "prop_lookup failed(%s) err(%d)\n",
macaddr_propname, rv);
return (DDI_FAILURE);
}
bcopy(macaddr, (caddr_t)vnetp->vendor_addr, ETHERADDRL);
bcopy(macaddr, (caddr_t)vnetp->curr_macaddr, ETHERADDRL);
ddi_prop_free(macaddr);
return (DDI_SUCCESS);
}
static void
vnet_fdb_create(vnet_t *vnetp)
{
char hashname[MAXNAMELEN];
(void) snprintf(hashname, MAXNAMELEN, "vnet%d-fdbhash",
vnetp->instance);
vnetp->fdb_nchains = vnet_fdb_nchains;
vnetp->fdb_hashp = mod_hash_create_ptrhash(hashname, vnetp->fdb_nchains,
mod_hash_null_valdtor, sizeof (void *));
}
static void
vnet_fdb_destroy(vnet_t *vnetp)
{
if (vnetp->fdb_hashp != NULL) {
mod_hash_destroy_hash(vnetp->fdb_hashp);
vnetp->fdb_hashp = NULL;
vnetp->fdb_nchains = 0;
}
}
void
vnet_fdbe_add(vnet_t *vnetp, vnet_res_t *vresp)
{
uint64_t addr = 0;
int rv;
KEY_HASH(addr, vresp->rem_macaddr);
(vresp->type == VIO_NET_RES_LDC_SERVICE) ?
(vresp->refcnt = 1) : (vresp->refcnt = 0);
if (vresp->type != VIO_NET_RES_HYBRID) {
rv = mod_hash_insert(vnetp->fdb_hashp, (mod_hash_key_t)addr,
(mod_hash_val_t)vresp);
if (rv != 0) {
DWARN(vnetp, "Duplicate macaddr key(%lx)\n", addr);
return;
}
}
if (vresp->type == VIO_NET_RES_LDC_SERVICE) {
WRITE_ENTER(&vnetp->vsw_fp_rw);
if (vnetp->vsw_fp == NULL)
vnetp->vsw_fp = vresp;
RW_EXIT(&vnetp->vsw_fp_rw);
} else if (vresp->type == VIO_NET_RES_HYBRID) {
WRITE_ENTER(&vnetp->vsw_fp_rw);
if (vnetp->hio_fp == NULL)
vnetp->hio_fp = vresp;
RW_EXIT(&vnetp->vsw_fp_rw);
}
}
static void
vnet_fdbe_del(vnet_t *vnetp, vnet_res_t *vresp)
{
uint64_t addr = 0;
int rv;
uint32_t refcnt;
vnet_res_t *tmp;
KEY_HASH(addr, vresp->rem_macaddr);
if (vresp->type != VIO_NET_RES_HYBRID) {
rv = mod_hash_remove(vnetp->fdb_hashp, (mod_hash_key_t)addr,
(mod_hash_val_t *)&tmp);
if (rv != 0) {
return;
}
}
if (vresp->type == VIO_NET_RES_LDC_SERVICE) {
WRITE_ENTER(&vnetp->vsw_fp_rw);
ASSERT(tmp == vnetp->vsw_fp);
vnetp->vsw_fp = NULL;
RW_EXIT(&vnetp->vsw_fp_rw);
} else if (vresp->type == VIO_NET_RES_HYBRID) {
WRITE_ENTER(&vnetp->vsw_fp_rw);
vnetp->hio_fp = NULL;
RW_EXIT(&vnetp->vsw_fp_rw);
}
(vresp->type == VIO_NET_RES_LDC_SERVICE) ?
(refcnt = 1) : (refcnt = 0);
while (vresp->refcnt > refcnt) {
delay(drv_usectohz(vnet_fdbe_refcnt_delay));
}
}
static vnet_res_t *
vnet_fdbe_find(vnet_t *vnetp, struct ether_addr *addrp)
{
uint64_t key = 0;
vnet_res_t *vresp;
int rv;
KEY_HASH(key, addrp->ether_addr_octet);
rv = mod_hash_find_cb(vnetp->fdb_hashp, (mod_hash_key_t)key,
(mod_hash_val_t *)&vresp, vnet_fdbe_find_cb);
if (rv != 0)
return (NULL);
return (vresp);
}
static void
vnet_fdbe_find_cb(mod_hash_key_t key, mod_hash_val_t val)
{
_NOTE(ARGUNUSED(key))
VNET_FDBE_REFHOLD((vnet_res_t *)val);
}
static void
vnet_rx_frames_untag(uint16_t pvid, mblk_t **mp)
{
struct ether_vlan_header *evhp;
mblk_t *bp;
mblk_t *bpt;
mblk_t *bph;
mblk_t *bpn;
bpn = bph = bpt = NULL;
for (bp = *mp; bp != NULL; bp = bpn) {
bpn = bp->b_next;
bp->b_next = bp->b_prev = NULL;
evhp = (struct ether_vlan_header *)bp->b_rptr;
if (ntohs(evhp->ether_tpid) == ETHERTYPE_VLAN &&
VLAN_ID(ntohs(evhp->ether_tci)) == pvid) {
bp = vnet_vlan_remove_tag(bp);
if (bp == NULL) {
continue;
}
}
if (bph == NULL) {
bph = bpt = bp;
} else {
bpt->b_next = bp;
bpt = bp;
}
}
*mp = bph;
}
static void
vnet_rx(vio_net_handle_t vrh, mblk_t *mp)
{
vnet_res_t *vresp = (vnet_res_t *)vrh;
vnet_t *vnetp = vresp->vnetp;
vnet_pseudo_rx_ring_t *ringp;
if ((vnetp == NULL) || (vnetp->mh == 0)) {
freemsgchain(mp);
return;
}
ringp = vresp->rx_ringp;
mac_rx_ring(vnetp->mh, ringp->handle, mp, ringp->gen_num);
}
void
vnet_tx_update(vio_net_handle_t vrh)
{
vnet_res_t *vresp = (vnet_res_t *)vrh;
vnet_t *vnetp = vresp->vnetp;
vnet_pseudo_tx_ring_t *tx_ringp;
vnet_pseudo_tx_group_t *tx_grp;
int i;
if (vnetp == NULL || vnetp->mh == NULL) {
return;
}
tx_grp = &vnetp->tx_grp[0];
for (i = 0; i < tx_grp->ring_cnt; i++) {
tx_ringp = &tx_grp->rings[i];
mac_tx_ring_update(vnetp->mh, tx_ringp->handle);
}
}
static void
vnet_tx_notify_thread(void *arg)
{
callb_cpr_t cprinfo;
vnet_pseudo_tx_group_t *tx_grp = (vnet_pseudo_tx_group_t *)arg;
vnet_pseudo_tx_ring_t *tx_ringp;
vnet_t *vnetp;
int i;
CALLB_CPR_INIT(&cprinfo, &tx_grp->flowctl_lock, callb_generic_cpr,
"vnet_tx_notify_thread");
mutex_enter(&tx_grp->flowctl_lock);
while (!tx_grp->flowctl_done) {
CALLB_CPR_SAFE_BEGIN(&cprinfo);
cv_wait(&tx_grp->flowctl_cv, &tx_grp->flowctl_lock);
CALLB_CPR_SAFE_END(&cprinfo, &tx_grp->flowctl_lock);
for (i = 0; i < tx_grp->ring_cnt; i++) {
tx_ringp = &tx_grp->rings[i];
if (tx_ringp->woken_up) {
tx_ringp->woken_up = B_FALSE;
vnetp = tx_ringp->vnetp;
mac_tx_ring_update(vnetp->mh, tx_ringp->handle);
}
}
}
tx_grp->flowctl_thread = NULL;
CALLB_CPR_EXIT(&cprinfo);
thread_exit();
}
void
vnet_tx_ring_update(void *arg1, uintptr_t arg2)
{
vnet_t *vnetp = (vnet_t *)arg1;
vnet_pseudo_tx_group_t *tx_grp;
vnet_pseudo_tx_ring_t *tx_ringp;
int i;
tx_grp = &vnetp->tx_grp[0];
for (i = 0; i < tx_grp->ring_cnt; i++) {
tx_ringp = &tx_grp->rings[i];
if (tx_ringp->hw_rh == (mac_ring_handle_t)arg2) {
mutex_enter(&tx_grp->flowctl_lock);
tx_ringp->woken_up = B_TRUE;
cv_signal(&tx_grp->flowctl_cv);
mutex_exit(&tx_grp->flowctl_lock);
break;
}
}
}
int
vnet_mtu_update(vnet_t *vnetp, uint32_t mtu)
{
int rv;
if (vnetp == NULL || vnetp->mh == NULL) {
return (EINVAL);
}
WRITE_ENTER(&vnetp->vrwlock);
if (vnetp->flags & VNET_STARTED) {
RW_EXIT(&vnetp->vrwlock);
cmn_err(CE_NOTE, "!vnet%d: Unable to process mtu "
"update as the device is plumbed\n",
vnetp->instance);
return (EBUSY);
}
rv = mac_maxsdu_update(vnetp->mh, mtu);
if (rv != 0) {
RW_EXIT(&vnetp->vrwlock);
cmn_err(CE_NOTE,
"!vnet%d: Unable to update mtu with mac layer\n",
vnetp->instance);
return (EIO);
}
vnetp->mtu = mtu;
RW_EXIT(&vnetp->vrwlock);
return (0);
}
void
vnet_link_update(vnet_t *vnetp, link_state_t link_state)
{
if (vnetp == NULL || vnetp->mh == NULL) {
return;
}
WRITE_ENTER(&vnetp->vrwlock);
if (vnetp->link_state == link_state) {
RW_EXIT(&vnetp->vrwlock);
return;
}
vnetp->link_state = link_state;
RW_EXIT(&vnetp->vrwlock);
mac_link_update(vnetp->mh, link_state);
}
int vio_net_resource_reg(mac_register_t *macp, vio_net_res_type_t type,
ether_addr_t local_macaddr, ether_addr_t rem_macaddr, vio_net_handle_t *vhp,
vio_net_callbacks_t *vcb)
{
vnet_t *vnetp;
vnet_res_t *vresp;
vresp = kmem_zalloc(sizeof (vnet_res_t), KM_SLEEP);
ether_copy(local_macaddr, vresp->local_macaddr);
ether_copy(rem_macaddr, vresp->rem_macaddr);
vresp->type = type;
bcopy(macp, &vresp->macreg, sizeof (mac_register_t));
DBG1(NULL, "Resource Registerig type=0%X\n", type);
READ_ENTER(&vnet_rw);
vnetp = vnet_headp;
while (vnetp != NULL) {
if (VNET_MATCH_RES(vresp, vnetp)) {
vresp->vnetp = vnetp;
if (vresp->type == VIO_NET_RES_HYBRID) {
vresp->ksp = vnet_hio_setup_kstats(DRV_NAME,
"hio", vresp);
if (vresp->ksp == NULL) {
cmn_err(CE_NOTE, "!vnet%d: Cannot "
"create kstats for hio resource",
vnetp->instance);
}
}
vnet_add_resource(vnetp, vresp);
break;
}
vnetp = vnetp->nextp;
}
RW_EXIT(&vnet_rw);
if (vresp->vnetp == NULL) {
DWARN(NULL, "No vnet instance");
kmem_free(vresp, sizeof (vnet_res_t));
return (ENXIO);
}
*vhp = vresp;
vcb->vio_net_rx_cb = vnet_rx;
vcb->vio_net_tx_update = vnet_tx_update;
vcb->vio_net_report_err = vnet_handle_res_err;
if (vnet_bind_rings(vresp) != 0) {
(void) vnet_rem_resource(vnetp, vresp);
vnet_hio_destroy_kstats(vresp->ksp);
KMEM_FREE(vresp);
return (1);
}
vnet_dispatch_res_task(vnetp);
return (0);
}
void
vio_net_resource_unreg(vio_net_handle_t vhp)
{
vnet_res_t *vresp = (vnet_res_t *)vhp;
vnet_t *vnetp = vresp->vnetp;
DBG1(NULL, "Resource Registerig hdl=0x%p", vhp);
ASSERT(vnetp != NULL);
vnet_fdbe_del(vnetp, vresp);
vnet_unbind_rings(vresp);
(void) vnet_rem_resource(vnetp, vresp);
vnet_hio_destroy_kstats(vresp->ksp);
KMEM_FREE(vresp);
}
static void
vnet_add_resource(vnet_t *vnetp, vnet_res_t *vresp)
{
WRITE_ENTER(&vnetp->vrwlock);
vresp->nextp = vnetp->vres_list;
vnetp->vres_list = vresp;
RW_EXIT(&vnetp->vrwlock);
}
static vnet_res_t *
vnet_rem_resource(vnet_t *vnetp, vnet_res_t *vresp)
{
vnet_res_t *vrp;
WRITE_ENTER(&vnetp->vrwlock);
if (vresp == vnetp->vres_list) {
vnetp->vres_list = vresp->nextp;
} else {
vrp = vnetp->vres_list;
while (vrp->nextp != NULL) {
if (vrp->nextp == vresp) {
vrp->nextp = vresp->nextp;
break;
}
vrp = vrp->nextp;
}
}
vresp->vnetp = NULL;
vresp->nextp = NULL;
RW_EXIT(&vnetp->vrwlock);
return (vresp);
}
void
vnet_dds_rx(void *arg, void *dmsg)
{
vnet_t *vnetp = arg;
vdds_process_dds_msg(vnetp, dmsg);
}
int
vnet_send_dds_msg(vnet_t *vnetp, void *dmsg)
{
int rv;
if (vnetp->vgenhdl != NULL) {
rv = vgen_dds_tx(vnetp->vgenhdl, dmsg);
}
return (rv);
}
void
vnet_dds_cleanup_hio(vnet_t *vnetp)
{
vdds_cleanup_hio(vnetp);
}
static void
vnet_handle_res_err(vio_net_handle_t vrh, vio_net_err_val_t err)
{
vnet_res_t *vresp = (vnet_res_t *)vrh;
vnet_t *vnetp = vresp->vnetp;
if (vnetp == NULL) {
return;
}
if ((vresp->type != VIO_NET_RES_LDC_SERVICE) &&
(vresp->type != VIO_NET_RES_HYBRID)) {
return;
}
vdds_cleanup_hio(vnetp);
}
static void
vnet_dispatch_res_task(vnet_t *vnetp)
{
int rv;
rv = ddi_taskq_dispatch(vnetp->taskqp, vnet_res_start_task,
vnetp, DDI_NOSLEEP);
if (rv != DDI_SUCCESS) {
cmn_err(CE_WARN,
"vnet%d:Can't dispatch start resource task",
vnetp->instance);
}
}
static void
vnet_res_start_task(void *arg)
{
vnet_t *vnetp = arg;
WRITE_ENTER(&vnetp->vrwlock);
if (vnetp->flags & VNET_STARTED) {
vnet_start_resources(vnetp);
}
RW_EXIT(&vnetp->vrwlock);
}
static void
vnet_start_resources(vnet_t *vnetp)
{
mac_register_t *macp;
mac_callbacks_t *cbp;
vnet_res_t *vresp;
int rv;
DBG1(vnetp, "enter\n");
ASSERT(RW_WRITE_HELD(&vnetp->vrwlock));
for (vresp = vnetp->vres_list; vresp != NULL; vresp = vresp->nextp) {
if (vresp->flags & VNET_STARTED) {
continue;
}
macp = &vresp->macreg;
cbp = macp->m_callbacks;
rv = cbp->mc_start(macp->m_driver);
if (rv == 0) {
vresp->flags |= VNET_STARTED;
vnet_fdbe_add(vnetp, vresp);
}
}
DBG1(vnetp, "exit\n");
}
static void
vnet_stop_resources(vnet_t *vnetp)
{
vnet_res_t *vresp;
mac_register_t *macp;
mac_callbacks_t *cbp;
DBG1(vnetp, "enter\n");
ASSERT(RW_WRITE_HELD(&vnetp->vrwlock));
for (vresp = vnetp->vres_list; vresp != NULL; ) {
if (vresp->flags & VNET_STARTED) {
vresp->flags &= ~VNET_STARTED;
vresp->flags |= VNET_STOPPING;
macp = &vresp->macreg;
cbp = macp->m_callbacks;
VNET_FDBE_REFHOLD(vresp);
RW_EXIT(&vnetp->vrwlock);
cbp->mc_stop(macp->m_driver);
WRITE_ENTER(&vnetp->vrwlock);
vresp->flags &= ~VNET_STOPPING;
VNET_FDBE_REFRELE(vresp);
}
vresp = vresp->nextp;
}
DBG1(vnetp, "exit\n");
}
kstat_t *
vnet_hio_setup_kstats(char *ks_mod, char *ks_name, vnet_res_t *vresp)
{
kstat_t *ksp;
vnet_t *vnetp = vresp->vnetp;
vnet_hio_kstats_t *hiokp;
size_t size;
ASSERT(vnetp != NULL);
size = sizeof (vnet_hio_kstats_t) / sizeof (kstat_named_t);
ksp = kstat_create(ks_mod, vnetp->instance, ks_name, "net",
KSTAT_TYPE_NAMED, size, 0);
if (ksp == NULL) {
return (NULL);
}
hiokp = (vnet_hio_kstats_t *)ksp->ks_data;
kstat_named_init(&hiokp->ipackets, "ipackets",
KSTAT_DATA_ULONG);
kstat_named_init(&hiokp->ierrors, "ierrors",
KSTAT_DATA_ULONG);
kstat_named_init(&hiokp->opackets, "opackets",
KSTAT_DATA_ULONG);
kstat_named_init(&hiokp->oerrors, "oerrors",
KSTAT_DATA_ULONG);
kstat_named_init(&hiokp->rbytes, "rbytes",
KSTAT_DATA_ULONG);
kstat_named_init(&hiokp->obytes, "obytes",
KSTAT_DATA_ULONG);
kstat_named_init(&hiokp->multircv, "multircv",
KSTAT_DATA_ULONG);
kstat_named_init(&hiokp->multixmt, "multixmt",
KSTAT_DATA_ULONG);
kstat_named_init(&hiokp->brdcstrcv, "brdcstrcv",
KSTAT_DATA_ULONG);
kstat_named_init(&hiokp->brdcstxmt, "brdcstxmt",
KSTAT_DATA_ULONG);
kstat_named_init(&hiokp->norcvbuf, "norcvbuf",
KSTAT_DATA_ULONG);
kstat_named_init(&hiokp->noxmtbuf, "noxmtbuf",
KSTAT_DATA_ULONG);
ksp->ks_update = vnet_hio_update_kstats;
ksp->ks_private = (void *)vresp;
kstat_install(ksp);
return (ksp);
}
static void
vnet_hio_destroy_kstats(kstat_t *ksp)
{
if (ksp != NULL)
kstat_delete(ksp);
}
static int
vnet_hio_update_kstats(kstat_t *ksp, int rw)
{
vnet_t *vnetp;
vnet_res_t *vresp;
vnet_hio_stats_t statsp;
vnet_hio_kstats_t *hiokp;
vresp = (vnet_res_t *)ksp->ks_private;
vnetp = vresp->vnetp;
bzero(&statsp, sizeof (vnet_hio_stats_t));
READ_ENTER(&vnetp->vsw_fp_rw);
if (vnetp->hio_fp == NULL) {
RW_EXIT(&vnetp->vsw_fp_rw);
return (0);
}
VNET_FDBE_REFHOLD(vnetp->hio_fp);
RW_EXIT(&vnetp->vsw_fp_rw);
vnet_hio_get_stats(vnetp->hio_fp, &statsp);
VNET_FDBE_REFRELE(vnetp->hio_fp);
hiokp = (vnet_hio_kstats_t *)ksp->ks_data;
if (rw == KSTAT_READ) {
hiokp->ipackets.value.ul = (uint32_t)statsp.ipackets;
hiokp->ipackets64.value.ull = statsp.ipackets;
hiokp->ierrors.value.ul = statsp.ierrors;
hiokp->opackets.value.ul = (uint32_t)statsp.opackets;
hiokp->opackets64.value.ull = statsp.opackets;
hiokp->oerrors.value.ul = statsp.oerrors;
hiokp->rbytes.value.ul = (uint32_t)statsp.rbytes;
hiokp->rbytes64.value.ull = statsp.rbytes;
hiokp->obytes.value.ul = (uint32_t)statsp.obytes;
hiokp->obytes64.value.ull = statsp.obytes;
hiokp->multircv.value.ul = statsp.multircv;
hiokp->multixmt.value.ul = statsp.multixmt;
hiokp->brdcstrcv.value.ul = statsp.brdcstrcv;
hiokp->brdcstxmt.value.ul = statsp.brdcstxmt;
hiokp->norcvbuf.value.ul = statsp.norcvbuf;
hiokp->noxmtbuf.value.ul = statsp.noxmtbuf;
} else {
return (EACCES);
}
return (0);
}
static void
vnet_hio_get_stats(vnet_res_t *vresp, vnet_hio_stats_t *statsp)
{
mac_register_t *macp;
mac_callbacks_t *cbp;
uint64_t val;
int stat;
macp = &vresp->macreg;
cbp = macp->m_callbacks;
for (stat = MAC_STAT_MIN; stat < MAC_STAT_OVERFLOWS; stat++) {
if (cbp->mc_getstat(macp->m_driver, stat, &val) == 0) {
switch (stat) {
case MAC_STAT_IPACKETS:
statsp->ipackets = val;
break;
case MAC_STAT_IERRORS:
statsp->ierrors = val;
break;
case MAC_STAT_OPACKETS:
statsp->opackets = val;
break;
case MAC_STAT_OERRORS:
statsp->oerrors = val;
break;
case MAC_STAT_RBYTES:
statsp->rbytes = val;
break;
case MAC_STAT_OBYTES:
statsp->obytes = val;
break;
case MAC_STAT_MULTIRCV:
statsp->multircv = val;
break;
case MAC_STAT_MULTIXMT:
statsp->multixmt = val;
break;
case MAC_STAT_BRDCSTRCV:
statsp->brdcstrcv = val;
break;
case MAC_STAT_BRDCSTXMT:
statsp->brdcstxmt = val;
break;
case MAC_STAT_NOXMTBUF:
statsp->noxmtbuf = val;
break;
case MAC_STAT_NORCVBUF:
statsp->norcvbuf = val;
break;
default:
break;
}
}
}
}
static boolean_t
vnet_m_capab(void *arg, mac_capab_t cap, void *cap_data)
{
vnet_t *vnetp = (vnet_t *)arg;
if (vnetp == NULL) {
return (0);
}
switch (cap) {
case MAC_CAPAB_RINGS: {
mac_capab_rings_t *cap_rings = cap_data;
if (cap_rings->mr_type == MAC_RING_TYPE_RX) {
cap_rings->mr_group_type = MAC_GROUP_TYPE_STATIC;
cap_rings->mr_rnum = vnetp->rx_grp[0].ring_cnt;
cap_rings->mr_rget = vnet_get_ring;
cap_rings->mr_gnum = VNET_NUM_PSEUDO_GROUPS;
cap_rings->mr_gget = vnet_get_group;
cap_rings->mr_gaddring = NULL;
cap_rings->mr_gremring = NULL;
} else {
cap_rings->mr_group_type = MAC_GROUP_TYPE_STATIC;
cap_rings->mr_rnum = vnetp->tx_grp[0].ring_cnt;
cap_rings->mr_rget = vnet_get_ring;
cap_rings->mr_gnum = 0;
cap_rings->mr_gget = vnet_get_group;
cap_rings->mr_gaddring = NULL;
cap_rings->mr_gremring = NULL;
}
return (B_TRUE);
}
default:
break;
}
return (B_FALSE);
}
static void
vnet_get_ring(void *arg, mac_ring_type_t rtype, const int g_index,
const int r_index, mac_ring_info_t *infop, mac_ring_handle_t r_handle)
{
vnet_t *vnetp = arg;
switch (rtype) {
case MAC_RING_TYPE_RX: {
vnet_pseudo_rx_group_t *rx_grp;
vnet_pseudo_rx_ring_t *rx_ringp;
mac_intr_t *mintr;
ASSERT(g_index == 0);
rx_grp = &vnetp->rx_grp[g_index];
ASSERT((r_index >= 0) && (r_index < rx_grp->max_ring_cnt));
rx_ringp = &rx_grp->rings[r_index];
rx_ringp->handle = r_handle;
rx_ringp->grp = rx_grp;
rx_ringp->vnetp = vnetp;
mintr = &infop->mri_intr;
mintr->mi_handle = (mac_intr_handle_t)rx_ringp;
mintr->mi_enable = (mac_intr_enable_t)vnet_ring_enable_intr;
mintr->mi_disable = (mac_intr_disable_t)vnet_ring_disable_intr;
infop->mri_driver = (mac_ring_driver_t)rx_ringp;
infop->mri_start = vnet_rx_ring_start;
infop->mri_stop = vnet_rx_ring_stop;
infop->mri_stat = vnet_rx_ring_stat;
infop->mri_poll = vnet_rx_poll;
infop->mri_flags = (vnet_mac_rx_queuing ?
MAC_RING_RX_ENQUEUE : 0);
break;
}
case MAC_RING_TYPE_TX: {
vnet_pseudo_tx_group_t *tx_grp;
vnet_pseudo_tx_ring_t *tx_ringp;
tx_grp = &vnetp->tx_grp[0];
ASSERT((r_index >= 0) && (r_index < tx_grp->ring_cnt));
tx_ringp = &tx_grp->rings[r_index];
tx_ringp->handle = r_handle;
tx_ringp->index = r_index;
tx_ringp->grp = tx_grp;
tx_ringp->vnetp = vnetp;
infop->mri_driver = (mac_ring_driver_t)tx_ringp;
infop->mri_start = vnet_tx_ring_start;
infop->mri_stop = vnet_tx_ring_stop;
infop->mri_stat = vnet_tx_ring_stat;
infop->mri_tx = vnet_tx_ring_send;
infop->mri_flags = (vnet_mac_tx_serialize ?
MAC_RING_TX_SERIALIZE : 0);
break;
}
default:
break;
}
}
static void
vnet_get_group(void *arg, mac_ring_type_t type, const int index,
mac_group_info_t *infop, mac_group_handle_t handle)
{
vnet_t *vnetp = (vnet_t *)arg;
switch (type) {
case MAC_RING_TYPE_RX:
{
vnet_pseudo_rx_group_t *rx_grp;
ASSERT(index == 0);
rx_grp = &vnetp->rx_grp[index];
rx_grp->handle = handle;
rx_grp->index = index;
rx_grp->vnetp = vnetp;
infop->mgi_driver = (mac_group_driver_t)rx_grp;
infop->mgi_start = NULL;
infop->mgi_stop = NULL;
infop->mgi_addmac = vnet_addmac;
infop->mgi_remmac = vnet_remmac;
infop->mgi_count = rx_grp->ring_cnt;
break;
}
case MAC_RING_TYPE_TX:
{
vnet_pseudo_tx_group_t *tx_grp;
ASSERT(index == 0);
tx_grp = &vnetp->tx_grp[index];
tx_grp->handle = handle;
tx_grp->index = index;
tx_grp->vnetp = vnetp;
infop->mgi_driver = (mac_group_driver_t)tx_grp;
infop->mgi_start = NULL;
infop->mgi_stop = NULL;
infop->mgi_addmac = NULL;
infop->mgi_remmac = NULL;
infop->mgi_count = VNET_NUM_PSEUDO_TXRINGS;
break;
}
default:
break;
}
}
static int
vnet_rx_ring_start(mac_ring_driver_t arg, uint64_t mr_gen_num)
{
vnet_pseudo_rx_ring_t *rx_ringp = (vnet_pseudo_rx_ring_t *)arg;
int err;
if ((rx_ringp->state &
(VNET_RXRING_LDC_SERVICE|VNET_RXRING_LDC_GUEST)) != 0) {
rx_ringp->gen_num = mr_gen_num;
rx_ringp->state |= VNET_RXRING_STARTED;
return (0);
}
ASSERT((rx_ringp->state & VNET_RXRING_HYBRID) != 0);
if (rx_ringp->hw_rh == NULL) {
rx_ringp->gen_num = mr_gen_num;
rx_ringp->state |= VNET_RXRING_STARTED;
return (0);
}
err = mac_hwring_activate(rx_ringp->hw_rh);
if (err == 0) {
rx_ringp->gen_num = mr_gen_num;
rx_ringp->state |= VNET_RXRING_STARTED;
} else {
err = ENXIO;
}
return (err);
}
static void
vnet_rx_ring_stop(mac_ring_driver_t arg)
{
vnet_pseudo_rx_ring_t *rx_ringp = (vnet_pseudo_rx_ring_t *)arg;
if ((rx_ringp->state &
(VNET_RXRING_LDC_SERVICE|VNET_RXRING_LDC_GUEST)) != 0) {
rx_ringp->state &= ~VNET_RXRING_STARTED;
return;
}
ASSERT((rx_ringp->state & VNET_RXRING_HYBRID) != 0);
if (rx_ringp->hw_rh == NULL) {
rx_ringp->state &= ~VNET_RXRING_STARTED;
return;
}
mac_hwring_quiesce(rx_ringp->hw_rh);
rx_ringp->state &= ~VNET_RXRING_STARTED;
}
static int
vnet_rx_ring_stat(mac_ring_driver_t rdriver, uint_t stat, uint64_t *val)
{
vnet_pseudo_rx_ring_t *rx_ringp = (vnet_pseudo_rx_ring_t *)rdriver;
vnet_t *vnetp = (vnet_t *)rx_ringp->vnetp;
vnet_res_t *vresp;
mac_register_t *macp;
mac_callbacks_t *cbp;
if ((rx_ringp->state & VNET_RXRING_HYBRID) != 0) {
READ_ENTER(&vnetp->vsw_fp_rw);
if (vnetp->hio_fp == NULL) {
RW_EXIT(&vnetp->vsw_fp_rw);
return (0);
}
VNET_FDBE_REFHOLD(vnetp->hio_fp);
RW_EXIT(&vnetp->vsw_fp_rw);
(void) mac_hwring_getstat(rx_ringp->hw_rh, stat, val);
VNET_FDBE_REFRELE(vnetp->hio_fp);
return (0);
}
ASSERT((rx_ringp->state &
(VNET_RXRING_LDC_SERVICE|VNET_RXRING_LDC_GUEST)) != 0);
vresp = (vnet_res_t *)rx_ringp->hw_rh;
macp = &vresp->macreg;
cbp = macp->m_callbacks;
(void) cbp->mc_getstat(macp->m_driver, stat, val);
return (0);
}
static int
vnet_tx_ring_start(mac_ring_driver_t arg, uint64_t mr_gen_num)
{
vnet_pseudo_tx_ring_t *tx_ringp = (vnet_pseudo_tx_ring_t *)arg;
tx_ringp->state |= VNET_TXRING_STARTED;
return (0);
}
static void
vnet_tx_ring_stop(mac_ring_driver_t arg)
{
vnet_pseudo_tx_ring_t *tx_ringp = (vnet_pseudo_tx_ring_t *)arg;
tx_ringp->state &= ~VNET_TXRING_STARTED;
}
static int
vnet_tx_ring_stat(mac_ring_driver_t rdriver, uint_t stat, uint64_t *val)
{
vnet_pseudo_tx_ring_t *tx_ringp = (vnet_pseudo_tx_ring_t *)rdriver;
vnet_tx_ring_stats_t *statsp;
statsp = &tx_ringp->tx_ring_stats;
switch (stat) {
case MAC_STAT_OPACKETS:
*val = statsp->opackets;
break;
case MAC_STAT_OBYTES:
*val = statsp->obytes;
break;
default:
*val = 0;
return (ENOTSUP);
}
return (0);
}
static int
vnet_ring_enable_intr(void *arg)
{
vnet_pseudo_rx_ring_t *rx_ringp = (vnet_pseudo_rx_ring_t *)arg;
vnet_res_t *vresp;
if (rx_ringp->hw_rh == NULL) {
ASSERT((rx_ringp->state & VNET_RXRING_HYBRID) != 0);
return (0);
}
if (rx_ringp->state & VNET_RXRING_HYBRID) {
return (mac_hwring_enable_intr(rx_ringp->hw_rh));
} else {
vresp = (vnet_res_t *)rx_ringp->hw_rh;
return (vgen_enable_intr(vresp->macreg.m_driver));
}
}
static int
vnet_ring_disable_intr(void *arg)
{
vnet_pseudo_rx_ring_t *rx_ringp = (vnet_pseudo_rx_ring_t *)arg;
vnet_res_t *vresp;
if (rx_ringp->hw_rh == NULL) {
ASSERT((rx_ringp->state & VNET_RXRING_HYBRID) != 0);
return (0);
}
if (rx_ringp->state & VNET_RXRING_HYBRID) {
return (mac_hwring_disable_intr(rx_ringp->hw_rh));
} else {
vresp = (vnet_res_t *)rx_ringp->hw_rh;
return (vgen_disable_intr(vresp->macreg.m_driver));
}
}
static mblk_t *
vnet_rx_poll(void *arg, int bytes_to_pickup)
{
vnet_pseudo_rx_ring_t *rx_ringp = (vnet_pseudo_rx_ring_t *)arg;
mblk_t *mp = NULL;
vnet_res_t *vresp;
vnet_t *vnetp = rx_ringp->vnetp;
if (rx_ringp->hw_rh == NULL) {
return (NULL);
}
if (rx_ringp->state & VNET_RXRING_HYBRID) {
mp = mac_hwring_poll(rx_ringp->hw_rh, bytes_to_pickup);
if (vnetp->pvid != vnetp->default_vlan_id) {
vnet_rx_frames_untag(vnetp->pvid, &mp);
}
} else {
vresp = (vnet_res_t *)rx_ringp->hw_rh;
mp = vgen_rx_poll(vresp->macreg.m_driver, bytes_to_pickup);
}
return (mp);
}
void
vnet_hio_rx_cb(void *arg, mac_resource_handle_t mrh, mblk_t *mp,
boolean_t loopback)
{
vnet_t *vnetp = (vnet_t *)arg;
vnet_pseudo_rx_ring_t *ringp = (vnet_pseudo_rx_ring_t *)mrh;
if (vnetp->pvid != vnetp->default_vlan_id) {
vnet_rx_frames_untag(vnetp->pvid, &mp);
if (mp == NULL) {
return;
}
}
mac_rx_ring(vnetp->mh, ringp->handle, mp, ringp->gen_num);
}
static int
vnet_addmac(void *arg, const uint8_t *mac_addr)
{
vnet_pseudo_rx_group_t *rx_grp = (vnet_pseudo_rx_group_t *)arg;
vnet_t *vnetp;
vnetp = rx_grp->vnetp;
if (bcmp(mac_addr, vnetp->curr_macaddr, ETHERADDRL) == 0) {
return (0);
}
cmn_err(CE_CONT, "!vnet%d: %s: Multiple macaddr unsupported\n",
vnetp->instance, __func__);
return (EINVAL);
}
static int
vnet_remmac(void *arg, const uint8_t *mac_addr)
{
vnet_pseudo_rx_group_t *rx_grp = (vnet_pseudo_rx_group_t *)arg;
vnet_t *vnetp;
vnetp = rx_grp->vnetp;
if (bcmp(mac_addr, vnetp->curr_macaddr, ETHERADDRL) == 0) {
return (0);
}
cmn_err(CE_CONT, "!vnet%d: %s: Invalid macaddr: %s\n",
vnetp->instance, __func__, ether_sprintf((void *)mac_addr));
return (EINVAL);
}
int
vnet_hio_mac_init(vnet_t *vnetp, char *ifname)
{
mac_handle_t mh;
mac_client_handle_t mch = NULL;
mac_unicast_handle_t muh = NULL;
mac_diag_t diag;
mac_register_t *macp;
char client_name[MAXNAMELEN];
int rv;
uint16_t mac_flags = MAC_UNICAST_TAG_DISABLE |
MAC_UNICAST_STRIP_DISABLE | MAC_UNICAST_PRIMARY;
vio_net_callbacks_t vcb;
ether_addr_t rem_addr =
{ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
uint32_t retries = 0;
if ((macp = mac_alloc(MAC_VERSION)) == NULL) {
return (EAGAIN);
}
do {
rv = mac_open_by_linkname(ifname, &mh);
if (rv == 0) {
break;
}
if (rv != ENOENT || (retries++ >= vnet_mac_open_retries)) {
mac_free(macp);
return (rv);
}
drv_usecwait(vnet_mac_open_delay);
} while (rv == ENOENT);
vnetp->hio_mh = mh;
(void) snprintf(client_name, MAXNAMELEN, "vnet%d-%s", vnetp->instance,
ifname);
rv = mac_client_open(mh, &mch, client_name, MAC_OPEN_FLAGS_EXCLUSIVE);
if (rv != 0) {
goto fail;
}
vnetp->hio_mch = mch;
rv = mac_unicast_add(mch, vnetp->curr_macaddr, mac_flags, &muh, 0,
&diag);
if (rv != 0) {
goto fail;
}
vnetp->hio_muh = muh;
macp->m_type_ident = MAC_PLUGIN_IDENT_ETHER;
macp->m_driver = vnetp;
macp->m_dip = NULL;
macp->m_src_addr = NULL;
macp->m_callbacks = &vnet_hio_res_callbacks;
macp->m_min_sdu = 0;
macp->m_max_sdu = ETHERMTU;
rv = vio_net_resource_reg(macp, VIO_NET_RES_HYBRID,
vnetp->curr_macaddr, rem_addr, &vnetp->hio_vhp, &vcb);
if (rv != 0) {
goto fail;
}
mac_free(macp);
mac_rx_set(vnetp->hio_mch, vnet_hio_rx_cb, vnetp);
return (0);
fail:
mac_free(macp);
vnet_hio_mac_cleanup(vnetp);
return (1);
}
void
vnet_hio_mac_cleanup(vnet_t *vnetp)
{
if (vnetp->hio_vhp != NULL) {
vio_net_resource_unreg(vnetp->hio_vhp);
vnetp->hio_vhp = NULL;
}
if (vnetp->hio_muh != NULL) {
(void) mac_unicast_remove(vnetp->hio_mch, vnetp->hio_muh);
vnetp->hio_muh = NULL;
}
if (vnetp->hio_mch != NULL) {
mac_client_close(vnetp->hio_mch, 0);
vnetp->hio_mch = NULL;
}
if (vnetp->hio_mh != NULL) {
mac_close(vnetp->hio_mh);
vnetp->hio_mh = NULL;
}
}
static int
vnet_bind_hwrings(vnet_t *vnetp)
{
mac_ring_handle_t hw_rh[VNET_NUM_HYBRID_RINGS];
mac_perim_handle_t mph1;
vnet_pseudo_rx_group_t *rx_grp;
vnet_pseudo_rx_ring_t *rx_ringp;
vnet_pseudo_tx_group_t *tx_grp;
vnet_pseudo_tx_ring_t *tx_ringp;
int hw_ring_cnt;
int i;
int rv;
mac_perim_enter_by_mh(vnetp->hio_mh, &mph1);
hw_ring_cnt = mac_hwrings_get(vnetp->hio_mch, &vnetp->rx_hwgh, hw_rh,
MAC_RING_TYPE_RX);
if (hw_ring_cnt != VNET_NUM_HYBRID_RINGS) {
cmn_err(CE_WARN,
"!vnet%d: vnet_bind_hwrings: bad rx hw_ring_cnt(%d)\n",
vnetp->instance, hw_ring_cnt);
goto fail;
}
if (vnetp->rx_hwgh != NULL) {
mac_rx_client_quiesce(vnetp->hio_mch);
mac_srs_perm_quiesce(vnetp->hio_mch, B_TRUE);
}
rx_grp = &vnetp->rx_grp[0];
for (i = 0; i < VNET_NUM_HYBRID_RINGS; i++) {
rx_ringp = &rx_grp->rings[i + VNET_HYBRID_RXRING_INDEX];
rx_ringp->hw_rh = hw_rh[i];
mac_hwring_setup(rx_ringp->hw_rh,
(mac_resource_handle_t)rx_ringp, NULL);
if (rx_ringp->state & VNET_RXRING_STARTED) {
rv = mac_hwring_activate(rx_ringp->hw_rh);
if (rv != 0) {
mac_hwring_teardown(rx_ringp->hw_rh);
rx_ringp->hw_rh = NULL;
goto fail;
}
}
}
hw_ring_cnt = mac_hwrings_get(vnetp->hio_mch, &vnetp->tx_hwgh, hw_rh,
MAC_RING_TYPE_TX);
if (hw_ring_cnt != VNET_NUM_HYBRID_RINGS) {
cmn_err(CE_WARN,
"!vnet%d: vnet_bind_hwrings: bad tx hw_ring_cnt(%d)\n",
vnetp->instance, hw_ring_cnt);
goto fail;
}
tx_grp = &vnetp->tx_grp[0];
for (i = 0; i < tx_grp->ring_cnt; i++) {
tx_ringp = &tx_grp->rings[i];
tx_ringp->hw_rh = hw_rh[i];
tx_ringp->state |= VNET_TXRING_HYBRID;
}
tx_grp->tx_notify_handle =
mac_client_tx_notify(vnetp->hio_mch, vnet_tx_ring_update, vnetp);
mac_perim_exit(mph1);
return (0);
fail:
mac_perim_exit(mph1);
vnet_unbind_hwrings(vnetp);
return (1);
}
static void
vnet_unbind_hwrings(vnet_t *vnetp)
{
mac_perim_handle_t mph1;
vnet_pseudo_rx_ring_t *rx_ringp;
vnet_pseudo_rx_group_t *rx_grp;
vnet_pseudo_tx_group_t *tx_grp;
vnet_pseudo_tx_ring_t *tx_ringp;
int i;
mac_perim_enter_by_mh(vnetp->hio_mh, &mph1);
tx_grp = &vnetp->tx_grp[0];
for (i = 0; i < VNET_NUM_HYBRID_RINGS; i++) {
tx_ringp = &tx_grp->rings[i];
if (tx_ringp->state & VNET_TXRING_HYBRID) {
tx_ringp->state &= ~VNET_TXRING_HYBRID;
tx_ringp->hw_rh = NULL;
}
}
(void) mac_client_tx_notify(vnetp->hio_mch, NULL,
tx_grp->tx_notify_handle);
rx_grp = &vnetp->rx_grp[0];
for (i = 0; i < VNET_NUM_HYBRID_RINGS; i++) {
rx_ringp = &rx_grp->rings[i + VNET_HYBRID_RXRING_INDEX];
if (rx_ringp->hw_rh != NULL) {
mac_hwring_quiesce(rx_ringp->hw_rh);
mac_hwring_teardown(rx_ringp->hw_rh);
rx_ringp->hw_rh = NULL;
}
}
if (vnetp->rx_hwgh != NULL) {
vnetp->rx_hwgh = NULL;
mac_srs_perm_quiesce(vnetp->hio_mch, B_FALSE);
mac_rx_client_restart(vnetp->hio_mch);
}
mac_perim_exit(mph1);
}
static int
vnet_bind_vgenring(vnet_res_t *vresp)
{
vnet_t *vnetp;
vnet_pseudo_rx_group_t *rx_grp;
vnet_pseudo_rx_ring_t *rx_ringp;
mac_perim_handle_t mph1;
int rv;
int type;
vnetp = vresp->vnetp;
type = vresp->type;
rx_grp = &vnetp->rx_grp[0];
if (type == VIO_NET_RES_LDC_SERVICE) {
rx_ringp = &rx_grp->rings[0];
rx_ringp->hw_rh = (mac_ring_handle_t)vresp;
vresp->rx_ringp = (void *)rx_ringp;
return (0);
}
ASSERT(type == VIO_NET_RES_LDC_GUEST);
mac_perim_enter_by_mh(vnetp->mh, &mph1);
rx_ringp = vnet_alloc_pseudo_rx_ring(vnetp);
if (rx_ringp == NULL) {
cmn_err(CE_WARN, "!vnet%d: Failed to allocate pseudo rx ring",
vnetp->instance);
goto fail;
}
rx_ringp->hw_rh = (mac_ring_handle_t)vresp;
vresp->rx_ringp = (void *)rx_ringp;
rx_ringp->state |= VNET_RXRING_LDC_GUEST;
rv = mac_group_add_ring(rx_grp->handle, rx_ringp->index);
if (rv != 0) {
rx_ringp->state &= ~VNET_RXRING_LDC_GUEST;
rx_ringp->hw_rh = NULL;
vnet_free_pseudo_rx_ring(vnetp, rx_ringp);
goto fail;
}
mac_perim_exit(mph1);
return (0);
fail:
mac_perim_exit(mph1);
return (1);
}
static void
vnet_unbind_vgenring(vnet_res_t *vresp)
{
vnet_t *vnetp;
vnet_pseudo_rx_group_t *rx_grp;
vnet_pseudo_rx_ring_t *rx_ringp;
mac_perim_handle_t mph1;
int type;
vnetp = vresp->vnetp;
type = vresp->type;
rx_grp = &vnetp->rx_grp[0];
if (vresp->rx_ringp == NULL) {
return;
}
if (type == VIO_NET_RES_LDC_SERVICE) {
rx_ringp = &rx_grp->rings[0];
rx_ringp->hw_rh = NULL;
vresp->rx_ringp = NULL;
return;
}
ASSERT(type == VIO_NET_RES_LDC_GUEST);
mac_perim_enter_by_mh(vnetp->mh, &mph1);
rx_ringp = (vnet_pseudo_rx_ring_t *)vresp->rx_ringp;
vresp->rx_ringp = NULL;
if (rx_ringp != NULL && (rx_ringp->state & VNET_RXRING_LDC_GUEST)) {
mac_group_rem_ring(rx_grp->handle, rx_ringp->handle);
rx_ringp->hw_rh = NULL;
rx_ringp->state &= ~VNET_RXRING_LDC_GUEST;
vnet_free_pseudo_rx_ring(vnetp, rx_ringp);
}
mac_perim_exit(mph1);
}
static void
vnet_unbind_rings(vnet_res_t *vresp)
{
switch (vresp->type) {
case VIO_NET_RES_LDC_SERVICE:
case VIO_NET_RES_LDC_GUEST:
vnet_unbind_vgenring(vresp);
break;
case VIO_NET_RES_HYBRID:
vnet_unbind_hwrings(vresp->vnetp);
break;
default:
break;
}
}
static int
vnet_bind_rings(vnet_res_t *vresp)
{
int rv;
switch (vresp->type) {
case VIO_NET_RES_LDC_SERVICE:
case VIO_NET_RES_LDC_GUEST:
rv = vnet_bind_vgenring(vresp);
break;
case VIO_NET_RES_HYBRID:
rv = vnet_bind_hwrings(vresp->vnetp);
break;
default:
rv = 1;
break;
}
return (rv);
}
int
vnet_hio_stat(void *arg, uint_t stat, uint64_t *val)
{
vnet_t *vnetp = (vnet_t *)arg;
*val = mac_stat_get(vnetp->hio_mh, stat);
return (0);
}
static int
vnet_hio_start(void *arg)
{
return (0);
}
static void
vnet_hio_stop(void *arg)
{
}
mblk_t *
vnet_hio_tx(void *arg, mblk_t *mp)
{
vnet_pseudo_tx_ring_t *tx_ringp;
mblk_t *nextp;
mblk_t *ret_mp;
tx_ringp = (vnet_pseudo_tx_ring_t *)arg;
for (;;) {
nextp = mp->b_next;
mp->b_next = NULL;
ret_mp = mac_hwring_tx(tx_ringp->hw_rh, mp);
if (ret_mp != NULL) {
ret_mp->b_next = nextp;
mp = ret_mp;
break;
}
if ((mp = nextp) == NULL)
break;
}
return (mp);
}
#ifdef VNET_IOC_DEBUG
static void
vnet_m_ioctl(void *arg, queue_t *q, mblk_t *mp)
{
struct iocblk *iocp;
vnet_t *vnetp;
iocp = (struct iocblk *)(uintptr_t)mp->b_rptr;
iocp->ioc_error = 0;
vnetp = (vnet_t *)arg;
if (vnetp == NULL) {
miocnak(q, mp, 0, EINVAL);
return;
}
switch (iocp->ioc_cmd) {
case VNET_FORCE_LINK_DOWN:
case VNET_FORCE_LINK_UP:
vnet_force_link_state(vnetp, q, mp);
break;
default:
iocp->ioc_error = EINVAL;
miocnak(q, mp, 0, iocp->ioc_error);
break;
}
}
static void
vnet_force_link_state(vnet_t *vnetp, queue_t *q, mblk_t *mp)
{
mac_register_t *macp;
mac_callbacks_t *cbp;
vnet_res_t *vresp;
READ_ENTER(&vnetp->vsw_fp_rw);
vresp = vnetp->vsw_fp;
if (vresp == NULL) {
RW_EXIT(&vnetp->vsw_fp_rw);
return;
}
macp = &vresp->macreg;
cbp = macp->m_callbacks;
cbp->mc_ioctl(macp->m_driver, q, mp);
RW_EXIT(&vnetp->vsw_fp_rw);
}
#else
static void
vnet_m_ioctl(void *arg, queue_t *q, mblk_t *mp)
{
vnet_t *vnetp;
vnetp = (vnet_t *)arg;
if (vnetp == NULL) {
miocnak(q, mp, 0, EINVAL);
return;
}
miocnak(q, mp, 0, ENOTSUP);
}
#endif