#include "unm_nic.h"
static char transfer_speed_propname[] = "transfer-speed";
static char speed_propname[] = "speed";
static char duplex_propname[] = "full-duplex";
static const nd_param_t nd_template_10000[] = {
{ PARAM_AUTONEG_CAP, 0, 1, 1, "-autoneg_cap" },
{ PARAM_PAUSE_CAP, 0, 1, 1, "-pause_cap" },
{ PARAM_ASYM_PAUSE_CAP, 0, 1, 1, "-asym_pause_cap" },
{ PARAM_10000FDX_CAP, 0, 1, 1, "-10000fdx_cap" },
{ PARAM_1000FDX_CAP, 0, 1, 0, "-1000fdx_cap" },
{ PARAM_1000HDX_CAP, 0, 1, 0, "-1000hdx_cap" },
{ PARAM_100T4_CAP, 0, 1, 0, "-100T4_cap" },
{ PARAM_100FDX_CAP, 0, 1, 0, "-100fdx_cap" },
{ PARAM_100HDX_CAP, 0, 1, 0, "-100hdx_cap" },
{ PARAM_10FDX_CAP, 0, 1, 0, "-10fdx_cap" },
{ PARAM_10HDX_CAP, 0, 1, 0, "-10hdx_cap" },
{ PARAM_ADV_AUTONEG_CAP, 0, 1, 1, "-adv_autoneg_cap" },
{ PARAM_ADV_PAUSE_CAP, 0, 1, 1, "+adv_pause_cap" },
{ PARAM_ADV_ASYM_PAUSE_CAP, 0, 1, 1, "+adv_asym_pause_cap" },
{ PARAM_ADV_10000FDX_CAP, 0, 1, 1, "+adv_10000fdx_cap" },
{ PARAM_ADV_1000FDX_CAP, 0, 1, 0, "+adv_1000fdx_cap" },
{ PARAM_ADV_1000HDX_CAP, 0, 1, 0, "-adv_1000hdx_cap" },
{ PARAM_ADV_100T4_CAP, 0, 1, 0, "-adv_100T4_cap" },
{ PARAM_ADV_100FDX_CAP, 0, 1, 0, "+adv_100fdx_cap" },
{ PARAM_ADV_100HDX_CAP, 0, 1, 0, "+adv_100hdx_cap" },
{ PARAM_ADV_10FDX_CAP, 0, 1, 0, "+adv_10fdx_cap" },
{ PARAM_ADV_10HDX_CAP, 0, 1, 0, "+adv_10hdx_cap" },
{ PARAM_LINK_STATUS, 0, 1, 0, "-link_status" },
{ PARAM_LINK_SPEED, 0, 10000, 0, "-link_speed" },
{ PARAM_LINK_DUPLEX, 0, 2, 0, "-link_duplex" },
{ PARAM_LOOP_MODE, 0, 2, 0, "-loop_mode" },
{ PARAM_COUNT, 0, 0, 0, NULL }
};
static const nd_param_t nd_template_1000[] = {
{ PARAM_AUTONEG_CAP, 0, 1, 1, "-autoneg_cap" },
{ PARAM_PAUSE_CAP, 0, 1, 1, "-pause_cap" },
{ PARAM_ASYM_PAUSE_CAP, 0, 1, 1, "-asym_pause_cap" },
{ PARAM_1000FDX_CAP, 0, 1, 1, "-1000fdx_cap" },
{ PARAM_1000HDX_CAP, 0, 1, 0, "-1000hdx_cap" },
{ PARAM_100T4_CAP, 0, 1, 0, "-100T4_cap" },
{ PARAM_100FDX_CAP, 0, 1, 0, "-100fdx_cap" },
{ PARAM_100HDX_CAP, 0, 1, 0, "-100hdx_cap" },
{ PARAM_10FDX_CAP, 0, 1, 0, "-10fdx_cap" },
{ PARAM_10HDX_CAP, 0, 1, 0, "-10hdx_cap" },
{ PARAM_ADV_AUTONEG_CAP, 0, 1, 1, "-adv_autoneg_cap" },
{ PARAM_ADV_PAUSE_CAP, 0, 1, 1, "+adv_pause_cap" },
{ PARAM_ADV_ASYM_PAUSE_CAP, 0, 1, 1, "+adv_asym_pause_cap" },
{ PARAM_ADV_1000FDX_CAP, 0, 1, 1, "+adv_1000fdx_cap" },
{ PARAM_ADV_1000HDX_CAP, 0, 1, 0, "-adv_1000hdx_cap" },
{ PARAM_ADV_100T4_CAP, 0, 1, 0, "-adv_100T4_cap" },
{ PARAM_ADV_100FDX_CAP, 0, 1, 0, "+adv_100fdx_cap" },
{ PARAM_ADV_100HDX_CAP, 0, 1, 0, "+adv_100hdx_cap" },
{ PARAM_ADV_10FDX_CAP, 0, 1, 0, "+adv_10fdx_cap" },
{ PARAM_ADV_10HDX_CAP, 0, 1, 0, "+adv_10hdx_cap" },
{ PARAM_LINK_STATUS, 0, 1, 0, "-link_status" },
{ PARAM_LINK_SPEED, 0, 1000, 0, "-link_speed" },
{ PARAM_LINK_DUPLEX, 0, 2, 0, "-link_duplex" },
{ PARAM_LOOP_MODE, 0, 2, 0, "-loop_mode" },
{ PARAM_COUNT, 0, 0, 0, NULL }
};
static int
unm_param_get(queue_t *q, mblk_t *mp, caddr_t cp, cred_t *credp)
{
nd_param_t *ndp;
ndp = (nd_param_t *)(uintptr_t)cp;
(void) mi_mpprintf(mp, "%d", ndp->ndp_val);
return (0);
}
static int
unm_param_set(queue_t *q, mblk_t *mp, char *value, caddr_t cp, cred_t *credp)
{
nd_param_t *ndp;
int new_value;
char *end;
ndp = (nd_param_t *)(uintptr_t)cp;
new_value = mi_strtol(value, &end, 10);
if (end == value)
return (EINVAL);
if (new_value < ndp->ndp_min || new_value > ndp->ndp_max)
return (EINVAL);
ndp->ndp_val = new_value;
ndp->ndp_info += 1;
return (0);
}
static int
unm_param_register(unm_adapter *adapter)
{
const nd_param_t *tmplp;
dev_info_t *dip;
nd_param_t *ndp;
caddr_t *nddpp;
pfi_t setfn;
char *nm;
int pval;
dip = adapter->dip;
nddpp = &adapter->nd_data_p;
ASSERT(*nddpp == NULL);
if (adapter->ahw.board_type == UNM_NIC_XGBE)
tmplp = nd_template_10000;
else
tmplp = nd_template_1000;
for (; tmplp->ndp_name != NULL; ++tmplp) {
ndp = &adapter->nd_params[tmplp->ndp_info];
*ndp = *tmplp;
nm = &ndp->ndp_name[0];
setfn = unm_param_set;
switch (*nm) {
default:
case '!':
continue;
case '+':
break;
case '-':
setfn = NULL;
break;
}
if (!nd_load(nddpp, ++nm, unm_param_get, setfn, (caddr_t)ndp))
goto nd_fail;
if (setfn && UNM_PROP_EXISTS(dip, nm)) {
pval = UNM_PROP_GET_INT(dip, nm);
if (pval >= ndp->ndp_min && pval <= ndp->ndp_max)
ndp->ndp_val = pval;
}
}
DPRINTF(1, (CE_WARN, "unm_param_register: OK"));
return (DDI_SUCCESS);
nd_fail:
if (adapter->ahw.board_type == UNM_NIC_XGBE) {
cmn_err(CE_WARN,
"unm_param_register: FAILED at index %d [info %d]",
(int)(tmplp-nd_template_10000), tmplp->ndp_info);
} else {
cmn_err(CE_WARN,
"unm_param_register: FAILED at index %d [info %d]",
(int)(tmplp-nd_template_1000), tmplp->ndp_info);
}
nd_free(nddpp);
return (DDI_FAILURE);
}
int
unm_nd_init(unm_adapter *adapter)
{
dev_info_t *dip;
int duplex;
int speed;
if (unm_param_register(adapter) != DDI_SUCCESS)
return (-1);
dip = adapter->dip;
if (UNM_PROP_EXISTS(dip, transfer_speed_propname)) {
speed = UNM_PROP_GET_INT(dip, transfer_speed_propname);
switch (speed) {
case 10000:
adapter->param_adv_autoneg = 1;
adapter->param_adv_10000fdx = 1;
adapter->param_adv_1000fdx = 0;
adapter->param_adv_1000hdx = 0;
adapter->param_adv_100fdx = 0;
adapter->param_adv_100hdx = 0;
adapter->param_adv_10fdx = 0;
adapter->param_adv_10hdx = 0;
break;
case 1000:
adapter->param_adv_autoneg = 1;
adapter->param_adv_1000fdx = 1;
adapter->param_adv_1000hdx = 1;
adapter->param_adv_100fdx = 0;
adapter->param_adv_100hdx = 0;
adapter->param_adv_10fdx = 0;
adapter->param_adv_10hdx = 0;
break;
case 100:
adapter->param_adv_autoneg = 1;
adapter->param_adv_1000fdx = 0;
adapter->param_adv_1000hdx = 0;
adapter->param_adv_100fdx = 1;
adapter->param_adv_100hdx = 1;
adapter->param_adv_10fdx = 0;
adapter->param_adv_10hdx = 0;
break;
case 10:
adapter->param_adv_autoneg = 1;
adapter->param_adv_1000fdx = 0;
adapter->param_adv_1000hdx = 0;
adapter->param_adv_100fdx = 0;
adapter->param_adv_100hdx = 0;
adapter->param_adv_10fdx = 1;
adapter->param_adv_10hdx = 1;
break;
default:
break;
}
}
if (UNM_PROP_EXISTS(dip, speed_propname) ||
UNM_PROP_EXISTS(dip, duplex_propname)) {
adapter->param_adv_autoneg = 0;
adapter->param_adv_10000fdx = 1;
adapter->param_adv_1000fdx = 1;
adapter->param_adv_1000hdx = 1;
adapter->param_adv_100fdx = 1;
adapter->param_adv_100hdx = 1;
adapter->param_adv_10fdx = 1;
adapter->param_adv_10hdx = 1;
speed = UNM_PROP_GET_INT(dip, speed_propname);
duplex = UNM_PROP_GET_INT(dip, duplex_propname);
switch (speed) {
case 10000:
default:
adapter->param_adv_1000fdx = 0;
adapter->param_adv_1000hdx = 0;
adapter->param_adv_100fdx = 0;
adapter->param_adv_100hdx = 0;
adapter->param_adv_10fdx = 0;
adapter->param_adv_10hdx = 0;
break;
case 1000:
adapter->param_adv_10000fdx = 0;
adapter->param_adv_100fdx = 0;
adapter->param_adv_100hdx = 0;
adapter->param_adv_10fdx = 0;
adapter->param_adv_10hdx = 0;
break;
case 100:
adapter->param_adv_10000fdx = 0;
adapter->param_adv_1000fdx = 0;
adapter->param_adv_1000hdx = 0;
adapter->param_adv_10fdx = 0;
adapter->param_adv_10hdx = 0;
break;
case 10:
adapter->param_adv_10000fdx = 0;
adapter->param_adv_1000fdx = 0;
adapter->param_adv_1000hdx = 0;
adapter->param_adv_100fdx = 0;
adapter->param_adv_100hdx = 0;
break;
}
switch (duplex) {
default:
case 1:
adapter->param_adv_1000hdx = 0;
adapter->param_adv_100hdx = 0;
adapter->param_adv_10hdx = 0;
break;
case 0:
adapter->param_adv_10000fdx = 0;
adapter->param_adv_1000fdx = 0;
adapter->param_adv_100fdx = 0;
adapter->param_adv_10fdx = 0;
break;
}
}
DPRINTF(1, (CE_WARN, "unm_nd_init: autoneg %d"
"pause %d asym_pause %d "
"10000fdx %d "
"1000fdx %d 1000hdx %d "
"100fdx %d 100hdx %d "
"10fdx %d 10hdx %d ",
adapter->param_adv_autoneg,
adapter->param_adv_pause, adapter->param_adv_asym_pause,
adapter->param_adv_10000fdx,
adapter->param_adv_1000fdx, adapter->param_adv_1000hdx,
adapter->param_adv_100fdx, adapter->param_adv_100hdx,
adapter->param_adv_10fdx, adapter->param_adv_10hdx));
return (0);
}
enum ioc_reply
unm_nd_ioctl(unm_adapter *adapter, queue_t *wq, mblk_t *mp, struct iocblk *iocp)
{
boolean_t ok;
int cmd;
DPRINTF(1, (CE_WARN, "unm_nd_ioctl($%p, $%p, $%p, $%p)",
(void *)adapter, (void *)wq, (void *)mp, (void *)iocp));
cmd = iocp->ioc_cmd;
switch (cmd) {
default:
DPRINTF(-1, (CE_WARN, "unm_nd_ioctl: invalid cmd 0x%x", cmd));
return (IOC_INVAL);
case ND_GET:
ok = nd_getset(wq, adapter->nd_data_p, mp);
DPRINTF(1, (CE_WARN, "unm_nd_ioctl: get %s", ok ? "OK" :
"FAIL"));
return (ok ? IOC_REPLY : IOC_INVAL);
case ND_SET:
if (adapter->param_loop_mode != UNM_LOOP_NONE) {
iocp->ioc_error = EBUSY;
return (IOC_INVAL);
}
ok = nd_getset(wq, adapter->nd_data_p, mp);
DPRINTF(1, (CE_WARN,
"unm_nd_ioctl: set %s err %d autoneg %d info %d",
ok ? "OK" : "FAIL", iocp->ioc_error,
adapter->nd_params[PARAM_ADV_AUTONEG_CAP].ndp_val,
adapter->nd_params[PARAM_ADV_AUTONEG_CAP].ndp_info));
if (!ok)
return (IOC_INVAL);
if (iocp->ioc_error)
return (IOC_REPLY);
return (IOC_RESTART_REPLY);
}
}
void
unm_nd_cleanup(unm_adapter *adapter)
{
nd_free(&adapter->nd_data_p);
}