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