1 /* $NetBSD: tp.c,v 1.9 2009/04/28 10:57:24 nonaka Exp $ */ 2 3 /*- 4 * Copyright (c) 2002, 2003 TAKEMRUA Shin 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 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 * 3. Neither the name of The NetBSD Foundation nor the names of its 16 * contributors may be used to endorse or promote products derived 17 * from this software without specific prior written permission. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 #include <stdio.h> 33 #include <string.h> 34 #include <sys/ioctl.h> 35 #include <sys/fcntl.h> 36 #include <sys/mman.h> 37 #include <errno.h> 38 #include <unistd.h> 39 40 #include "tpctl.h" 41 42 #define MIN(a, b) ((a) < (b) ? (a) : (b)) 43 44 #ifndef lint 45 #include <sys/cdefs.h> 46 __RCSID("$NetBSD: tp.c,v 1.9 2009/04/28 10:57:24 nonaka Exp $"); 47 #endif /* not lint */ 48 49 int 50 tp_init(struct tp *tp, int fd) 51 { 52 u_int flags; 53 struct wsmouse_calibcoords calibcoords; 54 struct wsmouse_id id; 55 #ifdef WSMOUSEIO_SETVERSION 56 int version = WSMOUSE_EVENT_VERSION; 57 58 if (ioctl(fd, WSMOUSEIO_SETVERSION, &version) == -1) { 59 return (-1); 60 } 61 #endif 62 63 tp->fd = fd; 64 65 #if 0 66 if (ioctl(tp->fd, WSMOUSEIO_GTYPE, &type) < 0) 67 return (-1); 68 if (type != WSMOUSE_TYPE_TPANEL) { 69 errno = EINVAL; 70 return (-1); 71 } 72 #else 73 if (ioctl(tp->fd, WSMOUSEIO_GCALIBCOORDS, &calibcoords) < 0) 74 return (-1); 75 #endif 76 flags = fcntl(tp->fd, F_GETFL); 77 if (flags == (u_int)-1) 78 return (-1); 79 flags |= O_NONBLOCK; 80 if (fcntl(tp->fd, F_SETFL, flags) < 0) 81 return (-1); 82 83 id.type = WSMOUSE_ID_TYPE_UIDSTR; 84 if (ioctl(tp->fd, WSMOUSEIO_GETID, &id) == 0) { 85 (void)strlcpy(tp->id, (char *)id.data, 86 MIN(sizeof(tp->id), id.length)); 87 } else { 88 tp->id[0] = '*'; 89 tp->id[1] = '\0'; 90 } 91 92 return (0); 93 } 94 95 int 96 tp_setrawmode(struct tp *tp) 97 { 98 struct wsmouse_calibcoords raw; 99 100 memset(&raw, 0, sizeof(raw)); 101 raw.samplelen = WSMOUSE_CALIBCOORDS_RESET; 102 103 return ioctl(tp->fd, WSMOUSEIO_SCALIBCOORDS, &raw); 104 } 105 106 int 107 tp_setcalibcoords(struct tp *tp, struct wsmouse_calibcoords *calibcoords) 108 { 109 return ioctl(tp->fd, WSMOUSEIO_SCALIBCOORDS, calibcoords); 110 } 111 112 int 113 tp_flush(struct tp *tp) 114 { 115 struct wscons_event ev; 116 int count; 117 118 count = 0; 119 while (read(tp->fd, &ev, sizeof(ev)) == sizeof(ev)) { 120 switch (ev.type) { 121 case WSCONS_EVENT_MOUSE_UP: 122 case WSCONS_EVENT_MOUSE_DOWN: 123 case WSCONS_EVENT_MOUSE_DELTA_X: 124 case WSCONS_EVENT_MOUSE_DELTA_Y: 125 case WSCONS_EVENT_MOUSE_ABSOLUTE_X: 126 case WSCONS_EVENT_MOUSE_ABSOLUTE_Y: 127 case WSCONS_EVENT_MOUSE_DELTA_Z: 128 case WSCONS_EVENT_MOUSE_ABSOLUTE_Z: 129 count++; 130 break; 131 132 default: 133 break; 134 } 135 } 136 137 return (count); 138 } 139 140 int 141 tp_get(struct tp *tp, int *x, int *y, int (*cancel)(void *), void *data) 142 { 143 struct wscons_event ev; 144 int x_done, y_done, res; 145 146 x_done = y_done = 0; 147 while (1) { 148 if (cancel != NULL && (res = (*cancel)(data)) != 0) 149 return (res); 150 if ((res = read(tp->fd, &ev, sizeof(ev))) < 0) { 151 if (errno != EWOULDBLOCK) 152 return (-1); 153 continue; 154 } 155 if (res != sizeof(ev)) { 156 errno = EINVAL; 157 return (-1); 158 } 159 switch (ev.type) { 160 case WSCONS_EVENT_MOUSE_ABSOLUTE_X: 161 *x = ev.value; 162 if (y_done) 163 return (0); 164 x_done = 1; 165 break; 166 167 case WSCONS_EVENT_MOUSE_ABSOLUTE_Y: 168 *y = ev.value; 169 if (x_done) 170 return (0); 171 y_done = 1; 172 break; 173 174 default: 175 break; 176 } 177 } 178 } 179 180 int 181 tp_waitup(struct tp *tp, int msec, int (*cancel)(void*), void *data) 182 { 183 int res; 184 185 while (1) { 186 if (cancel != NULL && (res = (*cancel)(data)) != 0) 187 return (res); 188 usleep(msec * 1000); 189 if (tp_flush(tp) == 0) 190 break; 191 } 192 193 return (0); 194 } 195