#include <sys/types.h>
#include <sys/errno.h>
#include <sys/modctl.h>
#include <sys/conf.h>
#include <sys/open.h>
#include <sys/stat.h>
#include <sys/pathname.h>
#include <sys/kmem.h>
#include <sys/debug.h>
#include <sys/pm.h>
#include <sys/ddi.h>
#include <sys/sunddi.h>
#include <sys/epm.h>
#include <sys/vfs.h>
#include <sys/mode.h>
#include <sys/mkdev.h>
#include <sys/promif.h>
#include <sys/consdev.h>
#include <sys/ddi_impldefs.h>
#include <sys/poll.h>
#include <sys/note.h>
#include <sys/taskq.h>
#include <sys/policy.h>
#include <sys/srn.h>
#define SRN_MINOR_TO_CLONE(minor) ((minor) & (SRN_MAX_CLONE - 1))
#define SU 0x002
#define SG 0x004
extern kmutex_t srn_clone_lock;
extern kcondvar_t srn_clones_cv[SRN_MAX_CLONE];
extern uint_t srn_poll_cnt[SRN_MAX_CLONE];
static struct srnstate {
dev_info_t *srn_dip;
int srn_instance;
uchar_t srn_clones[SRN_MAX_CLONE];
struct cred *srn_cred[SRN_MAX_CLONE];
int srn_type[SRN_MAX_CLONE];
int srn_delivered[SRN_MAX_CLONE];
srn_event_info_t srn_pending[SRN_MAX_CLONE];
int srn_fault[SRN_MAX_CLONE];
} srn = { NULL, -1};
typedef struct srnstate *srn_state_t;
kcondvar_t srn_clones_cv[SRN_MAX_CLONE];
uint_t srn_poll_cnt[SRN_MAX_CLONE];
int srn_apm_count;
int srn_autosx_count;
int srn_timeout = 10;
struct pollhead srn_pollhead[SRN_MAX_CLONE];
static int srn_open(dev_t *, int, int, cred_t *);
static int srn_close(dev_t, int, int, cred_t *);
static int srn_ioctl(dev_t, int, intptr_t, int, cred_t *, int *);
static int srn_chpoll(dev_t, short, int, short *, struct pollhead **);
static struct cb_ops srn_cb_ops = {
srn_open,
srn_close,
nodev,
nodev,
nodev,
nodev,
nodev,
srn_ioctl,
nodev,
nodev,
nodev,
srn_chpoll,
ddi_prop_op,
NULL,
D_NEW | D_MP
};
static int srn_getinfo(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg,
void **result);
static int srn_attach(dev_info_t *dip, ddi_attach_cmd_t cmd);
static int srn_detach(dev_info_t *dip, ddi_detach_cmd_t cmd);
static void srn_notify(int type, int event);
static struct dev_ops srn_ops = {
DEVO_REV,
0,
srn_getinfo,
nulldev,
nulldev,
srn_attach,
srn_detach,
nodev,
&srn_cb_ops,
NULL,
NULL,
ddi_quiesce_not_needed,
};
static struct modldrv modldrv = {
&mod_driverops,
"srn driver",
&srn_ops
};
static struct modlinkage modlinkage = {
MODREV_1, &modldrv, 0
};
int
_init(void)
{
return (mod_install(&modlinkage));
}
int
_fini(void)
{
return (mod_remove(&modlinkage));
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&modlinkage, modinfop));
}
static int
srn_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
int i;
extern void (*srn_signal)(int, int);
switch (cmd) {
case DDI_ATTACH:
if (srn.srn_instance != -1)
return (DDI_FAILURE);
srn.srn_instance = ddi_get_instance(dip);
if (ddi_create_minor_node(dip, "srn", S_IFCHR,
(srn.srn_instance << 8) + 0, DDI_PSEUDO, 0)
!= DDI_SUCCESS) {
return (DDI_FAILURE);
}
srn.srn_dip = dip;
for (i = 0; i < SRN_MAX_CLONE; i++)
cv_init(&srn_clones_cv[i], NULL, CV_DEFAULT, NULL);
srn.srn_instance = ddi_get_instance(dip);
mutex_enter(&srn_clone_lock);
srn_signal = srn_notify;
mutex_exit(&srn_clone_lock);
ddi_report_dev(dip);
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
}
static int
srn_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
int i;
extern int srn_inuse;
extern void (*srn_signal)(int, int);
switch (cmd) {
case DDI_DETACH:
mutex_enter(&srn_clone_lock);
while (srn_inuse) {
mutex_exit(&srn_clone_lock);
delay(1);
mutex_enter(&srn_clone_lock);
}
srn_signal = NULL;
mutex_exit(&srn_clone_lock);
for (i = 0; i < SRN_MAX_CLONE; i++)
cv_destroy(&srn_clones_cv[i]);
ddi_remove_minor_node(dip, NULL);
srn.srn_instance = -1;
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
}
#ifdef DEBUG
char *srn_cmd_string;
int srn_cmd;
#endif
static int
srn_perms(int perm, cred_t *cr)
{
if ((perm & SU) && secpolicy_power_mgmt(cr) == 0)
return (1);
if ((perm & SG) && (crgetgid(cr) == 0))
return (1);
return (0);
}
static int
srn_chpoll(dev_t dev, short events, int anyyet, short *reventsp,
struct pollhead **phpp)
{
extern struct pollhead srn_pollhead[];
int clone;
clone = SRN_MINOR_TO_CLONE(getminor(dev));
if ((events & (POLLIN | POLLRDNORM)) && srn_poll_cnt[clone]) {
*reventsp |= (POLLIN | POLLRDNORM);
} else {
*reventsp = 0;
}
if ((*reventsp == 0 && !anyyet) || (events & POLLET)) {
*phpp = &srn_pollhead[clone];
}
return (0);
}
static int
srn_getinfo(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg, void **result)
{
dev_t dev;
int instance;
switch (infocmd) {
case DDI_INFO_DEVT2DEVINFO:
if (srn.srn_instance == -1)
return (DDI_FAILURE);
*result = srn.srn_dip;
return (DDI_SUCCESS);
case DDI_INFO_DEVT2INSTANCE:
dev = (dev_t)arg;
instance = getminor(dev) >> 8;
*result = (void *)(uintptr_t)instance;
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
}
static int
srn_open(dev_t *devp, int flag, int otyp, cred_t *cr)
{
int clone;
if (otyp != OTYP_CHR)
return (EINVAL);
mutex_enter(&srn_clone_lock);
for (clone = 1; clone < SRN_MAX_CLONE - 1; clone++)
if (!srn.srn_clones[clone])
break;
if (clone == SRN_MAX_CLONE) {
mutex_exit(&srn_clone_lock);
return (ENXIO);
}
srn.srn_cred[clone] = cr;
ASSERT(srn_apm_count >= 0);
srn_apm_count++;
srn.srn_type[clone] = SRN_TYPE_APM;
crhold(cr);
*devp = makedevice(getmajor(*devp), (srn.srn_instance << 8) +
clone);
srn.srn_clones[clone] = 1;
srn.srn_cred[clone] = cr;
crhold(cr);
mutex_exit(&srn_clone_lock);
PMD(PMD_SX, ("srn open OK\n"))
return (0);
}
static int
srn_close(dev_t dev, int flag, int otyp, cred_t *cr)
{
int clone;
if (otyp != OTYP_CHR)
return (EINVAL);
clone = SRN_MINOR_TO_CLONE(getminor(dev));
PMD(PMD_SX, ("srn_close: minor %x, clone %x\n", getminor(dev),
clone))
mutex_enter(&srn_clone_lock);
crfree(srn.srn_cred[clone]);
srn.srn_cred[clone] = 0;
srn_poll_cnt[clone] = 0;
srn.srn_fault[clone] = 0;
if (srn.srn_pending[clone].ae_type || srn.srn_delivered[clone]) {
srn.srn_pending[clone].ae_type = 0;
srn.srn_delivered[clone] = 0;
cv_signal(&srn_clones_cv[clone]);
}
switch (srn.srn_type[clone]) {
case SRN_TYPE_AUTOSX:
ASSERT(srn_autosx_count);
srn_autosx_count--;
break;
case SRN_TYPE_APM:
ASSERT(srn_apm_count);
srn_apm_count--;
break;
default:
ASSERT(0);
return (EINVAL);
}
srn.srn_clones[clone] = 0;
mutex_exit(&srn_clone_lock);
return (0);
}
static int
srn_ioctl(dev_t dev, int cmd, intptr_t arg, int mode, cred_t *cr, int *rval_p)
{
int clone = SRN_MINOR_TO_CLONE(getminor(dev));
PMD(PMD_SX, ("ioctl: %x: begin\n", cmd))
switch (cmd) {
case SRN_IOC_NEXTEVENT:
case SRN_IOC_SUSPEND:
case SRN_IOC_RESUME:
case SRN_IOC_AUTOSX:
break;
default:
return (ENOTTY);
}
if (!srn_perms(SU | SG, srn.srn_cred[clone])) {
return (EPERM);
}
switch (cmd) {
case SRN_IOC_AUTOSX:
PMD(PMD_SX, ("SRN_IOC_AUTOSX entered\n"))
mutex_enter(&srn_clone_lock);
if (!srn.srn_clones[clone]) {
PMD(PMD_SX, (" ioctl !srn_clones--EINVAL\n"))
mutex_exit(&srn_clone_lock);
return (EINVAL);
}
if (srn.srn_pending[clone].ae_type) {
PMD(PMD_SX, ("AUTOSX while pending--EBUSY\n"))
mutex_exit(&srn_clone_lock);
return (EBUSY);
}
if (srn.srn_type[clone] == SRN_TYPE_AUTOSX) {
PMD(PMD_SX, ("AUTOSX already--EBUSY\n"))
mutex_exit(&srn_clone_lock);
return (EBUSY);
}
ASSERT(srn.srn_type[clone] == SRN_TYPE_APM);
srn.srn_type[clone] = SRN_TYPE_AUTOSX;
srn.srn_fault[clone] = 0;
srn_apm_count--;
ASSERT(srn_apm_count >= 0);
ASSERT(srn_autosx_count >= 0);
srn_autosx_count++;
mutex_exit(&srn_clone_lock);
PMD(PMD_SX, ("SRN_IOC_AUTOSX returns success\n"))
return (0);
case SRN_IOC_NEXTEVENT:
PMD(PMD_SX, ("SRN_IOC_NEXTEVENT entered\n"))
if (srn.srn_fault[clone]) {
PMD(PMD_SX, ("SRN_IOC_NEXTEVENT clone %d fault "
"cleared\n", clone))
srn.srn_fault[clone] = 0;
}
mutex_enter(&srn_clone_lock);
if (srn_poll_cnt[clone] == 0) {
mutex_exit(&srn_clone_lock);
PMD(PMD_SX, ("SRN_IOC_NEXTEVENT clone %d "
"EWOULDBLOCK\n", clone))
return (EWOULDBLOCK);
}
ASSERT(srn.srn_pending[clone].ae_type);
if (ddi_copyout(&srn.srn_pending[clone], (void *)arg,
sizeof (srn_event_info_t), mode) != 0) {
mutex_exit(&srn_clone_lock);
PMD(PMD_SX, ("SRN_IOC_NEXTEVENT clone %d EFAULT\n",
clone))
return (EFAULT);
}
if (srn.srn_type[clone] == SRN_TYPE_APM)
srn.srn_delivered[clone] =
srn.srn_pending[clone].ae_type;
PMD(PMD_SX, ("SRN_IOC_NEXTEVENT clone %d delivered %x\n",
clone, srn.srn_pending[clone].ae_type))
srn_poll_cnt[clone] = 0;
mutex_exit(&srn_clone_lock);
return (0);
case SRN_IOC_SUSPEND:
PMD(PMD_SX, ("SRN_IOC_SUSPEND entered clone %d\n", clone))
if (srn.srn_fault[clone]) {
PMD(PMD_SX, ("SRN_IOC_SUSPEND clone %d fault "
"cleared\n", clone))
srn.srn_fault[clone] = 0;
}
mutex_enter(&srn_clone_lock);
if (srn.srn_delivered[clone] != SRN_SUSPEND_REQ) {
mutex_exit(&srn_clone_lock);
PMD(PMD_SX, ("SRN_IOC_SUSPEND EINVAL\n"))
return (EINVAL);
}
srn.srn_delivered[clone] = 0;
srn.srn_pending[clone].ae_type = 0;
PMD(PMD_SX, ("SRN_IOC_SUSPEND clone %d ok\n", clone))
cv_signal(&srn_clones_cv[clone]);
mutex_exit(&srn_clone_lock);
return (0);
case SRN_IOC_RESUME:
PMD(PMD_SX, ("SRN_IOC_RESUME entered clone %d\n", clone))
if (srn.srn_fault[clone]) {
PMD(PMD_SX, ("SRN_IOC_RESUME clone %d fault "
"cleared\n", clone))
srn.srn_fault[clone] = 0;
}
mutex_enter(&srn_clone_lock);
if (srn.srn_delivered[clone] != SRN_NORMAL_RESUME) {
mutex_exit(&srn_clone_lock);
PMD(PMD_SX, ("SRN_IOC_RESUME EINVAL\n"))
return (EINVAL);
}
srn.srn_delivered[clone] = 0;
srn.srn_pending[clone].ae_type = 0;
PMD(PMD_SX, ("SRN_IOC_RESUME ok for clone %d\n", clone))
cv_signal(&srn_clones_cv[clone]);
mutex_exit(&srn_clone_lock);
return (0);
default:
PMD(PMD_SX, ("srn_ioctl unknown cmd EINVAL\n"))
return (EINVAL);
}
}
void
srn_notify(int type, int event)
{
int clone, count;
PMD(PMD_SX, ("srn_notify entered with type %d, event 0x%x\n",
type, event));
ASSERT(mutex_owned(&srn_clone_lock));
switch (type) {
case SRN_TYPE_APM:
if (srn_apm_count == 0) {
PMD(PMD_SX, ("no apm types\n"))
return;
}
count = srn_apm_count;
break;
case SRN_TYPE_AUTOSX:
if (srn_autosx_count == 0) {
PMD(PMD_SX, ("no autosx types\n"))
return;
}
count = srn_autosx_count;
break;
default:
PMD(PMD_SX, ("unsupported type\n"))
return;
}
ASSERT(count > 0);
PMD(PMD_SX, ("count %d\n", count))
for (clone = 0; clone < SRN_MAX_CLONE; clone++) {
if (srn.srn_type[clone] == type) {
#ifdef DEBUG
if (type == SRN_TYPE_APM && !srn.srn_fault[clone]) {
ASSERT(srn.srn_pending[clone].ae_type == 0);
ASSERT(srn_poll_cnt[clone] == 0);
ASSERT(srn.srn_delivered[clone] == 0);
}
#endif
srn.srn_pending[clone].ae_type = event;
srn_poll_cnt[clone] = 1;
PMD(PMD_SX, ("pollwake %d\n", clone))
pollwakeup(&srn_pollhead[clone], (POLLRDNORM | POLLIN));
count--;
if (count == 0)
break;
}
}
if (type == SRN_TYPE_AUTOSX) {
PMD(PMD_SX, ("Not waiting for AUTOSX ack\n"))
return;
}
ASSERT(type == SRN_TYPE_APM);
restart:
for (clone = 1; clone < SRN_MAX_CLONE; clone++) {
if (srn.srn_clones[clone] == 0 ||
srn.srn_type[clone] != SRN_TYPE_APM)
continue;
if (srn.srn_pending[clone].ae_type && !srn.srn_fault[clone]) {
PMD(PMD_SX, ("srn_notify waiting for ack for clone %d, "
"event %x\n", clone, event))
if (cv_timedwait(&srn_clones_cv[clone],
&srn_clone_lock, ddi_get_lbolt() +
drv_usectohz(srn_timeout * 1000000)) == -1) {
PMD(PMD_SX, ("srn_notify: clone %d did not "
"ack event %x\n", clone, event))
cmn_err(CE_WARN, "srn_notify: clone %d did "
"not ack event %x\n", clone, event);
srn.srn_fault[clone] = 1;
}
goto restart;
}
}
PMD(PMD_SX, ("srn_notify done with %x\n", event))
}