Home | History | Annotate | Line # | Download | only in isa
mms.c revision 1.29
      1  1.29   mycroft /*	$NetBSD: mms.c,v 1.29 1997/10/19 20:31:32 mycroft Exp $	*/
      2  1.13       cgd 
      3   1.1    andrew /*-
      4   1.8   mycroft  * Copyright (c) 1993, 1994 Charles Hannum.
      5   1.1    andrew  * Copyright (c) 1992, 1993 Erik Forsberg.
      6   1.1    andrew  * All rights reserved.
      7   1.1    andrew  *
      8   1.1    andrew  * Redistribution and use in source and binary forms, with or without
      9   1.1    andrew  * modification, are permitted provided that the following conditions
     10   1.1    andrew  * are met:
     11   1.1    andrew  * 1. Redistributions of source code must retain the above copyright
     12   1.1    andrew  *    notice, this list of conditions and the following disclaimer.
     13   1.1    andrew  *
     14   1.1    andrew  * THIS SOFTWARE IS PROVIDED BY ``AS IS'' AND ANY EXPRESS OR IMPLIED
     15   1.1    andrew  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
     16   1.1    andrew  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
     17   1.1    andrew  * NO EVENT SHALL I BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
     18   1.1    andrew  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
     19   1.1    andrew  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
     20   1.1    andrew  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
     21   1.1    andrew  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
     22   1.1    andrew  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
     23   1.1    andrew  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     24   1.1    andrew  */
     25   1.1    andrew 
     26   1.7   mycroft #include <sys/param.h>
     27   1.7   mycroft #include <sys/kernel.h>
     28   1.7   mycroft #include <sys/systm.h>
     29   1.7   mycroft #include <sys/buf.h>
     30   1.7   mycroft #include <sys/malloc.h>
     31   1.7   mycroft #include <sys/ioctl.h>
     32   1.7   mycroft #include <sys/tty.h>
     33   1.7   mycroft #include <sys/file.h>
     34   1.7   mycroft #include <sys/select.h>
     35   1.7   mycroft #include <sys/proc.h>
     36   1.7   mycroft #include <sys/vnode.h>
     37   1.8   mycroft #include <sys/device.h>
     38  1.25   mycroft #include <sys/poll.h>
     39   1.7   mycroft 
     40   1.8   mycroft #include <machine/cpu.h>
     41  1.24   mycroft #include <machine/intr.h>
     42  1.28   thorpej #include <machine/bus.h>
     43   1.7   mycroft #include <machine/mouse.h>
     44  1.23  christos #include <machine/conf.h>
     45   1.1    andrew 
     46  1.18       cgd #include <dev/isa/isavar.h>
     47   1.1    andrew 
     48   1.8   mycroft #define	MMS_ADDR	0	/* offset for register select */
     49   1.8   mycroft #define	MMS_DATA	1	/* offset for InPort data */
     50   1.8   mycroft #define	MMS_IDENT	2	/* offset for identification register */
     51   1.8   mycroft #define	MMS_NPORTS	4
     52   1.8   mycroft 
     53   1.8   mycroft #define	MMS_CHUNK	128	/* chunk size for read */
     54   1.8   mycroft #define	MMS_BSIZE	1020	/* buffer size */
     55   1.8   mycroft 
     56   1.8   mycroft struct mms_softc {		/* driver status information */
     57   1.8   mycroft 	struct device sc_dev;
     58  1.18       cgd 	void *sc_ih;
     59   1.8   mycroft 
     60  1.28   thorpej 	bus_space_tag_t sc_iot;
     61  1.28   thorpej 	bus_space_handle_t sc_ioh;
     62  1.28   thorpej 
     63   1.8   mycroft 	struct clist sc_q;
     64   1.8   mycroft 	struct selinfo sc_rsel;
     65   1.8   mycroft 	u_char sc_state;	/* mouse driver state */
     66   1.8   mycroft #define	MMS_OPEN	0x01	/* device is open */
     67   1.8   mycroft #define	MMS_ASLP	0x02	/* waiting for mouse data */
     68   1.8   mycroft 	u_char sc_status;	/* mouse button status */
     69   1.8   mycroft 	int sc_x, sc_y;		/* accumulated motion in the X,Y axis */
     70   1.9   mycroft };
     71   1.1    andrew 
     72  1.15   mycroft int mmsprobe __P((struct device *, void *, void *));
     73  1.15   mycroft void mmsattach __P((struct device *, struct device *, void *));
     74  1.18       cgd int mmsintr __P((void *));
     75   1.1    andrew 
     76  1.21   thorpej struct cfattach mms_ca = {
     77  1.21   thorpej 	sizeof(struct mms_softc), mmsprobe, mmsattach
     78  1.21   thorpej };
     79  1.21   thorpej 
     80  1.21   thorpej struct cfdriver mms_cd = {
     81  1.21   thorpej 	NULL, "mms", DV_TTY
     82   1.9   mycroft };
     83   1.1    andrew 
     84   1.8   mycroft #define	MMSUNIT(dev)	(minor(dev))
     85   1.8   mycroft 
     86   1.8   mycroft int
     87  1.15   mycroft mmsprobe(parent, match, aux)
     88  1.15   mycroft 	struct device *parent;
     89  1.15   mycroft 	void *match, *aux;
     90   1.1    andrew {
     91   1.9   mycroft 	struct isa_attach_args *ia = aux;
     92  1.28   thorpej 	bus_space_tag_t iot = ia->ia_iot;
     93  1.28   thorpej 	bus_space_handle_t ioh;
     94  1.29   mycroft 	int rv;
     95  1.28   thorpej 
     96  1.28   thorpej 	/* Disallow wildcarded i/o address. */
     97  1.28   thorpej 	if (ia->ia_iobase == ISACF_PORT_DEFAULT)
     98  1.28   thorpej 		return 0;
     99  1.28   thorpej 
    100  1.29   mycroft 	/* Map the i/o space. */
    101  1.28   thorpej 	if (bus_space_map(iot, ia->ia_iobase, MMS_NPORTS, 0, &ioh))
    102  1.28   thorpej 		return 0;
    103   1.1    andrew 
    104  1.29   mycroft 	rv = 0;
    105  1.29   mycroft 
    106   1.1    andrew 	/* Read identification register to see if present */
    107  1.28   thorpej 	if (bus_space_read_1(iot, ioh, MMS_IDENT) != 0xde)
    108  1.28   thorpej 		goto out;
    109   1.1    andrew 
    110   1.8   mycroft 	/* Seems it was there; reset. */
    111  1.28   thorpej 	bus_space_write_1(iot, ioh, MMS_ADDR, 0x87);
    112   1.1    andrew 
    113  1.28   thorpej 	rv = 1;
    114   1.9   mycroft 	ia->ia_iosize = MMS_NPORTS;
    115   1.9   mycroft 	ia->ia_msize = 0;
    116  1.29   mycroft 
    117  1.29   mycroft out:
    118  1.28   thorpej 	bus_space_unmap(iot, ioh, MMS_NPORTS);
    119  1.28   thorpej 	return rv;
    120   1.1    andrew }
    121   1.1    andrew 
    122   1.9   mycroft void
    123   1.9   mycroft mmsattach(parent, self, aux)
    124   1.9   mycroft 	struct device *parent, *self;
    125   1.9   mycroft 	void *aux;
    126   1.1    andrew {
    127   1.9   mycroft 	struct mms_softc *sc = (void *)self;
    128   1.9   mycroft 	struct isa_attach_args *ia = aux;
    129  1.28   thorpej 	bus_space_tag_t iot = ia->ia_iot;
    130  1.28   thorpej 	bus_space_handle_t ioh;
    131  1.10   mycroft 
    132  1.27  christos 	printf("\n");
    133   1.1    andrew 
    134  1.28   thorpej 	if (bus_space_map(iot, ia->ia_iobase, MMS_NPORTS, 0, &ioh)) {
    135  1.28   thorpej 		printf("%s: can't map i/o space\n", sc->sc_dev.dv_xname);
    136  1.28   thorpej 		return;
    137  1.28   thorpej 	}
    138  1.28   thorpej 
    139   1.8   mycroft 	/* Other initialization was done by mmsprobe. */
    140  1.28   thorpej 	sc->sc_iot = iot;
    141  1.28   thorpej 	sc->sc_ioh = ioh;
    142   1.8   mycroft 	sc->sc_state = 0;
    143  1.11   mycroft 
    144  1.22       cgd 	sc->sc_ih = isa_intr_establish(ia->ia_ic, ia->ia_irq, IST_PULSE,
    145  1.22       cgd 	    IPL_TTY, mmsintr, sc);
    146   1.1    andrew }
    147   1.1    andrew 
    148   1.8   mycroft int
    149  1.23  christos mmsopen(dev, flag, mode, p)
    150   1.8   mycroft 	dev_t dev;
    151   1.8   mycroft 	int flag;
    152  1.23  christos 	int mode;
    153  1.23  christos 	struct proc *p;
    154   1.1    andrew {
    155   1.2    andrew 	int unit = MMSUNIT(dev);
    156   1.2    andrew 	struct mms_softc *sc;
    157   1.1    andrew 
    158  1.21   thorpej 	if (unit >= mms_cd.cd_ndevs)
    159   1.8   mycroft 		return ENXIO;
    160  1.21   thorpej 	sc = mms_cd.cd_devs[unit];
    161   1.9   mycroft 	if (!sc)
    162   1.8   mycroft 		return ENXIO;
    163   1.1    andrew 
    164   1.8   mycroft 	if (sc->sc_state & MMS_OPEN)
    165   1.8   mycroft 		return EBUSY;
    166   1.1    andrew 
    167   1.8   mycroft 	if (clalloc(&sc->sc_q, MMS_BSIZE, 0) == -1)
    168   1.8   mycroft 		return ENOMEM;
    169   1.1    andrew 
    170   1.8   mycroft 	sc->sc_state |= MMS_OPEN;
    171   1.8   mycroft 	sc->sc_status = 0;
    172   1.8   mycroft 	sc->sc_x = sc->sc_y = 0;
    173   1.1    andrew 
    174   1.8   mycroft 	/* Enable interrupts. */
    175  1.28   thorpej 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_ADDR, 0x07);
    176  1.28   thorpej 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_DATA, 0x09);
    177   1.1    andrew 
    178   1.8   mycroft 	return 0;
    179   1.1    andrew }
    180   1.1    andrew 
    181   1.8   mycroft int
    182  1.23  christos mmsclose(dev, flag, mode, p)
    183   1.8   mycroft 	dev_t dev;
    184   1.8   mycroft 	int flag;
    185  1.23  christos 	int mode;
    186  1.23  christos 	struct proc *p;
    187   1.1    andrew {
    188  1.21   thorpej 	struct mms_softc *sc = mms_cd.cd_devs[MMSUNIT(dev)];
    189   1.1    andrew 
    190   1.8   mycroft 	/* Disable interrupts. */
    191  1.28   thorpej 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_ADDR, 0x87);
    192   1.1    andrew 
    193   1.8   mycroft 	sc->sc_state &= ~MMS_OPEN;
    194   1.1    andrew 
    195   1.8   mycroft 	clfree(&sc->sc_q);
    196   1.1    andrew 
    197   1.8   mycroft 	return 0;
    198   1.1    andrew }
    199   1.1    andrew 
    200   1.8   mycroft int
    201   1.8   mycroft mmsread(dev, uio, flag)
    202   1.8   mycroft 	dev_t dev;
    203   1.8   mycroft 	struct uio *uio;
    204   1.8   mycroft 	int flag;
    205   1.1    andrew {
    206  1.21   thorpej 	struct mms_softc *sc = mms_cd.cd_devs[MMSUNIT(dev)];
    207   1.8   mycroft 	int s;
    208  1.23  christos 	int error = 0;
    209   1.8   mycroft 	size_t length;
    210   1.8   mycroft 	u_char buffer[MMS_CHUNK];
    211   1.1    andrew 
    212   1.8   mycroft 	/* Block until mouse activity occured. */
    213   1.1    andrew 
    214   1.1    andrew 	s = spltty();
    215   1.8   mycroft 	while (sc->sc_q.c_cc == 0) {
    216   1.8   mycroft 		if (flag & IO_NDELAY) {
    217   1.1    andrew 			splx(s);
    218   1.8   mycroft 			return EWOULDBLOCK;
    219   1.1    andrew 		}
    220   1.8   mycroft 		sc->sc_state |= MMS_ASLP;
    221  1.23  christos 		error = tsleep((caddr_t)sc, PZERO | PCATCH, "mmsrea", 0);
    222  1.23  christos 		if (error) {
    223   1.8   mycroft 			sc->sc_state &= ~MMS_ASLP;
    224   1.1    andrew 			splx(s);
    225   1.8   mycroft 			return error;
    226   1.1    andrew 		}
    227   1.1    andrew 	}
    228   1.8   mycroft 	splx(s);
    229   1.1    andrew 
    230   1.8   mycroft 	/* Transfer as many chunks as possible. */
    231   1.1    andrew 
    232   1.8   mycroft 	while (sc->sc_q.c_cc > 0 && uio->uio_resid > 0) {
    233   1.8   mycroft 		length = min(sc->sc_q.c_cc, uio->uio_resid);
    234   1.1    andrew 		if (length > sizeof(buffer))
    235   1.1    andrew 			length = sizeof(buffer);
    236   1.1    andrew 
    237   1.8   mycroft 		/* Remove a small chunk from the input queue. */
    238   1.8   mycroft 		(void) q_to_b(&sc->sc_q, buffer, length);
    239   1.1    andrew 
    240   1.8   mycroft 		/* Copy the data to the user process. */
    241  1.23  christos 		if ((error = uiomove(buffer, length, uio)) != 0)
    242   1.1    andrew 			break;
    243   1.1    andrew 	}
    244   1.1    andrew 
    245   1.8   mycroft 	return error;
    246   1.1    andrew }
    247   1.1    andrew 
    248   1.8   mycroft int
    249  1.23  christos mmsioctl(dev, cmd, addr, flag, p)
    250   1.8   mycroft 	dev_t dev;
    251  1.14       cgd 	u_long cmd;
    252   1.8   mycroft 	caddr_t addr;
    253   1.8   mycroft 	int flag;
    254  1.23  christos 	struct proc *p;
    255   1.1    andrew {
    256  1.21   thorpej 	struct mms_softc *sc = mms_cd.cd_devs[MMSUNIT(dev)];
    257   1.1    andrew 	struct mouseinfo info;
    258   1.8   mycroft 	int s;
    259   1.8   mycroft 	int error;
    260   1.1    andrew 
    261   1.1    andrew 	switch (cmd) {
    262   1.1    andrew 	case MOUSEIOCREAD:
    263   1.1    andrew 		s = spltty();
    264   1.1    andrew 
    265   1.8   mycroft 		info.status = sc->sc_status;
    266   1.8   mycroft 		if (sc->sc_x || sc->sc_y)
    267   1.1    andrew 			info.status |= MOVEMENT;
    268   1.1    andrew 
    269   1.8   mycroft 		if (sc->sc_x > 127)
    270   1.1    andrew 			info.xmotion = 127;
    271   1.8   mycroft 		else if (sc->sc_x < -127)
    272   1.8   mycroft 			/* Bounding at -127 avoids a bug in XFree86. */
    273   1.8   mycroft 			info.xmotion = -127;
    274   1.1    andrew 		else
    275   1.8   mycroft 			info.xmotion = sc->sc_x;
    276   1.1    andrew 
    277   1.8   mycroft 		if (sc->sc_y > 127)
    278   1.1    andrew 			info.ymotion = 127;
    279   1.8   mycroft 		else if (sc->sc_y < -127)
    280   1.8   mycroft 			info.ymotion = -127;
    281   1.1    andrew 		else
    282   1.8   mycroft 			info.ymotion = sc->sc_y;
    283   1.1    andrew 
    284   1.8   mycroft 		/* Reset historical information. */
    285   1.8   mycroft 		sc->sc_x = sc->sc_y = 0;
    286   1.8   mycroft 		sc->sc_status &= ~BUTCHNGMASK;
    287  1.12       cgd 		ndflush(&sc->sc_q, sc->sc_q.c_cc);
    288   1.1    andrew 
    289   1.1    andrew 		splx(s);
    290   1.1    andrew 		error = copyout(&info, addr, sizeof(struct mouseinfo));
    291   1.1    andrew 		break;
    292   1.1    andrew 
    293   1.1    andrew 	default:
    294   1.1    andrew 		error = EINVAL;
    295   1.1    andrew 		break;
    296   1.8   mycroft 	}
    297   1.1    andrew 
    298   1.8   mycroft 	return error;
    299   1.1    andrew }
    300   1.1    andrew 
    301   1.8   mycroft int
    302  1.18       cgd mmsintr(arg)
    303  1.18       cgd 	void *arg;
    304   1.1    andrew {
    305  1.18       cgd 	struct mms_softc *sc = arg;
    306  1.29   mycroft 	bus_space_tag_t iot = sc->sc_iot;
    307  1.29   mycroft 	bus_space_handle_t ioh = sc->sc_ioh;
    308   1.8   mycroft 	u_char buttons, changed, status;
    309   1.8   mycroft 	char dx, dy;
    310   1.8   mycroft 	u_char buffer[5];
    311   1.8   mycroft 
    312   1.8   mycroft 	if ((sc->sc_state & MMS_OPEN) == 0)
    313   1.8   mycroft 		/* Interrupts are not expected. */
    314   1.8   mycroft 		return 0;
    315   1.8   mycroft 
    316   1.8   mycroft 	/* Freeze InPort registers (disabling interrupts). */
    317  1.28   thorpej 	bus_space_write_1(iot, ioh, MMS_ADDR, 0x07);
    318  1.28   thorpej 	bus_space_write_1(iot, ioh, MMS_DATA, 0x29);
    319   1.1    andrew 
    320  1.28   thorpej 	bus_space_write_1(iot, ioh, MMS_ADDR, 0x00);
    321  1.28   thorpej 	status = bus_space_read_1(iot, ioh, MMS_DATA);
    322   1.1    andrew 
    323   1.1    andrew 	if (status & 0x40) {
    324  1.28   thorpej 		bus_space_write_1(iot, ioh, MMS_ADDR, 1);
    325  1.28   thorpej 		dx = bus_space_read_1(iot, ioh, MMS_DATA);
    326   1.8   mycroft 		dx = (dx == -128) ? -127 : dx;
    327  1.28   thorpej 		bus_space_write_1(iot, ioh, MMS_ADDR, 2);
    328  1.28   thorpej 		dy = bus_space_read_1(iot, ioh, MMS_DATA);
    329   1.1    andrew 		dy = (dy == -128) ? 127 : -dy;
    330   1.8   mycroft 	} else
    331   1.1    andrew 		dx = dy = 0;
    332   1.1    andrew 
    333   1.8   mycroft 	/* Unfreeze InPort registers (reenabling interrupts). */
    334  1.28   thorpej 	bus_space_write_1(iot, ioh, MMS_ADDR, 0x07);
    335  1.28   thorpej 	bus_space_write_1(iot, ioh, MMS_DATA, 0x09);
    336   1.8   mycroft 
    337   1.8   mycroft 	buttons = status & BUTSTATMASK;
    338   1.8   mycroft 	changed = status & BUTCHNGMASK;
    339   1.8   mycroft 	sc->sc_status = buttons | (sc->sc_status & ~BUTSTATMASK) | changed;
    340   1.8   mycroft 
    341   1.8   mycroft 	if (dx || dy || changed) {
    342   1.8   mycroft 		/* Update accumulated movements. */
    343   1.8   mycroft 		sc->sc_x += dx;
    344   1.8   mycroft 		sc->sc_y += dy;
    345   1.8   mycroft 
    346   1.8   mycroft 		/* Add this event to the queue. */
    347   1.8   mycroft 		buffer[0] = 0x80 | (buttons ^ BUTSTATMASK);
    348   1.8   mycroft 		buffer[1] = dx;
    349   1.8   mycroft 		buffer[2] = dy;
    350   1.8   mycroft 		buffer[3] = buffer[4] = 0;
    351   1.8   mycroft 		(void) b_to_q(buffer, sizeof buffer, &sc->sc_q);
    352   1.1    andrew 
    353   1.8   mycroft 		if (sc->sc_state & MMS_ASLP) {
    354   1.8   mycroft 			sc->sc_state &= ~MMS_ASLP;
    355   1.5    andrew 			wakeup((caddr_t)sc);
    356   1.1    andrew 		}
    357   1.8   mycroft 		selwakeup(&sc->sc_rsel);
    358   1.8   mycroft 	}
    359   1.8   mycroft 
    360  1.11   mycroft 	return -1;
    361   1.1    andrew }
    362   1.1    andrew 
    363   1.8   mycroft int
    364  1.25   mycroft mmspoll(dev, events, p)
    365   1.8   mycroft 	dev_t dev;
    366  1.25   mycroft 	int events;
    367   1.8   mycroft 	struct proc *p;
    368   1.1    andrew {
    369  1.21   thorpej 	struct mms_softc *sc = mms_cd.cd_devs[MMSUNIT(dev)];
    370  1.25   mycroft 	int revents = 0;
    371  1.25   mycroft 	int s = spltty();
    372   1.1    andrew 
    373  1.25   mycroft 	if (events & (POLLIN | POLLRDNORM))
    374  1.25   mycroft 		if (sc->sc_q.c_cc > 0)
    375  1.25   mycroft 			revents |= events & (POLLIN | POLLRDNORM);
    376  1.25   mycroft 		else
    377  1.25   mycroft 			selrecord(p, &sc->sc_rsel);
    378   1.1    andrew 
    379   1.1    andrew 	splx(s);
    380  1.25   mycroft 	return (revents);
    381   1.1    andrew }
    382