#include <sys/types.h>
#include <sys/ddi.h>
#include <sys/inline.h>
#include <sys/conf.h>
#include <sys/sunddi.h>
#include <sys/sunndi.h>
#include <sys/i8042.h>
#include <sys/kmem.h>
#include <sys/promif.h>
#include <sys/note.h>
#ifdef __sparc
#define USE_SOFT_INTRS
#else
#undef USE_SOFT_INTRS
#endif
#if defined(__sparc)
#define I8042_CMD_DISABLE_ALL 0x34
#define I8042_CMD_ENABLE_ALL 0x07
#elif defined(__x86)
#define I8042_CMD_DISABLE_ALL 0x74
#define I8042_CMD_ENABLE_ALL 0x47
#endif
#define BUFSIZ 64
#define I8042_KEYBOARD 2
#define I8042_MOUSE 1
enum i8042_ports {
MAIN_PORT = 0,
AUX_PORT
};
#define NUM_PORTS 2
#define MAX_INTERRUPTS 2
struct i8042_port {
boolean_t initialized;
dev_info_t *dip;
int inumber;
enum i8042_ports which;
#if defined(USE_SOFT_INTRS)
ddi_softint_handle_t soft_hdl;
boolean_t soft_intr_enabled;
#else
kmutex_t intr_mutex;
#endif
uint_t (*intr_func)(caddr_t arg1, caddr_t arg2);
caddr_t intr_arg1;
caddr_t intr_arg2;
struct i8042 *i8042_global;
int wptr;
int rptr;
int overruns;
unsigned char buf[BUFSIZ];
volatile boolean_t has_glock;
};
struct i8042 {
dev_info_t *dip;
struct i8042_port i8042_ports[NUM_PORTS];
kmutex_t i8042_mutex;
kmutex_t i8042_out_mutex;
boolean_t initialized;
ddi_acc_handle_t io_handle;
uint8_t *io_addr;
int nintrs;
ddi_iblock_cookie_t *iblock_cookies;
uint_t init_state;
#define I8042_INIT_BASIC 0x00000001
#define I8042_INIT_REGS_MAPPED 0x00000002
#define I8042_INIT_MUTEXES 0x00000004
#define I8042_INIT_INTRS_ENABLED 0x00000010
uint_t intrs_added;
#ifdef __sparc
timeout_id_t timeout_id;
#endif
volatile int glock;
kcondvar_t glock_cv;
};
#define I8042_DATA 0x00
#define I8042_STAT 0x04
#define I8042_CMD 0x04
#define I8042_STAT_OUTBF 0x01
#define I8042_STAT_INBF 0x02
#define I8042_STAT_AUXBF 0x20
#define I8042_CMD_RCB 0x20
#define I8042_CMD_WCB 0x60
#define I8042_CMD_WRITE_AUX 0xD4
#define MAX_JUNK_ITERATIONS 1000
#define MAX_WAIT_ITERATIONS 25000
#define USECS_PER_WAIT 10
#ifdef __sparc
#define PLATFORM_MATCH(s) (strncmp(ddi_get_name(ddi_root_node()), \
(s), strlen(s)) == 0)
#define I8042_MIN_POLL_INTERVAL 1000
int i8042_poll_interval = 8000;
int i8042_fast_poll_interval;
int i8042_slow_poll_interval;
boolean_t i8042_polled_mode = B_FALSE;
boolean_t i8042_force_interrupt_mode = B_FALSE;
#endif
int max_wait_iterations = MAX_WAIT_ITERATIONS;
#ifdef DEBUG
int i8042_debug = 0;
#endif
static int i8042_map(dev_info_t *dip, dev_info_t *rdip, ddi_map_req_t *mp,
off_t offset, off_t len, caddr_t *addrp);
static int i8042_ctlops(dev_info_t *dip, dev_info_t *rdip,
ddi_ctl_enum_t op, void *arg, void *result);
static int i8042_attach(dev_info_t *dip, ddi_attach_cmd_t cmd);
static int i8042_detach(dev_info_t *dip, ddi_detach_cmd_t cmd);
static int i8042_intr_ops(dev_info_t *dip, dev_info_t *rdip,
ddi_intr_op_t intr_op, ddi_intr_handle_impl_t *hdlp, void *result);
static int i8042_bus_config(dev_info_t *, uint_t, ddi_bus_config_op_t,
void *, dev_info_t **);
static int i8042_bus_unconfig(dev_info_t *, uint_t,
ddi_bus_config_op_t, void *);
#ifdef __sparc
static int i8042_build_interrupts_property(dev_info_t *dip);
static boolean_t i8042_is_polling_platform(void);
#endif
static struct bus_ops i8042_bus_ops = {
BUSO_REV,
i8042_map,
NULL,
NULL,
NULL,
NULL,
NULL,
NULL,
NULL,
NULL,
NULL,
NULL,
NULL,
NULL,
i8042_ctlops,
ddi_bus_prop_op,
NULL,
NULL,
NULL,
NULL,
NULL,
i8042_bus_config,
i8042_bus_unconfig,
NULL,
NULL,
NULL,
NULL,
NULL,
i8042_intr_ops
};
static struct dev_ops i8042_ops = {
DEVO_REV,
0,
ddi_no_info,
nulldev,
0,
i8042_attach,
i8042_detach,
nodev,
(struct cb_ops *)0,
&i8042_bus_ops,
NULL,
ddi_quiesce_not_needed,
};
#include <sys/modctl.h>
extern struct mod_ops mod_driverops;
static struct modldrv modldrv = {
&mod_driverops,
"i8042 nexus driver",
&i8042_ops,
};
static struct modlinkage modlinkage = {
MODREV_1, (void *)&modldrv, NULL
};
int
_init(void)
{
int e;
e = mod_install(&modlinkage);
return (e);
}
int
_fini(void)
{
int e;
e = mod_remove(&modlinkage);
if (e != 0)
return (e);
return (e);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&modlinkage, modinfop));
}
#define DRIVER_NAME(dip) ddi_driver_name(dip)
static void i8042_timeout(void *arg);
static unsigned int i8042_intr(caddr_t arg);
static void i8042_write_command_byte(struct i8042 *, unsigned char);
static uint8_t i8042_get8(ddi_acc_impl_t *handlep, uint8_t *addr);
static void i8042_put8(ddi_acc_impl_t *handlep, uint8_t *addr,
uint8_t value);
static void i8042_send(struct i8042 *global, int reg, unsigned char cmd);
static uint8_t i8042_get8(ddi_acc_impl_t *handlep, uint8_t *addr);
unsigned int i8042_unclaimed_interrupts = 0;
static void
i8042_discard_junk_data(struct i8042 *global)
{
for (;;) {
unsigned char stat;
stat = ddi_get8(global->io_handle,
global->io_addr + I8042_STAT);
if (! (stat & I8042_STAT_OUTBF))
break;
(void) ddi_get8(global->io_handle,
global->io_addr + I8042_DATA);
}
}
static int
i8042_cleanup(struct i8042 *global)
{
int which_port, i;
struct i8042_port *port;
ASSERT(global != NULL);
if (global->initialized == B_TRUE) {
mutex_enter(&global->i8042_mutex);
for (which_port = 0; which_port < NUM_PORTS; which_port++) {
port = &global->i8042_ports[which_port];
if (port->initialized == B_TRUE) {
mutex_exit(&global->i8042_mutex);
return (DDI_FAILURE);
}
#if defined(USE_SOFT_INTRS)
if (port->soft_hdl != 0) {
mutex_exit(&global->i8042_mutex);
return (DDI_FAILURE);
}
#else
mutex_enter(&port->intr_mutex);
if (port->intr_func != NULL) {
mutex_exit(&port->intr_mutex);
mutex_exit(&global->i8042_mutex);
return (DDI_FAILURE);
}
mutex_exit(&port->intr_mutex);
#endif
}
global->initialized = B_FALSE;
mutex_exit(&global->i8042_mutex);
}
#ifdef __sparc
if (global->timeout_id != 0) {
(void) untimeout(global->timeout_id);
}
#endif
if (global->init_state & I8042_INIT_INTRS_ENABLED)
i8042_write_command_byte(global, I8042_CMD_DISABLE_ALL);
if (global->intrs_added) {
for (i = global->nintrs - 1; i >= 0; i--) {
if (global->intrs_added & (1 << i))
ddi_remove_intr(global->dip, i,
global->iblock_cookies[i]);
}
}
if (global->init_state & I8042_INIT_MUTEXES) {
for (which_port = 0; which_port < NUM_PORTS; which_port++) {
#ifndef USE_SOFT_INTRS
port = &global->i8042_ports[which_port];
mutex_destroy(&port->intr_mutex);
#endif
}
cv_destroy(&global->glock_cv);
mutex_destroy(&global->i8042_out_mutex);
mutex_destroy(&global->i8042_mutex);
}
if (global->init_state & I8042_INIT_REGS_MAPPED)
ddi_regs_map_free(&global->io_handle);
if (global->init_state & I8042_INIT_BASIC) {
ddi_set_driver_private(global->dip, (caddr_t)NULL);
if (global->nintrs > 0) {
kmem_free(global->iblock_cookies, global->nintrs *
sizeof (ddi_iblock_cookie_t));
}
kmem_free(global, sizeof (struct i8042));
}
return (DDI_SUCCESS);
}
#define OBF_WAIT_COUNT 1000
static int
i8042_wait_obf(struct i8042 *global)
{
int timer = 0;
while (!(ddi_get8(global->io_handle, global->io_addr + I8042_STAT) &
I8042_STAT_OUTBF)) {
if (++timer > OBF_WAIT_COUNT)
return (1);
drv_usecwait(10);
}
return (0);
}
static int
i8042_purge_outbuf(struct i8042 *global)
{
int i;
for (i = 0; i < MAX_JUNK_ITERATIONS; i++) {
if (i8042_wait_obf(global))
break;
(void) ddi_get8(global->io_handle,
global->io_addr + I8042_DATA);
}
return (i == MAX_JUNK_ITERATIONS);
}
static int
i8042_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
struct i8042_port *port;
enum i8042_ports which_port;
int i;
#if !defined(USE_SOFT_INTRS)
ddi_iblock_cookie_t cookie;
#endif
static ddi_device_acc_attr_t attr = {
DDI_DEVICE_ATTR_V0,
DDI_NEVERSWAP_ACC,
DDI_STRICTORDER_ACC,
};
struct i8042 *global;
#ifdef __sparc
int interval;
#endif
switch (cmd) {
case DDI_RESUME:
global = (struct i8042 *)ddi_get_driver_private(dip);
i8042_discard_junk_data(global);
i8042_write_command_byte(global, I8042_CMD_ENABLE_ALL);
return (DDI_SUCCESS);
case DDI_ATTACH:
break;
default:
return (DDI_FAILURE);
}
global = (struct i8042 *)kmem_zalloc(sizeof (struct i8042), KM_SLEEP);
ddi_set_driver_private(dip, (caddr_t)global);
global->dip = dip;
global->initialized = B_FALSE;
global->init_state |= I8042_INIT_BASIC;
if (ddi_regs_map_setup(dip, 0, (caddr_t *)&global->io_addr,
(offset_t)0, (offset_t)0, &attr, &global->io_handle)
!= DDI_SUCCESS)
goto fail;
global->init_state |= I8042_INIT_REGS_MAPPED;
if (ddi_dev_nintrs(dip, &global->nintrs) == DDI_FAILURE)
goto fail;
#ifdef __sparc
if ((i8042_polled_mode || i8042_is_polling_platform()) &&
!i8042_force_interrupt_mode) {
i8042_polled_mode = B_TRUE;
global->nintrs = 0;
} else if (global->nintrs == 0) {
if (i8042_build_interrupts_property(dip) == DDI_FAILURE ||
ddi_dev_nintrs(dip, &global->nintrs) == DDI_FAILURE ||
global->nintrs == 0) {
cmn_err(CE_WARN, "i8042#%d: No interrupts defined!",
ddi_get_instance(global->dip));
goto fail;
}
}
#else
if (global->nintrs == 0) {
cmn_err(CE_WARN, "i8042#%d: No interrupts defined!",
ddi_get_instance(global->dip));
goto fail;
}
#endif
if (global->nintrs > MAX_INTERRUPTS)
global->nintrs = MAX_INTERRUPTS;
if (global->nintrs > 0) {
global->iblock_cookies = kmem_zalloc(global->nintrs *
sizeof (ddi_iblock_cookie_t), KM_NOSLEEP);
for (i = 0; i < global->nintrs; i++) {
if (ddi_get_iblock_cookie(dip, i,
&global->iblock_cookies[i]) != DDI_SUCCESS)
goto fail;
}
} else
global->iblock_cookies = NULL;
mutex_init(&global->i8042_mutex, NULL, MUTEX_DRIVER,
(global->nintrs > 0) ? global->iblock_cookies[0] : NULL);
mutex_init(&global->i8042_out_mutex, NULL, MUTEX_DRIVER, NULL);
cv_init(&global->glock_cv, NULL, CV_DRIVER, NULL);
for (which_port = 0; which_port < NUM_PORTS; ++which_port) {
port = &global->i8042_ports[which_port];
port->initialized = B_FALSE;
port->i8042_global = global;
port->which = which_port;
#if defined(USE_SOFT_INTRS)
port->soft_hdl = 0;
#else
if (global->nintrs > 0) {
cookie = global->iblock_cookies[
(which_port < global->nintrs) ? which_port : 0];
mutex_init(&port->intr_mutex, NULL, MUTEX_DRIVER,
cookie);
} else {
mutex_init(&port->intr_mutex, NULL, MUTEX_DRIVER, NULL);
}
#endif
}
global->init_state |= I8042_INIT_MUTEXES;
i8042_write_command_byte(global, I8042_CMD_DISABLE_ALL);
global->init_state &= ~I8042_INIT_INTRS_ENABLED;
if (i8042_purge_outbuf(global) != 0)
goto fail;
ASSERT(global->nintrs <= (sizeof (global->intrs_added) * NBBY));
for (i = 0; i < global->nintrs; i++) {
if (ddi_add_intr(dip, i,
(ddi_iblock_cookie_t *)NULL,
(ddi_idevice_cookie_t *)NULL,
i8042_intr, (caddr_t)global) != DDI_SUCCESS)
goto fail;
global->intrs_added |= (1 << i);
}
global->initialized = B_TRUE;
i8042_write_command_byte(global, I8042_CMD_ENABLE_ALL);
global->init_state |= I8042_INIT_INTRS_ENABLED;
#ifdef __sparc
if (i8042_polled_mode) {
interval = i8042_poll_interval;
if (interval < I8042_MIN_POLL_INTERVAL)
interval = I8042_MIN_POLL_INTERVAL;
i8042_fast_poll_interval = interval;
i8042_slow_poll_interval = interval << 3;
global->timeout_id = timeout(i8042_timeout, global,
drv_usectohz(i8042_slow_poll_interval));
}
#endif
return (DDI_SUCCESS);
fail:
(void) i8042_cleanup(global);
return (DDI_FAILURE);
}
static int
i8042_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
struct i8042 *global = (struct i8042 *)ddi_get_driver_private(dip);
ASSERT(global != NULL);
switch (cmd) {
case DDI_SUSPEND:
#ifdef __sparc
i8042_write_command_byte(global, I8042_CMD_DISABLE_ALL);
#endif
return (DDI_SUCCESS);
case DDI_DETACH:
return (i8042_cleanup(global));
default:
return (DDI_FAILURE);
}
}
static int
i8042_map(
dev_info_t *dip,
dev_info_t *rdip,
ddi_map_req_t *mp,
off_t offset,
off_t len,
caddr_t *addrp)
{
struct i8042_port *port;
struct i8042 *global;
enum i8042_ports which_port;
int *iprop;
unsigned int iprop_len;
int rnumber;
ddi_acc_hdl_t *handle;
ddi_acc_impl_t *ap;
global = ddi_get_driver_private(dip);
switch (mp->map_type) {
case DDI_MT_REGSPEC:
which_port = *(int *)mp->map_obj.rp;
break;
case DDI_MT_RNUMBER:
rnumber = mp->map_obj.rnumber;
if (ddi_prop_lookup_int_array(DDI_DEV_T_ANY, rdip,
DDI_PROP_DONTPASS, "reg", &iprop, &iprop_len) !=
DDI_SUCCESS) {
#if defined(DEBUG)
cmn_err(CE_WARN, "%s #%d: Missing 'reg' on %s@%s",
DRIVER_NAME(dip), ddi_get_instance(dip),
ddi_node_name(rdip), ddi_get_name_addr(rdip));
#endif
return (DDI_FAILURE);
}
#if defined(DEBUG)
if (iprop_len != 1) {
cmn_err(CE_WARN, "%s #%d: Malformed 'reg' on %s@%s",
DRIVER_NAME(dip), ddi_get_instance(dip),
ddi_node_name(rdip), ddi_get_name_addr(rdip));
return (DDI_FAILURE);
}
if (rnumber < 0 || rnumber >= iprop_len) {
cmn_err(CE_WARN, "%s #%d: bad map request for %s@%s",
DRIVER_NAME(dip), ddi_get_instance(dip),
ddi_node_name(rdip), ddi_get_name_addr(rdip));
return (DDI_FAILURE);
}
#endif
which_port = iprop[rnumber];
ddi_prop_free((void *)iprop);
#if defined(DEBUG)
if (which_port != MAIN_PORT && which_port != AUX_PORT) {
cmn_err(CE_WARN,
"%s #%d: bad 'reg' value %d on %s@%s",
DRIVER_NAME(dip), ddi_get_instance(dip),
which_port,
ddi_node_name(rdip), ddi_get_name_addr(rdip));
return (DDI_FAILURE);
}
#endif
break;
default:
#if defined(DEBUG)
cmn_err(CE_WARN, "%s #%d: unknown map type %d for %s@%s",
DRIVER_NAME(dip), ddi_get_instance(dip),
mp->map_type,
ddi_node_name(rdip), ddi_get_name_addr(rdip));
#endif
return (DDI_FAILURE);
}
#if defined(DEBUG)
if (offset != 0 || len != 0) {
cmn_err(CE_WARN,
"%s #%d: partial mapping attempt for %s@%s ignored",
DRIVER_NAME(dip), ddi_get_instance(dip),
ddi_node_name(rdip), ddi_get_name_addr(rdip));
}
#endif
port = &global->i8042_ports[which_port];
switch (mp->map_op) {
case DDI_MO_MAP_LOCKED:
#if defined(USE_SOFT_INTRS)
port->soft_intr_enabled = B_FALSE;
#else
port->intr_func = NULL;
#endif
port->wptr = 0;
port->rptr = 0;
port->dip = dip;
port->inumber = 0;
port->has_glock = B_FALSE;
port->initialized = B_TRUE;
handle = mp->map_handlep;
handle->ah_bus_private = port;
handle->ah_addr = 0;
ap = (ddi_acc_impl_t *)handle->ah_platform_private;
ap->ahi_put8 = i8042_put8;
ap->ahi_get8 = i8042_get8;
ap->ahi_put16 = NULL;
ap->ahi_get16 = NULL;
ap->ahi_put32 = NULL;
ap->ahi_get32 = NULL;
ap->ahi_put64 = NULL;
ap->ahi_get64 = NULL;
ap->ahi_rep_put8 = NULL;
ap->ahi_rep_get8 = NULL;
ap->ahi_rep_put16 = NULL;
ap->ahi_rep_get16 = NULL;
ap->ahi_rep_put32 = NULL;
ap->ahi_rep_get32 = NULL;
ap->ahi_rep_put64 = NULL;
ap->ahi_rep_get64 = NULL;
*addrp = 0;
return (DDI_SUCCESS);
case DDI_MO_UNMAP:
port->initialized = B_FALSE;
return (DDI_SUCCESS);
default:
cmn_err(CE_WARN, "%s: map operation %d not supported",
DRIVER_NAME(dip), mp->map_op);
return (DDI_FAILURE);
}
}
#ifdef __sparc
static void
i8042_timeout(void *arg)
{
struct i8042 *i8042_p = (struct i8042 *)arg;
int interval;
if (i8042_fast_poll_interval != i8042_poll_interval) {
interval = i8042_poll_interval;
if (interval < I8042_MIN_POLL_INTERVAL)
interval = I8042_MIN_POLL_INTERVAL;
i8042_fast_poll_interval = interval;
i8042_slow_poll_interval = interval << 3;
}
interval = (i8042_intr((caddr_t)i8042_p) == DDI_INTR_CLAIMED) ?
i8042_fast_poll_interval : i8042_slow_poll_interval;
if (i8042_polled_mode)
i8042_p->timeout_id = timeout(i8042_timeout, arg,
drv_usectohz(interval));
else
i8042_p->timeout_id = 0;
}
#endif
static unsigned int
i8042_intr(caddr_t arg)
{
struct i8042 *global = (struct i8042 *)arg;
enum i8042_ports which_port;
unsigned char stat;
unsigned char byte;
int new_wptr;
struct i8042_port *port;
mutex_enter(&global->i8042_mutex);
stat = ddi_get8(global->io_handle, global->io_addr + I8042_STAT);
if (! (stat & I8042_STAT_OUTBF)) {
++i8042_unclaimed_interrupts;
mutex_exit(&global->i8042_mutex);
return (DDI_INTR_UNCLAIMED);
}
byte = ddi_get8(global->io_handle, global->io_addr + I8042_DATA);
which_port = (stat & I8042_STAT_AUXBF) ? AUX_PORT : MAIN_PORT;
port = &global->i8042_ports[which_port];
if (! port->initialized) {
mutex_exit(&global->i8042_mutex);
return (DDI_INTR_CLAIMED);
}
new_wptr = (port->wptr + 1) % BUFSIZ;
if (new_wptr == port->rptr) {
port->overruns++;
#if defined(DEBUG)
if (port->overruns % 50 == 1) {
cmn_err(CE_WARN, "i8042/%d: %d overruns\n",
which_port, port->overruns);
}
#endif
mutex_exit(&global->i8042_mutex);
return (DDI_INTR_CLAIMED);
}
port->buf[port->wptr] = byte;
port->wptr = new_wptr;
#if defined(USE_SOFT_INTRS)
if (port->soft_intr_enabled)
(void) ddi_intr_trigger_softint(port->soft_hdl,
port->intr_arg2);
#endif
mutex_exit(&global->i8042_mutex);
#if !defined(USE_SOFT_INTRS)
mutex_enter(&port->intr_mutex);
if (port->intr_func != NULL)
port->intr_func(port->intr_arg1, NULL);
mutex_exit(&port->intr_mutex);
#endif
return (DDI_INTR_CLAIMED);
}
static void
i8042_write_command_byte(struct i8042 *global, unsigned char cb)
{
mutex_enter(&global->i8042_out_mutex);
i8042_send(global, I8042_CMD, I8042_CMD_WCB);
i8042_send(global, I8042_DATA, cb);
mutex_exit(&global->i8042_out_mutex);
}
static void
i8042_send(struct i8042 *global, int reg, unsigned char val)
{
uint8_t stat;
int tries = 0;
while (1) {
stat = ddi_get8(global->io_handle,
global->io_addr + I8042_STAT);
if ((stat & I8042_STAT_INBF) == 0) {
ddi_put8(global->io_handle, global->io_addr+reg, val);
break;
}
if (++tries >= max_wait_iterations)
break;
else
drv_usecwait(USECS_PER_WAIT);
}
#ifdef DEBUG
if (tries >= MAX_WAIT_ITERATIONS)
cmn_err(CE_WARN, "i8042_send: timeout!");
#endif
}
static uint8_t
i8042_get8(ddi_acc_impl_t *handlep, uint8_t *addr)
{
struct i8042_port *port;
struct i8042 *global;
uint8_t ret;
ddi_acc_hdl_t *h;
uint8_t stat;
h = (ddi_acc_hdl_t *)handlep;
port = (struct i8042_port *)h->ah_bus_private;
global = port->i8042_global;
switch ((uintptr_t)addr) {
case I8042_LOCK:
ASSERT(port->has_glock != B_TRUE);
mutex_enter(&global->i8042_out_mutex);
while (global->glock) {
cv_wait(&global->glock_cv, &global->i8042_out_mutex);
}
port->has_glock = B_TRUE;
global->glock = 1;
mutex_exit(&global->i8042_out_mutex);
ret = 0;
break;
case I8042_UNLOCK:
mutex_enter(&global->i8042_out_mutex);
ASSERT(global->glock != 0);
ASSERT(port->has_glock == B_TRUE);
port->has_glock = B_FALSE;
global->glock = 0;
cv_signal(&global->glock_cv);
mutex_exit(&global->i8042_out_mutex);
ret = 0;
break;
case I8042_INT_INPUT_AVAIL:
mutex_enter(&global->i8042_mutex);
ret = port->rptr != port->wptr;
mutex_exit(&global->i8042_mutex);
return (ret);
case I8042_INT_INPUT_DATA:
mutex_enter(&global->i8042_mutex);
if (port->rptr != port->wptr) {
ret = port->buf[port->rptr];
port->rptr = (port->rptr + 1) % BUFSIZ;
} else {
#if defined(DEBUG)
cmn_err(CE_WARN,
"i8042: Tried to read from empty buffer");
#endif
ret = 0;
}
mutex_exit(&global->i8042_mutex);
break;
#if defined(DEBUG)
case I8042_INT_OUTPUT_DATA:
case I8042_POLL_OUTPUT_DATA:
cmn_err(CE_WARN, "i8042: read of write-only register 0x%p",
(void *)addr);
ret = 0;
break;
#endif
case I8042_POLL_INPUT_AVAIL:
if (port->rptr != port->wptr)
return (B_TRUE);
for (;;) {
stat = ddi_get8(global->io_handle,
global->io_addr + I8042_STAT);
if ((stat & I8042_STAT_OUTBF) == 0)
return (B_FALSE);
switch (port->which) {
case MAIN_PORT:
if ((stat & I8042_STAT_AUXBF) == 0)
return (B_TRUE);
break;
case AUX_PORT:
if ((stat & I8042_STAT_AUXBF) != 0)
return (B_TRUE);
break;
default:
cmn_err(CE_WARN, "data from unknown port: %d",
port->which);
}
(void) ddi_get8(global->io_handle,
global->io_addr + I8042_DATA);
}
case I8042_POLL_INPUT_DATA:
if (port->rptr != port->wptr) {
ret = port->buf[port->rptr];
port->rptr = (port->rptr + 1) % BUFSIZ;
return (ret);
}
stat = ddi_get8(global->io_handle,
global->io_addr + I8042_STAT);
if ((stat & I8042_STAT_OUTBF) == 0) {
#if defined(DEBUG)
prom_printf("I8042_POLL_INPUT_DATA: no data!\n");
#endif
return (0);
}
ret = ddi_get8(global->io_handle,
global->io_addr + I8042_DATA);
switch (port->which) {
case MAIN_PORT:
if ((stat & I8042_STAT_AUXBF) == 0)
return (ret);
break;
case AUX_PORT:
if ((stat & I8042_STAT_AUXBF) != 0)
return (ret);
break;
}
#if defined(DEBUG)
prom_printf("I8042_POLL_INPUT_DATA: data for wrong port!\n");
#endif
return (0);
default:
#if defined(DEBUG)
cmn_err(CE_WARN, "i8042: read of undefined register 0x%p",
(void *)addr);
#endif
ret = 0;
break;
}
return (ret);
}
static void
i8042_put8(ddi_acc_impl_t *handlep, uint8_t *addr, uint8_t value)
{
struct i8042 *global;
struct i8042_port *port;
ddi_acc_hdl_t *h;
h = (ddi_acc_hdl_t *)handlep;
port = (struct i8042_port *)h->ah_bus_private;
global = port->i8042_global;
switch ((uintptr_t)addr) {
case I8042_INT_OUTPUT_DATA:
case I8042_POLL_OUTPUT_DATA:
if ((uintptr_t)addr == I8042_INT_OUTPUT_DATA) {
mutex_enter(&global->i8042_out_mutex);
while (global->glock && !port->has_glock) {
cv_wait(&global->glock_cv,
&global->i8042_out_mutex);
}
}
if (port->which == AUX_PORT)
i8042_send(global, I8042_CMD, I8042_CMD_WRITE_AUX);
i8042_send(global, I8042_DATA, value);
if ((uintptr_t)addr == I8042_INT_OUTPUT_DATA)
mutex_exit(&global->i8042_out_mutex);
break;
#if defined(DEBUG)
case I8042_INT_INPUT_AVAIL:
case I8042_INT_INPUT_DATA:
case I8042_POLL_INPUT_AVAIL:
case I8042_POLL_INPUT_DATA:
cmn_err(CE_WARN, "i8042: write of read-only register 0x%p",
(void *)addr);
break;
default:
cmn_err(CE_WARN, "i8042: read of undefined register 0x%p",
(void *)addr);
break;
#endif
}
}
static int
i8042_intr_ops(dev_info_t *dip, dev_info_t *rdip, ddi_intr_op_t intr_op,
ddi_intr_handle_impl_t *hdlp, void *result)
{
struct i8042_port *port;
#if defined(USE_SOFT_INTRS)
struct i8042 *global;
int ret;
#endif
switch (intr_op) {
case DDI_INTROP_SUPPORTED_TYPES:
*(int *)result = DDI_INTR_TYPE_FIXED;
break;
case DDI_INTROP_GETCAP:
if (i_ddi_intr_ops(dip, rdip, intr_op, hdlp, result)
== DDI_FAILURE)
*(int *)result = 0;
break;
case DDI_INTROP_NINTRS:
case DDI_INTROP_NAVAIL:
*(int *)result = 1;
break;
case DDI_INTROP_ALLOC:
*(int *)result = hdlp->ih_scratch1;
break;
case DDI_INTROP_FREE:
break;
case DDI_INTROP_GETPRI:
*(int *)result = 5;
break;
case DDI_INTROP_ADDISR:
port = ddi_get_parent_data(rdip);
#if defined(USE_SOFT_INTRS)
global = port->i8042_global;
ret = ddi_intr_add_softint(rdip, &port->soft_hdl,
I8042_SOFTINT_PRI, hdlp->ih_cb_func, hdlp->ih_cb_arg1);
if (ret != DDI_SUCCESS) {
#if defined(DEBUG)
cmn_err(CE_WARN, "%s #%d: "
"Cannot add soft interrupt for %s #%d, ret=%d.",
DRIVER_NAME(dip), ddi_get_instance(dip),
DRIVER_NAME(rdip), ddi_get_instance(rdip), ret);
#endif
return (ret);
}
#else
mutex_enter(&port->intr_mutex);
port->intr_func = hdlp->ih_cb_func;
port->intr_arg1 = hdlp->ih_cb_arg1;
port->intr_arg2 = hdlp->ih_cb_arg2;
mutex_exit(&port->intr_mutex);
#endif
break;
case DDI_INTROP_REMISR:
port = ddi_get_parent_data(rdip);
#if defined(USE_SOFT_INTRS)
global = port->i8042_global;
mutex_enter(&global->i8042_mutex);
port->soft_hdl = 0;
mutex_exit(&global->i8042_mutex);
#else
mutex_enter(&port->intr_mutex);
port->intr_func = NULL;
mutex_exit(&port->intr_mutex);
#endif
break;
case DDI_INTROP_ENABLE:
port = ddi_get_parent_data(rdip);
#if defined(USE_SOFT_INTRS)
global = port->i8042_global;
mutex_enter(&global->i8042_mutex);
port->soft_intr_enabled = B_TRUE;
if (port->wptr != port->rptr)
(void) ddi_intr_trigger_softint(port->soft_hdl,
port->intr_arg2);
mutex_exit(&global->i8042_mutex);
#else
mutex_enter(&port->intr_mutex);
if (port->wptr != port->rptr)
port->intr_func(port->intr_arg1, port->intr_arg2);
mutex_exit(&port->intr_mutex);
#endif
break;
case DDI_INTROP_DISABLE:
#if defined(USE_SOFT_INTRS)
port = ddi_get_parent_data(rdip);
global = port->i8042_global;
mutex_enter(&global->i8042_mutex);
port->soft_intr_enabled = B_FALSE;
(void) ddi_intr_remove_softint(port->soft_hdl);
mutex_exit(&global->i8042_mutex);
#endif
break;
default:
return (DDI_FAILURE);
}
return (DDI_SUCCESS);
}
static int
i8042_ctlops(dev_info_t *dip, dev_info_t *rdip,
ddi_ctl_enum_t op, void *arg, void *result)
{
int *iprop;
unsigned int iprop_len;
int which_port;
char name[16];
struct i8042 *global;
dev_info_t *child;
global = ddi_get_driver_private(dip);
switch (op) {
case DDI_CTLOPS_INITCHILD:
child = (dev_info_t *)arg;
if (ddi_prop_lookup_int_array(DDI_DEV_T_ANY, child,
DDI_PROP_DONTPASS, "reg", &iprop, &iprop_len) !=
DDI_SUCCESS) {
#if defined(DEBUG)
cmn_err(CE_WARN, "%s #%d: Missing 'reg' on %s@???",
DRIVER_NAME(dip), ddi_get_instance(dip),
ddi_node_name(child));
#endif
return (DDI_FAILURE);
}
which_port = iprop[0];
ddi_prop_free((void *)iprop);
(void) sprintf(name, "%d", which_port);
ddi_set_name_addr(child, name);
ddi_set_parent_data(child,
(caddr_t)&global->i8042_ports[which_port]);
return (DDI_SUCCESS);
case DDI_CTLOPS_UNINITCHILD:
child = (dev_info_t *)arg;
ddi_set_name_addr(child, NULL);
ddi_set_parent_data(child, NULL);
return (DDI_SUCCESS);
case DDI_CTLOPS_REPORTDEV:
cmn_err(CE_CONT, "?8042 device: %s@%s, %s # %d\n",
ddi_node_name(rdip), ddi_get_name_addr(rdip),
DRIVER_NAME(rdip), ddi_get_instance(rdip));
return (DDI_SUCCESS);
default:
return (ddi_ctlops(dip, rdip, op, arg, result));
}
}
#if defined(__x86)
static dev_info_t *
i8042_devi_findchild_by_node_name(dev_info_t *pdip, char *nodename)
{
dev_info_t *child;
ASSERT(DEVI_BUSY_OWNED(pdip));
if (nodename == NULL) {
return ((dev_info_t *)NULL);
}
for (child = ddi_get_child(pdip); child != NULL;
child = ddi_get_next_sibling(child)) {
if (strcmp(ddi_node_name(child), nodename) == 0)
break;
}
return (child);
}
static void
alloc_kb_mouse(dev_info_t *i8042_dip, int nodes_needed)
{
dev_info_t *xdip;
int acpi_off = 0;
char *acpi_prop;
if (ddi_prop_lookup_string(DDI_DEV_T_ANY, ddi_root_node(),
DDI_PROP_DONTPASS, "acpi-enum", &acpi_prop) == DDI_PROP_SUCCESS) {
if (strcmp("off", acpi_prop) == 0) {
acpi_off = 1;
}
ddi_prop_free(acpi_prop);
}
if (acpi_off == 0) {
return;
}
if (nodes_needed & I8042_MOUSE) {
ndi_devi_alloc_sleep(i8042_dip, "mouse",
(pnode_t)DEVI_SID_NODEID, &xdip);
(void) ndi_prop_update_int(DDI_DEV_T_NONE, xdip,
"reg", 1);
(void) ndi_prop_update_int(DDI_DEV_T_NONE, xdip,
"interrupts", 2);
(void) ndi_prop_update_string(DDI_DEV_T_NONE, xdip,
"compatible", "pnpPNP,f03");
(void) ndi_prop_update_string(DDI_DEV_T_NONE, xdip,
"device_type", "mouse");
(void) ndi_devi_bind_driver(xdip, 0);
}
if (nodes_needed & I8042_KEYBOARD) {
ndi_devi_alloc_sleep(i8042_dip, "keyboard",
(pnode_t)DEVI_SID_NODEID, &xdip);
(void) ndi_prop_update_int(DDI_DEV_T_NONE, xdip,
"reg", 0);
(void) ndi_prop_update_int(DDI_DEV_T_NONE, xdip,
"interrupts", 1);
(void) ndi_prop_update_string(DDI_DEV_T_NONE, xdip,
"compatible", "pnpPNP,303");
(void) ndi_prop_update_string(DDI_DEV_T_NONE, xdip,
"device_type", "keyboard");
(void) ndi_devi_bind_driver(xdip, 0);
}
}
#endif
static int
i8042_bus_config(dev_info_t *parent, uint_t flags,
ddi_bus_config_op_t op, void *arg, dev_info_t **childp)
{
#if defined(__x86)
int nodes_needed = 0;
ndi_devi_enter(parent);
if (i8042_devi_findchild_by_node_name(parent, "keyboard") == NULL)
nodes_needed |= I8042_KEYBOARD;
if (i8042_devi_findchild_by_node_name(parent, "mouse") == NULL)
nodes_needed |= I8042_MOUSE;
if (nodes_needed)
alloc_kb_mouse(parent, nodes_needed);
ndi_devi_exit(parent);
#endif
return (ndi_busop_bus_config(parent, flags, op, arg, childp, 0));
}
static int
i8042_bus_unconfig(dev_info_t *parent, uint_t flags,
ddi_bus_config_op_t op, void *arg)
{
return (ndi_busop_bus_unconfig(parent, flags | NDI_UNCONFIG, op, arg));
}
#ifdef __sparc
static int
i8042_build_interrupts_property(dev_info_t *dip)
{
dev_info_t *child = ddi_get_child(dip);
uint_t nintr;
int *intrs = NULL;
int interrupts[MAX_INTERRUPTS];
int i = 0;
while (child != NULL && i < MAX_INTERRUPTS) {
if (ddi_prop_lookup_int_array(DDI_DEV_T_ANY, child,
DDI_PROP_DONTPASS, "interrupts", &intrs, &nintr)
== DDI_PROP_SUCCESS && intrs != NULL) {
while (nintr > 0 && i < MAX_INTERRUPTS) {
interrupts[i++] = intrs[--nintr];
}
ddi_prop_free(intrs);
}
child = ddi_get_next_sibling(child);
}
if (ddi_prop_update_int_array(DDI_DEV_T_NONE, dip, "interrupts",
interrupts, i) != DDI_PROP_SUCCESS) {
return (DDI_FAILURE);
}
if (ddi_prop_update_string(DDI_DEV_T_NONE, dip, "device_type", "serial")
!= DDI_PROP_SUCCESS) {
return (DDI_FAILURE);
}
return (DDI_SUCCESS);
}
static boolean_t
i8042_is_polling_platform(void)
{
if (PLATFORM_MATCH("SUNW,UltraAX-"))
return (B_TRUE);
else
return (B_FALSE);
}
#endif