Add locking and mark MPSAFE.
- Add a mutex to protect the softc. - Use callout(9) instead of timeout(9). - Consolidate duplicated detach routines into a bus-independent detach routine. - Add an extra sleep lock flag (MSESC_READING) to prevent other readers from reading while the first reader is copying data out of sc_bytes[] via uiomove(). - Use bus_*() instead of bus_space_*(). Tested by: nyan
This commit is contained in:
jhb
parent
1b90da9ab8
commit
e64c35384b
@ -99,7 +99,6 @@ static d_poll_t msepoll;
|
||||
|
||||
static struct cdevsw mse_cdevsw = {
|
||||
.d_version = D_VERSION,
|
||||
.d_flags = D_NEEDGIANT,
|
||||
.d_open = mseopen,
|
||||
.d_close = mseclose,
|
||||
.d_read = mseread,
|
||||
@ -109,9 +108,10 @@ static struct cdevsw mse_cdevsw = {
|
||||
};
|
||||
|
||||
static void mseintr(void *);
|
||||
static timeout_t msetimeout;
|
||||
static void mseintr_locked(mse_softc_t *sc);
|
||||
static void msetimeout(void *);
|
||||
|
||||
#define MSE_NBLOCKIO(dev) dev2unit(dev)
|
||||
#define MSE_NBLOCKIO(dev) (dev2unit(dev) != 0)
|
||||
|
||||
#define MSEPRI (PZERO + 3)
|
||||
|
||||
@ -123,32 +123,68 @@ mse_common_attach(device_t dev)
|
||||
|
||||
sc = device_get_softc(dev);
|
||||
unit = device_get_unit(dev);
|
||||
mtx_init(&sc->sc_lock, "mse", NULL, MTX_DEF);
|
||||
callout_init_mtx(&sc->sc_callout, &sc->sc_lock, 0);
|
||||
|
||||
rid = 0;
|
||||
sc->sc_intr = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
|
||||
RF_ACTIVE);
|
||||
if (sc->sc_intr == NULL) {
|
||||
bus_release_resource(dev, SYS_RES_IOPORT, rid, sc->sc_port);
|
||||
mtx_destroy(&sc->sc_lock);
|
||||
return ENXIO;
|
||||
}
|
||||
|
||||
if (bus_setup_intr(dev, sc->sc_intr,
|
||||
INTR_TYPE_TTY, NULL, mseintr, sc, &sc->sc_ih)) {
|
||||
if (bus_setup_intr(dev, sc->sc_intr, INTR_TYPE_TTY | INTR_MPSAFE,
|
||||
NULL, mseintr, sc, &sc->sc_ih)) {
|
||||
bus_release_resource(dev, SYS_RES_IOPORT, rid, sc->sc_port);
|
||||
bus_release_resource(dev, SYS_RES_IRQ, rid, sc->sc_intr);
|
||||
mtx_destroy(&sc->sc_lock);
|
||||
return ENXIO;
|
||||
}
|
||||
flags = device_get_flags(dev);
|
||||
sc->mode.accelfactor = (flags & MSE_CONFIG_ACCEL) >> 4;
|
||||
callout_handle_init(&sc->sc_callout);
|
||||
|
||||
sc->sc_dev = make_dev(&mse_cdevsw, 0, 0, 0, 0600, "mse%d", unit);
|
||||
sc->sc_dev = make_dev(&mse_cdevsw, 0, UID_ROOT, GID_WHEEL, 0600,
|
||||
"mse%d", unit);
|
||||
sc->sc_dev->si_drv1 = sc;
|
||||
sc->sc_ndev = make_dev(&mse_cdevsw, 1, 0, 0, 0600, "nmse%d", unit);
|
||||
sc->sc_ndev = make_dev(&mse_cdevsw, 1, UID_ROOT, GID_WHEEL, 0600,
|
||||
"nmse%d", unit);
|
||||
sc->sc_ndev->si_drv1 = sc;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
mse_detach(device_t dev)
|
||||
{
|
||||
mse_softc_t *sc;
|
||||
int rid;
|
||||
|
||||
sc = device_get_softc(dev);
|
||||
MSE_LOCK(sc);
|
||||
if (sc->sc_flags & MSESC_OPEN) {
|
||||
MSE_UNLOCK(sc);
|
||||
return EBUSY;
|
||||
}
|
||||
|
||||
/* Sabotage subsequent opens. */
|
||||
sc->sc_mousetype = MSE_NONE;
|
||||
MSE_UNLOCK(sc);
|
||||
|
||||
destroy_dev(sc->sc_dev);
|
||||
destroy_dev(sc->sc_ndev);
|
||||
|
||||
rid = 0;
|
||||
bus_teardown_intr(dev, sc->sc_intr, sc->sc_ih);
|
||||
bus_release_resource(dev, SYS_RES_IRQ, rid, sc->sc_intr);
|
||||
bus_release_resource(dev, SYS_RES_IOPORT, rid, sc->sc_port);
|
||||
|
||||
callout_drain(&sc->sc_callout);
|
||||
mtx_destroy(&sc->sc_lock);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Exclusive open the mouse, initialize it and enable interrupts.
|
||||
*/
|
||||
@ -156,18 +192,22 @@ static int
|
||||
mseopen(struct cdev *dev, int flags, int fmt, struct thread *td)
|
||||
{
|
||||
mse_softc_t *sc = dev->si_drv1;
|
||||
int s;
|
||||
|
||||
if (sc->sc_mousetype == MSE_NONE)
|
||||
MSE_LOCK(sc);
|
||||
if (sc->sc_mousetype == MSE_NONE) {
|
||||
MSE_UNLOCK(sc);
|
||||
return (ENXIO);
|
||||
if (sc->sc_flags & MSESC_OPEN)
|
||||
}
|
||||
if (sc->sc_flags & MSESC_OPEN) {
|
||||
MSE_UNLOCK(sc);
|
||||
return (EBUSY);
|
||||
}
|
||||
sc->sc_flags |= MSESC_OPEN;
|
||||
sc->sc_obuttons = sc->sc_buttons = MOUSE_MSC_BUTTONS;
|
||||
sc->sc_deltax = sc->sc_deltay = 0;
|
||||
sc->sc_bytesread = sc->mode.packetsize = MOUSE_MSC_PACKETSIZE;
|
||||
sc->sc_watchdog = FALSE;
|
||||
sc->sc_callout = timeout(msetimeout, dev, hz*2);
|
||||
callout_reset(&sc->sc_callout, hz * 2, msetimeout, dev);
|
||||
sc->mode.level = 0;
|
||||
sc->status.flags = 0;
|
||||
sc->status.button = sc->status.obutton = 0;
|
||||
@ -176,9 +216,8 @@ mseopen(struct cdev *dev, int flags, int fmt, struct thread *td)
|
||||
/*
|
||||
* Initialize mouse interface and enable interrupts.
|
||||
*/
|
||||
s = spltty();
|
||||
(*sc->sc_enablemouse)(sc->sc_iot, sc->sc_ioh);
|
||||
splx(s);
|
||||
(*sc->sc_enablemouse)(sc->sc_port);
|
||||
MSE_UNLOCK(sc);
|
||||
return (0);
|
||||
}
|
||||
|
||||
@ -189,14 +228,12 @@ static int
|
||||
mseclose(struct cdev *dev, int flags, int fmt, struct thread *td)
|
||||
{
|
||||
mse_softc_t *sc = dev->si_drv1;
|
||||
int s;
|
||||
|
||||
untimeout(msetimeout, dev, sc->sc_callout);
|
||||
callout_handle_init(&sc->sc_callout);
|
||||
s = spltty();
|
||||
(*sc->sc_disablemouse)(sc->sc_iot, sc->sc_ioh);
|
||||
MSE_LOCK(sc);
|
||||
callout_stop(&sc->sc_callout);
|
||||
(*sc->sc_disablemouse)(sc->sc_port);
|
||||
sc->sc_flags &= ~MSESC_OPEN;
|
||||
splx(s);
|
||||
MSE_UNLOCK(sc);
|
||||
return(0);
|
||||
}
|
||||
|
||||
@ -209,28 +246,39 @@ static int
|
||||
mseread(struct cdev *dev, struct uio *uio, int ioflag)
|
||||
{
|
||||
mse_softc_t *sc = dev->si_drv1;
|
||||
int xfer, s, error;
|
||||
int xfer, error;
|
||||
|
||||
/*
|
||||
* If there are no protocol bytes to be read, set up a new protocol
|
||||
* packet.
|
||||
*/
|
||||
s = spltty(); /* XXX Should be its own spl, but where is imlXX() */
|
||||
if (sc->sc_bytesread >= sc->mode.packetsize) {
|
||||
while (sc->sc_deltax == 0 && sc->sc_deltay == 0 &&
|
||||
(sc->sc_obuttons ^ sc->sc_buttons) == 0) {
|
||||
MSE_LOCK(sc);
|
||||
while (sc->sc_flags & MSESC_READING) {
|
||||
if (MSE_NBLOCKIO(dev)) {
|
||||
splx(s);
|
||||
MSE_UNLOCK(sc);
|
||||
return (0);
|
||||
}
|
||||
sc->sc_flags |= MSESC_WANT;
|
||||
error = tsleep(sc, MSEPRI | PCATCH,
|
||||
"mseread", 0);
|
||||
error = mtx_sleep(sc, &sc->sc_lock, MSEPRI | PCATCH, "mseread",
|
||||
0);
|
||||
if (error) {
|
||||
splx(s);
|
||||
MSE_UNLOCK(sc);
|
||||
return (error);
|
||||
}
|
||||
}
|
||||
sc->sc_flags |= MSESC_READING;
|
||||
xfer = 0;
|
||||
if (sc->sc_bytesread >= sc->mode.packetsize) {
|
||||
while (sc->sc_deltax == 0 && sc->sc_deltay == 0 &&
|
||||
(sc->sc_obuttons ^ sc->sc_buttons) == 0) {
|
||||
if (MSE_NBLOCKIO(dev))
|
||||
goto out;
|
||||
sc->sc_flags |= MSESC_WANT;
|
||||
error = mtx_sleep(sc, &sc->sc_lock, MSEPRI | PCATCH,
|
||||
"mseread", 0);
|
||||
if (error)
|
||||
goto out;
|
||||
}
|
||||
|
||||
/*
|
||||
* Generate protocol bytes.
|
||||
@ -257,13 +305,21 @@ mseread(struct cdev *dev, struct uio *uio, int ioflag)
|
||||
sc->sc_deltax = sc->sc_deltay = 0;
|
||||
sc->sc_bytesread = 0;
|
||||
}
|
||||
splx(s);
|
||||
xfer = min(uio->uio_resid, sc->mode.packetsize - sc->sc_bytesread);
|
||||
MSE_UNLOCK(sc);
|
||||
error = uiomove(&sc->sc_bytes[sc->sc_bytesread], xfer, uio);
|
||||
if (error)
|
||||
return (error);
|
||||
MSE_LOCK(sc);
|
||||
out:
|
||||
sc->sc_flags &= ~MSESC_READING;
|
||||
if (error == 0)
|
||||
sc->sc_bytesread += xfer;
|
||||
return(0);
|
||||
if (sc->sc_flags & MSESC_WANT) {
|
||||
sc->sc_flags &= ~MSESC_WANT;
|
||||
MSE_UNLOCK(sc);
|
||||
wakeup(sc);
|
||||
} else
|
||||
MSE_UNLOCK(sc);
|
||||
return (error);
|
||||
}
|
||||
|
||||
/*
|
||||
@ -275,20 +331,19 @@ mseioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag, struct thread *td
|
||||
mse_softc_t *sc = dev->si_drv1;
|
||||
mousestatus_t status;
|
||||
int err = 0;
|
||||
int s;
|
||||
|
||||
switch (cmd) {
|
||||
|
||||
case MOUSE_GETHWINFO:
|
||||
s = spltty();
|
||||
MSE_LOCK(sc);
|
||||
*(mousehw_t *)addr = sc->hw;
|
||||
if (sc->mode.level == 0)
|
||||
((mousehw_t *)addr)->model = MOUSE_MODEL_GENERIC;
|
||||
splx(s);
|
||||
MSE_UNLOCK(sc);
|
||||
break;
|
||||
|
||||
case MOUSE_GETMODE:
|
||||
s = spltty();
|
||||
MSE_LOCK(sc);
|
||||
*(mousemode_t *)addr = sc->mode;
|
||||
switch (sc->mode.level) {
|
||||
case 0:
|
||||
@ -299,7 +354,7 @@ mseioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag, struct thread *td
|
||||
((mousemode_t *)addr)->syncmask[1] = MOUSE_SYS_SYNC;
|
||||
break;
|
||||
}
|
||||
splx(s);
|
||||
MSE_UNLOCK(sc);
|
||||
break;
|
||||
|
||||
case MOUSE_SETMODE:
|
||||
@ -310,9 +365,11 @@ mseioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag, struct thread *td
|
||||
default:
|
||||
return (EINVAL);
|
||||
}
|
||||
if (((mousemode_t *)addr)->accelfactor < -1)
|
||||
MSE_LOCK(sc);
|
||||
if (((mousemode_t *)addr)->accelfactor < -1) {
|
||||
MSE_UNLOCK(sc);
|
||||
return (EINVAL);
|
||||
else if (((mousemode_t *)addr)->accelfactor >= 0)
|
||||
} else if (((mousemode_t *)addr)->accelfactor >= 0)
|
||||
sc->mode.accelfactor =
|
||||
((mousemode_t *)addr)->accelfactor;
|
||||
sc->mode.level = ((mousemode_t *)addr)->level;
|
||||
@ -326,23 +383,30 @@ mseioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag, struct thread *td
|
||||
= MOUSE_SYS_PACKETSIZE;
|
||||
break;
|
||||
}
|
||||
MSE_UNLOCK(sc);
|
||||
break;
|
||||
|
||||
case MOUSE_GETLEVEL:
|
||||
MSE_LOCK(sc);
|
||||
*(int *)addr = sc->mode.level;
|
||||
MSE_UNLOCK(sc);
|
||||
break;
|
||||
|
||||
case MOUSE_SETLEVEL:
|
||||
switch (*(int *)addr) {
|
||||
case 0:
|
||||
MSE_LOCK(sc);
|
||||
sc->mode.level = *(int *)addr;
|
||||
sc->sc_bytesread = sc->mode.packetsize
|
||||
= MOUSE_MSC_PACKETSIZE;
|
||||
MSE_UNLOCK(sc);
|
||||
break;
|
||||
case 1:
|
||||
MSE_LOCK(sc);
|
||||
sc->mode.level = *(int *)addr;
|
||||
sc->sc_bytesread = sc->mode.packetsize
|
||||
= MOUSE_SYS_PACKETSIZE;
|
||||
MSE_UNLOCK(sc);
|
||||
break;
|
||||
default:
|
||||
return (EINVAL);
|
||||
@ -350,7 +414,7 @@ mseioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag, struct thread *td
|
||||
break;
|
||||
|
||||
case MOUSE_GETSTATUS:
|
||||
s = spltty();
|
||||
MSE_LOCK(sc);
|
||||
status = sc->status;
|
||||
sc->status.flags = 0;
|
||||
sc->status.obutton = sc->status.button;
|
||||
@ -358,7 +422,7 @@ mseioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag, struct thread *td
|
||||
sc->status.dx = 0;
|
||||
sc->status.dy = 0;
|
||||
sc->status.dz = 0;
|
||||
splx(s);
|
||||
MSE_UNLOCK(sc);
|
||||
*(mousestatus_t *)addr = status;
|
||||
break;
|
||||
|
||||
@ -385,24 +449,18 @@ static int
|
||||
msepoll(struct cdev *dev, int events, struct thread *td)
|
||||
{
|
||||
mse_softc_t *sc = dev->si_drv1;
|
||||
int s;
|
||||
int revents = 0;
|
||||
|
||||
s = spltty();
|
||||
MSE_LOCK(sc);
|
||||
if (events & (POLLIN | POLLRDNORM)) {
|
||||
if (sc->sc_bytesread != sc->mode.packetsize ||
|
||||
sc->sc_deltax != 0 || sc->sc_deltay != 0 ||
|
||||
(sc->sc_obuttons ^ sc->sc_buttons) != 0)
|
||||
revents |= events & (POLLIN | POLLRDNORM);
|
||||
else {
|
||||
/*
|
||||
* Since this is an exclusive open device, any previous
|
||||
* proc pointer is trash now, so we can just assign it.
|
||||
*/
|
||||
else
|
||||
selrecord(td, &sc->sc_selp);
|
||||
}
|
||||
}
|
||||
splx(s);
|
||||
MSE_UNLOCK(sc);
|
||||
return (revents);
|
||||
}
|
||||
|
||||
@ -417,13 +475,14 @@ msetimeout(void *arg)
|
||||
|
||||
dev = (struct cdev *)arg;
|
||||
sc = dev->si_drv1;
|
||||
MSE_ASSERT_LOCKED(sc);
|
||||
if (sc->sc_watchdog) {
|
||||
if (bootverbose)
|
||||
printf("%s: lost interrupt?\n", devtoname(dev));
|
||||
mseintr(sc);
|
||||
mseintr_locked(sc);
|
||||
}
|
||||
sc->sc_watchdog = TRUE;
|
||||
sc->sc_callout = timeout(msetimeout, dev, hz);
|
||||
callout_schedule(&sc->sc_callout, hz);
|
||||
}
|
||||
|
||||
/*
|
||||
@ -431,6 +490,16 @@ msetimeout(void *arg)
|
||||
*/
|
||||
static void
|
||||
mseintr(void *arg)
|
||||
{
|
||||
mse_softc_t *sc = arg;
|
||||
|
||||
MSE_LOCK(sc);
|
||||
mseintr_locked(sc);
|
||||
MSE_UNLOCK(sc);
|
||||
}
|
||||
|
||||
static void
|
||||
mseintr_locked(mse_softc_t *sc)
|
||||
{
|
||||
/*
|
||||
* the table to turn MouseSystem button bits (MOUSE_MSC_BUTTON?UP)
|
||||
@ -446,7 +515,6 @@ mseintr(void *arg)
|
||||
MOUSE_BUTTON1DOWN | MOUSE_BUTTON2DOWN,
|
||||
MOUSE_BUTTON1DOWN | MOUSE_BUTTON2DOWN | MOUSE_BUTTON3DOWN
|
||||
};
|
||||
mse_softc_t *sc = arg;
|
||||
int dx, dy, but;
|
||||
int sign;
|
||||
|
||||
@ -458,7 +526,7 @@ mseintr(void *arg)
|
||||
if ((sc->sc_flags & MSESC_OPEN) == 0)
|
||||
return;
|
||||
|
||||
(*sc->sc_getmouse)(sc->sc_iot, sc->sc_ioh, &dx, &dy, &but);
|
||||
(*sc->sc_getmouse)(sc->sc_port, &dx, &dy, &but);
|
||||
if (sc->mode.accelfactor > 0) {
|
||||
sign = (dx < 0);
|
||||
dx = dx * dx / sc->mode.accelfactor;
|
||||
|
||||
@ -91,12 +91,11 @@
|
||||
|
||||
static int mse_cbus_probe(device_t dev);
|
||||
static int mse_cbus_attach(device_t dev);
|
||||
static int mse_cbus_detach(device_t dev);
|
||||
|
||||
static device_method_t mse_methods[] = {
|
||||
DEVMETHOD(device_probe, mse_cbus_probe),
|
||||
DEVMETHOD(device_attach, mse_cbus_attach),
|
||||
DEVMETHOD(device_detach, mse_cbus_detach),
|
||||
DEVMETHOD(device_detach, mse_detach),
|
||||
{ 0, 0 }
|
||||
};
|
||||
|
||||
@ -136,10 +135,10 @@ static struct isa_pnp_id mse_ids[] = {
|
||||
static bus_addr_t mse_port[] = {0, 2, 4, 6};
|
||||
|
||||
static int mse_probe98m(device_t dev, mse_softc_t *sc);
|
||||
static void mse_disable98m(bus_space_tag_t t, bus_space_handle_t h);
|
||||
static void mse_get98m(bus_space_tag_t t, bus_space_handle_t h,
|
||||
static void mse_disable98m(struct resource *port);
|
||||
static void mse_get98m(struct resource *port,
|
||||
int *dx, int *dy, int *but);
|
||||
static void mse_enable98m(bus_space_tag_t t, bus_space_handle_t h);
|
||||
static void mse_enable98m(struct resource *port);
|
||||
|
||||
static struct mse_types mse_types[] = {
|
||||
{ MSE_98BUSMOUSE,
|
||||
@ -173,8 +172,6 @@ mse_cbus_probe(device_t dev)
|
||||
bus_release_resource(dev, SYS_RES_IOPORT, rid, sc->sc_port);
|
||||
return ENXIO;
|
||||
}
|
||||
sc->sc_iot = rman_get_bustag(sc->sc_port);
|
||||
sc->sc_ioh = rman_get_bushandle(sc->sc_port);
|
||||
|
||||
/*
|
||||
* Check for each mouse type in the table.
|
||||
@ -216,33 +213,10 @@ mse_cbus_attach(device_t dev)
|
||||
bus_release_resource(dev, SYS_RES_IOPORT, rid, sc->sc_port);
|
||||
return ENXIO;
|
||||
}
|
||||
sc->sc_iot = rman_get_bustag(sc->sc_port);
|
||||
sc->sc_ioh = rman_get_bushandle(sc->sc_port);
|
||||
|
||||
return (mse_common_attach(dev));
|
||||
}
|
||||
|
||||
static int
|
||||
mse_cbus_detach(device_t dev)
|
||||
{
|
||||
mse_softc_t *sc;
|
||||
int rid;
|
||||
|
||||
sc = device_get_softc(dev);
|
||||
if (sc->sc_flags & MSESC_OPEN)
|
||||
return EBUSY;
|
||||
|
||||
rid = 0;
|
||||
BUS_TEARDOWN_INTR(device_get_parent(dev), dev, sc->sc_intr, sc->sc_ih);
|
||||
bus_release_resource(dev, SYS_RES_IRQ, rid, sc->sc_intr);
|
||||
bus_release_resource(dev, SYS_RES_IOPORT, rid, sc->sc_port);
|
||||
|
||||
destroy_dev(sc->sc_dev);
|
||||
destroy_dev(sc->sc_ndev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Routines for the PC98 bus mouse.
|
||||
*/
|
||||
@ -255,15 +229,15 @@ static int
|
||||
mse_probe98m(device_t dev, mse_softc_t *sc)
|
||||
{
|
||||
/* mode set */
|
||||
bus_space_write_1(sc->sc_iot, sc->sc_ioh, MODE, 0x93);
|
||||
bus_write_1(sc->sc_port, MODE, 0x93);
|
||||
|
||||
/* initialize */
|
||||
/* INT disable */
|
||||
bus_space_write_1(sc->sc_iot, sc->sc_ioh, INT, INT_DISABLE);
|
||||
bus_write_1(sc->sc_port, INT, INT_DISABLE);
|
||||
/* HC = 0 */
|
||||
bus_space_write_1(sc->sc_iot, sc->sc_ioh, HC, HC_NO_CLEAR);
|
||||
bus_write_1(sc->sc_port, HC, HC_NO_CLEAR);
|
||||
/* HC = 1 */
|
||||
bus_space_write_1(sc->sc_iot, sc->sc_ioh, HC, HC_CLEAR);
|
||||
bus_write_1(sc->sc_port, HC, HC_CLEAR);
|
||||
|
||||
return (1);
|
||||
}
|
||||
@ -272,57 +246,56 @@ mse_probe98m(device_t dev, mse_softc_t *sc)
|
||||
* Initialize PC98 bus mouse and enable interrupts.
|
||||
*/
|
||||
static void
|
||||
mse_enable98m(bus_space_tag_t tag, bus_space_handle_t handle)
|
||||
mse_enable98m(struct resource *port)
|
||||
{
|
||||
bus_space_write_1(tag, handle, INT, INT_ENABLE); /* INT enable */
|
||||
bus_space_write_1(tag, handle, HC, HC_NO_CLEAR); /* HC = 0 */
|
||||
bus_space_write_1(tag, handle, HC, HC_CLEAR); /* HC = 1 */
|
||||
bus_write_1(port, INT, INT_ENABLE); /* INT enable */
|
||||
bus_write_1(port, HC, HC_NO_CLEAR); /* HC = 0 */
|
||||
bus_write_1(port, HC, HC_CLEAR); /* HC = 1 */
|
||||
}
|
||||
|
||||
/*
|
||||
* Disable interrupts for PC98 Bus mouse.
|
||||
*/
|
||||
static void
|
||||
mse_disable98m(bus_space_tag_t tag, bus_space_handle_t handle)
|
||||
mse_disable98m(struct resource *port)
|
||||
{
|
||||
bus_space_write_1(tag, handle, INT, INT_DISABLE); /* INT disable */
|
||||
bus_space_write_1(tag, handle, HC, HC_NO_CLEAR); /* HC = 0 */
|
||||
bus_space_write_1(tag, handle, HC, HC_CLEAR); /* HC = 1 */
|
||||
bus_write_1(port, INT, INT_DISABLE); /* INT disable */
|
||||
bus_write_1(port, HC, HC_NO_CLEAR); /* HC = 0 */
|
||||
bus_write_1(port, HC, HC_CLEAR); /* HC = 1 */
|
||||
}
|
||||
|
||||
/*
|
||||
* Get current dx, dy and up/down button state.
|
||||
*/
|
||||
static void
|
||||
mse_get98m(bus_space_tag_t tag, bus_space_handle_t handle, int *dx, int *dy,
|
||||
int *but)
|
||||
mse_get98m(struct resource *port, int *dx, int *dy, int *but)
|
||||
{
|
||||
register char x, y;
|
||||
|
||||
bus_space_write_1(tag, handle, INT, INT_DISABLE); /* INT disable */
|
||||
bus_write_1(port, INT, INT_DISABLE); /* INT disable */
|
||||
|
||||
bus_space_write_1(tag, handle, HC, HC_CLEAR); /* HC = 1 */
|
||||
bus_write_1(port, HC, HC_CLEAR); /* HC = 1 */
|
||||
|
||||
/* X low */
|
||||
bus_space_write_1(tag, handle, MSE_PORTC, 0x90 | XL);
|
||||
x = bus_space_read_1(tag, handle, MSE_PORTA) & 0x0f;
|
||||
bus_write_1(port, MSE_PORTC, 0x90 | XL);
|
||||
x = bus_read_1(port, MSE_PORTA) & 0x0f;
|
||||
/* X high */
|
||||
bus_space_write_1(tag, handle, MSE_PORTC, 0x90 | XH);
|
||||
x |= ((bus_space_read_1(tag, handle, MSE_PORTA) & 0x0f) << 4);
|
||||
bus_write_1(port, MSE_PORTC, 0x90 | XH);
|
||||
x |= ((bus_read_1(port, MSE_PORTA) & 0x0f) << 4);
|
||||
|
||||
/* Y low */
|
||||
bus_space_write_1(tag, handle, MSE_PORTC, 0x90 | YL);
|
||||
y = (bus_space_read_1(tag, handle, MSE_PORTA) & 0x0f);
|
||||
bus_write_1(port, MSE_PORTC, 0x90 | YL);
|
||||
y = (bus_read_1(port, MSE_PORTA) & 0x0f);
|
||||
/* Y high */
|
||||
bus_space_write_1(tag, handle, MSE_PORTC, 0x90 | YH);
|
||||
y |= ((bus_space_read_1(tag, handle, MSE_PORTA) & 0x0f) << 4);
|
||||
bus_write_1(port, MSE_PORTC, 0x90 | YH);
|
||||
y |= ((bus_read_1(port, MSE_PORTA) & 0x0f) << 4);
|
||||
|
||||
*but = (bus_space_read_1(tag, handle, MSE_PORTA) >> 5) & 7;
|
||||
*but = (bus_read_1(port, MSE_PORTA) >> 5) & 7;
|
||||
|
||||
*dx = x;
|
||||
*dy = y;
|
||||
|
||||
bus_space_write_1(tag, handle, HC, HC_NO_CLEAR); /* HC = 0 */
|
||||
bus_write_1(port, HC, HC_NO_CLEAR); /* HC = 0 */
|
||||
|
||||
bus_space_write_1(tag, handle, INT, INT_ENABLE); /* INT enable */
|
||||
bus_write_1(port, INT, INT_ENABLE); /* INT enable */
|
||||
}
|
||||
|
||||
@ -91,12 +91,11 @@
|
||||
|
||||
static int mse_isa_probe(device_t dev);
|
||||
static int mse_isa_attach(device_t dev);
|
||||
static int mse_isa_detach(device_t dev);
|
||||
|
||||
static device_method_t mse_methods[] = {
|
||||
DEVMETHOD(device_probe, mse_isa_probe),
|
||||
DEVMETHOD(device_attach, mse_isa_attach),
|
||||
DEVMETHOD(device_detach, mse_isa_detach),
|
||||
DEVMETHOD(device_detach, mse_detach),
|
||||
{ 0, 0 }
|
||||
};
|
||||
|
||||
@ -156,12 +155,10 @@ static struct isa_pnp_id mse_ids[] = {
|
||||
#define MSE_INTREN 0x00
|
||||
|
||||
static int mse_probelogi(device_t dev, mse_softc_t *sc);
|
||||
static void mse_disablelogi(bus_space_tag_t t,
|
||||
bus_space_handle_t h);
|
||||
static void mse_getlogi(bus_space_tag_t t, bus_space_handle_t h,
|
||||
int *dx, int *dy, int *but);
|
||||
static void mse_enablelogi(bus_space_tag_t t,
|
||||
bus_space_handle_t h);
|
||||
static void mse_disablelogi(struct resource *port);
|
||||
static void mse_getlogi(struct resource *port, int *dx, int *dy,
|
||||
int *but);
|
||||
static void mse_enablelogi(struct resource *port);
|
||||
|
||||
/*
|
||||
* ATI Inport mouse definitions
|
||||
@ -175,10 +172,10 @@ static void mse_enablelogi(bus_space_tag_t t,
|
||||
#define MSE_INPORT_INTREN 0x09
|
||||
|
||||
static int mse_probeati(device_t dev, mse_softc_t *sc);
|
||||
static void mse_enableati(bus_space_tag_t t, bus_space_handle_t h);
|
||||
static void mse_disableati(bus_space_tag_t t, bus_space_handle_t h);
|
||||
static void mse_getati(bus_space_tag_t t, bus_space_handle_t h,
|
||||
int *dx, int *dy, int *but);
|
||||
static void mse_enableati(struct resource *port);
|
||||
static void mse_disableati(struct resource *port);
|
||||
static void mse_getati(struct resource *port, int *dx, int *dy,
|
||||
int *but);
|
||||
|
||||
static struct mse_types mse_types[] = {
|
||||
{ MSE_ATIINPORT,
|
||||
@ -213,8 +210,6 @@ mse_isa_probe(device_t dev)
|
||||
MSE_IOSIZE, RF_ACTIVE);
|
||||
if (sc->sc_port == NULL)
|
||||
return ENXIO;
|
||||
sc->sc_iot = rman_get_bustag(sc->sc_port);
|
||||
sc->sc_ioh = rman_get_bushandle(sc->sc_port);
|
||||
|
||||
/*
|
||||
* Check for each mouse type in the table.
|
||||
@ -252,33 +247,10 @@ mse_isa_attach(device_t dev)
|
||||
MSE_IOSIZE, RF_ACTIVE);
|
||||
if (sc->sc_port == NULL)
|
||||
return ENXIO;
|
||||
sc->sc_iot = rman_get_bustag(sc->sc_port);
|
||||
sc->sc_ioh = rman_get_bushandle(sc->sc_port);
|
||||
|
||||
return (mse_common_attach(dev));
|
||||
}
|
||||
|
||||
static int
|
||||
mse_isa_detach(device_t dev)
|
||||
{
|
||||
mse_softc_t *sc;
|
||||
int rid;
|
||||
|
||||
sc = device_get_softc(dev);
|
||||
if (sc->sc_flags & MSESC_OPEN)
|
||||
return EBUSY;
|
||||
|
||||
rid = 0;
|
||||
BUS_TEARDOWN_INTR(device_get_parent(dev), dev, sc->sc_intr, sc->sc_ih);
|
||||
bus_release_resource(dev, SYS_RES_IRQ, rid, sc->sc_intr);
|
||||
bus_release_resource(dev, SYS_RES_IOPORT, rid, sc->sc_port);
|
||||
|
||||
destroy_dev(sc->sc_dev);
|
||||
destroy_dev(sc->sc_ndev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Routines for the Logitech mouse.
|
||||
*/
|
||||
@ -293,15 +265,14 @@ mse_probelogi(device_t dev, mse_softc_t *sc)
|
||||
|
||||
int sig;
|
||||
|
||||
bus_space_write_1(sc->sc_iot, sc->sc_ioh, MSE_PORTD, MSE_SETUP);
|
||||
bus_write_1(sc->sc_port, MSE_PORTD, MSE_SETUP);
|
||||
/* set the signature port */
|
||||
bus_space_write_1(sc->sc_iot, sc->sc_ioh, MSE_PORTB, MSE_LOGI_SIG);
|
||||
bus_write_1(sc->sc_port, MSE_PORTB, MSE_LOGI_SIG);
|
||||
|
||||
DELAY(30000); /* 30 ms delay */
|
||||
sig = bus_space_read_1(sc->sc_iot, sc->sc_ioh, MSE_PORTB) & 0xFF;
|
||||
sig = bus_read_1(sc->sc_port, MSE_PORTB) & 0xFF;
|
||||
if (sig == MSE_LOGI_SIG) {
|
||||
bus_space_write_1(sc->sc_iot, sc->sc_ioh, MSE_PORTC,
|
||||
MSE_DISINTR);
|
||||
bus_write_1(sc->sc_port, MSE_PORTC, MSE_DISINTR);
|
||||
return(1);
|
||||
} else {
|
||||
if (bootverbose)
|
||||
@ -314,46 +285,45 @@ mse_probelogi(device_t dev, mse_softc_t *sc)
|
||||
* Initialize Logitech mouse and enable interrupts.
|
||||
*/
|
||||
static void
|
||||
mse_enablelogi(bus_space_tag_t tag, bus_space_handle_t handle)
|
||||
mse_enablelogi(struct resource *port)
|
||||
{
|
||||
int dx, dy, but;
|
||||
|
||||
bus_space_write_1(tag, handle, MSE_PORTD, MSE_SETUP);
|
||||
mse_getlogi(tag, handle, &dx, &dy, &but);
|
||||
bus_write_1(port, MSE_PORTD, MSE_SETUP);
|
||||
mse_getlogi(port, &dx, &dy, &but);
|
||||
}
|
||||
|
||||
/*
|
||||
* Disable interrupts for Logitech mouse.
|
||||
*/
|
||||
static void
|
||||
mse_disablelogi(bus_space_tag_t tag, bus_space_handle_t handle)
|
||||
mse_disablelogi(struct resource *port)
|
||||
{
|
||||
|
||||
bus_space_write_1(tag, handle, MSE_PORTC, MSE_DISINTR);
|
||||
bus_write_1(port, MSE_PORTC, MSE_DISINTR);
|
||||
}
|
||||
|
||||
/*
|
||||
* Get the current dx, dy and button up/down state.
|
||||
*/
|
||||
static void
|
||||
mse_getlogi(bus_space_tag_t tag, bus_space_handle_t handle, int *dx, int *dy,
|
||||
int *but)
|
||||
mse_getlogi(struct resource *port, int *dx, int *dy, int *but)
|
||||
{
|
||||
register char x, y;
|
||||
|
||||
bus_space_write_1(tag, handle, MSE_PORTC, MSE_HOLD | MSE_RXLOW);
|
||||
x = bus_space_read_1(tag, handle, MSE_PORTA);
|
||||
bus_write_1(port, MSE_PORTC, MSE_HOLD | MSE_RXLOW);
|
||||
x = bus_read_1(port, MSE_PORTA);
|
||||
*but = (x >> 5) & MOUSE_MSC_BUTTONS;
|
||||
x &= 0xf;
|
||||
bus_space_write_1(tag, handle, MSE_PORTC, MSE_HOLD | MSE_RXHIGH);
|
||||
x |= (bus_space_read_1(tag, handle, MSE_PORTA) << 4);
|
||||
bus_space_write_1(tag, handle, MSE_PORTC, MSE_HOLD | MSE_RYLOW);
|
||||
y = (bus_space_read_1(tag, handle, MSE_PORTA) & 0xf);
|
||||
bus_space_write_1(tag, handle, MSE_PORTC, MSE_HOLD | MSE_RYHIGH);
|
||||
y |= (bus_space_read_1(tag, handle, MSE_PORTA) << 4);
|
||||
bus_write_1(port, MSE_PORTC, MSE_HOLD | MSE_RXHIGH);
|
||||
x |= (bus_read_1(port, MSE_PORTA) << 4);
|
||||
bus_write_1(port, MSE_PORTC, MSE_HOLD | MSE_RYLOW);
|
||||
y = (bus_read_1(port, MSE_PORTA) & 0xf);
|
||||
bus_write_1(port, MSE_PORTC, MSE_HOLD | MSE_RYHIGH);
|
||||
y |= (bus_read_1(port, MSE_PORTA) << 4);
|
||||
*dx = x;
|
||||
*dy = y;
|
||||
bus_space_write_1(tag, handle, MSE_PORTC, MSE_INTREN);
|
||||
bus_write_1(port, MSE_PORTC, MSE_INTREN);
|
||||
}
|
||||
|
||||
/*
|
||||
@ -369,7 +339,7 @@ mse_probeati(device_t dev, mse_softc_t *sc)
|
||||
int i;
|
||||
|
||||
for (i = 0; i < 2; i++)
|
||||
if (bus_space_read_1(sc->sc_iot, sc->sc_ioh, MSE_PORTC) == 0xde)
|
||||
if (bus_read_1(sc->sc_port, MSE_PORTC) == 0xde)
|
||||
return (1);
|
||||
return (0);
|
||||
}
|
||||
@ -378,44 +348,43 @@ mse_probeati(device_t dev, mse_softc_t *sc)
|
||||
* Initialize ATI Inport mouse and enable interrupts.
|
||||
*/
|
||||
static void
|
||||
mse_enableati(bus_space_tag_t tag, bus_space_handle_t handle)
|
||||
mse_enableati(struct resource *port)
|
||||
{
|
||||
|
||||
bus_space_write_1(tag, handle, MSE_PORTA, MSE_INPORT_RESET);
|
||||
bus_space_write_1(tag, handle, MSE_PORTA, MSE_INPORT_MODE);
|
||||
bus_space_write_1(tag, handle, MSE_PORTB, MSE_INPORT_INTREN);
|
||||
bus_write_1(port, MSE_PORTA, MSE_INPORT_RESET);
|
||||
bus_write_1(port, MSE_PORTA, MSE_INPORT_MODE);
|
||||
bus_write_1(port, MSE_PORTB, MSE_INPORT_INTREN);
|
||||
}
|
||||
|
||||
/*
|
||||
* Disable interrupts for ATI Inport mouse.
|
||||
*/
|
||||
static void
|
||||
mse_disableati(bus_space_tag_t tag, bus_space_handle_t handle)
|
||||
mse_disableati(struct resource *port)
|
||||
{
|
||||
|
||||
bus_space_write_1(tag, handle, MSE_PORTA, MSE_INPORT_MODE);
|
||||
bus_space_write_1(tag, handle, MSE_PORTB, 0);
|
||||
bus_write_1(port, MSE_PORTA, MSE_INPORT_MODE);
|
||||
bus_write_1(port, MSE_PORTB, 0);
|
||||
}
|
||||
|
||||
/*
|
||||
* Get current dx, dy and up/down button state.
|
||||
*/
|
||||
static void
|
||||
mse_getati(bus_space_tag_t tag, bus_space_handle_t handle, int *dx, int *dy,
|
||||
int *but)
|
||||
mse_getati(struct resource *port, int *dx, int *dy, int *but)
|
||||
{
|
||||
char byte;
|
||||
|
||||
bus_space_write_1(tag, handle, MSE_PORTA, MSE_INPORT_MODE);
|
||||
bus_space_write_1(tag, handle, MSE_PORTB, MSE_INPORT_HOLD);
|
||||
bus_space_write_1(tag, handle, MSE_PORTA, MSE_INPORT_STATUS);
|
||||
*but = ~bus_space_read_1(tag, handle, MSE_PORTB) & MOUSE_MSC_BUTTONS;
|
||||
bus_space_write_1(tag, handle, MSE_PORTA, MSE_INPORT_DX);
|
||||
byte = bus_space_read_1(tag, handle, MSE_PORTB);
|
||||
bus_write_1(port, MSE_PORTA, MSE_INPORT_MODE);
|
||||
bus_write_1(port, MSE_PORTB, MSE_INPORT_HOLD);
|
||||
bus_write_1(port, MSE_PORTA, MSE_INPORT_STATUS);
|
||||
*but = ~bus_read_1(port, MSE_PORTB) & MOUSE_MSC_BUTTONS;
|
||||
bus_write_1(port, MSE_PORTA, MSE_INPORT_DX);
|
||||
byte = bus_read_1(port, MSE_PORTB);
|
||||
*dx = byte;
|
||||
bus_space_write_1(tag, handle, MSE_PORTA, MSE_INPORT_DY);
|
||||
byte = bus_space_read_1(tag, handle, MSE_PORTB);
|
||||
bus_write_1(port, MSE_PORTA, MSE_INPORT_DY);
|
||||
byte = bus_read_1(port, MSE_PORTB);
|
||||
*dy = byte;
|
||||
bus_space_write_1(tag, handle, MSE_PORTA, MSE_INPORT_MODE);
|
||||
bus_space_write_1(tag, handle, MSE_PORTB, MSE_INPORT_INTREN);
|
||||
bus_write_1(port, MSE_PORTA, MSE_INPORT_MODE);
|
||||
bus_write_1(port, MSE_PORTB, MSE_INPORT_INTREN);
|
||||
}
|
||||
|
||||
@ -46,7 +46,7 @@
|
||||
|
||||
/*
|
||||
* Software control structure for mouse. The sc_enablemouse(),
|
||||
* sc_disablemouse() and sc_getmouse() routines must be called spl'd().
|
||||
* sc_disablemouse() and sc_getmouse() routines must be called locked.
|
||||
*/
|
||||
typedef struct mse_softc {
|
||||
int sc_flags;
|
||||
@ -54,22 +54,19 @@ typedef struct mse_softc {
|
||||
struct selinfo sc_selp;
|
||||
struct resource *sc_port;
|
||||
struct resource *sc_intr;
|
||||
bus_space_tag_t sc_iot;
|
||||
bus_space_handle_t sc_ioh;
|
||||
void *sc_ih;
|
||||
void (*sc_enablemouse)(bus_space_tag_t t,
|
||||
bus_space_handle_t h);
|
||||
void (*sc_disablemouse)(bus_space_tag_t t,
|
||||
bus_space_handle_t h);
|
||||
void (*sc_getmouse)(bus_space_tag_t t, bus_space_handle_t h,
|
||||
int *dx, int *dy, int *but);
|
||||
void (*sc_enablemouse)(struct resource *port);
|
||||
void (*sc_disablemouse)(struct resource *port);
|
||||
void (*sc_getmouse)(struct resource *port, int *dx, int *dy,
|
||||
int *but);
|
||||
int sc_deltax;
|
||||
int sc_deltay;
|
||||
int sc_obuttons;
|
||||
int sc_buttons;
|
||||
int sc_bytesread;
|
||||
u_char sc_bytes[MOUSE_SYS_PACKETSIZE];
|
||||
struct callout_handle sc_callout;
|
||||
struct callout sc_callout;
|
||||
struct mtx sc_lock;
|
||||
int sc_watchdog;
|
||||
struct cdev *sc_dev;
|
||||
struct cdev *sc_ndev;
|
||||
@ -78,9 +75,14 @@ typedef struct mse_softc {
|
||||
mousestatus_t status;
|
||||
} mse_softc_t;
|
||||
|
||||
#define MSE_LOCK(sc) mtx_lock(&(sc)->sc_lock)
|
||||
#define MSE_UNLOCK(sc) mtx_unlock(&(sc)->sc_lock)
|
||||
#define MSE_ASSERT_LOCKED(sc) mtx_assert(&(sc)->sc_lock, MA_OWNED)
|
||||
|
||||
/* Flags */
|
||||
#define MSESC_OPEN 0x1
|
||||
#define MSESC_WANT 0x2
|
||||
#define MSESC_READING 0x4
|
||||
|
||||
/* and Mouse Types */
|
||||
#define MSE_NONE 0 /* don't move this! */
|
||||
@ -110,12 +112,11 @@ struct mse_types {
|
||||
int m_type; /* Type of bus mouse */
|
||||
int (*m_probe)(device_t dev, mse_softc_t *sc);
|
||||
/* Probe routine to test for it */
|
||||
void (*m_enable)(bus_space_tag_t t, bus_space_handle_t h);
|
||||
void (*m_enable)(struct resource *port);
|
||||
/* Start routine */
|
||||
void (*m_disable)(bus_space_tag_t t, bus_space_handle_t h);
|
||||
void (*m_disable)(struct resource *port);
|
||||
/* Disable interrupts routine */
|
||||
void (*m_get)(bus_space_tag_t t, bus_space_handle_t h, int *dx,
|
||||
int *dy, int *but);
|
||||
void (*m_get)(struct resource *port, int *dx, int *dy, int *but);
|
||||
/* and get mouse status */
|
||||
mousehw_t m_hw; /* buttons iftype type model hwid */
|
||||
mousemode_t m_mode; /* proto rate res accel level size mask */
|
||||
@ -123,3 +124,4 @@ struct mse_types {
|
||||
|
||||
extern devclass_t mse_devclass;
|
||||
int mse_common_attach(device_t);
|
||||
int mse_detach(device_t);
|
||||
|
||||
Loading…
Reference in New Issue
Block a user