root/dev/pckbc/pms_intelli.c

DEFINITIONS

1. pmsi_setintellimode
2. pmsiprobe
3. pmsiattach
4. pmsi_enable
5. pmsi_disable
6. pmsi_ioctl
7. pmsiinput

    1 /* $OpenBSD: pms_intelli.c,v 1.1 2007/08/01 12:16:59 kettenis Exp $ */
    2 /* $NetBSD: psm_intelli.c,v 1.8 2000/06/05 22:20:57 sommerfeld Exp $ */
    4 /*-
    5  * Copyright (c) 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/device.h>
   30 #include <sys/ioctl.h>
   32 #include <machine/bus.h>
   34 #include <dev/ic/pckbcvar.h>
   36 #include <dev/pckbc/pmsreg.h>
   38 #include <dev/wscons/wsconsio.h>
   39 #include <dev/wscons/wsmousevar.h>
   41 struct pmsi_softc {             /* driver status information */
   42         struct device sc_dev;
pckbc_tag_t sc_kbctag;
   45         int sc_kbcslot;
   47         int sc_enabled;         /* input enabled? */
   48         int inputstate;
u_int buttons, oldbuttons;      /* mouse button status */
   50         signed char dx, dy;
   52         struct device *sc_wsmousedev;
   53 };
   55 int pmsiprobe(struct device *, void *, void *);
   56 void pmsiattach(struct device *, struct device *, void *);
   57 void pmsiinput(void *, int);
   59 struct cfattach pmsi_ca = {
   60         sizeof(struct pmsi_softc), pmsiprobe, pmsiattach,
   61 };
   63 int     pmsi_enable(void *);
   64 int     pmsi_ioctl(void *, u_long, caddr_t, int, struct proc *);
   65 void    pmsi_disable(void *);
   67 const struct wsmouse_accessops pmsi_accessops = {
pmsi_enable,
pmsi_ioctl,
pmsi_disable,
   71 };
   73 static int pmsi_setintellimode(pckbc_tag_t, pckbc_slot_t);
   75 static int
pmsi_setintellimode(tag, slot)
pckbc_tag_t tag;
pckbc_slot_t slot;
   79 {
u_char cmd[2], resp[1];
   81         int i, res;
   82         static u_char rates[] = {200, 100, 80};
cmd[0] = PMS_SET_SAMPLE;
   85         for (i = 0; i < 3; i++) {
cmd[1] = rates[i];
res = pckbc_poll_cmd(tag, slot, cmd, 2, 0, 0, 0);
   88                 if (res)
   89                         return (res);
   90         }
cmd[0] = PMS_SEND_DEV_ID;
res = pckbc_poll_cmd(tag, slot, cmd, 1, 1, resp, 0);
   94         if (res)
   95                 return (res);
   96         if (resp[0] != 3)
   97                 return (ENXIO);
   99         return (0);
  100 }
  102 int
pmsiprobe(parent, match, aux)
  104         struct device *parent;
  105         void *match;
  106         void *aux;
  107 {
  108         struct pckbc_attach_args *pa = aux;
u_char cmd[1], resp[2];
  110         int res;
  112         if (pa->pa_slot != PCKBC_AUX_SLOT)
  113                 return (0);
  115         /* Flush any garbage. */
pckbc_flush(pa->pa_tag, pa->pa_slot);
  118         /* reset the device */
cmd[0] = PMS_RESET;
res = pckbc_poll_cmd(pa->pa_tag, pa->pa_slot, cmd, 1, 2, resp, 1);
  121         if (res) {
  122 #ifdef DEBUG
printf("pmsiprobe: reset error %d\n", res);
  124 #endif
  125                 return (0);
  126         }
  127         if (resp[0] != PMS_RSTDONE) {
printf("pmsiprobe: reset response 0x%x\n", resp[0]);
  129                 return (0);
  130         }
  132         /* get type number (0 = mouse) */
  133         if (resp[1] != 0) {
  134 #ifdef DEBUG
printf("pmsiprobe: type 0x%x\n", resp[1]);
  136 #endif
  137                 return (0);
  138         }
  140         if ((res = pmsi_setintellimode(pa->pa_tag, pa->pa_slot))) {
  141 #ifdef DEBUG
printf("pmsiprobe: intellimode -> %d\n", res);
  143 #endif
  144                 return (0);
  145         }
  147         return (20);
  148 }
  150 void
pmsiattach(parent, self, aux)
  152         struct device *parent, *self;
  153         void *aux;
  154 {
  155         struct pmsi_softc *sc = (void *)self;
  156         struct pckbc_attach_args *pa = aux;
  157         struct wsmousedev_attach_args a;
u_char cmd[1], resp[2];
  159         int res;
sc->sc_kbctag = pa->pa_tag;
sc->sc_kbcslot = pa->pa_slot;
printf("\n");
  166         /* Flush any garbage. */
pckbc_flush(pa->pa_tag, pa->pa_slot);
  169         /* reset the device */
cmd[0] = PMS_RESET;
res = pckbc_poll_cmd(pa->pa_tag, pa->pa_slot, cmd, 1, 2, resp, 1);
  172 #ifdef DEBUG
  173         if (res || resp[0] != PMS_RSTDONE || resp[1] != 0) {
printf("pmsiattach: reset error\n");
  175                 return;
  176         }
  177 #endif
res = pmsi_setintellimode(pa->pa_tag, pa->pa_slot);
  179 #ifdef DEBUG
  180         if (res) {
printf("pmsiattach: error setting intelli mode\n");
  182                 return;
  183         }
  184 #endif
  186         /* Other initialization was done by pmsiprobe. */
sc->inputstate = 0;
sc->oldbuttons = 0;
pckbc_set_inputhandler(sc->sc_kbctag, sc->sc_kbcslot,
pmsiinput, sc, sc->sc_dev.dv_xname);
a.accessops = &pmsi_accessops;
a.accesscookie = sc;
  196         /*
  197          * Attach the wsmouse, saving a handle to it.
  198          * Note that we don't need to check this pointer against NULL
  199          * here or in pmsintr, because if this fails pms_enable() will
  200          * never be called, so pmsiinput() will never be called.
  201          */
sc->sc_wsmousedev = config_found(self, &a, wsmousedevprint);
  204         /* no interrupts until enabled */
cmd[0] = PMS_DEV_DISABLE;
res = pckbc_poll_cmd(pa->pa_tag, pa->pa_slot, cmd, 1, 0, 0, 0);
  207         if (res)
printf("pmsiattach: disable error\n");
pckbc_slot_enable(sc->sc_kbctag, sc->sc_kbcslot, 0);
  210 }
  212 int
pmsi_enable(v)
  214         void *v;
  215 {
  216         struct pmsi_softc *sc = v;
u_char cmd[1];
  218         int res;
  220         if (sc->sc_enabled)
  221                 return EBUSY;
sc->sc_enabled = 1;
sc->inputstate = 0;
sc->oldbuttons = 0;
pckbc_slot_enable(sc->sc_kbctag, sc->sc_kbcslot, 1);
cmd[0] = PMS_DEV_ENABLE;
res = pckbc_enqueue_cmd(sc->sc_kbctag, sc->sc_kbcslot, cmd, 1, 0, 1, 0);
  231         if (res)
printf("pmsi_enable: command error\n");
  234         return 0;
  235 }
  237 void
pmsi_disable(v)
  239         void *v;
  240 {
  241         struct pmsi_softc *sc = v;
u_char cmd[1];
  243         int res;
cmd[0] = PMS_DEV_DISABLE;
res = pckbc_enqueue_cmd(sc->sc_kbctag, sc->sc_kbcslot, cmd, 1, 0, 1, 0);
  247         if (res)
printf("pmsi_disable: command error\n");
pckbc_slot_enable(sc->sc_kbctag, sc->sc_kbcslot, 0);
sc->sc_enabled = 0;
  253 }
  255 int
pmsi_ioctl(v, cmd, data, flag, p)
  257         void *v;
u_long cmd;
caddr_t data;
  260         int flag;
  261         struct proc *p;
  262 {
  263         struct pmsi_softc *sc = v;
u_char kbcmd[2];
  265         int i;
  267         switch (cmd) {
  268         case WSMOUSEIO_GTYPE:
  269                 *(u_int *)data = WSMOUSE_TYPE_PS2;
  270                 break;
  272         case WSMOUSEIO_SRES:
i = ((int) *(u_int *)data - 12) / 25;           
  274                 /* valid values are {0,1,2,3} */
  275                 if (i < 0)
i = 0;
  277                 if (i > 3)
i = 3;
kbcmd[0] = PMS_SET_RES;
kbcmd[1] = (unsigned char) i;                   
i = pckbc_enqueue_cmd(sc->sc_kbctag, sc->sc_kbcslot, kbcmd, 
  283                     2, 0, 1, 0);
  285                 if (i)
printf("pms_ioctl: SET_RES command error\n");
  287                 break;
  289         default:
  290                 return (-1);
  291         }
  292         return (0);
  293 }
  295 /* Masks for the first byte of a packet */
  296 #define PS2LBUTMASK 0x01
  297 #define PS2RBUTMASK 0x02
  298 #define PS2MBUTMASK 0x04
  300 void pmsiinput(vsc, data)
  301 void *vsc;
  302 int data;
  303 {
  304         struct pmsi_softc *sc = vsc;
  305         signed char dz;
u_int changed;
  308         if (!sc->sc_enabled) {
  309                 /* Interrupts are not expected.  Discard the byte. */
  310                 return;
  311         }
  313         switch (sc->inputstate) {
  315         case 0:
  316                 if ((data & 0xc0) == 0) { /* no ovfl, bit 3 == 1 too? */
sc->buttons = ((data & PS2LBUTMASK) ? 0x1 : 0) |
  318                             ((data & PS2MBUTMASK) ? 0x2 : 0) |
  319                             ((data & PS2RBUTMASK) ? 0x4 : 0);
  320                         ++sc->inputstate;
  321                 }
  322                 break;
  324         case 1:
sc->dx = data;
  326                 /* Bounding at -127 avoids a bug in XFree86. */
sc->dx = (sc->dx == -128) ? -127 : sc->dx;
  328                 ++sc->inputstate;
  329                 break;
  331         case 2:
sc->dy = data;
sc->dy = (sc->dy == -128) ? -127 : sc->dy;
  334                 ++sc->inputstate;
  335                 break;
  337         case 3:
dz = data;
dz = (dz == -128) ? -127 : dz;
sc->inputstate = 0;
changed = (sc->buttons ^ sc->oldbuttons);
sc->oldbuttons = sc->buttons;
  345                 if (sc->dx || sc->dy || dz || changed)
wsmouse_input(sc->sc_wsmousedev,
sc->buttons, sc->dx, sc->dy, dz, 0,
WSMOUSE_INPUT_DELTA);
  349                 break;
  350         }
  352         return;
  353 }
  355 struct cfdriver pmsi_cd = {
NULL, "pmsi", DV_DULL
  357 };