438 lines
11 KiB
C
438 lines
11 KiB
C
/* $NetBSD: zsms.c,v 1.17 2008/03/29 19:15:36 tsutsui Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1992, 1993
|
|
* The Regents of the University of California. All rights reserved.
|
|
*
|
|
* This software was developed by the Computer Systems Engineering group
|
|
* at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
|
|
* contributed to Berkeley.
|
|
*
|
|
* All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by the University of
|
|
* California, Lawrence Berkeley Laboratory.
|
|
*
|
|
* 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.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. Neither the name of the University nor the names of its contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``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 THE REGENTS OR CONTRIBUTORS 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.
|
|
*
|
|
* @(#)ms.c 8.1 (Berkeley) 6/11/93
|
|
*/
|
|
|
|
/*
|
|
* VSXXX mice attached with channel A of the 1st SCC
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: zsms.c,v 1.17 2008/03/29 19:15:36 tsutsui Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/syslog.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/tty.h>
|
|
|
|
#include <dev/ic/z8530reg.h>
|
|
#include <machine/z8530var.h>
|
|
|
|
#include <dev/dec/lk201.h>
|
|
|
|
#include <dev/wscons/wsconsio.h>
|
|
#include <dev/wscons/wsmousevar.h>
|
|
|
|
#include "locators.h"
|
|
|
|
/*
|
|
* How many input characters we can buffer.
|
|
* The port-specific var.h may override this.
|
|
* Note: must be a power of two!
|
|
*/
|
|
#define ZSMS_RX_RING_SIZE 256
|
|
#define ZSMS_RX_RING_MASK (ZSMS_RX_RING_SIZE-1)
|
|
/*
|
|
* Output buffer. Only need a few chars.
|
|
*/
|
|
#define ZSMS_TX_RING_SIZE 16
|
|
#define ZSMS_TX_RING_MASK (ZSMS_TX_RING_SIZE-1)
|
|
|
|
#define ZSMS_BPS 4800
|
|
|
|
struct zsms_softc { /* driver status information */
|
|
device_t zsms_dev; /* required first: base device */
|
|
struct zs_chanstate *zsms_cs;
|
|
|
|
/* Flags to communicate with zsms_softintr() */
|
|
volatile int zsms_intr_flags;
|
|
#define INTR_RX_OVERRUN 1
|
|
#define INTR_TX_EMPTY 2
|
|
#define INTR_ST_CHECK 4
|
|
|
|
/*
|
|
* The receive ring buffer.
|
|
*/
|
|
u_int zsms_rbget; /* ring buffer `get' index */
|
|
volatile u_int zsms_rbput; /* ring buffer `put' index */
|
|
u_short zsms_rbuf[ZSMS_RX_RING_SIZE]; /* rr1, data pairs */
|
|
|
|
int sc_enabled; /* input enabled? */
|
|
int sc_selftest; /* self test in progress */
|
|
|
|
int inputstate;
|
|
u_int buttons;
|
|
int dx, dy;
|
|
|
|
struct device *sc_wsmousedev;
|
|
};
|
|
|
|
static struct zsops zsops_zsms;
|
|
|
|
static int zsms_match(device_t, cfdata_t, void *);
|
|
static void zsms_attach(device_t, device_t, void *);
|
|
static void zsms_input(void *, int);
|
|
|
|
CFATTACH_DECL_NEW(zsms, sizeof(struct zsms_softc),
|
|
zsms_match, zsms_attach, NULL, NULL);
|
|
|
|
static int zsms_enable(void *);
|
|
static int zsms_ioctl(void *, u_long, void *, int, struct lwp *);
|
|
static void zsms_disable(void *);
|
|
|
|
static const struct wsmouse_accessops zsms_accessops = {
|
|
zsms_enable,
|
|
zsms_ioctl,
|
|
zsms_disable,
|
|
};
|
|
|
|
static int
|
|
zsms_match(device_t parent, cfdata_t cf, void *aux)
|
|
{
|
|
struct zsc_attach_args *args = aux;
|
|
|
|
/* Exact match is better than wildcard. */
|
|
if (cf->cf_loc[ZSCCF_CHANNEL] == args->channel)
|
|
return 2;
|
|
|
|
/* This driver accepts wildcard. */
|
|
if (cf->cf_loc[ZSCCF_CHANNEL] == ZSCCF_CHANNEL_DEFAULT)
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
zsms_attach(device_t parent, device_t self, void *aux)
|
|
{
|
|
struct zsc_softc *zsc = device_private(parent);
|
|
struct zsms_softc *zsms = device_private(self);
|
|
struct zsc_attach_args *args = aux;
|
|
struct zs_chanstate *cs;
|
|
struct wsmousedev_attach_args a;
|
|
int s;
|
|
|
|
zsms->zsms_dev = self;
|
|
cs = zsc->zsc_cs[args->channel];
|
|
cs->cs_private = zsms;
|
|
cs->cs_ops = &zsops_zsms;
|
|
zsms->zsms_cs = cs;
|
|
|
|
aprint_normal("\n");
|
|
|
|
/* Initialize the speed, etc. */
|
|
s = splzs();
|
|
/* May need reset... */
|
|
zs_write_reg(cs, 9, ZSWR9_A_RESET);
|
|
/* These are OK as set by zscc: WR3, WR5 */
|
|
/* We don't care about status or tx interrupts. */
|
|
cs->cs_preg[1] = ZSWR1_RIE;
|
|
(void) zs_set_speed(cs, ZSMS_BPS);
|
|
|
|
/* mouse wants odd parity */
|
|
cs->cs_preg[4] |= ZSWR4_PARENB;
|
|
/* cs->cs_preg[4] &= ~ZSWR4_EVENP; (no-op) */
|
|
|
|
zs_loadchannelregs(cs);
|
|
splx(s);
|
|
|
|
a.accessops = &zsms_accessops;
|
|
a.accesscookie = zsms;
|
|
|
|
zsms->sc_enabled = 0;
|
|
zsms->sc_selftest = 0;
|
|
zsms->sc_wsmousedev = config_found(self, &a, wsmousedevprint);
|
|
}
|
|
|
|
static int
|
|
zsms_enable(void *v)
|
|
{
|
|
struct zsms_softc *sc = v;
|
|
|
|
if (sc->sc_enabled)
|
|
return EBUSY;
|
|
|
|
sc->sc_selftest = 4; /* wait for 4 byte reply upto 1/2 sec */
|
|
zs_write_data(sc->zsms_cs, MOUSE_SELF_TEST);
|
|
(void)tsleep(zsms_enable, TTIPRI, "zsmsopen", hz / 2);
|
|
if (sc->sc_selftest != 0) {
|
|
sc->sc_selftest = 0;
|
|
return ENXIO;
|
|
}
|
|
/* XXX DELAY before mode set? */
|
|
zs_write_data(sc->zsms_cs, MOUSE_INCREMENTAL);
|
|
sc->sc_enabled = 1;
|
|
sc->inputstate = 0;
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
zsms_disable(void *v)
|
|
{
|
|
struct zsms_softc *sc = v;
|
|
|
|
sc->sc_enabled = 0;
|
|
}
|
|
|
|
static int
|
|
zsms_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;
|
|
}
|
|
|
|
static void
|
|
zsms_input(void *vsc, int data)
|
|
{
|
|
struct zsms_softc *sc = vsc;
|
|
|
|
if (sc->sc_enabled == 0) {
|
|
if (sc->sc_selftest > 0) {
|
|
sc->sc_selftest -= 1;
|
|
if (sc->sc_selftest == 0)
|
|
wakeup(zsms_enable);
|
|
}
|
|
return;
|
|
}
|
|
|
|
if ((data & MOUSE_START_FRAME) != 0)
|
|
sc->inputstate = 1;
|
|
else
|
|
sc->inputstate++;
|
|
|
|
if (sc->inputstate == 1) {
|
|
/* LMR -> RML: wsevents counts 0 for the left-most */
|
|
sc->buttons = data & 02;
|
|
if (data & 01)
|
|
sc->buttons |= 04;
|
|
if (data & 04)
|
|
sc->buttons |= 01;
|
|
sc->dx = data & MOUSE_X_SIGN;
|
|
sc->dy = data & MOUSE_Y_SIGN;
|
|
} else if (sc->inputstate == 2) {
|
|
if (sc->dx == 0)
|
|
sc->dx = -data;
|
|
else
|
|
sc->dx = data;
|
|
} else if (sc->inputstate == 3) {
|
|
sc->inputstate = 0;
|
|
if (sc->dy == 0)
|
|
sc->dy = -data;
|
|
else
|
|
sc->dy = data;
|
|
wsmouse_input(sc->sc_wsmousedev,
|
|
sc->buttons,
|
|
sc->dx, sc->dy, 0, 0,
|
|
WSMOUSE_INPUT_DELTA);
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
/****************************************************************
|
|
* Interface to the lower layer (zscc)
|
|
****************************************************************/
|
|
|
|
static void zsms_rxint(struct zs_chanstate *);
|
|
static void zsms_stint(struct zs_chanstate *, int);
|
|
static void zsms_txint(struct zs_chanstate *);
|
|
static void zsms_softint(struct zs_chanstate *);
|
|
|
|
static void
|
|
zsms_rxint(struct zs_chanstate *cs)
|
|
{
|
|
struct zsms_softc *zsms;
|
|
int put, put_next;
|
|
uint8_t c, rr1;
|
|
|
|
zsms = cs->cs_private;
|
|
put = zsms->zsms_rbput;
|
|
|
|
/*
|
|
* First read the status, because reading the received char
|
|
* destroys the status of this char.
|
|
*/
|
|
rr1 = zs_read_reg(cs, 1);
|
|
c = zs_read_data(cs);
|
|
if (rr1 & (ZSRR1_FE | ZSRR1_DO | ZSRR1_PE)) {
|
|
/* Clear the receive error. */
|
|
zs_write_csr(cs, ZSWR0_RESET_ERRORS);
|
|
}
|
|
|
|
zsms->zsms_rbuf[put] = (c << 8) | rr1;
|
|
put_next = (put + 1) & ZSMS_RX_RING_MASK;
|
|
|
|
/* Would overrun if increment makes (put==get). */
|
|
if (put_next == zsms->zsms_rbget) {
|
|
zsms->zsms_intr_flags |= INTR_RX_OVERRUN;
|
|
} else {
|
|
/* OK, really increment. */
|
|
put = put_next;
|
|
}
|
|
|
|
/* Done reading. */
|
|
zsms->zsms_rbput = put;
|
|
|
|
/* Ask for softint() call. */
|
|
cs->cs_softreq = 1;
|
|
}
|
|
|
|
|
|
static void
|
|
zsms_txint(struct zs_chanstate *cs)
|
|
{
|
|
struct zsms_softc *zsms;
|
|
|
|
zsms = cs->cs_private;
|
|
zs_write_csr(cs, ZSWR0_RESET_TXINT);
|
|
zsms->zsms_intr_flags |= INTR_TX_EMPTY;
|
|
/* Ask for softint() call. */
|
|
cs->cs_softreq = 1;
|
|
}
|
|
|
|
|
|
static void
|
|
zsms_stint(struct zs_chanstate *cs, int force)
|
|
{
|
|
struct zsms_softc *zsms;
|
|
int rr0;
|
|
|
|
zsms = cs->cs_private;
|
|
|
|
rr0 = zs_read_csr(cs);
|
|
zs_write_csr(cs, ZSWR0_RESET_STATUS);
|
|
|
|
/*
|
|
* We have to accumulate status line changes here.
|
|
* Otherwise, if we get multiple status interrupts
|
|
* before the softint runs, we could fail to notice
|
|
* some status line changes in the softint routine.
|
|
* Fix from Bill Studenmund, October 1996.
|
|
*/
|
|
cs->cs_rr0_delta |= (cs->cs_rr0 ^ rr0);
|
|
cs->cs_rr0 = rr0;
|
|
zsms->zsms_intr_flags |= INTR_ST_CHECK;
|
|
|
|
/* Ask for softint() call. */
|
|
cs->cs_softreq = 1;
|
|
}
|
|
|
|
|
|
static void
|
|
zsms_softint(struct zs_chanstate *cs)
|
|
{
|
|
struct zsms_softc *zsms;
|
|
int get, c, s;
|
|
int intr_flags;
|
|
u_short ring_data;
|
|
|
|
zsms = cs->cs_private;
|
|
|
|
/* Atomically get and clear flags. */
|
|
s = splzs();
|
|
intr_flags = zsms->zsms_intr_flags;
|
|
zsms->zsms_intr_flags = 0;
|
|
|
|
/* Now lower to spltty for the rest. */
|
|
(void) spltty();
|
|
|
|
/*
|
|
* Copy data from the receive ring to the event layer.
|
|
*/
|
|
get = zsms->zsms_rbget;
|
|
while (get != zsms->zsms_rbput) {
|
|
ring_data = zsms->zsms_rbuf[get];
|
|
get = (get + 1) & ZSMS_RX_RING_MASK;
|
|
|
|
/* low byte of ring_data is rr1 */
|
|
c = (ring_data >> 8) & 0xff;
|
|
|
|
if (ring_data & ZSRR1_DO)
|
|
intr_flags |= INTR_RX_OVERRUN;
|
|
if (ring_data & (ZSRR1_FE | ZSRR1_PE)) {
|
|
log(LOG_ERR, "%s: input error (0x%x)\n",
|
|
device_xname(zsms->zsms_dev), ring_data);
|
|
c = -1; /* signal input error */
|
|
}
|
|
|
|
/* Pass this up to the "middle" layer. */
|
|
zsms_input(zsms, c);
|
|
}
|
|
if (intr_flags & INTR_RX_OVERRUN) {
|
|
log(LOG_ERR, "%s: input overrun\n",
|
|
device_xname(zsms->zsms_dev));
|
|
}
|
|
zsms->zsms_rbget = get;
|
|
|
|
if (intr_flags & INTR_TX_EMPTY) {
|
|
/*
|
|
* Transmit done. (Not expected.)
|
|
*/
|
|
log(LOG_ERR, "%s: transmit interrupt?\n",
|
|
device_xname(zsms->zsms_dev));
|
|
}
|
|
|
|
if (intr_flags & INTR_ST_CHECK) {
|
|
/*
|
|
* Status line change. (Not expected.)
|
|
*/
|
|
log(LOG_ERR, "%s: status interrupt?\n",
|
|
device_xname(zsms->zsms_dev));
|
|
cs->cs_rr0_delta = 0;
|
|
}
|
|
|
|
splx(s);
|
|
}
|
|
|
|
static struct zsops zsops_zsms = {
|
|
zsms_rxint, /* receive char available */
|
|
zsms_stint, /* external/status */
|
|
zsms_txint, /* xmit buffer empty */
|
|
zsms_softint, /* process software interrupt */
|
|
};
|