source: mainline/uspace/srv/hid/input/input.c@ 4daee7a

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since 4daee7a was f9ab562, checked in by Jakub Jermar <jakub@…>, 13 years ago

Remove support for the testarm machine.
  • Property mode set to 100644
File size: 15.6 KB
Line 
1/*
2 * Copyright (c) 2006 Josef Cejka
3 * Copyright (c) 2011 Jiri Svoboda
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 *
10 * - Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * - 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 * - The name of the author may not be used to endorse or promote products
16 * derived from this software without specific prior written permission.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 */
29
30/**
31 * @addtogroup inputgen generic
32 * @brief HelenOS input server.
33 * @ingroup input
34 * @{
35 */
36/** @file
37 */
38
39#include <adt/list.h>
40#include <stdbool.h>
41#include <fibril_synch.h>
42#include <ipc/services.h>
43#include <ipc/input.h>
44#include <sysinfo.h>
45#include <stdio.h>
46#include <unistd.h>
47#include <stdlib.h>
48#include <stdio.h>
49#include <ns.h>
50#include <async.h>
51#include <errno.h>
52#include <adt/fifo.h>
53#include <io/console.h>
54#include <io/keycode.h>
55#include <loc.h>
56#include "layout.h"
57#include "kbd.h"
58#include "kbd_port.h"
59#include "kbd_ctl.h"
60#include "mouse.h"
61#include "mouse_proto.h"
62#include "input.h"
63
64#define NUM_LAYOUTS 3
65
66static layout_ops_t *layout[NUM_LAYOUTS] = {
67 &us_qwerty_ops,
68 &us_dvorak_ops,
69 &cz_ops
70};
71
72static void kbd_devs_yield(void);
73static void kbd_devs_reclaim(void);
74
75async_sess_t *client_sess = NULL;
76
77/** List of keyboard devices */
78static list_t kbd_devs;
79
80/** List of mouse devices */
81static list_t mouse_devs;
82
83bool irc_service = false;
84async_sess_t *irc_sess = NULL;
85
86static FIBRIL_MUTEX_INITIALIZE(discovery_lock);
87
88void kbd_push_data(kbd_dev_t *kdev, sysarg_t data)
89{
90 (*kdev->ctl_ops->parse)(data);
91}
92
93void mouse_push_data(mouse_dev_t *mdev, sysarg_t data)
94{
95 (*mdev->proto_ops->parse)(data);
96}
97
98void kbd_push_event(kbd_dev_t *kdev, int type, unsigned int key)
99{
100 kbd_event_t ev;
101 unsigned int mod_mask;
102
103 switch (key) {
104 case KC_LCTRL: mod_mask = KM_LCTRL; break;
105 case KC_RCTRL: mod_mask = KM_RCTRL; break;
106 case KC_LSHIFT: mod_mask = KM_LSHIFT; break;
107 case KC_RSHIFT: mod_mask = KM_RSHIFT; break;
108 case KC_LALT: mod_mask = KM_LALT; break;
109 case KC_RALT: mod_mask = KM_RALT; break;
110 default: mod_mask = 0; break;
111 }
112
113 if (mod_mask != 0) {
114 if (type == KEY_PRESS)
115 kdev->mods = kdev->mods | mod_mask;
116 else
117 kdev->mods = kdev->mods & ~mod_mask;
118 }
119
120 switch (key) {
121 case KC_CAPS_LOCK: mod_mask = KM_CAPS_LOCK; break;
122 case KC_NUM_LOCK: mod_mask = KM_NUM_LOCK; break;
123 case KC_SCROLL_LOCK: mod_mask = KM_SCROLL_LOCK; break;
124 default: mod_mask = 0; break;
125 }
126
127 if (mod_mask != 0) {
128 if (type == KEY_PRESS) {
129 /*
130 * Only change lock state on transition from released
131 * to pressed. This prevents autorepeat from messing
132 * up the lock state.
133 */
134 kdev->mods = kdev->mods ^ (mod_mask & ~kdev->lock_keys);
135 kdev->lock_keys = kdev->lock_keys | mod_mask;
136
137 /* Update keyboard lock indicator lights. */
138 (*kdev->ctl_ops->set_ind)(kdev, kdev->mods);
139 } else {
140 kdev->lock_keys = kdev->lock_keys & ~mod_mask;
141 }
142 }
143
144 if (type == KEY_PRESS && (kdev->mods & KM_LCTRL) &&
145 key == KC_F1) {
146 layout_destroy(kdev->active_layout);
147 kdev->active_layout = layout_create(layout[0]);
148 return;
149 }
150
151 if (type == KEY_PRESS && (kdev->mods & KM_LCTRL) &&
152 key == KC_F2) {
153 layout_destroy(kdev->active_layout);
154 kdev->active_layout = layout_create(layout[1]);
155 return;
156 }
157
158 if (type == KEY_PRESS && (kdev->mods & KM_LCTRL) &&
159 key == KC_F3) {
160 layout_destroy(kdev->active_layout);
161 kdev->active_layout = layout_create(layout[2]);
162 return;
163 }
164
165 ev.type = type;
166 ev.key = key;
167 ev.mods = kdev->mods;
168
169 ev.c = layout_parse_ev(kdev->active_layout, &ev);
170
171 async_exch_t *exch = async_exchange_begin(client_sess);
172 async_msg_4(exch, INPUT_EVENT_KEY, ev.type, ev.key, ev.mods, ev.c);
173 async_exchange_end(exch);
174}
175
176/** Mouse pointer has moved. */
177void mouse_push_event_move(mouse_dev_t *mdev, int dx, int dy, int dz)
178{
179 async_exch_t *exch = async_exchange_begin(client_sess);
180 if (dx || dy)
181 async_msg_2(exch, INPUT_EVENT_MOVE, dx, dy);
182 if (dz) {
183 // TODO: Implement proper wheel support
184 keycode_t code = dz > 0 ? KC_UP : KC_DOWN;
185 for (int i = 0; i < 3; ++i) {
186 async_msg_4(exch, INPUT_EVENT_KEY, KEY_PRESS, code, 0, 0);
187 }
188 async_msg_4(exch, INPUT_EVENT_KEY, KEY_RELEASE, code, 0, 0);
189 }
190 async_exchange_end(exch);
191}
192
193/** Mouse pointer has moved in absolute mode. */
194void mouse_push_event_abs_move(mouse_dev_t *mdev, unsigned int x, unsigned int y,
195 unsigned int max_x, unsigned int max_y)
196{
197 if (max_x && max_y) {
198 async_exch_t *exch = async_exchange_begin(client_sess);
199 async_msg_4(exch, INPUT_EVENT_ABS_MOVE, x, y, max_x, max_y);
200 async_exchange_end(exch);
201 }
202}
203
204/** Mouse button has been pressed. */
205void mouse_push_event_button(mouse_dev_t *mdev, int bnum, int press)
206{
207 async_exch_t *exch = async_exchange_begin(client_sess);
208 async_msg_2(exch, INPUT_EVENT_BUTTON, bnum, press);
209 async_exchange_end(exch);
210}
211
212static void client_connection(ipc_callid_t iid, ipc_call_t *icall, void *arg)
213{
214 async_answer_0(iid, EOK);
215
216 while (true) {
217 ipc_call_t call;
218 ipc_callid_t callid = async_get_call(&call);
219
220 if (!IPC_GET_IMETHOD(call)) {
221 if (client_sess != NULL) {
222 async_hangup(client_sess);
223 client_sess = NULL;
224 }
225
226 async_answer_0(callid, EOK);
227 return;
228 }
229
230 async_sess_t *sess =
231 async_callback_receive_start(EXCHANGE_SERIALIZE, &call);
232 if (sess != NULL) {
233 if (client_sess == NULL) {
234 client_sess = sess;
235 async_answer_0(callid, EOK);
236 } else
237 async_answer_0(callid, ELIMIT);
238 } else {
239 switch (IPC_GET_IMETHOD(call)) {
240 case INPUT_YIELD:
241 kbd_devs_yield();
242 async_answer_0(callid, EOK);
243 break;
244 case INPUT_RECLAIM:
245 kbd_devs_reclaim();
246 async_answer_0(callid, EOK);
247 break;
248 default:
249 async_answer_0(callid, EINVAL);
250 }
251 }
252 }
253}
254
255static kbd_dev_t *kbd_dev_new(void)
256{
257 kbd_dev_t *kdev = calloc(1, sizeof(kbd_dev_t));
258 if (kdev == NULL) {
259 printf("%s: Error allocating keyboard device. "
260 "Out of memory.\n", NAME);
261 return NULL;
262 }
263
264 link_initialize(&kdev->kbd_devs);
265
266 kdev->mods = KM_NUM_LOCK;
267 kdev->lock_keys = 0;
268 kdev->active_layout = layout_create(layout[0]);
269
270 return kdev;
271}
272
273static mouse_dev_t *mouse_dev_new(void)
274{
275 mouse_dev_t *mdev = calloc(1, sizeof(mouse_dev_t));
276 if (mdev == NULL) {
277 printf("%s: Error allocating keyboard device. "
278 "Out of memory.\n", NAME);
279 return NULL;
280 }
281
282 link_initialize(&mdev->mouse_devs);
283
284 return mdev;
285}
286
287/** Add new legacy keyboard device. */
288static void kbd_add_dev(kbd_port_ops_t *port, kbd_ctl_ops_t *ctl)
289{
290 kbd_dev_t *kdev = kbd_dev_new();
291 if (kdev == NULL)
292 return;
293
294 kdev->port_ops = port;
295 kdev->ctl_ops = ctl;
296 kdev->svc_id = 0;
297
298 /* Initialize port driver. */
299 if ((*kdev->port_ops->init)(kdev) != 0)
300 goto fail;
301
302 /* Initialize controller driver. */
303 if ((*kdev->ctl_ops->init)(kdev) != 0) {
304 /* XXX Uninit port */
305 goto fail;
306 }
307
308 list_append(&kdev->kbd_devs, &kbd_devs);
309 return;
310
311fail:
312 free(kdev);
313}
314
315/** Add new legacy mouse device. */
316static void mouse_add_dev(mouse_port_ops_t *port, mouse_proto_ops_t *proto)
317{
318 mouse_dev_t *mdev = mouse_dev_new();
319 if (mdev == NULL)
320 return;
321
322 mdev->port_ops = port;
323 mdev->proto_ops = proto;
324 mdev->svc_id = 0;
325
326 /* Initialize port driver. */
327 if ((*mdev->port_ops->init)(mdev) != 0)
328 goto fail;
329
330 /* Initialize protocol driver. */
331 if ((*mdev->proto_ops->init)(mdev) != 0) {
332 /* XXX Uninit port */
333 goto fail;
334 }
335
336 list_append(&mdev->mouse_devs, &mouse_devs);
337 return;
338
339fail:
340 free(mdev);
341}
342
343/** Add new kbdev device.
344 *
345 * @param service_id Service ID of the keyboard device
346 *
347 */
348static int kbd_add_kbdev(service_id_t service_id, kbd_dev_t **kdevp)
349{
350 kbd_dev_t *kdev = kbd_dev_new();
351 if (kdev == NULL)
352 return -1;
353
354 kdev->svc_id = service_id;
355 kdev->port_ops = NULL;
356 kdev->ctl_ops = &kbdev_ctl;
357
358 int rc = loc_service_get_name(service_id, &kdev->svc_name);
359 if (rc != EOK) {
360 kdev->svc_name = NULL;
361 goto fail;
362 }
363
364 /* Initialize controller driver. */
365 if ((*kdev->ctl_ops->init)(kdev) != 0) {
366 goto fail;
367 }
368
369 list_append(&kdev->kbd_devs, &kbd_devs);
370 *kdevp = kdev;
371 return EOK;
372
373fail:
374 if (kdev->svc_name != NULL)
375 free(kdev->svc_name);
376 free(kdev);
377 return -1;
378}
379
380/** Add new mousedev device.
381 *
382 * @param service_id Service ID of the mouse device
383 *
384 */
385static int mouse_add_mousedev(service_id_t service_id, mouse_dev_t **mdevp)
386{
387 mouse_dev_t *mdev = mouse_dev_new();
388 if (mdev == NULL)
389 return -1;
390
391 mdev->svc_id = service_id;
392 mdev->port_ops = NULL;
393 mdev->proto_ops = &mousedev_proto;
394
395 int rc = loc_service_get_name(service_id, &mdev->svc_name);
396 if (rc != EOK) {
397 mdev->svc_name = NULL;
398 goto fail;
399 }
400
401 /* Initialize controller driver. */
402 if ((*mdev->proto_ops->init)(mdev) != 0) {
403 goto fail;
404 }
405
406 list_append(&mdev->mouse_devs, &mouse_devs);
407 *mdevp = mdev;
408 return EOK;
409
410fail:
411 free(mdev);
412 return -1;
413}
414
415/** Add legacy drivers/devices. */
416static void kbd_add_legacy_devs(void)
417{
418 /*
419 * Need to add these drivers based on config unless we can probe
420 * them automatically.
421 */
422#if defined(UARCH_arm32) && defined(MACHINE_gta02)
423 kbd_add_dev(&chardev_port, &stty_ctl);
424#endif
425#if defined(UARCH_arm32) && defined(MACHINE_integratorcp)
426 kbd_add_dev(&pl050_port, &pc_ctl);
427#endif
428#if defined(MACHINE_ski)
429 kbd_add_dev(&ski_port, &stty_ctl);
430#endif
431#if defined(MACHINE_msim)
432 kbd_add_dev(&msim_port, &stty_ctl);
433#endif
434#if (defined(MACHINE_lgxemul) || defined(MACHINE_bgxemul)) && defined(CONFIG_FB)
435 kbd_add_dev(&gxemul_port, &gxe_fb_ctl);
436#endif
437#if defined(MACHINE_lgxemul) || defined(MACHINE_bgxemul) && !defined(CONFIG_FB)
438 kbd_add_dev(&gxemul_port, &stty_ctl);
439#endif
440#if defined(UARCH_ppc32)
441 kbd_add_dev(&adb_port, &apple_ctl);
442#endif
443#if defined(UARCH_sparc64) && defined(PROCESSOR_sun4v)
444 kbd_add_dev(&niagara_port, &stty_ctl);
445#endif
446#if defined(UARCH_sparc64) && defined(MACHINE_generic)
447 kbd_add_dev(&ns16550_port, &sun_ctl);
448#endif
449 /* Silence warning on abs32le about kbd_add_dev() being unused */
450 (void) kbd_add_dev;
451}
452
453/** Add legacy drivers/devices. */
454static void mouse_add_legacy_devs(void)
455{
456 /*
457 * Need to add these drivers based on config unless we can probe
458 * them automatically.
459 */
460#if defined(UARCH_ppc32)
461 mouse_add_dev(&adb_mouse_port, &adb_proto);
462#endif
463 /* Silence warning on abs32le about mouse_add_dev() being unused */
464 (void) mouse_add_dev;
465}
466
467static void kbd_devs_yield(void)
468{
469 /* For each keyboard device */
470 list_foreach(kbd_devs, kdev_link) {
471 kbd_dev_t *kdev = list_get_instance(kdev_link, kbd_dev_t,
472 kbd_devs);
473
474 /* Yield port */
475 if (kdev->port_ops != NULL)
476 (*kdev->port_ops->yield)();
477 }
478}
479
480static void kbd_devs_reclaim(void)
481{
482 /* For each keyboard device */
483 list_foreach(kbd_devs, kdev_link) {
484 kbd_dev_t *kdev = list_get_instance(kdev_link, kbd_dev_t,
485 kbd_devs);
486
487 /* Reclaim port */
488 if (kdev->port_ops != NULL)
489 (*kdev->port_ops->reclaim)();
490 }
491}
492
493static int dev_check_new_kbdevs(void)
494{
495 category_id_t keyboard_cat;
496 service_id_t *svcs;
497 size_t count, i;
498 bool already_known;
499 int rc;
500
501 rc = loc_category_get_id("keyboard", &keyboard_cat, IPC_FLAG_BLOCKING);
502 if (rc != EOK) {
503 printf("%s: Failed resolving category 'keyboard'.\n", NAME);
504 return ENOENT;
505 }
506
507 /*
508 * Check for new keyboard devices
509 */
510 rc = loc_category_get_svcs(keyboard_cat, &svcs, &count);
511 if (rc != EOK) {
512 printf("%s: Failed getting list of keyboard devices.\n",
513 NAME);
514 return EIO;
515 }
516
517 for (i = 0; i < count; i++) {
518 already_known = false;
519
520 /* Determine whether we already know this device. */
521 list_foreach(kbd_devs, kdev_link) {
522 kbd_dev_t *kdev = list_get_instance(kdev_link,
523 kbd_dev_t, kbd_devs);
524 if (kdev->svc_id == svcs[i]) {
525 already_known = true;
526 break;
527 }
528 }
529
530 if (!already_known) {
531 kbd_dev_t *kdev;
532 if (kbd_add_kbdev(svcs[i], &kdev) == EOK) {
533 printf("%s: Connected keyboard device '%s'\n",
534 NAME, kdev->svc_name);
535 }
536 }
537 }
538
539 free(svcs);
540
541 /* XXX Handle device removal */
542
543 return EOK;
544}
545
546static int dev_check_new_mousedevs(void)
547{
548 category_id_t mouse_cat;
549 service_id_t *svcs;
550 size_t count, i;
551 bool already_known;
552 int rc;
553
554 rc = loc_category_get_id("mouse", &mouse_cat, IPC_FLAG_BLOCKING);
555 if (rc != EOK) {
556 printf("%s: Failed resolving category 'mouse'.\n", NAME);
557 return ENOENT;
558 }
559
560 /*
561 * Check for new mouse devices
562 */
563 rc = loc_category_get_svcs(mouse_cat, &svcs, &count);
564 if (rc != EOK) {
565 printf("%s: Failed getting list of mouse devices.\n",
566 NAME);
567 return EIO;
568 }
569
570 for (i = 0; i < count; i++) {
571 already_known = false;
572
573 /* Determine whether we already know this device. */
574 list_foreach(mouse_devs, mdev_link) {
575 mouse_dev_t *mdev = list_get_instance(mdev_link,
576 mouse_dev_t, mouse_devs);
577 if (mdev->svc_id == svcs[i]) {
578 already_known = true;
579 break;
580 }
581 }
582
583 if (!already_known) {
584 mouse_dev_t *mdev;
585 if (mouse_add_mousedev(svcs[i], &mdev) == EOK) {
586 printf("%s: Connected mouse device '%s'\n",
587 NAME, mdev->svc_name);
588 }
589 }
590 }
591
592 free(svcs);
593
594 /* XXX Handle device removal */
595
596 return EOK;
597}
598
599static int dev_check_new(void)
600{
601 int rc;
602
603 fibril_mutex_lock(&discovery_lock);
604
605 rc = dev_check_new_kbdevs();
606 if (rc != EOK) {
607 fibril_mutex_unlock(&discovery_lock);
608 return rc;
609 }
610
611 rc = dev_check_new_mousedevs();
612 if (rc != EOK) {
613 fibril_mutex_unlock(&discovery_lock);
614 return rc;
615 }
616
617 fibril_mutex_unlock(&discovery_lock);
618
619 return EOK;
620}
621
622static void cat_change_cb(void)
623{
624 dev_check_new();
625}
626
627/** Start listening for new devices. */
628static int input_start_dev_discovery(void)
629{
630 int rc;
631
632 rc = loc_register_cat_change_cb(cat_change_cb);
633 if (rc != EOK) {
634 printf("%s: Failed registering callback for device discovery. "
635 "(%d)\n", NAME, rc);
636 return rc;
637 }
638
639 return dev_check_new();
640}
641
642static void usage(char *name)
643{
644 printf("Usage: %s <service_name>\n", name);
645}
646
647int main(int argc, char **argv)
648{
649 if (argc < 2) {
650 usage(argv[0]);
651 return 1;
652 }
653
654 printf("%s: HelenOS input service\n", NAME);
655
656 sysarg_t obio;
657
658 list_initialize(&kbd_devs);
659 list_initialize(&mouse_devs);
660
661 if ((sysinfo_get_value("kbd.cir.obio", &obio) == EOK) && (obio))
662 irc_service = true;
663
664 if (irc_service) {
665 while (irc_sess == NULL)
666 irc_sess = service_connect_blocking(EXCHANGE_SERIALIZE,
667 SERVICE_IRC, 0, 0);
668 }
669
670 /* Add legacy keyboard devices. */
671 kbd_add_legacy_devs();
672
673 /* Add legacy mouse devices. */
674 mouse_add_legacy_devs();
675
676 /* Register driver */
677 async_set_client_connection(client_connection);
678 int rc = loc_server_register(NAME);
679 if (rc != EOK) {
680 printf("%s: Unable to register server\n", NAME);
681 return rc;
682 }
683
684 service_id_t service_id;
685 rc = loc_service_register(argv[1], &service_id);
686 if (rc != EOK) {
687 printf("%s: Unable to register service %s\n", NAME, argv[1]);
688 return rc;
689 }
690
691 /* Start looking for new input devices */
692 input_start_dev_discovery();
693
694 printf("%s: Accepting connections\n", NAME);
695 task_retval(0);
696 async_manager();
697
698 /* Not reached. */
699 return 0;
700}
701
702/**
703 * @}
704 */
Note: See TracBrowser for help on using the repository browser.