add support for native "Intelli" mice (wheel = z axis)
This commit is contained in:
drochner
parent
eec66e52bd
commit
ee4bf8991d
@ -1,4 +1,4 @@
|
||||
# $NetBSD: files.pckbc,v 1.3 1998/06/16 11:26:04 drochner Exp $
|
||||
# $NetBSD: files.pckbc,v 1.4 1998/07/27 22:36:23 drochner Exp $
|
||||
# devices attached at pckbc, for use with wscons
|
||||
|
||||
device pckbd: wskbddev
|
||||
@ -9,3 +9,7 @@ defopt PCKBD_LAYOUT
|
||||
device psm: wsmousedev
|
||||
attach psm at pckbc
|
||||
file dev/pckbc/psm.c psm
|
||||
|
||||
device psmi: wsmousedev
|
||||
attach psmi at pckbc
|
||||
file dev/pckbc/psm_intelli.c psmi
|
||||
|
||||
330
sys/dev/pckbc/psm_intelli.c
Normal file
330
sys/dev/pckbc/psm_intelli.c
Normal file
@ -0,0 +1,330 @@
|
||||
/* $NetBSD: psm_intelli.c,v 1.1 1998/07/27 22:36:23 drochner Exp $ */
|
||||
|
||||
/*-
|
||||
* Copyright (c) 1994 Charles Hannum.
|
||||
* Copyright (c) 1992, 1993 Erik Forsberg.
|
||||
* All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
* 1. Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY ``AS IS'' AND ANY EXPRESS OR IMPLIED
|
||||
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
||||
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
|
||||
* NO EVENT SHALL I BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
||||
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
||||
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
||||
* PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||||
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
*/
|
||||
|
||||
#include <sys/param.h>
|
||||
#include <sys/systm.h>
|
||||
#include <sys/device.h>
|
||||
#include <sys/ioctl.h>
|
||||
|
||||
#include <dev/isa/isavar.h>
|
||||
#include <dev/isa/pckbcvar.h>
|
||||
|
||||
#include <dev/pckbc/psmreg.h>
|
||||
|
||||
#include <dev/wscons/wsconsio.h>
|
||||
#include <dev/wscons/wsmousevar.h>
|
||||
|
||||
struct psmi_softc { /* driver status information */
|
||||
struct device sc_dev;
|
||||
|
||||
pckbc_tag_t sc_kbctag;
|
||||
int sc_kbcslot;
|
||||
|
||||
int sc_enabled; /* input enabled? */
|
||||
int inputstate;
|
||||
u_int buttons, oldbuttons; /* mouse button status */
|
||||
signed char dx, dy;
|
||||
|
||||
struct device *sc_wsmousedev;
|
||||
};
|
||||
|
||||
int psmiprobe __P((struct device *, struct cfdata *, void *));
|
||||
void psmiattach __P((struct device *, struct device *, void *));
|
||||
void psmiinput __P((void *, int));
|
||||
|
||||
struct cfattach psmi_ca = {
|
||||
sizeof(struct psmi_softc), psmiprobe, psmiattach,
|
||||
};
|
||||
|
||||
int psmi_enable __P((void *));
|
||||
int psmi_ioctl __P((void *, u_long, caddr_t, int, struct proc *));
|
||||
void psmi_disable __P((void *));
|
||||
|
||||
const struct wsmouse_accessops psmi_accessops = {
|
||||
psmi_enable,
|
||||
psmi_ioctl,
|
||||
psmi_disable,
|
||||
};
|
||||
|
||||
static int psmi_setintellimode __P((pckbc_tag_t, pckbc_slot_t));
|
||||
|
||||
static int
|
||||
psmi_setintellimode(tag, slot)
|
||||
pckbc_tag_t tag;
|
||||
pckbc_slot_t slot;
|
||||
{
|
||||
u_char cmd[2], resp[1];
|
||||
int i, res;
|
||||
static u_char rates[] = {200, 100, 80};
|
||||
|
||||
cmd[0] = PMS_SET_SAMPLE;
|
||||
for (i = 0; i < 3; i++) {
|
||||
cmd[1] = rates[i];
|
||||
res = pckbc_poll_cmd(tag, slot, cmd, 2, 0, 0, 0);
|
||||
if (res)
|
||||
return (res);
|
||||
}
|
||||
|
||||
cmd[0] = PMS_SEND_DEV_ID;
|
||||
res = pckbc_poll_cmd(tag, slot, cmd, 1, 1, resp, 0);
|
||||
if (res)
|
||||
return (res);
|
||||
if (resp[0] != 3)
|
||||
return (ENXIO);
|
||||
|
||||
return (0);
|
||||
}
|
||||
|
||||
int
|
||||
psmiprobe(parent, match, aux)
|
||||
struct device *parent;
|
||||
struct cfdata *match;
|
||||
void *aux;
|
||||
{
|
||||
struct pckbc_attach_args *pa = aux;
|
||||
u_char cmd[1], resp[2];
|
||||
int res;
|
||||
|
||||
if (pa->pa_slot != PCKBC_AUX_SLOT)
|
||||
return (0);
|
||||
|
||||
/* Flush any garbage. */
|
||||
pckbc_flush(pa->pa_tag, pa->pa_slot);
|
||||
|
||||
/* reset the device */
|
||||
cmd[0] = PMS_RESET;
|
||||
res = pckbc_poll_cmd(pa->pa_tag, pa->pa_slot, cmd, 1, 2, resp, 1);
|
||||
if (res) {
|
||||
#ifdef DEBUG
|
||||
printf("psmiprobe: reset error %d\n", res);
|
||||
#endif
|
||||
return (0);
|
||||
}
|
||||
if (resp[0] != PMS_RSTDONE) {
|
||||
printf("psmiprobe: reset response 0x%x\n", resp[0]);
|
||||
return (0);
|
||||
}
|
||||
|
||||
/* get type number (0 = mouse) */
|
||||
if (resp[1] != 0) {
|
||||
#ifdef DEBUG
|
||||
printf("psmiprobe: type 0x%x\n", resp[1]);
|
||||
#endif
|
||||
return (0);
|
||||
}
|
||||
|
||||
if ((res = psmi_setintellimode(pa->pa_tag, pa->pa_slot))) {
|
||||
#ifdef DEBUG
|
||||
printf("psmiprobe: intellimode -> %d\n", res);
|
||||
#endif
|
||||
return (0);
|
||||
}
|
||||
|
||||
return (20);
|
||||
}
|
||||
|
||||
void
|
||||
psmiattach(parent, self, aux)
|
||||
struct device *parent, *self;
|
||||
void *aux;
|
||||
{
|
||||
struct psmi_softc *sc = (void *)self;
|
||||
struct pckbc_attach_args *pa = aux;
|
||||
struct wsmousedev_attach_args a;
|
||||
u_char cmd[1], resp[2];
|
||||
int res;
|
||||
|
||||
sc->sc_kbctag = pa->pa_tag;
|
||||
sc->sc_kbcslot = pa->pa_slot;
|
||||
|
||||
printf("\n");
|
||||
|
||||
/* Flush any garbage. */
|
||||
pckbc_flush(pa->pa_tag, pa->pa_slot);
|
||||
|
||||
/* reset the device */
|
||||
cmd[0] = PMS_RESET;
|
||||
res = pckbc_poll_cmd(pa->pa_tag, pa->pa_slot, cmd, 1, 2, resp, 1);
|
||||
#ifdef DEBUG
|
||||
if (res || resp[0] != PMS_RSTDONE || resp[1] != 0) {
|
||||
printf("psmiattach: reset error\n");
|
||||
return;
|
||||
}
|
||||
#endif
|
||||
res = psmi_setintellimode(pa->pa_tag, pa->pa_slot);
|
||||
#ifdef DEBUG
|
||||
if (res) {
|
||||
printf("psmiattach: error setting intelli mode\n");
|
||||
return;
|
||||
}
|
||||
#endif
|
||||
|
||||
/* Other initialization was done by psmiprobe. */
|
||||
sc->inputstate = 0;
|
||||
sc->oldbuttons = 0;
|
||||
|
||||
pckbc_set_inputhandler(sc->sc_kbctag, sc->sc_kbcslot,
|
||||
psmiinput, sc);
|
||||
|
||||
a.accessops = &psmi_accessops;
|
||||
a.accesscookie = sc;
|
||||
|
||||
/*
|
||||
* Attach the wsmouse, saving a handle to it.
|
||||
* Note that we don't need to check this pointer against NULL
|
||||
* here or in psmintr, because if this fails pms_enable() will
|
||||
* never be called, so psmintr() will never be called.
|
||||
*/
|
||||
sc->sc_wsmousedev = config_found(self, &a, wsmousedevprint);
|
||||
|
||||
/* no interrupts until enabled */
|
||||
cmd[0] = PMS_DEV_DISABLE;
|
||||
res = pckbc_poll_cmd(pa->pa_tag, pa->pa_slot, cmd, 1, 0, 0, 0);
|
||||
if (res)
|
||||
printf("psmiattach: disable error\n");
|
||||
pckbc_slot_enable(sc->sc_kbctag, sc->sc_kbcslot, 0);
|
||||
}
|
||||
|
||||
int
|
||||
psmi_enable(v)
|
||||
void *v;
|
||||
{
|
||||
struct psmi_softc *sc = v;
|
||||
u_char cmd[1];
|
||||
int res;
|
||||
|
||||
if (sc->sc_enabled)
|
||||
return EBUSY;
|
||||
|
||||
sc->sc_enabled = 1;
|
||||
sc->inputstate = 0;
|
||||
sc->oldbuttons = 0;
|
||||
|
||||
pckbc_slot_enable(sc->sc_kbctag, sc->sc_kbcslot, 1);
|
||||
|
||||
cmd[0] = PMS_DEV_ENABLE;
|
||||
res = pckbc_enqueue_cmd(sc->sc_kbctag, sc->sc_kbcslot, cmd, 1, 0, 1, 0);
|
||||
if (res)
|
||||
printf("psmi_enable: command error\n");
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void
|
||||
psmi_disable(v)
|
||||
void *v;
|
||||
{
|
||||
struct psmi_softc *sc = v;
|
||||
u_char cmd[1];
|
||||
int res;
|
||||
|
||||
cmd[0] = PMS_DEV_DISABLE;
|
||||
res = pckbc_enqueue_cmd(sc->sc_kbctag, sc->sc_kbcslot, cmd, 1, 0, 1, 0);
|
||||
if (res)
|
||||
printf("psmi_disable: command error\n");
|
||||
|
||||
pckbc_slot_enable(sc->sc_kbctag, sc->sc_kbcslot, 0);
|
||||
|
||||
sc->sc_enabled = 0;
|
||||
}
|
||||
|
||||
int
|
||||
psmi_ioctl(v, cmd, data, flag, p)
|
||||
void *v;
|
||||
u_long cmd;
|
||||
caddr_t data;
|
||||
int flag;
|
||||
struct proc *p;
|
||||
{
|
||||
#if 0
|
||||
struct pms_softc *sc = v;
|
||||
#endif
|
||||
|
||||
switch (cmd) {
|
||||
case WSMOUSEIO_GTYPE:
|
||||
*(u_int *)data = WSMOUSE_TYPE_PS2;
|
||||
return (0);
|
||||
}
|
||||
return (-1);
|
||||
}
|
||||
|
||||
/* Masks for the first byte of a packet */
|
||||
#define PS2LBUTMASK 0x01
|
||||
#define PS2RBUTMASK 0x02
|
||||
#define PS2MBUTMASK 0x04
|
||||
|
||||
void psmiinput(vsc, data)
|
||||
void *vsc;
|
||||
int data;
|
||||
{
|
||||
struct psmi_softc *sc = vsc;
|
||||
signed char dz;
|
||||
u_int changed;
|
||||
|
||||
if (!sc->sc_enabled) {
|
||||
/* Interrupts are not expected. Discard the byte. */
|
||||
return;
|
||||
}
|
||||
|
||||
switch (sc->inputstate) {
|
||||
|
||||
case 0:
|
||||
if ((data & 0xc0) == 0) { /* no ovfl, bit 3 == 1 too? */
|
||||
sc->buttons = ((data & PS2LBUTMASK) ? 0x1 : 0) |
|
||||
((data & PS2MBUTMASK) ? 0x2 : 0) |
|
||||
((data & PS2RBUTMASK) ? 0x4 : 0);
|
||||
++sc->inputstate;
|
||||
}
|
||||
break;
|
||||
|
||||
case 1:
|
||||
sc->dx = data;
|
||||
/* Bounding at -127 avoids a bug in XFree86. */
|
||||
sc->dx = (sc->dx == -128) ? -127 : sc->dx;
|
||||
++sc->inputstate;
|
||||
break;
|
||||
|
||||
case 2:
|
||||
sc->dy = data;
|
||||
sc->dy = (sc->dy == -128) ? -127 : sc->dy;
|
||||
++sc->inputstate;
|
||||
break;
|
||||
|
||||
case 3:
|
||||
dz = data;
|
||||
dz = (dz == -128) ? -127 : dz;
|
||||
sc->inputstate = 0;
|
||||
|
||||
changed = (sc->buttons ^ sc->oldbuttons);
|
||||
sc->oldbuttons = sc->buttons;
|
||||
|
||||
if (sc->dx || sc->dy || changed)
|
||||
wsmouse_input(sc->sc_wsmousedev,
|
||||
sc->buttons, sc->dx, sc->dy, dz);
|
||||
break;
|
||||
}
|
||||
|
||||
return;
|
||||
}
|
||||
Loading…
Reference in New Issue
Block a user