#include <sys/types.h>
#include <sys/conf.h>
#include <sys/beep.h>
#include <sys/ksynch.h>
#include <sys/ddi.h>
#include <sys/sunddi.h>
#include <sys/modctl.h>
#include <sys/pit.h>
#include <sys/inttypes.h>
#define PIT_BEEP_UNIT(dev) (getminor((dev)))
typedef struct pit_beep_state {
dev_info_t *dip;
} pit_beep_state_t;
#define PIT_BEEP_ON 1
#define PIT_BEEP_OFF 0
static void *pit_beep_statep;
static int pit_beep_attach(dev_info_t *dip, ddi_attach_cmd_t cmd);
static int pit_beep_detach(dev_info_t *dip, ddi_detach_cmd_t cmd);
static int pit_beep_info(dev_info_t *dip, ddi_info_cmd_t infocmd,
void *arg, void **result);
static void pit_beep_freq(void *arg, int freq);
static void pit_beep_on(void *arg);
static void pit_beep_off(void *arg);
struct cb_ops pit_beep_cb_ops = {
nulldev,
nulldev,
nulldev,
nulldev,
nulldev,
nulldev,
nulldev,
nulldev,
nulldev,
nulldev,
nulldev,
nochpoll,
ddi_prop_op,
NULL,
D_MP | D_NEW
};
static struct dev_ops pit_beep_ops = {
DEVO_REV,
0,
pit_beep_info,
nulldev,
nulldev,
pit_beep_attach,
pit_beep_detach,
nodev,
&pit_beep_cb_ops,
0,
NULL,
ddi_quiesce_not_needed,
};
static struct modldrv modldrv = {
&mod_driverops,
"Intel Pit_beep Driver",
&pit_beep_ops,
};
static struct modlinkage modlinkage = {
MODREV_1, (void *)&modldrv, NULL
};
int
_init(void)
{
int error;
if ((error = ddi_soft_state_init(&pit_beep_statep,
sizeof (pit_beep_state_t), 1)) != 0) {
return (error);
}
if ((error = mod_install(&modlinkage)) != 0) {
ddi_soft_state_fini(&pit_beep_statep);
}
return (error);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&modlinkage, modinfop));
}
int
_fini(void)
{
int error;
error = mod_remove(&modlinkage);
if (error == 0) {
ddi_soft_state_fini(&pit_beep_statep);
}
return (error);
}
static int
pit_beep_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
switch (cmd) {
case DDI_ATTACH:
break;
case DDI_RESUME:
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
pit_beep_off(dip);
(void) beep_init((void *)dip, pit_beep_on, pit_beep_off,
pit_beep_freq);
ddi_report_dev(dip);
return (DDI_SUCCESS);
}
static int
pit_beep_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
switch (cmd) {
case DDI_SUSPEND:
if (!beep_busy()) {
return (DDI_SUCCESS);
} else {
return (DDI_FAILURE);
}
default:
return (DDI_FAILURE);
}
}
static int
pit_beep_info(dev_info_t *dip, ddi_info_cmd_t infocmd,
void *arg, void **result)
{
dev_t dev;
pit_beep_state_t *statep;
int instance, error;
switch (infocmd) {
case DDI_INFO_DEVT2DEVINFO:
dev = (dev_t)arg;
instance = PIT_BEEP_UNIT(dev);
if ((statep = ddi_get_soft_state(pit_beep_statep,
instance)) == NULL) {
return (DDI_FAILURE);
}
*result = (void *)statep->dip;
error = DDI_SUCCESS;
break;
case DDI_INFO_DEVT2INSTANCE:
dev = (dev_t)arg;
instance = PIT_BEEP_UNIT(dev);
*result = (void *)(uintptr_t)instance;
error = DDI_SUCCESS;
break;
default:
error = DDI_FAILURE;
}
return (error);
}
static void
pit_beep_freq(void *arg, int freq)
{
int counter;
if (freq == 0)
counter = 0;
else {
counter = PIT_HZ / freq;
if (counter > UINT16_MAX)
counter = UINT16_MAX;
else if (counter < 1)
counter = 1;
}
outb(PITCTL_PORT, PIT_C2 | PIT_READMODE | PIT_RATEMODE);
outb(PITCTR2_PORT, counter & 0xff);
outb(PITCTR2_PORT, counter >> 8);
}
static void
pit_beep_on(void *arg)
{
outb(PITAUX_PORT, inb(PITAUX_PORT) | (PITAUX_OUT2 | PITAUX_GATE2));
}
static void
pit_beep_off(void *arg)
{
outb(PITAUX_PORT, inb(PITAUX_PORT) & ~(PITAUX_OUT2 | PITAUX_GATE2));
}