#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: dtms.c,v 1.13 2021/08/07 16:19:02 thorpej Exp $");
#include "locators.h"
#include <sys/param.h>
#include <sys/bus.h>
#include <sys/device.h>
#include <sys/ioctl.h>
#include <sys/syslog.h>
#include <sys/systm.h>
#include <pmax/tc/dtreg.h>
#include <pmax/tc/dtvar.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsmousevar.h>
struct dtms_softc {
device_t sc_dev;
device_t sc_wsmousedev;
int sc_enabled;
};
int dtms_match(device_t, cfdata_t, void *);
void dtms_attach(device_t, device_t, void *);
int dtms_input(void *, int);
int dtms_enable(void *);
int dtms_ioctl(void *, u_long, void *, int, struct lwp *);
void dtms_disable(void *);
void dtms_handler(void *, struct dt_msg *);
CFATTACH_DECL_NEW(dtms, sizeof(struct dtms_softc),
dtms_match, dtms_attach, NULL, NULL);
const struct wsmouse_accessops dtms_accessops = {
dtms_enable,
dtms_ioctl,
dtms_disable,
};
int
dtms_match(device_t parent, cfdata_t cf, void *aux)
{
struct dt_attach_args *dta;
dta = aux;
return (dta->dta_addr == DT_ADDR_MOUSE);
}
void
dtms_attach(device_t parent, device_t self, void *aux)
{
struct wsmousedev_attach_args a;
struct dtms_softc *sc;
struct dt_softc *dt;
dt = device_private(parent);
sc = device_private(self);
sc->sc_dev = self;
printf("\n");
if (dt_establish_handler(dt, &dt_ms_dv, sc, dtms_handler)) {
printf("%s: unable to establish handler\n", device_xname(self));
return;
}
a.accessops = &dtms_accessops;
a.accesscookie = sc;
sc->sc_wsmousedev = config_found(self, &a, wsmousedevprint, CFARGS_NONE);
}
int
dtms_enable(void *cookie)
{
struct dtms_softc *sc;
sc = cookie;
if (sc->sc_enabled)
return (EBUSY);
sc->sc_enabled = 1;
return (0);
}
void
dtms_disable(void *cookie)
{
struct dtms_softc *sc;
sc = cookie;
sc->sc_enabled = 0;
}
int
dtms_ioctl(void *v, u_long cmd, void *data, int flag, struct lwp *l)
{
if (cmd == WSMOUSEIO_GTYPE) {
*(u_int *)data = WSMOUSE_TYPE_VSXXX;
return (0);
}
return (EPASSTHROUGH);
}
void
dtms_handler(void *cookie, struct dt_msg *msg)
{
struct dtms_softc *sc;
int buttons, dx, dy;
short tmp;
sc = cookie;
if (!sc->sc_enabled)
return;
tmp = DT_GET_SHORT(msg->body[0], msg->body[1]);
buttons = tmp & 1;
if (tmp & 2)
buttons |= 4;
if (tmp & 4)
buttons |= 2;
tmp = DT_GET_SHORT(msg->body[2], msg->body[3]);
if (tmp < 0)
dx = -(-tmp & 0x1f);
else
dx = tmp & 0x1f;
tmp = DT_GET_SHORT(msg->body[4], msg->body[5]);
if (tmp < 0)
dy = -(-tmp & 0x1f);
else
dy = tmp & 0x1f;
wsmouse_input(sc->sc_wsmousedev,
buttons,
dx, dy, 0, 0,
WSMOUSE_INPUT_DELTA);
}