#include <sys/types.h>
#include <sys/ddi.h>
#include <sys/modctl.h>
#include <sys/hsvc.h>
#include <n2piupc_tables.h>
#include <n2piupc.h>
#ifdef DEBUG
int n2piupc_debug = 0;
#endif
void *n2piupc_state_p;
static int n2piupc_attach(dev_info_t *dip, ddi_attach_cmd_t cmd);
static int n2piupc_detach(dev_info_t *dip, ddi_detach_cmd_t cmd);
#define N2PIUPC_REQ_MAJOR_VER 1
#define N2PIUPC_REQ_MINOR_VER 0
static hsvc_info_t n2piupc_hsvc = {
HSVC_REV_1,
NULL,
N2PIU_PERF_COUNTER_GROUP_ID,
N2PIUPC_REQ_MAJOR_VER,
N2PIUPC_REQ_MINOR_VER,
MODULE_NAME
};
static uint64_t n2piupc_sup_minor;
static struct dev_ops n2piupc_ops = {
DEVO_REV,
0,
nulldev,
nulldev,
nulldev,
n2piupc_attach,
n2piupc_detach,
nodev,
NULL,
NULL,
nodev,
ddi_quiesce_not_needed,
};
extern struct mod_ops mod_driverops;
static struct modldrv md = {
&mod_driverops,
"N2 PIU Perf Counter",
&n2piupc_ops,
};
static struct modlinkage ml = {
MODREV_1,
(void *)&md,
NULL
};
int
_init(void)
{
int rval;
if ((rval = hsvc_register(&n2piupc_hsvc, &n2piupc_sup_minor)) !=
DDI_SUCCESS) {
N2PIUPC_DBG1("%s: Could not hsvc_register: %d\n",
MODULE_NAME, rval);
goto bad_hv_register;
}
if ((rval = ddi_soft_state_init(&n2piupc_state_p,
sizeof (n2piupc_t), 1)) != DDI_SUCCESS)
goto bad_softstate_init;
if ((rval = n2piupc_kstat_init()) != DDI_SUCCESS)
goto bad_kstat_init;
if ((rval = mod_install(&ml)) == DDI_SUCCESS)
return (DDI_SUCCESS);
bad_mod_install:
n2piupc_kstat_fini();
bad_kstat_init:
ddi_soft_state_fini(&n2piupc_state_p);
bad_softstate_init:
(void) hsvc_unregister(&n2piupc_hsvc);
bad_hv_register:
return (rval);
}
int
_fini(void)
{
int rval;
rval = mod_remove(&ml);
if (rval != DDI_SUCCESS)
return (rval);
n2piupc_kstat_fini();
ddi_soft_state_fini(&n2piupc_state_p);
(void) hsvc_unregister(&n2piupc_hsvc);
return (rval);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&ml, modinfop));
}
static int
n2piupc_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
n2piupc_t *n2piupc_p;
uint32_t regprop[4];
int len;
int instance = ddi_get_instance(dip);
switch (cmd) {
case DDI_RESUME:
case DDI_ATTACH:
if (ddi_soft_state_zalloc(n2piupc_state_p, instance) !=
DDI_SUCCESS) {
cmn_err(CE_WARN, "%s%d: Can't allocate softstate.\n",
NAMEINST(dip));
goto bad_softstate;
}
n2piupc_p = (n2piupc_t *)ddi_get_soft_state(n2piupc_state_p,
instance);
n2piupc_p->n2piupc_dip = dip;
len = sizeof (regprop);
if (ddi_getlongprop_buf(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS,
"reg", (caddr_t)regprop, &len) != DDI_SUCCESS) {
cmn_err(CE_WARN,
"%s%d: Cannot get reg property\n",
NAMEINST(dip));
goto bad_handle;
}
n2piupc_p->n2piupc_handle = regprop[0] & 0xfffffff;
if (n2piupc_kstat_attach(n2piupc_p) != DDI_SUCCESS)
goto bad_kstat_attach;
return (DDI_SUCCESS);
bad_kstat_attach:
bad_handle:
(void) ddi_soft_state_free(n2piupc_state_p, instance);
bad_softstate:
return (DDI_FAILURE);
default:
return (DDI_FAILURE);
}
}
static int
n2piupc_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
int instance = ddi_get_instance(dip);
n2piupc_t *n2piupc_p = (n2piupc_t *)ddi_get_soft_state(
n2piupc_state_p, instance);
switch (cmd) {
case DDI_SUSPEND:
case DDI_DETACH:
n2piupc_kstat_detach(n2piupc_p);
(void) ddi_soft_state_free(n2piupc_state_p, instance);
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
}