Lines Matching +full:abs +full:- +full:range
1 // SPDX-License-Identifier: GPL-2.0-or-later
5 * Copyright (c) 1999-2002 Vojtech Pavlik
51 __u16 keymap[KEY_MAX - BTN_MISC + 1];
52 __u16 keypam[KEY_MAX - BTN_MISC + 1];
55 __s16 abs[ABS_CNT]; member
71 switch (corr->type) { in joydev_correct()
77 value = value > corr->coef[0] ? (value < corr->coef[1] ? 0 : in joydev_correct()
78 ((corr->coef[3] * (value - corr->coef[1])) >> 14)) : in joydev_correct()
79 ((corr->coef[2] * (value - corr->coef[0])) >> 14); in joydev_correct()
86 return clamp(value, -32767, 32767); in joydev_correct()
92 struct joydev *joydev = client->joydev; in joydev_pass_event()
97 spin_lock(&client->buffer_lock); in joydev_pass_event()
99 client->buffer[client->head] = *event; in joydev_pass_event()
101 if (client->startup == joydev->nabs + joydev->nkey) { in joydev_pass_event()
102 client->head++; in joydev_pass_event()
103 client->head &= JOYDEV_BUFFER_SIZE - 1; in joydev_pass_event()
104 if (client->tail == client->head) in joydev_pass_event()
105 client->startup = 0; in joydev_pass_event()
108 spin_unlock(&client->buffer_lock); in joydev_pass_event()
110 kill_fasync(&client->fasync, SIGIO, POLL_IN); in joydev_pass_event()
116 struct joydev *joydev = handle->private; in joydev_event()
126 event.number = joydev->keymap[code - BTN_MISC]; in joydev_event()
132 event.number = joydev->absmap[code]; in joydev_event()
134 &joydev->corr[event.number]); in joydev_event()
135 if (event.value == joydev->abs[event.number]) in joydev_event()
137 joydev->abs[event.number] = event.value; in joydev_event()
147 list_for_each_entry_rcu(client, &joydev->client_list, node) in joydev_event()
151 wake_up_interruptible(&joydev->wait); in joydev_event()
156 struct joydev_client *client = file->private_data; in joydev_fasync()
158 return fasync_helper(fd, file, on, &client->fasync); in joydev_fasync()
165 input_put_device(joydev->handle.dev); in joydev_free()
172 spin_lock(&joydev->client_lock); in joydev_attach_client()
173 list_add_tail_rcu(&client->node, &joydev->client_list); in joydev_attach_client()
174 spin_unlock(&joydev->client_lock); in joydev_attach_client()
180 spin_lock(&joydev->client_lock); in joydev_detach_client()
181 list_del_rcu(&client->node); in joydev_detach_client()
182 spin_unlock(&joydev->client_lock); in joydev_detach_client()
188 struct input_dev *dev = joydev->handle.dev; in joydev_refresh_state()
191 for (i = 0; i < joydev->nabs; i++) { in joydev_refresh_state()
192 val = input_abs_get_val(dev, joydev->abspam[i]); in joydev_refresh_state()
193 joydev->abs[i] = joydev_correct(val, &joydev->corr[i]); in joydev_refresh_state()
201 retval = mutex_lock_interruptible(&joydev->mutex); in joydev_open_device()
205 if (!joydev->exist) in joydev_open_device()
206 retval = -ENODEV; in joydev_open_device()
207 else if (!joydev->open++) { in joydev_open_device()
208 retval = input_open_device(&joydev->handle); in joydev_open_device()
210 joydev->open--; in joydev_open_device()
215 mutex_unlock(&joydev->mutex); in joydev_open_device()
221 mutex_lock(&joydev->mutex); in joydev_close_device()
223 if (joydev->exist && !--joydev->open) in joydev_close_device()
224 input_close_device(&joydev->handle); in joydev_close_device()
226 mutex_unlock(&joydev->mutex); in joydev_close_device()
237 spin_lock(&joydev->client_lock); in joydev_hangup()
238 list_for_each_entry(client, &joydev->client_list, node) in joydev_hangup()
239 kill_fasync(&client->fasync, SIGIO, POLL_HUP); in joydev_hangup()
240 spin_unlock(&joydev->client_lock); in joydev_hangup()
242 wake_up_interruptible(&joydev->wait); in joydev_hangup()
247 struct joydev_client *client = file->private_data; in joydev_release()
248 struct joydev *joydev = client->joydev; in joydev_release()
261 container_of(inode->i_cdev, struct joydev, cdev); in joydev_open()
267 return -ENOMEM; in joydev_open()
269 spin_lock_init(&client->buffer_lock); in joydev_open()
270 client->joydev = joydev; in joydev_open()
277 file->private_data = client; in joydev_open()
292 struct joydev *joydev = client->joydev; in joydev_generate_startup_event()
295 spin_lock_irq(&client->buffer_lock); in joydev_generate_startup_event()
297 have_event = client->startup < joydev->nabs + joydev->nkey; in joydev_generate_startup_event()
301 event->time = jiffies_to_msecs(jiffies); in joydev_generate_startup_event()
302 if (client->startup < joydev->nkey) { in joydev_generate_startup_event()
303 event->type = JS_EVENT_BUTTON | JS_EVENT_INIT; in joydev_generate_startup_event()
304 event->number = client->startup; in joydev_generate_startup_event()
305 event->value = !!test_bit(joydev->keypam[event->number], in joydev_generate_startup_event()
306 input->key); in joydev_generate_startup_event()
308 event->type = JS_EVENT_AXIS | JS_EVENT_INIT; in joydev_generate_startup_event()
309 event->number = client->startup - joydev->nkey; in joydev_generate_startup_event()
310 event->value = joydev->abs[event->number]; in joydev_generate_startup_event()
312 client->startup++; in joydev_generate_startup_event()
315 spin_unlock_irq(&client->buffer_lock); in joydev_generate_startup_event()
325 spin_lock_irq(&client->buffer_lock); in joydev_fetch_next_event()
327 have_event = client->head != client->tail; in joydev_fetch_next_event()
329 *event = client->buffer[client->tail++]; in joydev_fetch_next_event()
330 client->tail &= JOYDEV_BUFFER_SIZE - 1; in joydev_fetch_next_event()
333 spin_unlock_irq(&client->buffer_lock); in joydev_fetch_next_event()
345 struct joydev *joydev = client->joydev; in joydev_0x_read()
349 spin_lock_irq(&input->event_lock); in joydev_0x_read()
354 for (data.buttons = i = 0; i < 32 && i < joydev->nkey; i++) in joydev_0x_read()
356 test_bit(joydev->keypam[i], input->key) ? (1 << i) : 0; in joydev_0x_read()
357 data.x = (joydev->abs[0] / 256 + 128) >> joydev->glue.JS_CORR.x; in joydev_0x_read()
358 data.y = (joydev->abs[1] / 256 + 128) >> joydev->glue.JS_CORR.y; in joydev_0x_read()
363 spin_lock(&client->buffer_lock); in joydev_0x_read()
364 client->startup = 0; in joydev_0x_read()
365 client->tail = client->head; in joydev_0x_read()
366 spin_unlock(&client->buffer_lock); in joydev_0x_read()
368 spin_unlock_irq(&input->event_lock); in joydev_0x_read()
371 return -EFAULT; in joydev_0x_read()
378 struct joydev *joydev = client->joydev; in joydev_data_pending()
380 return client->startup < joydev->nabs + joydev->nkey || in joydev_data_pending()
381 client->head != client->tail; in joydev_data_pending()
387 struct joydev_client *client = file->private_data; in joydev_read()
388 struct joydev *joydev = client->joydev; in joydev_read()
389 struct input_dev *input = joydev->handle.dev; in joydev_read()
393 if (!joydev->exist) in joydev_read()
394 return -ENODEV; in joydev_read()
397 return -EINVAL; in joydev_read()
402 if (!joydev_data_pending(client) && (file->f_flags & O_NONBLOCK)) in joydev_read()
403 return -EAGAIN; in joydev_read()
405 retval = wait_event_interruptible(joydev->wait, in joydev_read()
406 !joydev->exist || joydev_data_pending(client)); in joydev_read()
410 if (!joydev->exist) in joydev_read()
411 return -ENODEV; in joydev_read()
417 return -EFAULT; in joydev_read()
426 return -EFAULT; in joydev_read()
434 /* No kernel lock - fine */
437 struct joydev_client *client = file->private_data; in joydev_poll()
438 struct joydev *joydev = client->joydev; in joydev_poll()
440 poll_wait(file, &joydev->wait, wait); in joydev_poll()
442 (joydev->exist ? 0 : (EPOLLHUP | EPOLLERR)); in joydev_poll()
452 len = min(len, sizeof(joydev->abspam)); in joydev_handle_JSIOCSAXMAP()
459 for (i = 0; i < len && i < joydev->nabs; i++) { in joydev_handle_JSIOCSAXMAP()
461 retval = -EINVAL; in joydev_handle_JSIOCSAXMAP()
466 memcpy(joydev->abspam, abspam, len); in joydev_handle_JSIOCSAXMAP()
468 for (i = 0; i < joydev->nabs; i++) in joydev_handle_JSIOCSAXMAP()
469 joydev->absmap[joydev->abspam[i]] = i; in joydev_handle_JSIOCSAXMAP()
484 return -EINVAL; in joydev_handle_JSIOCSBTNMAP()
486 len = min(len, sizeof(joydev->keypam)); in joydev_handle_JSIOCSBTNMAP()
493 for (i = 0; i < (len / 2) && i < joydev->nkey; i++) { in joydev_handle_JSIOCSBTNMAP()
495 retval = -EINVAL; in joydev_handle_JSIOCSBTNMAP()
500 memcpy(joydev->keypam, keypam, len); in joydev_handle_JSIOCSBTNMAP()
502 for (i = 0; i < joydev->nkey; i++) in joydev_handle_JSIOCSBTNMAP()
503 joydev->keymap[joydev->keypam[i] - BTN_MISC] = i; in joydev_handle_JSIOCSBTNMAP()
514 struct input_dev *dev = joydev->handle.dev; in joydev_ioctl_common()
519 /* Process fixed-sized commands. */ in joydev_ioctl_common()
523 return copy_from_user(&joydev->glue.JS_CORR, argp, in joydev_ioctl_common()
524 sizeof(joydev->glue.JS_CORR)) ? -EFAULT : 0; in joydev_ioctl_common()
527 return copy_to_user(argp, &joydev->glue.JS_CORR, in joydev_ioctl_common()
528 sizeof(joydev->glue.JS_CORR)) ? -EFAULT : 0; in joydev_ioctl_common()
531 return get_user(joydev->glue.JS_TIMEOUT, (s32 __user *) argp); in joydev_ioctl_common()
534 return put_user(joydev->glue.JS_TIMEOUT, (s32 __user *) argp); in joydev_ioctl_common()
540 return put_user(joydev->nabs, (__u8 __user *) argp); in joydev_ioctl_common()
543 return put_user(joydev->nkey, (__u8 __user *) argp); in joydev_ioctl_common()
546 if (copy_from_user(joydev->corr, argp, in joydev_ioctl_common()
547 sizeof(joydev->corr[0]) * joydev->nabs)) in joydev_ioctl_common()
548 return -EFAULT; in joydev_ioctl_common()
550 for (i = 0; i < joydev->nabs; i++) { in joydev_ioctl_common()
551 int val = input_abs_get_val(dev, joydev->abspam[i]); in joydev_ioctl_common()
552 joydev->abs[i] = joydev_correct(val, &joydev->corr[i]); in joydev_ioctl_common()
557 return copy_to_user(argp, joydev->corr, in joydev_ioctl_common()
558 sizeof(joydev->corr[0]) * joydev->nabs) ? -EFAULT : 0; in joydev_ioctl_common()
563 * Process variable-sized commands (the axis and button map commands in joydev_ioctl_common()
564 * are considered variable-sized to decouple them from the values of in joydev_ioctl_common()
573 len = min_t(size_t, _IOC_SIZE(cmd), sizeof(joydev->abspam)); in joydev_ioctl_common()
574 return copy_to_user(argp, joydev->abspam, len) ? -EFAULT : len; in joydev_ioctl_common()
580 len = min_t(size_t, _IOC_SIZE(cmd), sizeof(joydev->keypam)); in joydev_ioctl_common()
581 return copy_to_user(argp, joydev->keypam, len) ? -EFAULT : len; in joydev_ioctl_common()
584 name = dev->name; in joydev_ioctl_common()
589 return copy_to_user(argp, name, len) ? -EFAULT : len; in joydev_ioctl_common()
592 return -EINVAL; in joydev_ioctl_common()
599 struct joydev_client *client = file->private_data; in joydev_compat_ioctl()
600 struct joydev *joydev = client->joydev; in joydev_compat_ioctl()
606 retval = mutex_lock_interruptible(&joydev->mutex); in joydev_compat_ioctl()
610 if (!joydev->exist) { in joydev_compat_ioctl()
611 retval = -ENODEV; in joydev_compat_ioctl()
620 joydev->glue.JS_TIMELIMIT = tmp32; in joydev_compat_ioctl()
624 tmp32 = joydev->glue.JS_TIMELIMIT; in joydev_compat_ioctl()
630 sizeof(ds32)) ? -EFAULT : 0; in joydev_compat_ioctl()
632 joydev->glue.JS_TIMEOUT = ds32.JS_TIMEOUT; in joydev_compat_ioctl()
633 joydev->glue.BUSY = ds32.BUSY; in joydev_compat_ioctl()
634 joydev->glue.JS_EXPIRETIME = ds32.JS_EXPIRETIME; in joydev_compat_ioctl()
635 joydev->glue.JS_TIMELIMIT = ds32.JS_TIMELIMIT; in joydev_compat_ioctl()
636 joydev->glue.JS_SAVE = ds32.JS_SAVE; in joydev_compat_ioctl()
637 joydev->glue.JS_CORR = ds32.JS_CORR; in joydev_compat_ioctl()
642 ds32.JS_TIMEOUT = joydev->glue.JS_TIMEOUT; in joydev_compat_ioctl()
643 ds32.BUSY = joydev->glue.BUSY; in joydev_compat_ioctl()
644 ds32.JS_EXPIRETIME = joydev->glue.JS_EXPIRETIME; in joydev_compat_ioctl()
645 ds32.JS_TIMELIMIT = joydev->glue.JS_TIMELIMIT; in joydev_compat_ioctl()
646 ds32.JS_SAVE = joydev->glue.JS_SAVE; in joydev_compat_ioctl()
647 ds32.JS_CORR = joydev->glue.JS_CORR; in joydev_compat_ioctl()
649 retval = copy_to_user(argp, &ds32, sizeof(ds32)) ? -EFAULT : 0; in joydev_compat_ioctl()
658 mutex_unlock(&joydev->mutex); in joydev_compat_ioctl()
666 struct joydev_client *client = file->private_data; in joydev_ioctl()
667 struct joydev *joydev = client->joydev; in joydev_ioctl()
671 retval = mutex_lock_interruptible(&joydev->mutex); in joydev_ioctl()
675 if (!joydev->exist) { in joydev_ioctl()
676 retval = -ENODEV; in joydev_ioctl()
683 retval = get_user(joydev->glue.JS_TIMELIMIT, in joydev_ioctl()
688 retval = put_user(joydev->glue.JS_TIMELIMIT, in joydev_ioctl()
693 retval = copy_from_user(&joydev->glue, argp, in joydev_ioctl()
694 sizeof(joydev->glue)) ? -EFAULT : 0; in joydev_ioctl()
698 retval = copy_to_user(argp, &joydev->glue, in joydev_ioctl()
699 sizeof(joydev->glue)) ? -EFAULT : 0; in joydev_ioctl()
707 mutex_unlock(&joydev->mutex); in joydev_ioctl()
726 * Mark device non-existent. This disables writes, ioctls and
732 mutex_lock(&joydev->mutex); in joydev_mark_dead()
733 joydev->exist = false; in joydev_mark_dead()
734 mutex_unlock(&joydev->mutex); in joydev_mark_dead()
739 struct input_handle *handle = &joydev->handle; in joydev_cleanup()
744 /* joydev is marked dead so no one else accesses joydev->open */ in joydev_cleanup()
745 if (joydev->open) in joydev_cleanup()
750 * These codes are copied from from hid-ids.h, unfortunately there is no common
800 for (id = joydev_blacklist; id->flags; id++) { in joydev_dev_is_blacklisted()
802 dev_dbg(&dev->dev, in joydev_dev_is_blacklisted()
803 "joydev: blacklisting '%s'\n", dev->name); in joydev_dev_is_blacklisted()
821 * pointing devices so that there is one-to-one relationship in joydev_dev_is_absolute_mouse()
849 if (bitmap_equal(jd_scratch, dev->evbit, EV_CNT)) in joydev_dev_is_absolute_mouse()
854 if (bitmap_equal(jd_scratch, dev->evbit, EV_CNT)) in joydev_dev_is_absolute_mouse()
859 if (bitmap_equal(jd_scratch, dev->evbit, EV_CNT)) in joydev_dev_is_absolute_mouse()
868 if (!bitmap_equal(dev->absbit, jd_scratch, ABS_CNT)) in joydev_dev_is_absolute_mouse()
876 if (!bitmap_equal(dev->keybit, jd_scratch, KEY_CNT)) in joydev_dev_is_absolute_mouse()
883 if (dev->id.bustype == BUS_AMIGA) in joydev_dev_is_absolute_mouse()
918 error = -ENOMEM; in joydev_connect()
922 INIT_LIST_HEAD(&joydev->client_list); in joydev_connect()
923 spin_lock_init(&joydev->client_lock); in joydev_connect()
924 mutex_init(&joydev->mutex); in joydev_connect()
925 init_waitqueue_head(&joydev->wait); in joydev_connect()
926 joydev->exist = true; in joydev_connect()
929 /* Normalize device number if it falls into legacy range */ in joydev_connect()
931 dev_no -= JOYDEV_MINOR_BASE; in joydev_connect()
932 dev_set_name(&joydev->dev, "js%d", dev_no); in joydev_connect()
934 joydev->handle.dev = input_get_device(dev); in joydev_connect()
935 joydev->handle.name = dev_name(&joydev->dev); in joydev_connect()
936 joydev->handle.handler = handler; in joydev_connect()
937 joydev->handle.private = joydev; in joydev_connect()
939 for_each_set_bit(i, dev->absbit, ABS_CNT) { in joydev_connect()
940 joydev->absmap[i] = joydev->nabs; in joydev_connect()
941 joydev->abspam[joydev->nabs] = i; in joydev_connect()
942 joydev->nabs++; in joydev_connect()
945 for (i = BTN_JOYSTICK - BTN_MISC; i < KEY_MAX - BTN_MISC + 1; i++) in joydev_connect()
946 if (test_bit(i + BTN_MISC, dev->keybit)) { in joydev_connect()
947 joydev->keymap[i] = joydev->nkey; in joydev_connect()
948 joydev->keypam[joydev->nkey] = i + BTN_MISC; in joydev_connect()
949 joydev->nkey++; in joydev_connect()
952 for (i = 0; i < BTN_JOYSTICK - BTN_MISC; i++) in joydev_connect()
953 if (test_bit(i + BTN_MISC, dev->keybit)) { in joydev_connect()
954 joydev->keymap[i] = joydev->nkey; in joydev_connect()
955 joydev->keypam[joydev->nkey] = i + BTN_MISC; in joydev_connect()
956 joydev->nkey++; in joydev_connect()
959 for (i = 0; i < joydev->nabs; i++) { in joydev_connect()
960 j = joydev->abspam[i]; in joydev_connect()
962 joydev->corr[i].type = JS_CORR_NONE; in joydev_connect()
965 joydev->corr[i].type = JS_CORR_BROKEN; in joydev_connect()
966 joydev->corr[i].prec = input_abs_get_fuzz(dev, j); in joydev_connect()
969 joydev->corr[i].coef[0] = t - input_abs_get_flat(dev, j); in joydev_connect()
970 joydev->corr[i].coef[1] = t + input_abs_get_flat(dev, j); in joydev_connect()
972 t = (input_abs_get_max(dev, j) - input_abs_get_min(dev, j)) / 2 in joydev_connect()
973 - 2 * input_abs_get_flat(dev, j); in joydev_connect()
975 joydev->corr[i].coef[2] = (1 << 29) / t; in joydev_connect()
976 joydev->corr[i].coef[3] = (1 << 29) / t; in joydev_connect()
980 joydev->dev.devt = MKDEV(INPUT_MAJOR, minor); in joydev_connect()
981 joydev->dev.class = &input_class; in joydev_connect()
982 joydev->dev.parent = &dev->dev; in joydev_connect()
983 joydev->dev.release = joydev_free; in joydev_connect()
984 device_initialize(&joydev->dev); in joydev_connect()
986 error = input_register_handle(&joydev->handle); in joydev_connect()
990 cdev_init(&joydev->cdev, &joydev_fops); in joydev_connect()
992 error = cdev_device_add(&joydev->cdev, &joydev->dev); in joydev_connect()
1000 input_unregister_handle(&joydev->handle); in joydev_connect()
1002 put_device(&joydev->dev); in joydev_connect()
1010 struct joydev *joydev = handle->private; in joydev_disconnect()
1012 cdev_device_del(&joydev->cdev, &joydev->dev); in joydev_disconnect()
1014 input_free_minor(MINOR(joydev->dev.devt)); in joydev_disconnect()
1016 put_device(&joydev->dev); in joydev_disconnect()