Lines Matching +full:port +full:- +full:2
2 * Copyright (c) 1996-2001 Vojtech Pavlik
12 * the Free Software Foundation; either version 2 of the License, or
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
88 #define ANALOG_LOOP_TIME 2000 /* 2 * loop */
91 #define ANALOG_AXIS_TIME 2 /* 2 * refresh */
93 #define ANALOG_FUZZ_BITS 2 /* 2 bit more */
119 struct analog analog[2];
143 #define DELTA(x,y) (boot_cpu_has(X86_FEATURE_TSC) ? ((y) - (x)) : ((x) - (y) + ((x) < (y) ? PIT_TIC…
160 #define DELTA(x,y) ((y)-(x))
164 #define DELTA(x,y) ((y)-(x))
170 #define DELTA(x,y) ((y)-(x))
189 return y - x; in delta()
200 struct input_dev *dev = analog->dev; in analog_decode()
203 if (analog->mask & ANALOG_HAT_FCS) in analog_decode()
211 if (analog->mask & (0x10 << i)) in analog_decode()
212 input_report_key(dev, analog->buttons[j++], (buttons >> i) & 1); in analog_decode()
214 if (analog->mask & ANALOG_HBTN_CHF) in analog_decode()
216 input_report_key(dev, analog->buttons[j++], (buttons >> (i + 10)) & 1); in analog_decode()
218 if (analog->mask & ANALOG_BTN_TL) in analog_decode()
219 input_report_key(dev, analog_pads[0], axes[2] < (initial[2] >> 1)); in analog_decode()
220 if (analog->mask & ANALOG_BTN_TR) in analog_decode()
222 if (analog->mask & ANALOG_BTN_TL2) in analog_decode()
223 input_report_key(dev, analog_pads[2], axes[2] > (initial[2] + (initial[2] >> 1))); in analog_decode()
224 if (analog->mask & ANALOG_BTN_TR2) in analog_decode()
228 if (analog->mask & (1 << i)) in analog_decode()
232 if (analog->mask & analog_exts[i]) { in analog_decode()
234 ((buttons >> ((i << 2) + 7)) & 1) - ((buttons >> ((i << 2) + 9)) & 1)); in analog_decode()
236 ((buttons >> ((i << 2) + 8)) & 1) - ((buttons >> ((i << 2) + 6)) & 1)); in analog_decode()
246 static int analog_cooked_read(struct analog_port *port) in analog_cooked_read() argument
248 struct gameport *gameport = port->gameport; in analog_cooked_read()
255 loopout = (ANALOG_LOOP_TIME * port->loop) / 1000; in analog_cooked_read()
256 timeout = ANALOG_MAX_TIME * port->speed; in analog_cooked_read()
264 this = port->mask; in analog_cooked_read()
272 this = gameport_read(gameport) & port->mask; in analog_cooked_read()
286 for (--i; i >= 0; i--) { in analog_cooked_read()
290 port->axes[j] = (delta(start, time[i]) << ANALOG_FUZZ_BITS) / port->loop; in analog_cooked_read()
293 return -(this != port->mask); in analog_cooked_read()
296 static int analog_button_read(struct analog_port *port, char saitek, char chf) in analog_button_read() argument
300 int strobe = gameport_time(port->gameport, ANALOG_SAITEK_TIME); in analog_button_read()
302 u = gameport_read(port->gameport); in analog_button_read()
305 port->buttons = (~u >> 4) & 0xf; in analog_button_read()
309 port->buttons = 0; in analog_button_read()
312 port->buttons |= 1 << analog_chf[(~u >> 4) & 0xf]; in analog_button_read()
316 gameport_trigger(port->gameport); in analog_button_read()
317 while (((u = gameport_read(port->gameport)) & port->mask) && t) t--; in analog_button_read()
321 return -(!t || (i == 16)); in analog_button_read()
330 struct analog_port *port = gameport_get_drvdata(gameport); in analog_poll() local
333 char saitek = !!(port->analog[0].mask & ANALOG_SAITEK); in analog_poll()
334 char chf = !!(port->analog[0].mask & ANALOG_ANY_CHF); in analog_poll()
336 if (port->cooked) { in analog_poll()
337 port->bads -= gameport_cooked_read(port->gameport, port->axes, &port->buttons); in analog_poll()
339 port->buttons = port->buttons ? (1 << analog_chf[port->buttons]) : 0; in analog_poll()
340 port->reads++; in analog_poll()
342 if (!port->axtime--) { in analog_poll()
343 port->bads -= analog_cooked_read(port); in analog_poll()
344 port->bads -= analog_button_read(port, saitek, chf); in analog_poll()
345 port->reads++; in analog_poll()
346 port->axtime = ANALOG_AXIS_TIME - 1; in analog_poll()
349 analog_button_read(port, saitek, chf); in analog_poll()
353 for (i = 0; i < 2; i++) in analog_poll()
354 if (port->analog[i].mask) in analog_poll()
355 analog_decode(port->analog + i, port->axes, port->initial, port->buttons); in analog_poll()
364 struct analog_port *port = input_get_drvdata(dev); in analog_open() local
366 gameport_start_polling(port->gameport); in analog_open()
376 struct analog_port *port = input_get_drvdata(dev); in analog_close() local
378 gameport_stop_polling(port->gameport); in analog_close()
383 * and timeout values for a joystick port.
386 static void analog_calibrate_timer(struct analog_port *port) in analog_calibrate_timer() argument
388 struct gameport *gameport = port->gameport; in analog_calibrate_timer()
394 port->speed = 1000000; in analog_calibrate_timer()
406 port->speed = delta(t1, t2) - delta(t2, t3); in analog_calibrate_timer()
421 t = delta(t1, t2) - delta(t2, t3); in analog_calibrate_timer()
425 port->loop = tx / 50; in analog_calibrate_timer()
434 snprintf(analog->name, sizeof(analog->name), "Analog %d-axis %d-button", in analog_name()
435 hweight8(analog->mask & ANALOG_AXES_STD), in analog_name()
436 hweight8(analog->mask & ANALOG_BTNS_STD) + !!(analog->mask & ANALOG_BTNS_CHF) * 2 + in analog_name()
437 hweight16(analog->mask & ANALOG_BTNS_GAMEPAD) + !!(analog->mask & ANALOG_HBTN_CHF) * 4); in analog_name()
439 if (analog->mask & ANALOG_HATS_ALL) in analog_name()
440 snprintf(analog->name, sizeof(analog->name), "%s %d-hat", in analog_name()
441 analog->name, hweight16(analog->mask & ANALOG_HATS_ALL)); in analog_name()
443 if (analog->mask & ANALOG_HAT_FCS) in analog_name()
444 strlcat(analog->name, " FCS", sizeof(analog->name)); in analog_name()
445 if (analog->mask & ANALOG_ANY_CHF) in analog_name()
446 strlcat(analog->name, (analog->mask & ANALOG_SAITEK) ? " Saitek" : " CHF", in analog_name()
447 sizeof(analog->name)); in analog_name()
449 strlcat(analog->name, (analog->mask & ANALOG_GAMEPAD) ? " gamepad": " joystick", in analog_name()
450 sizeof(analog->name)); in analog_name()
457 static int analog_init_device(struct analog_port *port, struct analog *analog, int index) in analog_init_device() argument
464 snprintf(analog->phys, sizeof(analog->phys), in analog_init_device()
465 "%s/input%d", port->gameport->phys, index); in analog_init_device()
466 analog->buttons = (analog->mask & ANALOG_GAMEPAD) ? analog_pad_btn : analog_joy_btn; in analog_init_device()
468 analog->dev = input_dev = input_allocate_device(); in analog_init_device()
470 return -ENOMEM; in analog_init_device()
472 input_dev->name = analog->name; in analog_init_device()
473 input_dev->phys = analog->phys; in analog_init_device()
474 input_dev->id.bustype = BUS_GAMEPORT; in analog_init_device()
475 input_dev->id.vendor = GAMEPORT_ID_VENDOR_ANALOG; in analog_init_device()
476 input_dev->id.product = analog->mask >> 4; in analog_init_device()
477 input_dev->id.version = 0x0100; in analog_init_device()
478 input_dev->dev.parent = &port->gameport->dev; in analog_init_device()
480 input_set_drvdata(input_dev, port); in analog_init_device()
482 input_dev->open = analog_open; in analog_init_device()
483 input_dev->close = analog_close; in analog_init_device()
485 input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS); in analog_init_device()
488 if (analog->mask & (1 << i)) { in analog_init_device()
491 x = port->axes[i]; in analog_init_device()
492 y = (port->axes[0] + port->axes[1]) >> 1; in analog_init_device()
493 z = y - port->axes[i]; in analog_init_device()
494 z = z > 0 ? z : -z; in analog_init_device()
498 if ((i == 2 || i == 3) && (j == 2 || j == 3) && (z > (y >> 3))) in analog_init_device()
501 if (analog->mask & ANALOG_SAITEK) { in analog_init_device()
502 if (i == 2) x = port->axes[i]; in analog_init_device()
503 v = x - (x >> 2); in analog_init_device()
507 input_set_abs_params(input_dev, t, v, (x << 1) - v, port->fuzz, w); in analog_init_device()
512 if (analog->mask & analog_exts[i]) in analog_init_device()
513 for (x = 0; x < 2; x++) { in analog_init_device()
515 input_set_abs_params(input_dev, t, -1, 1, 0, 0); in analog_init_device()
519 if (analog->mask & (0x10 << i)) in analog_init_device()
520 set_bit(analog->buttons[j++], input_dev->keybit); in analog_init_device()
522 if (analog->mask & ANALOG_BTNS_CHF) in analog_init_device()
523 for (i = 0; i < 2; i++) in analog_init_device()
524 set_bit(analog->buttons[j++], input_dev->keybit); in analog_init_device()
526 if (analog->mask & ANALOG_HBTN_CHF) in analog_init_device()
528 set_bit(analog->buttons[j++], input_dev->keybit); in analog_init_device()
531 if (analog->mask & (ANALOG_BTN_TL << i)) in analog_init_device()
532 set_bit(analog_pads[i], input_dev->keybit); in analog_init_device()
534 analog_decode(analog, port->axes, port->initial, port->buttons); in analog_init_device()
536 error = input_register_device(analog->dev); in analog_init_device()
538 input_free_device(analog->dev); in analog_init_device()
546 * analog_init_devices() sets up device-specific values and registers the input devices.
549 static int analog_init_masks(struct analog_port *port) in analog_init_masks() argument
552 struct analog *analog = port->analog; in analog_init_masks()
555 if (!port->mask) in analog_init_masks()
556 return -1; in analog_init_masks()
558 if ((port->mask & 3) != 3 && port->mask != 0xc) { in analog_init_masks()
561 port->mask, port->gameport->phys); in analog_init_masks()
562 return -1; in analog_init_masks()
566 i = analog_options[0]; /* FIXME !!! - need to specify options for different ports */ in analog_init_masks()
571 | port->mask | ((port->mask << 8) & ANALOG_HAT_FCS) in analog_init_masks()
572 | ((port->mask << 10) & ANALOG_BTNS_TLR) | ((port->mask << 12) & ANALOG_BTNS_TLR2); in analog_init_masks()
579 | ((~analog[0].mask & ANALOG_HAT_FCS) << 2) in analog_init_masks()
589 : (((ANALOG_BTNS_STD | port->mask) & ~analog[0].mask) | ANALOG_GAMEPAD); in analog_init_masks()
591 if (port->cooked) { in analog_init_masks()
593 for (i = 0; i < 4; i++) max[i] = port->axes[i] << 1; in analog_init_masks()
595 if ((analog[0].mask & 0x7) == 0x7) max[2] = (max[0] + max[1]) >> 1; in analog_init_masks()
597 if ((analog[0].mask & ANALOG_BTN_TL) && !(analog[0].mask & ANALOG_BTN_TL2)) max[2] >>= 1; in analog_init_masks()
601 gameport_calibrate(port->gameport, port->axes, max); in analog_init_masks()
605 port->initial[i] = port->axes[i]; in analog_init_masks()
607 return -!(analog[0].mask || analog[1].mask); in analog_init_masks()
610 … analog_init_port(struct gameport *gameport, struct gameport_driver *drv, struct analog_port *port) in analog_init_port() argument
614 port->gameport = gameport; in analog_init_port()
616 gameport_set_drvdata(gameport, port); in analog_init_port()
620 analog_calibrate_timer(port); in analog_init_port()
625 port->mask = (gameport_read(gameport) ^ t) & t & 0xf; in analog_init_port()
626 port->fuzz = (port->speed * ANALOG_FUZZ_MAGIC) / port->loop / 1000 + ANALOG_FUZZ_BITS; in analog_init_port()
629 if (!analog_cooked_read(port)) in analog_init_port()
639 while ((gameport_read(port->gameport) & port->mask) && (u < t)) in analog_init_port()
644 while ((gameport_read(port->gameport) & port->mask) && (v < t)) in analog_init_port()
647 if (v < (u >> 1)) { /* FIXME - more than one port */ in analog_init_port()
648 analog_options[0] |= /* FIXME - more than one port */ in analog_init_port()
659 if (!gameport_cooked_read(gameport, port->axes, &port->buttons)) in analog_init_port()
662 if (port->axes[i] != -1) in analog_init_port()
663 port->mask |= 1 << i; in analog_init_port()
665 port->fuzz = gameport->fuzz; in analog_init_port()
666 port->cooked = 1; in analog_init_port()
675 struct analog_port *port; in analog_connect() local
679 if (!(port = kzalloc(sizeof(struct analog_port), GFP_KERNEL))) in analog_connect()
680 return - ENOMEM; in analog_connect()
682 err = analog_init_port(gameport, drv, port); in analog_connect()
686 err = analog_init_masks(port); in analog_connect()
693 for (i = 0; i < 2; i++) in analog_connect()
694 if (port->analog[i].mask) { in analog_connect()
695 err = analog_init_device(port, port->analog + i, i); in analog_connect()
702 fail3: while (--i >= 0) in analog_connect()
703 if (port->analog[i].mask) in analog_connect()
704 input_unregister_device(port->analog[i].dev); in analog_connect()
707 kfree(port); in analog_connect()
713 struct analog_port *port = gameport_get_drvdata(gameport); in analog_disconnect() local
716 for (i = 0; i < 2; i++) in analog_disconnect()
717 if (port->analog[i].mask) in analog_disconnect()
718 input_unregister_device(port->analog[i].dev); in analog_disconnect()
722 port->bads, port->reads, port->reads ? (port->bads * 100 / port->reads) : 0, in analog_disconnect()
723 port->gameport->phys); in analog_disconnect()
724 kfree(port); in analog_disconnect()
735 { "2btn", 0x0000003f },
736 { "y-joy", 0x0cc00033 },
737 { "y-pad", 0x8cc80033 },
766 printk(KERN_WARNING "analog.c: Bad config for port %d - \"%s\"\n", i, js[i]); in analog_parse_options()