The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/dev/hpc/tpcalib.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /*      $NetBSD: tpcalib.c,v 1.6 2003/01/03 04:36:26 takemura Exp $     */
    2 
    3 /*
    4  * Copyright (c) 1999-2003 TAKEMURA Shin All rights reserved.
    5  * Copyright (c) 1999 PocketBSD Project. All rights reserved.
    6  *
    7  * Redistribution and use in source and binary forms, with or without
    8  * modification, are permitted provided that the following conditions
    9  * are met:
   10  * 1. Redistributions of source code must retain the above copyright
   11  *    notice, this list of conditions and the following disclaimer.
   12  * 2. Redistributions in binary form must reproduce the above copyright
   13  *    notice, this list of conditions and the following disclaimer in the
   14  *    documentation and/or other materials provided with the distribution.
   15  *
   16  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
   17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   19  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
   20  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   26  * SUCH DAMAGE.
   27  *
   28  */
   29 
   30 #include <sys/cdefs.h>
   31 __KERNEL_RCSID(0, "$NetBSD: tpcalib.c,v 1.6 2003/01/03 04:36:26 takemura Exp $");
   32 
   33 #include <sys/param.h>
   34 #include <sys/systm.h>
   35 #include <sys/device.h>
   36 #include <sys/kernel.h>
   37 #include <dev/wscons/wsconsio.h>
   38 #include <dev/hpc/tpcalibvar.h>
   39 
   40 #include <machine/platid.h>
   41 #include <machine/platid_mask.h>
   42 
   43 #define TPCALIBDEBUG
   44 #ifdef TPCALIBDEBUG
   45 int     tpcalib_debug = 0;
   46 #define DPRINTF(arg) if (tpcalib_debug) printf arg;
   47 #else
   48 #define DPRINTF(arg)
   49 #endif
   50 
   51 /* mra is defined in mra.c */
   52 extern int mra_Y_AX1_BX2_C(int *, int, int *, int, int *, int, int, int, int *,
   53     int *, int *);
   54 
   55 #define SCALE   (1024*256)
   56 
   57 int
   58 tpcalib_init(struct tpcalib_softc *sc)
   59 {
   60         tpcalib_reset(sc);
   61         return (0);
   62 }
   63 
   64 void
   65 tpcalib_reset(struct tpcalib_softc *sc)
   66 {
   67         /* This indicate 'raw mode'. No translation will be done. */
   68         sc->sc_saved.samplelen = WSMOUSE_CALIBCOORDS_RESET;
   69 }
   70 
   71 void
   72 tpcalib_trans(struct tpcalib_softc *sc, int rawx, int rawy, int *x, int *y)
   73 {
   74         if (sc->sc_saved.samplelen == WSMOUSE_CALIBCOORDS_RESET) {
   75                 /* This indicate 'raw mode'. No translation will be done. */
   76                 *x = rawx;
   77                 *y = rawy;
   78         } else {
   79                 *x = (sc->sc_ax * rawx + sc->sc_bx * rawy) / SCALE + sc->sc_cx;
   80                 *y = (sc->sc_ay * rawx + sc->sc_by * rawy) / SCALE + sc->sc_cy;
   81                 if (*x < sc->sc_minx) *x = sc->sc_minx;
   82                 if (*y < sc->sc_miny) *y = sc->sc_miny;
   83                 if (sc->sc_maxx < *x)
   84                         *x = sc->sc_maxx;
   85                 if (sc->sc_maxy < *y)
   86                         *y = sc->sc_maxy;
   87         }
   88 }
   89 
   90 int
   91 tpcalib_ioctl(struct tpcalib_softc *sc, u_long cmd, caddr_t data, int flag,
   92     struct proc *p)
   93 {
   94         struct wsmouse_calibcoords *d;
   95         struct wsmouse_id *id;
   96         char *idstr;
   97         int s;
   98 
   99         switch (cmd) {
  100         case WSMOUSEIO_SCALIBCOORDS:
  101                 s = sizeof(struct wsmouse_calibcoord);
  102                 d = (struct wsmouse_calibcoords *)data;
  103                 if (d->samplelen == WSMOUSE_CALIBCOORDS_RESET) {
  104                         tpcalib_reset(sc);
  105                 } else
  106                         if (mra_Y_AX1_BX2_C(&d->samples[0].x, s,
  107                             &d->samples[0].rawx, s,
  108                             &d->samples[0].rawy, s,
  109                             d->samplelen, SCALE,
  110                             &sc->sc_ax, &sc->sc_bx, &sc->sc_cx) ||
  111                             mra_Y_AX1_BX2_C(&d->samples[0].y, s,
  112                                 &d->samples[0].rawx, s,
  113                                 &d->samples[0].rawy, s,
  114                                 d->samplelen, SCALE,
  115                                 &sc->sc_ay, &sc->sc_by, &sc->sc_cy)) {
  116                                 printf("tpcalib: MRA error");
  117                                 tpcalib_reset(sc);
  118                         
  119                                 return (EINVAL);
  120                         } else {
  121                                 sc->sc_minx = d->minx;
  122                                 sc->sc_maxx = d->maxx;
  123                                 sc->sc_miny = d->miny;
  124                                 sc->sc_maxy = d->maxy;
  125                                 sc->sc_saved = *d;
  126                                 DPRINTF(("tpcalib: x=%d~%d y=%d~%d\n",
  127                                     sc->sc_minx, sc->sc_maxx,
  128                                     sc->sc_miny, sc->sc_maxy));
  129                                 DPRINTF(("tpcalib: Ax=%d Bx=%d Cx=%d\n",
  130                                     sc->sc_ax, sc->sc_bx, sc->sc_cx));
  131                                 DPRINTF(("tpcalib: Ay=%d By=%d Cy=%d\n",
  132                                     sc->sc_ay, sc->sc_by, sc->sc_cy));
  133                         }
  134                 break;
  135 
  136         case WSMOUSEIO_GCALIBCOORDS:
  137                 d = (struct wsmouse_calibcoords *)data;
  138                 *d = sc->sc_saved;
  139                 break;
  140 
  141         case WSMOUSEIO_GETID:
  142                 /*
  143                  * return unique ID string,
  144                  * "<vendor> <model> <serial number>"
  145                  */
  146                 id = (struct wsmouse_id *)data;
  147                 if (id->type != WSMOUSE_ID_TYPE_UIDSTR)
  148                         return (EINVAL);
  149                 idstr = platid_name(&platid);
  150                 s = strlen(idstr);
  151                 if (WSMOUSE_ID_MAXLEN - 10 < s)
  152                         s = WSMOUSE_ID_MAXLEN - 10;
  153                 memcpy(id->data, idstr, s);
  154                 strcpy(&id->data[s], " SN000000");
  155                 id->length = s + 9;
  156                 break;
  157 
  158         default:
  159                 return (EPASSTHROUGH);
  160         }
  161         return (0);
  162 }

Cache object: 2aba190d08611fccc42c2cb15c151196


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.