Annotation of sys/arch/macppc/dev/tpms.c, Revision 1.1.1.1
1.1 nbrk 1: /* $OpenBSD: tpms.c,v 1.12 2007/06/14 10:11:16 mbalmer Exp $ */
2:
3: /*
4: * Copyright (c) 2005, Johan Wallén
5: * 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 are
9: * met:
10: *
11: * 1. Redistributions of source code must retain the above copyright
12: * notice, this list of conditions and the following disclaimer.
13: *
14: * 2. Redistributions in binary form must reproduce the above
15: * copyright notice, this list of conditions and the following
16: * disclaimer in the documentation and/or other materials provided
17: * with the distribution.
18: *
19: * 3. The name of the copyright holder may not be used to endorse or
20: * promote products derived from this software without specific
21: * prior written permission.
22: *
23: * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDER "AS IS" AND ANY
24: * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
26: * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER BE
27: * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
28: * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
29: * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
30: * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
31: * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
32: * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
33: * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
34: */
35:
36: /*
37: * The tpms driver provides support for the trackpad on new (post
38: * February 2005) Apple PowerBooks (and iBooks?) that are not standard
39: * USB HID mice.
40: */
41:
42: /*
43: * The protocol (that is, the interpretation of the data generated by
44: * the trackpad) is taken from the Linux appletouch driver version
45: * 0.08 by Johannes Berg, Stelian Pop and Frank Arnold. The method
46: * used to detect fingers on the trackpad is also taken from that
47: * driver.
48: */
49:
50: /*
51: * PROTOCOL:
52: *
53: * The driver transfers continuously 81 byte events. The last byte is
54: * 1 if the button is pressed, and is 0 otherwise. Of the remaining
55: * bytes, 26 + 16 = 42 are sensors detecting pressure in the X or
56: * horizontal, and Y or vertical directions, respectively. On 12 and
57: * 15 inch PowerBooks, only the 16 first sensors in the X-direction
58: * are used. In the X-direction, the sensors correspond to byte
59: * positions
60: *
61: * 2, 7, 12, 17, 22, 27, 32, 37, 4, 9, 14, 19, 24, 29, 34, 39, 42,
62: * 47, 52, 57, 62, 67, 72, 77, 44 and 49;
63: *
64: * in the Y direction, the sensors correspond to byte positions
65: *
66: * 1, 6, 11, 16, 21, 26, 31, 36, 3, 8, 13, 18, 23, 28, 33 and 38.
67: *
68: * The change in the sensor values over time is more interesting than
69: * their absolute values: if the pressure increases, we know that the
70: * finger has just moved there.
71: *
72: * We keep track of the previous sample (of sensor values in the X and
73: * Y directions) and the accumulated change for each sensor. When we
74: * receive a new sample, we add the difference of the new sensor value
75: * and the old value to the accumulated change. If the accumulator
76: * becomes negative, we set it to zero. The effect is that the
77: * accumulator is large for sensors whose pressure has recently
78: * increased. If there is little change in pressure (or if the
79: * pressure decreases), the accumulator drifts back to zero.
80: *
81: * Since there is some fluctuations, we ignore accumulator values
82: * below a threshold. The raw finger position is computed as a
83: * weighted average of the other sensors (the weights are the
84: * accumulated changes).
85: *
86: * For smoothing, we keep track of the previous raw finger position,
87: * and the virtual position reported to wsmouse. The new raw position
88: * is computed as a weighted average of the old raw position and the
89: * computed raw position. Since this still generates some noise, we
90: * compute a new virtual position as a weighted average of the previous
91: * virtual position and the new raw position. The weights are
92: * controlled by the raw change and a noise parameter. The position
93: * is reported as a relative position.
94: */
95:
96: /*
97: * TODO:
98: *
99: * Add support for other drivers of the same type.
100: *
101: * Add support for tapping and two-finger scrolling? The
102: * implementation already detects two fingers, so this should be
103: * relatively easy.
104: *
105: * Implement some of the mouse ioctls?
106: *
107: * Take care of the XXXs.
108: *
109: */
110:
111: #include <sys/param.h>
112: #include <sys/device.h>
113: #include <sys/errno.h>
114:
115: #include <sys/ioctl.h>
116: #include <sys/systm.h>
117: #include <sys/tty.h>
118:
119: #include <dev/usb/usb.h>
120: #include <dev/usb/usbdi.h>
121: #include <dev/usb/usbdevs.h>
122: #include <dev/usb/uhidev.h>
123:
124: #include <dev/wscons/wsconsio.h>
125: #include <dev/wscons/wsmousevar.h>
126:
127: /*
128: * Debugging output.
129: */
130:
131: /* XXX Should be redone, and its use should be added back. */
132:
133: #ifdef TPMS_DEBUG
134:
135: /*
136: * Print the error message (preceded by the driver and function)
137: * specified by the string literal fmt (followed by newline) if
138: * tpmsdebug is greater than n. The macro may only be used in the
139: * scope of sc, which must be castable to struct device *. There must
140: * be at least one vararg. Do not define TPMS_DEBUG on non-C99
141: * compilers.
142: */
143:
144: #define DPRINTFN(n, fmt, ...) \
145: do { \
146: if (tpmsdebug > (n)) \
147: logprintf("%s: %s: " fmt "\n", \
148: ((struct device *) sc)->dv_xname, \
149: __func__, __VA_ARGS__); \
150: } while ( /* CONSTCOND */ 0)
151:
152: int tpmsdebug = 0;
153:
154: #endif /* TPMS_DEBUG */
155:
156: /*
157: * Magic numbers.
158: */
159:
160: /* The amount of data transfered by the USB device. */
161: #define TPMS_DATA_LEN 81
162:
163: /* The maximum number of sensors. */
164: #define TPMS_X_SENSORS 26
165: #define TPMS_Y_SENSORS 16
166: #define TPMS_SENSORS (TPMS_X_SENSORS + TPMS_Y_SENSORS)
167:
168: /*
169: * Parameters for supported devices. For generality, these parameters
170: * can be different for each device. The meanings of the parameters
171: * are as follows.
172: *
173: * desc: A printable description used for dmesg output.
174: *
175: * noise: Amount of noise in the computed position. This controls
176: * how large a change must be to get reported, and how
177: * large enough changes are smoothed. A good value can
178: * probably only be found experimentally, but something around
179: * 16 seems suitable.
180: *
181: * product: The product ID of the trackpad.
182: *
183: *
184: * threshold: Accumulated changes less than this are ignored. A good
185: * value could be determined experimentally, but 5 is a
186: * reasonable guess.
187: *
188: * vendor: The vendor ID. Currently USB_VENDOR_APPLE for all devices.
189: *
190: * x_factor: Factor used in computations with X-coordinates. If the
191: * x-resolution of the display is x, this should be
192: * (x + 1) / (x_sensors - 1). Other values work fine, but
193: * then the aspect ratio is not necessarily kept.
194: *
195: * x_sensors: The number of sensors in the X-direction.
196: *
197: * y_factor: As x_factors, but for Y-coordinates.
198: *
199: * y_sensors: The number of sensors in the Y-direction.
200: */
201:
202: struct tpms_dev {
203: const char *descr; /* Description of the driver (for dmesg). */
204: int noise; /* Amount of noise in the computed position. */
205: int threshold; /* Changes less than this are ignored. */
206: int x_factor; /* Factor used in computation with X-coordinates. */
207: int x_sensors; /* The number of X-sensors. */
208: int y_factor; /* Factor used in computation with Y-coordinates. */
209: int y_sensors; /* The number of Y-sensors. */
210: uint16_t product; /* Product ID. */
211: uint16_t vendor; /* The vendor ID. */
212: };
213:
214: /* Devices supported by this driver. */
215: static struct tpms_dev tpms_devices[] =
216: {
217: #define POWERBOOK_TOUCHPAD(inches, prod, x_fact, x_sens, y_fact) \
218: { \
219: .descr = #inches " inch PowerBook Trackpad", \
220: .vendor = USB_VENDOR_APPLE, \
221: .product = (prod), \
222: .noise = 16, \
223: .threshold = 5, \
224: .x_factor = (x_fact), \
225: .x_sensors = (x_sens), \
226: .y_factor = (y_fact), \
227: .y_sensors = 16 \
228: }
229: /* 12 inch PowerBooks */
230: POWERBOOK_TOUCHPAD(12, 0x030a, 69, 16, 52), /* XXX Not tested. */
231: /* 14 inch iBook G4 */
232: POWERBOOK_TOUCHPAD(14, 0x030b, 69, 16, 52),
233: /* 15 inch PowerBooks */
234: POWERBOOK_TOUCHPAD(15, 0x020e, 85, 16, 57), /* XXX Not tested. */
235: POWERBOOK_TOUCHPAD(15, 0x020f, 85, 16, 57),
236: /* 17 inch PowerBooks */
237: POWERBOOK_TOUCHPAD(17, 0x020d, 71, 26, 68) /* XXX Not tested. */
238: #undef POWERBOOK_TOUCHPAD
239: };
240:
241: /* The number of supported devices. */
242: #define TPMS_NUM_DEVICES (sizeof(tpms_devices) / sizeof(tpms_devices[0]))
243:
244: /*
245: * Types and prototypes.
246: */
247:
248: /* Device data. */
249: struct tpms_softc {
250: struct uhidev sc_hdev; /* USB parent (got the struct device). */
251: int sc_acc[TPMS_SENSORS]; /* Accumulated sensor values. */
252: signed char sc_prev[TPMS_SENSORS]; /* Previous sample. */
253: signed char sc_sample[TPMS_SENSORS]; /* Current sample. */
254: struct device *sc_wsmousedev; /* WSMouse device. */
255: int sc_noise; /* Amount of noise. */
256: int sc_threshold; /* Threshold value. */
257: int sc_x; /* Virtual position in horizontal
258: * direction (wsmouse position). */
259: int sc_x_factor; /* X-coordinate factor. */
260: int sc_x_raw; /* X-position of finger on trackpad. */
261: int sc_x_sensors; /* Number of X-sensors. */
262: int sc_y; /* Virtual position in vertical direction
263: * (wsmouse position). */
264: int sc_y_factor; /* Y-coordinate factor. */
265: int sc_y_raw; /* Y-position of finger on trackpad. */
266: int sc_y_sensors; /* Number of Y-sensors. */
267: uint32_t sc_buttons; /* Button state. */
268: uint32_t sc_status; /* Status flags. */
269: #define TPMS_ENABLED 1 /* Is the device enabled? */
270: #define TPMS_DYING 2 /* Is the device dying? */
271: #define TPMS_VALID 4 /* Is the previous sample valid? */
272: };
273:
274: void tpms_intr(struct uhidev *, void *, unsigned int);
275: int tpms_enable(void *);
276: void tpms_disable(void *);
277: int tpms_ioctl(void *, unsigned long, caddr_t, int, struct proc *);
278: void reorder_sample(signed char *, signed char *);
279: int compute_delta(struct tpms_softc *, int *, int *, int *, uint32_t *);
280: int detect_pos(int *, int, int, int, int *, int *);
281: int smooth_pos(int, int, int);
282:
283: /* Access methods for wsmouse. */
284: const struct wsmouse_accessops tpms_accessops = {
285: tpms_enable,
286: tpms_ioctl,
287: tpms_disable,
288: };
289:
290: /* This take cares also of the basic device registration. */
291: int tpms_match(struct device *, void *, void *);
292: void tpms_attach(struct device *, struct device *, void *);
293: int tpms_detach(struct device *, int);
294: int tpms_activate(struct device *, enum devact);
295:
296: struct cfdriver tpms_cd = {
297: NULL, "tpms", DV_DULL
298: };
299:
300: const struct cfattach tpms_ca = {
301: sizeof(struct tpms_softc),
302: tpms_match,
303: tpms_attach,
304: tpms_detach,
305: tpms_activate,
306: };
307:
308: /*
309: * Basic driver.
310: */
311:
312: /* Try to match the device at some uhidev. */
313:
314: int
315: tpms_match(struct device *parent, void *match, void *aux)
316: {
317: struct usb_attach_arg *uaa = aux;
318: struct uhidev_attach_arg *uha = (struct uhidev_attach_arg *)uaa;
319: usb_device_descriptor_t *udd;
320: int i;
321: uint16_t vendor, product;
322:
323: /*
324: * We just check if the vendor and product IDs have the magic numbers
325: * we expect.
326: */
327: if ((udd = usbd_get_device_descriptor(uha->parent->sc_udev)) != NULL) {
328: vendor = UGETW(udd->idVendor);
329: product = UGETW(udd->idProduct);
330: for (i = 0; i < TPMS_NUM_DEVICES; i++) {
331: if (vendor == tpms_devices[i].vendor &&
332: product == tpms_devices[i].product)
333: return (UMATCH_IFACECLASS);
334: }
335: }
336:
337: return (UMATCH_NONE);
338: }
339:
340:
341: /* Attach the device. */
342:
343: void
344: tpms_attach(struct device *parent, struct device *self, void *aux)
345: {
346: struct tpms_softc *sc = (struct tpms_softc *)self;
347: struct usb_attach_arg *uaa = aux;
348: struct uhidev_attach_arg *uha = (struct uhidev_attach_arg *)uaa;
349: struct wsmousedev_attach_args a;
350: struct tpms_dev *pd;
351: usb_device_descriptor_t *udd;
352: int i;
353: uint16_t vendor, product;
354:
355: /* Fill in device-specific parameters. */
356: if ((udd = usbd_get_device_descriptor(uha->parent->sc_udev)) != NULL) {
357: product = UGETW(udd->idProduct);
358: vendor = UGETW(udd->idVendor);
359: for (i = 0; i < TPMS_NUM_DEVICES; i++) {
360: pd = &tpms_devices[i];
361: if (product == pd->product && vendor == pd->vendor) {
362: printf(": %s\n", pd->descr);
363: sc->sc_noise = pd->noise;
364: sc->sc_threshold = pd->threshold;
365: sc->sc_x_factor = pd->x_factor;
366: sc->sc_x_sensors = pd->x_sensors;
367: sc->sc_y_factor = pd->y_factor;
368: sc->sc_y_sensors = pd->y_sensors;
369: break;
370: }
371: }
372: }
373: if (sc->sc_x_sensors <= 0 || sc->sc_x_sensors > TPMS_X_SENSORS ||
374: sc->sc_y_sensors <= 0 || sc->sc_y_sensors > TPMS_Y_SENSORS) {
375: printf(": unexpected sensors configuration (%d:%d)\n",
376: sc->sc_x_sensors, sc->sc_y_sensors);
377: return;
378: }
379:
380: sc->sc_hdev.sc_intr = tpms_intr;
381: sc->sc_hdev.sc_parent = uha->parent;
382: sc->sc_hdev.sc_report_id = uha->reportid;
383:
384: sc->sc_status = 0;
385:
386: a.accessops = &tpms_accessops;
387: a.accesscookie = sc;
388: sc->sc_wsmousedev = config_found(self, &a, wsmousedevprint);
389: }
390:
391: /* Detach the device. */
392:
393: int
394: tpms_detach(struct device *self, int flags)
395: {
396: struct tpms_softc *sc = (struct tpms_softc *)self;
397: int ret;
398:
399: /* The wsmouse driver does all the work. */
400: ret = 0;
401: if (sc->sc_wsmousedev != NULL)
402: ret = config_detach(sc->sc_wsmousedev, flags);
403:
404: return (ret);
405: }
406:
407: /* Activate the device. */
408:
409: int
410: tpms_activate(struct device *self, enum devact act)
411: {
412: struct tpms_softc *sc = (struct tpms_softc *)self;
413: int ret;
414:
415: if (act == DVACT_DEACTIVATE) {
416: ret = 0;
417: if (sc->sc_wsmousedev != NULL)
418: ret = config_deactivate(sc->sc_wsmousedev);
419: sc->sc_status |= TPMS_DYING;
420: return (ret);
421: }
422: return (EOPNOTSUPP);
423: }
424:
425:
426: /* Enable the device. */
427:
428: int
429: tpms_enable(void *v)
430: {
431: struct tpms_softc *sc = v;
432:
433: /* Check that we are not detaching or already enabled. */
434: if (sc->sc_status & TPMS_DYING)
435: return (EIO);
436: if (sc->sc_status & TPMS_ENABLED)
437: return (EBUSY);
438:
439: sc->sc_status |= TPMS_ENABLED;
440: sc->sc_status &= ~TPMS_VALID;
441: sc->sc_buttons = 0;
442: memset(sc->sc_sample, 0, sizeof(sc->sc_sample));
443:
444: return (uhidev_open(&sc->sc_hdev));
445: }
446:
447: /* Disable the device. */
448:
449: void
450: tpms_disable(void *v)
451: {
452: struct tpms_softc *sc = v;
453:
454: if (!(sc->sc_status & TPMS_ENABLED))
455: return;
456:
457: sc->sc_status &= ~TPMS_ENABLED;
458: uhidev_close(&sc->sc_hdev);
459: }
460:
461: int
462: tpms_ioctl(void *v, unsigned long cmd, caddr_t data, int flag, struct proc *p)
463: {
464: switch (cmd) {
465: case WSMOUSEIO_GTYPE:
466: *(u_int *)data = WSMOUSE_TYPE_TPANEL;
467: return (0);
468: }
469:
470: return (-1);
471: }
472:
473: /*
474: * Interrupts & pointer movement.
475: */
476:
477: /* Handle interrupts. */
478:
479: void
480: tpms_intr(struct uhidev *addr, void *ibuf, unsigned int len)
481: {
482: struct tpms_softc *sc = (struct tpms_softc *)addr;
483: signed char *data;
484: int dx, dy, dz, i, s;
485: uint32_t buttons;
486:
487: /* Ignore incomplete data packets. */
488: if (len != TPMS_DATA_LEN)
489: return;
490: data = ibuf;
491:
492: /* The last byte is 1 if the button is pressed and 0 otherwise. */
493: buttons = !!data[TPMS_DATA_LEN - 1];
494:
495: /* Everything below assumes that the sample is reordered. */
496: reorder_sample(sc->sc_sample, data);
497:
498: /* Is this the first sample? */
499: if (!(sc->sc_status & TPMS_VALID)) {
500: sc->sc_status |= TPMS_VALID;
501: sc->sc_x = sc->sc_y = -1;
502: sc->sc_x_raw = sc->sc_y_raw = -1;
503: memcpy(sc->sc_prev, sc->sc_sample, sizeof(sc->sc_prev));
504: memset(sc->sc_acc, 0, sizeof(sc->sc_acc));
505: return;
506: }
507: /* Accumulate the sensor change while keeping it nonnegative. */
508: for (i = 0; i < TPMS_SENSORS; i++) {
509: sc->sc_acc[i] += sc->sc_sample[i] - sc->sc_prev[i];
510: if (sc->sc_acc[i] < 0)
511: sc->sc_acc[i] = 0;
512: }
513: memcpy(sc->sc_prev, sc->sc_sample, sizeof(sc->sc_prev));
514:
515: /* Compute change. */
516: dx = dy = dz = 0;
517: if (!compute_delta(sc, &dx, &dy, &dz, &buttons))
518: return;
519:
520: /* Report to wsmouse. */
521: if ((dx != 0 || dy != 0 || dz != 0 || buttons != sc->sc_buttons) &&
522: sc->sc_wsmousedev != NULL) {
523: s = spltty();
524: wsmouse_input(sc->sc_wsmousedev, buttons, dx, -dy, dz, 0,
525: WSMOUSE_INPUT_DELTA);
526: splx(s);
527: }
528: sc->sc_buttons = buttons;
529: }
530:
531: /*
532: * Reorder the sensor values so that all the X-sensors are before the
533: * Y-sensors in the natural order. Note that this might have to be
534: * rewritten if TPMS_X_SENSORS or TPMS_Y_SENSORS change.
535: */
536:
537: void
538: reorder_sample(signed char *to, signed char *from)
539: {
540: int i;
541:
542: for (i = 0; i < 8; i++) {
543: /* X-sensors. */
544: to[i] = from[5 * i + 2];
545: to[i + 8] = from[5 * i + 4];
546: to[i + 16] = from[5 * i + 42];
547: #if 0
548: /*
549: * XXX This seems to introduce random vertical jumps, so
550: * we ignore these sensors until we figure out their meaning.
551: */
552: if (i < 2)
553: to[i + 24] = from[5 * i + 44];
554: #endif /* 0 */
555: /* Y-sensors. */
556: to[i + 26] = from[5 * i + 1];
557: to[i + 34] = from[5 * i + 3];
558: }
559: }
560:
561: /*
562: * Compute the change in x, y and z direction, update the button state
563: * (to simulate more than one button, scrolling etc.), and update the
564: * history. Note that dx, dy, dz and buttons are modified only if
565: * corresponding pressure is detected and should thus be initialised
566: * before the call. Return 0 on error.
567: */
568:
569: /* XXX Could we report something useful in dz? */
570:
571: int
572: compute_delta(struct tpms_softc *sc, int *dx, int *dy, int *dz,
573: uint32_t * buttons)
574: {
575: int x_det, y_det, x_raw, y_raw, x_fingers, y_fingers, fingers, x, y;
576:
577: x_det = detect_pos(sc->sc_acc, sc->sc_x_sensors, sc->sc_threshold,
578: sc->sc_x_factor, &x_raw, &x_fingers);
579: y_det = detect_pos(sc->sc_acc + TPMS_X_SENSORS, sc->sc_y_sensors,
580: sc->sc_threshold, sc->sc_y_factor,
581: &y_raw, &y_fingers);
582: fingers = max(x_fingers, y_fingers);
583:
584: /* Check the number of fingers and if we have detected a position. */
585: if (fingers > 1) {
586: /* More than one finger detected, resetting. */
587: memset(sc->sc_acc, 0, sizeof(sc->sc_acc));
588: sc->sc_x_raw = sc->sc_y_raw = sc->sc_x = sc->sc_y = -1;
589: return 0;
590: } else if (x_det == 0 && y_det == 0) {
591: /* No position detected, resetting. */
592: memset(sc->sc_acc, 0, sizeof(sc->sc_acc));
593: sc->sc_x_raw = sc->sc_y_raw = sc->sc_x = sc->sc_y = -1;
594: } else if (x_det > 0 && y_det > 0) {
595: /* Smooth position. */
596: if (sc->sc_x_raw >= 0) {
597: sc->sc_x_raw = (3 * sc->sc_x_raw + x_raw) / 4;
598: sc->sc_y_raw = (3 * sc->sc_y_raw + y_raw) / 4;
599: /*
600: * Compute virtual position and change if we already
601: * have a decent position.
602: */
603: if (sc->sc_x >= 0) {
604: x = smooth_pos(sc->sc_x, sc->sc_x_raw,
605: sc->sc_noise);
606: y = smooth_pos(sc->sc_y, sc->sc_y_raw,
607: sc->sc_noise);
608: *dx = x - sc->sc_x;
609: *dy = y - sc->sc_y;
610: sc->sc_x = x;
611: sc->sc_y = y;
612: } else {
613: /* Initialise virtual position. */
614: sc->sc_x = sc->sc_x_raw;
615: sc->sc_y = sc->sc_y_raw;
616: }
617: } else {
618: /* Initialise raw position. */
619: sc->sc_x_raw = x_raw;
620: sc->sc_y_raw = y_raw;
621: }
622: }
623: return (1);
624: }
625:
626: /*
627: * Compute the new smoothed position from the previous smoothed position
628: * and the raw position.
629: */
630:
631: int
632: smooth_pos(int pos_old, int pos_raw, int noise)
633: {
634: int ad, delta;
635:
636: delta = pos_raw - pos_old;
637: ad = abs(delta);
638:
639: /* Too small changes are ignored. */
640: if (ad < noise / 2)
641: delta = 0;
642: /* A bit larger changes are smoothed. */
643: else if (ad < noise)
644: delta /= 4;
645: else if (ad < 2 * noise)
646: delta /= 2;
647:
648: return (pos_old + delta);
649: }
650:
651: /*
652: * Detect the position of the finger. Returns the total pressure.
653: * The position is returned in pos_ret and the number of fingers
654: * is returned in fingers_ret. The position returned in pos_ret
655: * is in [0, (n_sensors - 1) * factor - 1].
656: */
657:
658: int
659: detect_pos(int *sensors, int n_sensors, int threshold, int fact,
660: int *pos_ret, int *fingers_ret)
661: {
662: int i, w, s;
663:
664: /*
665: * Compute the number of fingers, total pressure, and weighted
666: * position of the fingers.
667: */
668: *fingers_ret = 0;
669: w = s = 0;
670: for (i = 0; i < n_sensors; i++) {
671: if (sensors[i] >= threshold) {
672: if (i == 0 || sensors[i - 1] < threshold)
673: *fingers_ret += 1;
674: s += sensors[i];
675: w += sensors[i] * i;
676: }
677: }
678:
679: if (s > 0)
680: *pos_ret = w * fact / s;
681:
682: return (s);
683: }
CVSweb