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 < 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()
483 len = min(len, sizeof(joydev->keypam)); in joydev_handle_JSIOCSBTNMAP()
490 for (i = 0; i < joydev->nkey; i++) { in joydev_handle_JSIOCSBTNMAP()
492 retval = -EINVAL; in joydev_handle_JSIOCSBTNMAP()
497 memcpy(joydev->keypam, keypam, len); in joydev_handle_JSIOCSBTNMAP()
499 for (i = 0; i < joydev->nkey; i++) in joydev_handle_JSIOCSBTNMAP()
500 joydev->keymap[keypam[i] - BTN_MISC] = i; in joydev_handle_JSIOCSBTNMAP()
511 struct input_dev *dev = joydev->handle.dev; in joydev_ioctl_common()
516 /* Process fixed-sized commands. */ in joydev_ioctl_common()
520 return copy_from_user(&joydev->glue.JS_CORR, argp, in joydev_ioctl_common()
521 sizeof(joydev->glue.JS_CORR)) ? -EFAULT : 0; in joydev_ioctl_common()
524 return copy_to_user(argp, &joydev->glue.JS_CORR, in joydev_ioctl_common()
525 sizeof(joydev->glue.JS_CORR)) ? -EFAULT : 0; in joydev_ioctl_common()
528 return get_user(joydev->glue.JS_TIMEOUT, (s32 __user *) argp); in joydev_ioctl_common()
531 return put_user(joydev->glue.JS_TIMEOUT, (s32 __user *) argp); in joydev_ioctl_common()
537 return put_user(joydev->nabs, (__u8 __user *) argp); in joydev_ioctl_common()
540 return put_user(joydev->nkey, (__u8 __user *) argp); in joydev_ioctl_common()
543 if (copy_from_user(joydev->corr, argp, in joydev_ioctl_common()
544 sizeof(joydev->corr[0]) * joydev->nabs)) in joydev_ioctl_common()
545 return -EFAULT; in joydev_ioctl_common()
547 for (i = 0; i < joydev->nabs; i++) { in joydev_ioctl_common()
548 int val = input_abs_get_val(dev, joydev->abspam[i]); in joydev_ioctl_common()
549 joydev->abs[i] = joydev_correct(val, &joydev->corr[i]); in joydev_ioctl_common()
554 return copy_to_user(argp, joydev->corr, in joydev_ioctl_common()
555 sizeof(joydev->corr[0]) * joydev->nabs) ? -EFAULT : 0; in joydev_ioctl_common()
560 * Process variable-sized commands (the axis and button map commands in joydev_ioctl_common()
561 * are considered variable-sized to decouple them from the values of in joydev_ioctl_common()
570 len = min_t(size_t, _IOC_SIZE(cmd), sizeof(joydev->abspam)); in joydev_ioctl_common()
571 return copy_to_user(argp, joydev->abspam, len) ? -EFAULT : len; in joydev_ioctl_common()
577 len = min_t(size_t, _IOC_SIZE(cmd), sizeof(joydev->keypam)); in joydev_ioctl_common()
578 return copy_to_user(argp, joydev->keypam, len) ? -EFAULT : len; in joydev_ioctl_common()
581 name = dev->name; in joydev_ioctl_common()
586 return copy_to_user(argp, name, len) ? -EFAULT : len; in joydev_ioctl_common()
589 return -EINVAL; in joydev_ioctl_common()
596 struct joydev_client *client = file->private_data; in joydev_compat_ioctl()
597 struct joydev *joydev = client->joydev; in joydev_compat_ioctl()
603 retval = mutex_lock_interruptible(&joydev->mutex); in joydev_compat_ioctl()
607 if (!joydev->exist) { in joydev_compat_ioctl()
608 retval = -ENODEV; in joydev_compat_ioctl()
617 joydev->glue.JS_TIMELIMIT = tmp32; in joydev_compat_ioctl()
621 tmp32 = joydev->glue.JS_TIMELIMIT; in joydev_compat_ioctl()
627 sizeof(ds32)) ? -EFAULT : 0; in joydev_compat_ioctl()
629 joydev->glue.JS_TIMEOUT = ds32.JS_TIMEOUT; in joydev_compat_ioctl()
630 joydev->glue.BUSY = ds32.BUSY; in joydev_compat_ioctl()
631 joydev->glue.JS_EXPIRETIME = ds32.JS_EXPIRETIME; in joydev_compat_ioctl()
632 joydev->glue.JS_TIMELIMIT = ds32.JS_TIMELIMIT; in joydev_compat_ioctl()
633 joydev->glue.JS_SAVE = ds32.JS_SAVE; in joydev_compat_ioctl()
634 joydev->glue.JS_CORR = ds32.JS_CORR; in joydev_compat_ioctl()
639 ds32.JS_TIMEOUT = joydev->glue.JS_TIMEOUT; in joydev_compat_ioctl()
640 ds32.BUSY = joydev->glue.BUSY; in joydev_compat_ioctl()
641 ds32.JS_EXPIRETIME = joydev->glue.JS_EXPIRETIME; in joydev_compat_ioctl()
642 ds32.JS_TIMELIMIT = joydev->glue.JS_TIMELIMIT; in joydev_compat_ioctl()
643 ds32.JS_SAVE = joydev->glue.JS_SAVE; in joydev_compat_ioctl()
644 ds32.JS_CORR = joydev->glue.JS_CORR; in joydev_compat_ioctl()
646 retval = copy_to_user(argp, &ds32, sizeof(ds32)) ? -EFAULT : 0; in joydev_compat_ioctl()
655 mutex_unlock(&joydev->mutex); in joydev_compat_ioctl()
663 struct joydev_client *client = file->private_data; in joydev_ioctl()
664 struct joydev *joydev = client->joydev; in joydev_ioctl()
668 retval = mutex_lock_interruptible(&joydev->mutex); in joydev_ioctl()
672 if (!joydev->exist) { in joydev_ioctl()
673 retval = -ENODEV; in joydev_ioctl()
680 retval = get_user(joydev->glue.JS_TIMELIMIT, in joydev_ioctl()
685 retval = put_user(joydev->glue.JS_TIMELIMIT, in joydev_ioctl()
690 retval = copy_from_user(&joydev->glue, argp, in joydev_ioctl()
691 sizeof(joydev->glue)) ? -EFAULT : 0; in joydev_ioctl()
695 retval = copy_to_user(argp, &joydev->glue, in joydev_ioctl()
696 sizeof(joydev->glue)) ? -EFAULT : 0; in joydev_ioctl()
704 mutex_unlock(&joydev->mutex); in joydev_ioctl()
723 * Mark device non-existent. This disables writes, ioctls and
729 mutex_lock(&joydev->mutex); in joydev_mark_dead()
730 joydev->exist = false; in joydev_mark_dead()
731 mutex_unlock(&joydev->mutex); in joydev_mark_dead()
736 struct input_handle *handle = &joydev->handle; in joydev_cleanup()
741 /* joydev is marked dead so no one else accesses joydev->open */ in joydev_cleanup()
742 if (joydev->open) in joydev_cleanup()
747 * These codes are copied from from hid-ids.h, unfortunately there is no common
797 for (id = joydev_blacklist; id->flags; id++) { in joydev_dev_is_blacklisted()
799 dev_dbg(&dev->dev, in joydev_dev_is_blacklisted()
800 "joydev: blacklisting '%s'\n", dev->name); in joydev_dev_is_blacklisted()
818 * pointing devices so that there is one-to-one relationship in joydev_dev_is_absolute_mouse()
846 if (bitmap_equal(jd_scratch, dev->evbit, EV_CNT)) in joydev_dev_is_absolute_mouse()
851 if (bitmap_equal(jd_scratch, dev->evbit, EV_CNT)) in joydev_dev_is_absolute_mouse()
856 if (bitmap_equal(jd_scratch, dev->evbit, EV_CNT)) in joydev_dev_is_absolute_mouse()
865 if (!bitmap_equal(dev->absbit, jd_scratch, ABS_CNT)) in joydev_dev_is_absolute_mouse()
873 if (!bitmap_equal(dev->keybit, jd_scratch, KEY_CNT)) in joydev_dev_is_absolute_mouse()
880 if (dev->id.bustype == BUS_AMIGA) in joydev_dev_is_absolute_mouse()
915 error = -ENOMEM; in joydev_connect()
919 INIT_LIST_HEAD(&joydev->client_list); in joydev_connect()
920 spin_lock_init(&joydev->client_lock); in joydev_connect()
921 mutex_init(&joydev->mutex); in joydev_connect()
922 init_waitqueue_head(&joydev->wait); in joydev_connect()
923 joydev->exist = true; in joydev_connect()
926 /* Normalize device number if it falls into legacy range */ in joydev_connect()
928 dev_no -= JOYDEV_MINOR_BASE; in joydev_connect()
929 dev_set_name(&joydev->dev, "js%d", dev_no); in joydev_connect()
931 joydev->handle.dev = input_get_device(dev); in joydev_connect()
932 joydev->handle.name = dev_name(&joydev->dev); in joydev_connect()
933 joydev->handle.handler = handler; in joydev_connect()
934 joydev->handle.private = joydev; in joydev_connect()
936 for_each_set_bit(i, dev->absbit, ABS_CNT) { in joydev_connect()
937 joydev->absmap[i] = joydev->nabs; in joydev_connect()
938 joydev->abspam[joydev->nabs] = i; in joydev_connect()
939 joydev->nabs++; in joydev_connect()
942 for (i = BTN_JOYSTICK - BTN_MISC; i < KEY_MAX - BTN_MISC + 1; i++) in joydev_connect()
943 if (test_bit(i + BTN_MISC, dev->keybit)) { in joydev_connect()
944 joydev->keymap[i] = joydev->nkey; in joydev_connect()
945 joydev->keypam[joydev->nkey] = i + BTN_MISC; in joydev_connect()
946 joydev->nkey++; in joydev_connect()
949 for (i = 0; i < BTN_JOYSTICK - BTN_MISC; i++) in joydev_connect()
950 if (test_bit(i + BTN_MISC, dev->keybit)) { in joydev_connect()
951 joydev->keymap[i] = joydev->nkey; in joydev_connect()
952 joydev->keypam[joydev->nkey] = i + BTN_MISC; in joydev_connect()
953 joydev->nkey++; in joydev_connect()
956 for (i = 0; i < joydev->nabs; i++) { in joydev_connect()
957 j = joydev->abspam[i]; in joydev_connect()
959 joydev->corr[i].type = JS_CORR_NONE; in joydev_connect()
962 joydev->corr[i].type = JS_CORR_BROKEN; in joydev_connect()
963 joydev->corr[i].prec = input_abs_get_fuzz(dev, j); in joydev_connect()
966 joydev->corr[i].coef[0] = t - input_abs_get_flat(dev, j); in joydev_connect()
967 joydev->corr[i].coef[1] = t + input_abs_get_flat(dev, j); in joydev_connect()
969 t = (input_abs_get_max(dev, j) - input_abs_get_min(dev, j)) / 2 in joydev_connect()
970 - 2 * input_abs_get_flat(dev, j); in joydev_connect()
972 joydev->corr[i].coef[2] = (1 << 29) / t; in joydev_connect()
973 joydev->corr[i].coef[3] = (1 << 29) / t; in joydev_connect()
977 joydev->dev.devt = MKDEV(INPUT_MAJOR, minor); in joydev_connect()
978 joydev->dev.class = &input_class; in joydev_connect()
979 joydev->dev.parent = &dev->dev; in joydev_connect()
980 joydev->dev.release = joydev_free; in joydev_connect()
981 device_initialize(&joydev->dev); in joydev_connect()
983 error = input_register_handle(&joydev->handle); in joydev_connect()
987 cdev_init(&joydev->cdev, &joydev_fops); in joydev_connect()
989 error = cdev_device_add(&joydev->cdev, &joydev->dev); in joydev_connect()
997 input_unregister_handle(&joydev->handle); in joydev_connect()
999 put_device(&joydev->dev); in joydev_connect()
1007 struct joydev *joydev = handle->private; in joydev_disconnect()
1009 cdev_device_del(&joydev->cdev, &joydev->dev); in joydev_disconnect()
1011 input_free_minor(MINOR(joydev->dev.devt)); in joydev_disconnect()
1013 put_device(&joydev->dev); in joydev_disconnect()