hid.c (128080) | hid.c (137868) |
---|---|
1/* 2 * hid.c 3 * 4 * Copyright (c) 2004 Maksim Yevmenkin <m_evmenkin@yahoo.com> 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 --- 11 unchanged lines hidden (view full) --- 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 * | 1/* 2 * hid.c 3 * 4 * Copyright (c) 2004 Maksim Yevmenkin <m_evmenkin@yahoo.com> 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 --- 11 unchanged lines hidden (view full) --- 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 * $Id: hid.c,v 1.3 2004/02/26 21:47:35 max Exp $ 29 * $FreeBSD: head/usr.sbin/bluetooth/bthidd/hid.c 128080 2004-04-10 00:18:00Z emax $ | 28 * $Id: hid.c,v 1.4 2004/11/17 21:59:42 max Exp $ 29 * $FreeBSD: head/usr.sbin/bluetooth/bthidd/hid.c 137868 2004-11-18 18:05:15Z emax $ |
30 */ 31 32#include <sys/consio.h> 33#include <sys/mouse.h> 34#include <sys/queue.h> 35#include <assert.h> 36#include <bluetooth.h> 37#include <errno.h> 38#include <dev/usb/usb.h> 39#include <dev/usb/usbhid.h> 40#include <stdio.h> 41#include <string.h> 42#include <syslog.h> | 30 */ 31 32#include <sys/consio.h> 33#include <sys/mouse.h> 34#include <sys/queue.h> 35#include <assert.h> 36#include <bluetooth.h> 37#include <errno.h> 38#include <dev/usb/usb.h> 39#include <dev/usb/usbhid.h> 40#include <stdio.h> 41#include <string.h> 42#include <syslog.h> |
43#include <unistd.h> |
|
43#include <usbhid.h> 44#include "bthidd.h" 45#include "bthid_config.h" | 44#include <usbhid.h> 45#include "bthidd.h" 46#include "bthid_config.h" |
47#include "kbd.h" |
|
46 47#undef min 48#define min(x, y) (((x) < (y))? (x) : (y)) 49 | 48 49#undef min 50#define min(x, y) (((x) < (y))? (x) : (y)) 51 |
52#undef ASIZE 53#define ASIZE(a) (sizeof(a)/sizeof(a[0])) 54 |
|
50/* 51 * Process data from control channel 52 */ 53 54int 55hid_control(bthid_session_p s, char *data, int len) 56{ 57 assert(s != NULL); --- 60 unchanged lines hidden (view full) --- 118int 119hid_interrupt(bthid_session_p s, char *data, int len) 120{ 121 hid_device_p hid_device = NULL; 122 hid_data_t d; 123 hid_item_t h; 124 int report_id, usage, page, val, 125 mouse_x, mouse_y, mouse_z, mouse_butt, | 55/* 56 * Process data from control channel 57 */ 58 59int 60hid_control(bthid_session_p s, char *data, int len) 61{ 62 assert(s != NULL); --- 60 unchanged lines hidden (view full) --- 123int 124hid_interrupt(bthid_session_p s, char *data, int len) 125{ 126 hid_device_p hid_device = NULL; 127 hid_data_t d; 128 hid_item_t h; 129 int report_id, usage, page, val, 130 mouse_x, mouse_y, mouse_z, mouse_butt, |
126 nkeys, keys[32]; /* XXX how big keys[] should be? */ | 131 mevents, kevents; |
127 128 assert(s != NULL); | 132 133 assert(s != NULL); |
134 assert(s->srv != NULL); |
|
129 assert(data != NULL); 130 131 if (len < 3) { 132 syslog(LOG_ERR, "Got short message (%d bytes) on Interrupt " \ 133 "channel from %s", len, bt_ntoa(&s->bdaddr, NULL)); 134 return (-1); 135 } 136 --- 6 unchanged lines hidden (view full) --- 143 144 report_id = data[1]; 145 data += 2; 146 len -= 2; 147 148 hid_device = get_hid_device(&s->bdaddr); 149 assert(hid_device != NULL); 150 | 135 assert(data != NULL); 136 137 if (len < 3) { 138 syslog(LOG_ERR, "Got short message (%d bytes) on Interrupt " \ 139 "channel from %s", len, bt_ntoa(&s->bdaddr, NULL)); 140 return (-1); 141 } 142 --- 6 unchanged lines hidden (view full) --- 149 150 report_id = data[1]; 151 data += 2; 152 len -= 2; 153 154 hid_device = get_hid_device(&s->bdaddr); 155 assert(hid_device != NULL); 156 |
151 mouse_x = mouse_y = mouse_z = mouse_butt = nkeys = 0; | 157 mouse_x = mouse_y = mouse_z = mouse_butt = mevents = kevents = 0; |
152 153 for (d = hid_start_parse(hid_device->desc, 1 << hid_input, -1); 154 hid_get_item(d, &h) > 0; ) { 155 if ((h.flags & HIO_CONST) || (h.report_ID != report_id)) 156 continue; 157 158 page = HID_PAGE(h.usage); 159 usage = HID_USAGE(h.usage); 160 val = hid_get_data(data, &h); 161 162 switch (page) { 163 case HUP_GENERIC_DESKTOP: 164 switch (usage) { 165 case HUG_X: 166 mouse_x = val; | 158 159 for (d = hid_start_parse(hid_device->desc, 1 << hid_input, -1); 160 hid_get_item(d, &h) > 0; ) { 161 if ((h.flags & HIO_CONST) || (h.report_ID != report_id)) 162 continue; 163 164 page = HID_PAGE(h.usage); 165 usage = HID_USAGE(h.usage); 166 val = hid_get_data(data, &h); 167 168 switch (page) { 169 case HUP_GENERIC_DESKTOP: 170 switch (usage) { 171 case HUG_X: 172 mouse_x = val; |
173 mevents ++; |
|
167 break; 168 169 case HUG_Y: 170 mouse_y = val; | 174 break; 175 176 case HUG_Y: 177 mouse_y = val; |
178 mevents ++; |
|
171 break; 172 173 case HUG_WHEEL: 174 mouse_z = -val; | 179 break; 180 181 case HUG_WHEEL: 182 mouse_z = -val; |
183 mevents ++; |
|
175 break; 176 177 case HUG_SYSTEM_SLEEP: 178 if (val) 179 syslog(LOG_NOTICE, "Sleep button pressed"); 180 break; 181 } 182 break; 183 184 case HUP_KEYBOARD: | 184 break; 185 186 case HUG_SYSTEM_SLEEP: 187 if (val) 188 syslog(LOG_NOTICE, "Sleep button pressed"); 189 break; 190 } 191 break; 192 193 case HUP_KEYBOARD: |
194 kevents ++; 195 |
|
185 if (h.flags & HIO_VARIABLE) { | 196 if (h.flags & HIO_VARIABLE) { |
186 if (val && nkeys < sizeof(keys)) 187 keys[nkeys ++] = usage; | 197 if (val && usage < kbd_maxkey()) 198 bit_set(s->srv->keys, usage); |
188 } else { | 199 } else { |
189 if (val && nkeys < sizeof(keys)) 190 keys[nkeys ++] = val; | 200 if (val && val < kbd_maxkey()) 201 bit_set(s->srv->keys, val); 202 |
191 data ++; 192 len --; 193 194 len = min(len, h.report_size); 195 while (len > 0) { 196 val = hid_get_data(data, &h); | 203 data ++; 204 len --; 205 206 len = min(len, h.report_size); 207 while (len > 0) { 208 val = hid_get_data(data, &h); |
197 if (val && nkeys < sizeof(keys)) 198 keys[nkeys ++] = val; | 209 if (val && val < kbd_maxkey()) 210 bit_set(s->srv->keys, val); 211 |
199 data ++; 200 len --; 201 } 202 } 203 break; 204 205 case HUP_BUTTON: 206 mouse_butt |= (val << (usage - 1)); | 212 data ++; 213 len --; 214 } 215 } 216 break; 217 218 case HUP_BUTTON: 219 mouse_butt |= (val << (usage - 1)); |
220 mevents ++; |
|
207 break; 208 | 221 break; 222 |
223 case HUP_CONSUMER: 224 if (!val) 225 break; 226 227 switch (usage) { 228 case 0xb5: /* Scan Next Track */ 229 val = 0x19; 230 break; 231 232 case 0xb6: /* Scan Previous Track */ 233 val = 0x10; 234 break; 235 236 case 0xb7: /* Stop */ 237 val = 0x24; 238 break; 239 240 case 0xcd: /* Play/Pause */ 241 val = 0x22; 242 break; 243 244 case 0xe2: /* Mute */ 245 val = 0x20; 246 break; 247 248 case 0xe9: /* Volume Up */ 249 val = 0x30; 250 break; 251 252 case 0xea: /* Volume Down */ 253 val = 0x2E; 254 break; 255 256 case 0x183: /* Media Select */ 257 val = 0x6D; 258 break; 259 260 case 0x018a: /* Mail */ 261 val = 0x6C; 262 break; 263 264 case 0x192: /* Calculator */ 265 val = 0x21; 266 break; 267 268 case 0x194: /* My Computer */ 269 val = 0x6B; 270 break; 271 272 case 0x221: /* WWW Search */ 273 val = 0x65; 274 break; 275 276 case 0x223: /* WWW Home */ 277 val = 0x32; 278 break; 279 280 case 0x224: /* WWW Back */ 281 val = 0x6A; 282 break; 283 284 case 0x225: /* WWW Forward */ 285 val = 0x69; 286 break; 287 288 case 0x226: /* WWW Stop */ 289 val = 0x68; 290 break; 291 292 case 0227: /* WWW Refresh */ 293 val = 0x67; 294 break; 295 296 case 0x22a: /* WWW Favorites */ 297 val = 0x66; 298 break; 299 300 default: 301 val = 0; 302 break; 303 } 304 305 /* XXX FIXME - UGLY HACK */ 306 if (val != 0) { 307 int buf[4] = { 0xe0, val, 0xe0, val|0x80 }; 308 309 write(s->srv->vkbd, buf, sizeof(buf)); 310 } 311 break; 312 |
|
209 case HUP_MICROSOFT: 210 switch (usage) { 211 case 0xfe01: 212 if (!hid_device->battery_power) 213 break; 214 215 switch (val) { 216 case 1: --- 14 unchanged lines hidden (view full) --- 231 } 232 break; 233 } 234 break; 235 } 236 } 237 hid_end_parse(d); 238 | 313 case HUP_MICROSOFT: 314 switch (usage) { 315 case 0xfe01: 316 if (!hid_device->battery_power) 317 break; 318 319 switch (val) { 320 case 1: --- 14 unchanged lines hidden (view full) --- 335 } 336 break; 337 } 338 break; 339 } 340 } 341 hid_end_parse(d); 342 |
343 /* Feed keyboard events into kernel */ 344 if (kevents > 0) 345 kbd_process_keys(s); 346 |
|
239 /* | 347 /* |
240 * XXX FIXME Feed mouse and keyboard events into kernel 241 * The code block below works, but it is not 242 * good enough | 348 * XXX FIXME Feed mouse events into kernel. 349 * The code block below works, but it is not good enough. 350 * Need to track double-clicks etc. |
243 */ 244 | 351 */ 352 |
245 if (mouse_x != 0 || mouse_y != 0 || mouse_z != 0 || mouse_butt != 0) { | 353 if (mevents > 0) { |
246 struct mouse_info mi; 247 248 mi.operation = MOUSE_ACTION; 249 mi.u.data.x = mouse_x; 250 mi.u.data.y = mouse_y; 251 mi.u.data.z = mouse_z; 252 mi.u.data.buttons = mouse_butt; 253 254 if (ioctl(s->srv->cons, CONS_MOUSECTL, &mi) < 0) 255 syslog(LOG_ERR, "Could not process mouse events from " \ 256 "%s. %s (%d)", bt_ntoa(&s->bdaddr, NULL), 257 strerror(errno), errno); 258 } 259 260 return (0); 261} 262 | 354 struct mouse_info mi; 355 356 mi.operation = MOUSE_ACTION; 357 mi.u.data.x = mouse_x; 358 mi.u.data.y = mouse_y; 359 mi.u.data.z = mouse_z; 360 mi.u.data.buttons = mouse_butt; 361 362 if (ioctl(s->srv->cons, CONS_MOUSECTL, &mi) < 0) 363 syslog(LOG_ERR, "Could not process mouse events from " \ 364 "%s. %s (%d)", bt_ntoa(&s->bdaddr, NULL), 365 strerror(errno), errno); 366 } 367 368 return (0); 369} 370 |