#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: ms.c,v 1.28 2022/06/26 06:25:09 tsutsui Exp $");
#include <sys/param.h>
#include <sys/conf.h>
#include <sys/ioctl.h>
#include <sys/kernel.h>
#include <sys/proc.h>
#include <sys/systm.h>
#include <sys/callout.h>
#include <sys/tty.h>
#include <sys/signalvar.h>
#include <machine/msioctl.h>
#include <atari/dev/event_var.h>
#include <atari/dev/vuid_event.h>
#include <atari/dev/kbdvar.h>
#include <atari/dev/msvar.h>
#include "mouse.h"
#if NMOUSE > 0
#if NMOUSE > 1
#undef NMOUSE
#define NMOUSE 1
#endif
typedef void (*FPV)(void *);
static struct ms_softc ms_softc[NMOUSE];
static dev_type_open(msopen);
static dev_type_close(msclose);
static dev_type_read(msread);
static dev_type_ioctl(msioctl);
static dev_type_poll(mspoll);
static dev_type_kqfilter(mskqfilter);
const struct cdevsw ms_cdevsw = {
.d_open = msopen,
.d_close = msclose,
.d_read = msread,
.d_write = nowrite,
.d_ioctl = msioctl,
.d_stop = nostop,
.d_tty = notty,
.d_poll = mspoll,
.d_mmap = nommap,
.d_kqfilter = mskqfilter,
.d_discard = nodiscard,
.d_flag = 0
};
static void ms_3b_delay(struct ms_softc *);
int
mouseattach(int cnt)
{
printf("1 mouse configured\n");
ms_softc[0].ms_emul3b = 1;
callout_init(&ms_softc[0].ms_delay_ch, 0);
return NMOUSE;
}
static void
ms_3b_delay(struct ms_softc *ms)
{
REL_MOUSE rel_ms;
rel_ms.id = TIMEOUT_ID;
rel_ms.dx = rel_ms.dy = 0;
mouse_soft(&rel_ms, sizeof(rel_ms), KBD_TIMEO_PKG);
}
void
mouse_soft(REL_MOUSE *rel_ms, int size, int type)
{
struct ms_softc *ms = &ms_softc[0];
struct firm_event *fe, *fe2;
REL_MOUSE fake_mouse;
int get, put;
int s;
uint8_t mbut, bmask;
int flush_buttons;
if (ms->ms_events.ev_io == NULL)
return;
switch (type) {
case KBD_JOY1_PKG:
if (ms->ms_emul3b)
return;
flush_buttons = 1;
fake_mouse.id = ((rel_ms->dx & 0x01) != 0 ? 0x04 : 0x00) |
(ms->ms_buttons & 0x03);
fake_mouse.dx = fake_mouse.dy = 0;
rel_ms = &fake_mouse;
break;
case KBD_TIMEO_PKG:
flush_buttons = 1;
fake_mouse.id = ms->ms_buttons;
fake_mouse.dx = fake_mouse.dy = 0;
rel_ms = &fake_mouse;
break;
case KBD_RMS_PKG:
rel_ms->id = (ms->ms_buttons & 0x04) | (rel_ms->id & 0x03);
flush_buttons = ms->ms_emul3b ? 0 : 1;
break;
default:
return;
}
s = splev();
get = ms->ms_events.ev_get;
put = ms->ms_events.ev_put;
fe = &ms->ms_events.ev_q[put];
if ((type != KBD_TIMEO_PKG) && ms->ms_emul3b && ms->ms_bq_idx != 0)
callout_stop(&ms->ms_delay_ch);
if ((mbut = (rel_ms->id ^ ms->ms_buttons)) == 0 && (put != get)) {
ms->ms_dx += rel_ms->dx;
ms->ms_dy += rel_ms->dy;
goto out;
}
rel_ms->dx += ms->ms_dx;
rel_ms->dy += ms->ms_dy;
ms->ms_dx = ms->ms_dy = 0;
if (rel_ms->dx != 0) {
if ((++put) % EV_QSIZE == get) {
put--;
goto out;
}
fe->id = LOC_X_DELTA;
fe->value = rel_ms->dx;
firm_gettime(fe);
if (put >= EV_QSIZE) {
put = 0;
fe = &ms->ms_events.ev_q[0];
} else {
fe++;
}
}
if (rel_ms->dy != 0) {
if ((++put) % EV_QSIZE == get) {
put--;
goto out;
}
fe->id = LOC_Y_DELTA;
fe->value = rel_ms->dy;
firm_gettime(fe);
if (put >= EV_QSIZE) {
put = 0;
fe = &ms->ms_events.ev_q[0];
} else {
fe++;
}
}
if (mbut != 0 && (type != KBD_TIMEO_PKG)) {
for (bmask = 0x01; bmask < 0x08; bmask <<= 1) {
if ((mbut & bmask) == 0)
continue;
fe2 = &ms->ms_bq[ms->ms_bq_idx++];
if (bmask == 0x01)
fe2->id = MS_RIGHT;
else if (bmask == 0x02)
fe2->id = MS_LEFT;
else
fe2->id = MS_MIDDLE;
fe2->value =
(rel_ms->id & bmask) != 0 ? VKEY_DOWN : VKEY_UP;
firm_gettime(fe2);
}
}
if (ms->ms_emul3b && ms->ms_bq_idx != 0 && (type != KBD_TIMEO_PKG)) {
if ((ms->ms_buttons & 0x04) != 0 && (mbut & 0x03) != 0) {
ms->ms_bq[0].id = MS_MIDDLE;
ms->ms_bq_idx = 1;
rel_ms->id = 0;
flush_buttons = 1;
goto out;
}
if (ms->ms_bq_idx == 2) {
if (ms->ms_bq[0].value == ms->ms_bq[1].value) {
ms->ms_bq[0].id = MS_MIDDLE;
ms->ms_bq_idx = 1;
rel_ms->id = 7;
}
}
else if (ms->ms_bq[0].value == VKEY_DOWN) {
callout_reset(&ms->ms_delay_ch, 10,
(FPV)ms_3b_delay, (void *)ms);
goto out;
}
flush_buttons = 1;
}
out:
if (flush_buttons) {
int i;
for (i = 0; i < ms->ms_bq_idx; i++) {
if ((++put) % EV_QSIZE == get) {
ms->ms_bq_idx = 0;
put--;
goto out;
}
*fe = ms->ms_bq[i];
if (put >= EV_QSIZE) {
put = 0;
fe = &ms->ms_events.ev_q[0];
} else {
fe++;
}
}
ms->ms_bq_idx = 0;
}
ms->ms_events.ev_put = put;
ms->ms_buttons = rel_ms->id;
splx(s);
EV_WAKEUP(&ms->ms_events);
}
static int
msopen(dev_t dev, int flags, int mode, struct lwp *l)
{
uint8_t report_ms_joy[] = { 0x14, 0x08 };
struct ms_softc *ms;
int unit;
unit = minor(dev);
ms = &ms_softc[unit];
if (unit >= NMOUSE)
return EXDEV;
if (ms->ms_events.ev_io)
return EBUSY;
ms->ms_events.ev_io = l->l_proc;
ms->ms_dx = ms->ms_dy = 0;
ms->ms_buttons = 0;
ms->ms_bq[0].id = ms->ms_bq[1].id = 0;
ms->ms_bq_idx = 0;
ev_init(&ms->ms_events);
kbd_write(report_ms_joy, sizeof(report_ms_joy));
return 0;
}
static int
msclose(dev_t dev, int flags, int mode, struct lwp *l)
{
uint8_t disable_ms_joy[] = { 0x12, 0x1a };
int unit;
struct ms_softc *ms;
unit = minor(dev);
ms = &ms_softc[unit];
kbd_write(disable_ms_joy, sizeof(disable_ms_joy));
ev_fini(&ms->ms_events);
ms->ms_events.ev_io = NULL;
return 0;
}
static int
msread(dev_t dev, struct uio *uio, int flags)
{
struct ms_softc *ms;
ms = &ms_softc[minor(dev)];
return ev_read(&ms->ms_events, uio, flags);
}
static int
msioctl(dev_t dev, u_long cmd, register void * data, int flag, struct lwp *l)
{
struct ms_softc *ms;
int unit;
unit = minor(dev);
ms = &ms_softc[unit];
switch (cmd) {
case MIOCS3B_EMUL:
ms->ms_emul3b = (*(int *)data != 0) ? 1 : 0;
return 0;
case MIOCG3B_EMUL:
*(int *)data = ms->ms_emul3b;
return 0;
case FIONBIO:
return 0;
case FIOASYNC:
ms->ms_events.ev_async = *(int *)data != 0;
return 0;
case FIOSETOWN:
if (-*(int *)data != ms->ms_events.ev_io->p_pgid &&
*(int *)data != ms->ms_events.ev_io->p_pid)
return EPERM;
return 0;
case TIOCSPGRP:
if (*(int *)data != ms->ms_events.ev_io->p_pgid)
return EPERM;
return 0;
case VUIDGFORMAT:
*(int *)data = VUID_FIRM_EVENT;
return 0;
case VUIDSFORMAT:
if (*(int *)data != VUID_FIRM_EVENT)
return EINVAL;
return 0;
}
return ENOTTY;
}
static int
mspoll(dev_t dev, int events, struct lwp *l)
{
struct ms_softc *ms;
ms = &ms_softc[minor(dev)];
return ev_poll(&ms->ms_events, events, l);
}
static int
mskqfilter(dev_t dev, struct knote *kn)
{
struct ms_softc *ms;
ms = &ms_softc[minor(dev)];
return ev_kqfilter(&ms->ms_events, kn);
}
#endif