root/arch/i386/isa/mms.c

DEFINITIONS

1. mmsprobe
2. mmsattach
3. mms_enable
4. mms_disable
5. mms_ioctl
6. mmsintr

    1 /* $OpenBSD: mms.c,v 1.19 2007/04/10 22:37:17 miod Exp $ */
    2 /*      $NetBSD: mms.c,v 1.35 2000/01/08 02:57:25 takemura Exp $        */
    4 /*-
    5  * Copyright (c) 1993, 1994 Charles M. Hannum.
    6  * Copyright (c) 1992, 1993 Erik Forsberg.
    7  * All rights reserved.
    8  *
    9  * Redistribution and use in source and binary forms, with or without
   10  * modification, are permitted provided that the following conditions
   11  * are met:
   12  * 1. Redistributions of source code must retain the above copyright
   13  *    notice, this list of conditions and the following disclaimer.
   14  *
   15  * THIS SOFTWARE IS PROVIDED BY ``AS IS'' AND ANY EXPRESS OR IMPLIED
   16  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
   17  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
   18  * NO EVENT SHALL I BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
   19  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
   20  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
   21  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
   22  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
   23  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
   24  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
   25  */
   27 #include <sys/param.h>
   28 #include <sys/systm.h>
   29 #include <sys/ioctl.h>
   30 #include <sys/device.h>
   32 #include <machine/intr.h>
   33 #include <machine/bus.h>
   35 #include <dev/isa/isavar.h>
   37 #include <dev/wscons/wsconsio.h>
   38 #include <dev/wscons/wsmousevar.h>
   40 #define MMS_ADDR        0       /* offset for register select */
   41 #define MMS_DATA        1       /* offset for InPort data */
   42 #define MMS_IDENT       2       /* offset for identification register */
   43 #define MMS_NPORTS      4
   45 struct mms_softc {              /* driver status information */
   46         struct device sc_dev;
   47         void *sc_ih;
bus_space_tag_t sc_iot;
bus_space_handle_t sc_ioh;
   52         int sc_enabled; /* device is open */
   54         struct device *sc_wsmousedev;
   55 };
   57 int mmsprobe(struct device *, void *, void *);
   58 void mmsattach(struct device *, struct device *, void *);
   59 int mmsintr(void *);
   61 struct cfattach mms_ca = {
   62         sizeof(struct mms_softc), mmsprobe, mmsattach
   63 };
   65 int     mms_enable(void *);
   66 int     mms_ioctl(void *, u_long, caddr_t, int, struct proc *);
   67 void    mms_disable(void *);
   69 const struct wsmouse_accessops mms_accessops = {
mms_enable,
mms_ioctl,
mms_disable,
   73 };
   75 int
mmsprobe(struct device *parent, void *match, void *aux)
   77 {
   78         struct isa_attach_args *ia = aux;
bus_space_tag_t iot = ia->ia_iot;
bus_space_handle_t ioh;
   81         int rv;
   83         /* Disallow wildcarded i/o address. */
   84         if (ia->ia_iobase == IOBASEUNK)
   85                 return 0;
   87         /* Map the i/o space. */
   88         if (bus_space_map(iot, ia->ia_iobase, MMS_NPORTS, 0, &ioh))
   89                 return 0;
rv = 0;
   93         /* Read identification register to see if present */
   94         if (bus_space_read_1(iot, ioh, MMS_IDENT) != 0xde)
   95                 goto out;
   97         /* Seems it was there; reset. */
bus_space_write_1(iot, ioh, MMS_ADDR, 0x87);
rv = 1;
ia->ia_iosize = MMS_NPORTS;
ia->ia_msize = 0;
out:
bus_space_unmap(iot, ioh, MMS_NPORTS);
  106         return rv;
  107 }
  109 void
mmsattach(struct device *parent, struct device *self, void *aux)
  111 {
  112         struct mms_softc *sc = (void *)self;
  113         struct isa_attach_args *ia = aux;
bus_space_tag_t iot = ia->ia_iot;
bus_space_handle_t ioh;
  116         struct wsmousedev_attach_args a;
printf("\n");
  120         if (bus_space_map(iot, ia->ia_iobase, MMS_NPORTS, 0, &ioh)) {
printf("%s: can't map i/o space\n", sc->sc_dev.dv_xname);
  122                 return;
  123         }
  125         /* Other initialization was done by mmsprobe. */
sc->sc_iot = iot;
sc->sc_ioh = ioh;
sc->sc_enabled = 0;
sc->sc_ih = isa_intr_establish(ia->ia_ic, ia->ia_irq, IST_PULSE,
IPL_TTY, mmsintr, sc, sc->sc_dev.dv_xname);
a.accessops = &mms_accessops;
a.accesscookie = sc;
  136         /*
  137          * Attach the wsmouse, saving a handle to it.
  138          * Note that we don't need to check this pointer against NULL
  139          * here or in psmintr, because if this fails lms_enable() will
  140          * never be called, so lmsintr() will never be called.
  141          */
sc->sc_wsmousedev = config_found(self, &a, wsmousedevprint);
  143 }
  145 int
mms_enable(void *v)
  147 {
  148         struct mms_softc *sc = v;
  150         if (sc->sc_enabled)
  151                 return EBUSY;
sc->sc_enabled = 1;
  155         /* Enable interrupts. */
bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_ADDR, 0x07);
bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_DATA, 0x09);
  159         return 0;
  160 }
  162 void
mms_disable(void *v)
  164 {
  165         struct mms_softc *sc = v;
  167         /* Disable interrupts. */
bus_space_write_1(sc->sc_iot, sc->sc_ioh, MMS_ADDR, 0x87);
sc->sc_enabled = 0;
  171 }
  173 int
mms_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
  175 {
  176 #if 0
  177         struct mms_softc *sc = v;
  178 #endif
  180         switch (cmd) {
  181         case WSMOUSEIO_GTYPE:
  182                 *(u_int *)data = WSMOUSE_TYPE_MMS;
  183                 return (0);
  184         }
  185         return (-1);
  186 }
  188 int
mmsintr(void *arg)
  190 {
  191         struct mms_softc *sc = arg;
bus_space_tag_t iot = sc->sc_iot;
bus_space_handle_t ioh = sc->sc_ioh;
u_char status;
  195         signed char dx, dy;
u_int buttons;
  197         int changed;
  199         if (!sc->sc_enabled)
  200                 /* Interrupts are not expected. */
  201                 return 0;
  203         /* Freeze InPort registers (disabling interrupts). */
bus_space_write_1(iot, ioh, MMS_ADDR, 0x07);
bus_space_write_1(iot, ioh, MMS_DATA, 0x29);
bus_space_write_1(iot, ioh, MMS_ADDR, 0x00);
status = bus_space_read_1(iot, ioh, MMS_DATA);
  210         if (status & 0x40) {
bus_space_write_1(iot, ioh, MMS_ADDR, 1);
dx = bus_space_read_1(iot, ioh, MMS_DATA);
  213                 /* Bounding at -127 avoids a bug in XFree86. */
dx = (dx == -128) ? -127 : dx;
bus_space_write_1(iot, ioh, MMS_ADDR, 2);
dy = bus_space_read_1(iot, ioh, MMS_DATA);
dy = (dy == -128) ? 127 : -dy;
  219         } else
dx = dy = 0;
  222         /* Unfreeze InPort registers (reenabling interrupts). */
bus_space_write_1(iot, ioh, MMS_ADDR, 0x07);
bus_space_write_1(iot, ioh, MMS_DATA, 0x09);
buttons = ((status & 0x04) ? 0x1 : 0) |
  227                 ((status & 0x02) ? 0x2 : 0) |
  228                 ((status & 0x01) ? 0x4 : 0);
changed = status & 0x38;
  231         if (dx || dy || changed)
wsmouse_input(sc->sc_wsmousedev,
buttons, dx, dy, 0, 0, WSMOUSE_INPUT_DELTA);
  235         return -1;
  236 }
  238 struct cfdriver mms_cd = {
NULL, "mms", DV_DULL
  240 };