#include <sys/types.h>
#include <sys/conf.h>
#include <sys/ddi.h>
#include <sys/sunddi.h>
#include <sys/modctl.h>
static int spm_attach(dev_info_t *, ddi_attach_cmd_t);
static int spm_detach(dev_info_t *, ddi_detach_cmd_t);
struct spm_soft_state {
dev_info_t *dip;
};
static struct dev_ops spm_ops = {
DEVO_REV,
0,
nodev,
nulldev,
nulldev,
spm_attach,
spm_detach,
nodev,
(struct cb_ops *)0,
(struct bus_ops *)0,
NULL,
ddi_quiesce_not_supported,
};
static void *spm_state;
static int spm_inst = -1;
static struct modldrv modldrv = {
&mod_driverops,
"schizo pm driver",
&spm_ops,
};
static struct modlinkage modlinkage = {
MODREV_1,
(void *)&modldrv,
NULL
};
#define SCHIZO_SAFARI_ECLK_32 0x20ULL
#define SCHIZO_SAFARI_ECLK_2 0x2ULL
#define SCHIZO_SAFARI_ECLK_1 0x1ULL
#define SCHIZO_SAFARI_ECLK_MASK (SCHIZO_SAFARI_ECLK_32 | \
SCHIZO_SAFARI_ECLK_2 | SCHIZO_SAFARI_ECLK_1)
static const uint64_t schizo_safari_masks[] = {
SCHIZO_SAFARI_ECLK_32,
SCHIZO_SAFARI_ECLK_2,
SCHIZO_SAFARI_ECLK_1
};
static volatile uint64_t *spm_schizo_csr;
ddi_acc_handle_t spm_schizo_handle;
int
_init(void)
{
int error;
if ((error = ddi_soft_state_init(&spm_state,
sizeof (struct spm_soft_state), 0)) != 0)
return (error);
if ((error = mod_install(&modlinkage)) != 0)
ddi_soft_state_fini(&spm_state);
return (error);
}
int
_fini(void)
{
int error;
if ((error = mod_remove(&modlinkage)) == 0)
ddi_soft_state_fini(&spm_state);
return (error);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&modlinkage, modinfop));
}
static int
spm_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
int rv;
struct spm_soft_state *softsp;
ddi_device_acc_attr_t attr;
switch (cmd) {
case DDI_ATTACH:
if (spm_inst != -1) {
cmn_err(CE_WARN, "spm_attach: "
"only one instance is allowed.");
return (DDI_FAILURE);
}
break;
case DDI_RESUME:
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
spm_inst = ddi_get_instance(dip);
if (ddi_soft_state_zalloc(spm_state, spm_inst) != DDI_SUCCESS) {
cmn_err(CE_WARN, "spm_attach: can't allocate state.");
return (DDI_FAILURE);
}
if ((softsp = ddi_get_soft_state(spm_state, spm_inst)) == NULL) {
cmn_err(CE_WARN, "spm_attach: can't get state.");
return (DDI_FAILURE);
}
softsp->dip = dip;
attr.devacc_attr_version = DDI_DEVICE_ATTR_V0;
attr.devacc_attr_endian_flags = DDI_NEVERSWAP_ACC;
attr.devacc_attr_dataorder = DDI_STRICTORDER_ACC;
rv = ddi_regs_map_setup(dip, 0,
(caddr_t *)&spm_schizo_csr, 0, 8, &attr, &spm_schizo_handle);
if (rv != DDI_SUCCESS) {
cmn_err(CE_WARN, "spm_attach: can't map the register.");
ddi_soft_state_free(spm_state, spm_inst);
return (rv);
}
ddi_report_dev(dip);
return (DDI_SUCCESS);
}
static int
spm_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
switch (cmd) {
case DDI_SUSPEND:
return (DDI_SUCCESS);
case DDI_DETACH:
return (DDI_FAILURE);
default:
return (DDI_FAILURE);
}
}
void
spm_change_schizo_speed(int lvl_index)
{
uint64_t contents;
ASSERT(lvl_index >= 0 && lvl_index <= 2);
contents = ddi_get64(spm_schizo_handle, (uint64_t *)spm_schizo_csr);
contents &= ~SCHIZO_SAFARI_ECLK_MASK;
contents |= schizo_safari_masks[ lvl_index ];
ddi_put64(spm_schizo_handle, (uint64_t *)spm_schizo_csr, contents);
}