12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136 |
- // SPDX-License-Identifier: GPL-2.0-or-later
- /*
- * User level driver support for input subsystem
- *
- * Heavily based on evdev.c by Vojtech Pavlik
- *
- * Author: Aristeu Sergio Rozanski Filho <[email protected]>
- *
- * Changes/Revisions:
- * 0.4 01/09/2014 (Benjamin Tissoires <[email protected]>)
- * - add UI_GET_SYSNAME ioctl
- * 0.3 09/04/2006 (Anssi Hannula <[email protected]>)
- * - updated ff support for the changes in kernel interface
- * - added MODULE_VERSION
- * 0.2 16/10/2004 (Micah Dowty <[email protected]>)
- * - added force feedback support
- * - added UI_SET_PHYS
- * 0.1 20/06/2002
- * - first public version
- */
- #include <uapi/linux/uinput.h>
- #include <linux/poll.h>
- #include <linux/sched.h>
- #include <linux/slab.h>
- #include <linux/module.h>
- #include <linux/init.h>
- #include <linux/fs.h>
- #include <linux/miscdevice.h>
- #include <linux/overflow.h>
- #include <linux/input/mt.h>
- #include "../input-compat.h"
- #define UINPUT_NAME "uinput"
- #define UINPUT_BUFFER_SIZE 16
- #define UINPUT_NUM_REQUESTS 16
- #define UINPUT_TIMESTAMP_ALLOWED_OFFSET_SECS 10
- enum uinput_state { UIST_NEW_DEVICE, UIST_SETUP_COMPLETE, UIST_CREATED };
- struct uinput_request {
- unsigned int id;
- unsigned int code; /* UI_FF_UPLOAD, UI_FF_ERASE */
- int retval;
- struct completion done;
- union {
- unsigned int effect_id;
- struct {
- struct ff_effect *effect;
- struct ff_effect *old;
- } upload;
- } u;
- };
- struct uinput_device {
- struct input_dev *dev;
- struct mutex mutex;
- enum uinput_state state;
- wait_queue_head_t waitq;
- unsigned char ready;
- unsigned char head;
- unsigned char tail;
- struct input_event buff[UINPUT_BUFFER_SIZE];
- unsigned int ff_effects_max;
- struct uinput_request *requests[UINPUT_NUM_REQUESTS];
- wait_queue_head_t requests_waitq;
- spinlock_t requests_lock;
- };
- static int uinput_dev_event(struct input_dev *dev,
- unsigned int type, unsigned int code, int value)
- {
- struct uinput_device *udev = input_get_drvdata(dev);
- struct timespec64 ts;
- ktime_get_ts64(&ts);
- udev->buff[udev->head] = (struct input_event) {
- .input_event_sec = ts.tv_sec,
- .input_event_usec = ts.tv_nsec / NSEC_PER_USEC,
- .type = type,
- .code = code,
- .value = value,
- };
- udev->head = (udev->head + 1) % UINPUT_BUFFER_SIZE;
- wake_up_interruptible(&udev->waitq);
- return 0;
- }
- /* Atomically allocate an ID for the given request. Returns 0 on success. */
- static bool uinput_request_alloc_id(struct uinput_device *udev,
- struct uinput_request *request)
- {
- unsigned int id;
- bool reserved = false;
- spin_lock(&udev->requests_lock);
- for (id = 0; id < UINPUT_NUM_REQUESTS; id++) {
- if (!udev->requests[id]) {
- request->id = id;
- udev->requests[id] = request;
- reserved = true;
- break;
- }
- }
- spin_unlock(&udev->requests_lock);
- return reserved;
- }
- static struct uinput_request *uinput_request_find(struct uinput_device *udev,
- unsigned int id)
- {
- /* Find an input request, by ID. Returns NULL if the ID isn't valid. */
- if (id >= UINPUT_NUM_REQUESTS)
- return NULL;
- return udev->requests[id];
- }
- static int uinput_request_reserve_slot(struct uinput_device *udev,
- struct uinput_request *request)
- {
- /* Allocate slot. If none are available right away, wait. */
- return wait_event_interruptible(udev->requests_waitq,
- uinput_request_alloc_id(udev, request));
- }
- static void uinput_request_release_slot(struct uinput_device *udev,
- unsigned int id)
- {
- /* Mark slot as available */
- spin_lock(&udev->requests_lock);
- udev->requests[id] = NULL;
- spin_unlock(&udev->requests_lock);
- wake_up(&udev->requests_waitq);
- }
- static int uinput_request_send(struct uinput_device *udev,
- struct uinput_request *request)
- {
- int retval;
- retval = mutex_lock_interruptible(&udev->mutex);
- if (retval)
- return retval;
- if (udev->state != UIST_CREATED) {
- retval = -ENODEV;
- goto out;
- }
- init_completion(&request->done);
- /*
- * Tell our userspace application about this new request
- * by queueing an input event.
- */
- uinput_dev_event(udev->dev, EV_UINPUT, request->code, request->id);
- out:
- mutex_unlock(&udev->mutex);
- return retval;
- }
- static int uinput_request_submit(struct uinput_device *udev,
- struct uinput_request *request)
- {
- int retval;
- retval = uinput_request_reserve_slot(udev, request);
- if (retval)
- return retval;
- retval = uinput_request_send(udev, request);
- if (retval)
- goto out;
- if (!wait_for_completion_timeout(&request->done, 30 * HZ)) {
- retval = -ETIMEDOUT;
- goto out;
- }
- retval = request->retval;
- out:
- uinput_request_release_slot(udev, request->id);
- return retval;
- }
- /*
- * Fail all outstanding requests so handlers don't wait for the userspace
- * to finish processing them.
- */
- static void uinput_flush_requests(struct uinput_device *udev)
- {
- struct uinput_request *request;
- int i;
- spin_lock(&udev->requests_lock);
- for (i = 0; i < UINPUT_NUM_REQUESTS; i++) {
- request = udev->requests[i];
- if (request) {
- request->retval = -ENODEV;
- complete(&request->done);
- }
- }
- spin_unlock(&udev->requests_lock);
- }
- static void uinput_dev_set_gain(struct input_dev *dev, u16 gain)
- {
- uinput_dev_event(dev, EV_FF, FF_GAIN, gain);
- }
- static void uinput_dev_set_autocenter(struct input_dev *dev, u16 magnitude)
- {
- uinput_dev_event(dev, EV_FF, FF_AUTOCENTER, magnitude);
- }
- static int uinput_dev_playback(struct input_dev *dev, int effect_id, int value)
- {
- return uinput_dev_event(dev, EV_FF, effect_id, value);
- }
- static int uinput_dev_upload_effect(struct input_dev *dev,
- struct ff_effect *effect,
- struct ff_effect *old)
- {
- struct uinput_device *udev = input_get_drvdata(dev);
- struct uinput_request request;
- /*
- * uinput driver does not currently support periodic effects with
- * custom waveform since it does not have a way to pass buffer of
- * samples (custom_data) to userspace. If ever there is a device
- * supporting custom waveforms we would need to define an additional
- * ioctl (UI_UPLOAD_SAMPLES) but for now we just bail out.
- */
- if (effect->type == FF_PERIODIC &&
- effect->u.periodic.waveform == FF_CUSTOM)
- return -EINVAL;
- request.code = UI_FF_UPLOAD;
- request.u.upload.effect = effect;
- request.u.upload.old = old;
- return uinput_request_submit(udev, &request);
- }
- static int uinput_dev_erase_effect(struct input_dev *dev, int effect_id)
- {
- struct uinput_device *udev = input_get_drvdata(dev);
- struct uinput_request request;
- if (!test_bit(EV_FF, dev->evbit))
- return -ENOSYS;
- request.code = UI_FF_ERASE;
- request.u.effect_id = effect_id;
- return uinput_request_submit(udev, &request);
- }
- static int uinput_dev_flush(struct input_dev *dev, struct file *file)
- {
- /*
- * If we are called with file == NULL that means we are tearing
- * down the device, and therefore we can not handle FF erase
- * requests: either we are handling UI_DEV_DESTROY (and holding
- * the udev->mutex), or the file descriptor is closed and there is
- * nobody on the other side anymore.
- */
- return file ? input_ff_flush(dev, file) : 0;
- }
- static void uinput_destroy_device(struct uinput_device *udev)
- {
- const char *name, *phys;
- struct input_dev *dev = udev->dev;
- enum uinput_state old_state = udev->state;
- udev->state = UIST_NEW_DEVICE;
- if (dev) {
- name = dev->name;
- phys = dev->phys;
- if (old_state == UIST_CREATED) {
- uinput_flush_requests(udev);
- input_unregister_device(dev);
- } else {
- input_free_device(dev);
- }
- kfree(name);
- kfree(phys);
- udev->dev = NULL;
- }
- }
- static int uinput_create_device(struct uinput_device *udev)
- {
- struct input_dev *dev = udev->dev;
- int error, nslot;
- if (udev->state != UIST_SETUP_COMPLETE) {
- printk(KERN_DEBUG "%s: write device info first\n", UINPUT_NAME);
- return -EINVAL;
- }
- if (test_bit(EV_ABS, dev->evbit)) {
- input_alloc_absinfo(dev);
- if (!dev->absinfo) {
- error = -EINVAL;
- goto fail1;
- }
- if (test_bit(ABS_MT_SLOT, dev->absbit)) {
- nslot = input_abs_get_max(dev, ABS_MT_SLOT) + 1;
- error = input_mt_init_slots(dev, nslot, 0);
- if (error)
- goto fail1;
- } else if (test_bit(ABS_MT_POSITION_X, dev->absbit)) {
- input_set_events_per_packet(dev, 60);
- }
- }
- if (test_bit(EV_FF, dev->evbit) && !udev->ff_effects_max) {
- printk(KERN_DEBUG "%s: ff_effects_max should be non-zero when FF_BIT is set\n",
- UINPUT_NAME);
- error = -EINVAL;
- goto fail1;
- }
- if (udev->ff_effects_max) {
- error = input_ff_create(dev, udev->ff_effects_max);
- if (error)
- goto fail1;
- dev->ff->upload = uinput_dev_upload_effect;
- dev->ff->erase = uinput_dev_erase_effect;
- dev->ff->playback = uinput_dev_playback;
- dev->ff->set_gain = uinput_dev_set_gain;
- dev->ff->set_autocenter = uinput_dev_set_autocenter;
- /*
- * The standard input_ff_flush() implementation does
- * not quite work for uinput as we can't reasonably
- * handle FF requests during device teardown.
- */
- dev->flush = uinput_dev_flush;
- }
- dev->event = uinput_dev_event;
- input_set_drvdata(udev->dev, udev);
- error = input_register_device(udev->dev);
- if (error)
- goto fail2;
- udev->state = UIST_CREATED;
- return 0;
- fail2: input_ff_destroy(dev);
- fail1: uinput_destroy_device(udev);
- return error;
- }
- static int uinput_open(struct inode *inode, struct file *file)
- {
- struct uinput_device *newdev;
- newdev = kzalloc(sizeof(struct uinput_device), GFP_KERNEL);
- if (!newdev)
- return -ENOMEM;
- mutex_init(&newdev->mutex);
- spin_lock_init(&newdev->requests_lock);
- init_waitqueue_head(&newdev->requests_waitq);
- init_waitqueue_head(&newdev->waitq);
- newdev->state = UIST_NEW_DEVICE;
- file->private_data = newdev;
- stream_open(inode, file);
- return 0;
- }
- static int uinput_validate_absinfo(struct input_dev *dev, unsigned int code,
- const struct input_absinfo *abs)
- {
- int min, max, range;
- min = abs->minimum;
- max = abs->maximum;
- if ((min != 0 || max != 0) && max < min) {
- printk(KERN_DEBUG
- "%s: invalid abs[%02x] min:%d max:%d\n",
- UINPUT_NAME, code, min, max);
- return -EINVAL;
- }
- if (!check_sub_overflow(max, min, &range) && abs->flat > range) {
- printk(KERN_DEBUG
- "%s: abs_flat #%02x out of range: %d (min:%d/max:%d)\n",
- UINPUT_NAME, code, abs->flat, min, max);
- return -EINVAL;
- }
- return 0;
- }
- static int uinput_validate_absbits(struct input_dev *dev)
- {
- unsigned int cnt;
- int error;
- if (!test_bit(EV_ABS, dev->evbit))
- return 0;
- /*
- * Check if absmin/absmax/absfuzz/absflat are sane.
- */
- for_each_set_bit(cnt, dev->absbit, ABS_CNT) {
- if (!dev->absinfo)
- return -EINVAL;
- error = uinput_validate_absinfo(dev, cnt, &dev->absinfo[cnt]);
- if (error)
- return error;
- }
- return 0;
- }
- static int uinput_dev_setup(struct uinput_device *udev,
- struct uinput_setup __user *arg)
- {
- struct uinput_setup setup;
- struct input_dev *dev;
- if (udev->state == UIST_CREATED)
- return -EINVAL;
- if (copy_from_user(&setup, arg, sizeof(setup)))
- return -EFAULT;
- if (!setup.name[0])
- return -EINVAL;
- dev = udev->dev;
- dev->id = setup.id;
- udev->ff_effects_max = setup.ff_effects_max;
- kfree(dev->name);
- dev->name = kstrndup(setup.name, UINPUT_MAX_NAME_SIZE, GFP_KERNEL);
- if (!dev->name)
- return -ENOMEM;
- udev->state = UIST_SETUP_COMPLETE;
- return 0;
- }
- static int uinput_abs_setup(struct uinput_device *udev,
- struct uinput_setup __user *arg, size_t size)
- {
- struct uinput_abs_setup setup = {};
- struct input_dev *dev;
- int error;
- if (size > sizeof(setup))
- return -E2BIG;
- if (udev->state == UIST_CREATED)
- return -EINVAL;
- if (copy_from_user(&setup, arg, size))
- return -EFAULT;
- if (setup.code > ABS_MAX)
- return -ERANGE;
- dev = udev->dev;
- error = uinput_validate_absinfo(dev, setup.code, &setup.absinfo);
- if (error)
- return error;
- input_alloc_absinfo(dev);
- if (!dev->absinfo)
- return -ENOMEM;
- set_bit(setup.code, dev->absbit);
- dev->absinfo[setup.code] = setup.absinfo;
- return 0;
- }
- /* legacy setup via write() */
- static int uinput_setup_device_legacy(struct uinput_device *udev,
- const char __user *buffer, size_t count)
- {
- struct uinput_user_dev *user_dev;
- struct input_dev *dev;
- int i;
- int retval;
- if (count != sizeof(struct uinput_user_dev))
- return -EINVAL;
- if (!udev->dev) {
- udev->dev = input_allocate_device();
- if (!udev->dev)
- return -ENOMEM;
- }
- dev = udev->dev;
- user_dev = memdup_user(buffer, sizeof(struct uinput_user_dev));
- if (IS_ERR(user_dev))
- return PTR_ERR(user_dev);
- udev->ff_effects_max = user_dev->ff_effects_max;
- /* Ensure name is filled in */
- if (!user_dev->name[0]) {
- retval = -EINVAL;
- goto exit;
- }
- kfree(dev->name);
- dev->name = kstrndup(user_dev->name, UINPUT_MAX_NAME_SIZE,
- GFP_KERNEL);
- if (!dev->name) {
- retval = -ENOMEM;
- goto exit;
- }
- dev->id.bustype = user_dev->id.bustype;
- dev->id.vendor = user_dev->id.vendor;
- dev->id.product = user_dev->id.product;
- dev->id.version = user_dev->id.version;
- for (i = 0; i < ABS_CNT; i++) {
- input_abs_set_max(dev, i, user_dev->absmax[i]);
- input_abs_set_min(dev, i, user_dev->absmin[i]);
- input_abs_set_fuzz(dev, i, user_dev->absfuzz[i]);
- input_abs_set_flat(dev, i, user_dev->absflat[i]);
- }
- retval = uinput_validate_absbits(dev);
- if (retval < 0)
- goto exit;
- udev->state = UIST_SETUP_COMPLETE;
- retval = count;
- exit:
- kfree(user_dev);
- return retval;
- }
- /*
- * Returns true if the given timestamp is valid (i.e., if all the following
- * conditions are satisfied), false otherwise.
- * 1) given timestamp is positive
- * 2) it's within the allowed offset before the current time
- * 3) it's not in the future
- */
- static bool is_valid_timestamp(const ktime_t timestamp)
- {
- ktime_t zero_time;
- ktime_t current_time;
- ktime_t min_time;
- ktime_t offset;
- zero_time = ktime_set(0, 0);
- if (ktime_compare(zero_time, timestamp) >= 0)
- return false;
- current_time = ktime_get();
- offset = ktime_set(UINPUT_TIMESTAMP_ALLOWED_OFFSET_SECS, 0);
- min_time = ktime_sub(current_time, offset);
- if (ktime_after(min_time, timestamp) || ktime_after(timestamp, current_time))
- return false;
- return true;
- }
- static ssize_t uinput_inject_events(struct uinput_device *udev,
- const char __user *buffer, size_t count)
- {
- struct input_event ev;
- size_t bytes = 0;
- ktime_t timestamp;
- if (count != 0 && count < input_event_size())
- return -EINVAL;
- while (bytes + input_event_size() <= count) {
- /*
- * Note that even if some events were fetched successfully
- * we are still going to return EFAULT instead of partial
- * count to let userspace know that it got it's buffers
- * all wrong.
- */
- if (input_event_from_user(buffer + bytes, &ev))
- return -EFAULT;
- timestamp = ktime_set(ev.input_event_sec, ev.input_event_usec * NSEC_PER_USEC);
- if (is_valid_timestamp(timestamp))
- input_set_timestamp(udev->dev, timestamp);
- input_event(udev->dev, ev.type, ev.code, ev.value);
- bytes += input_event_size();
- cond_resched();
- }
- return bytes;
- }
- static ssize_t uinput_write(struct file *file, const char __user *buffer,
- size_t count, loff_t *ppos)
- {
- struct uinput_device *udev = file->private_data;
- int retval;
- if (count == 0)
- return 0;
- retval = mutex_lock_interruptible(&udev->mutex);
- if (retval)
- return retval;
- retval = udev->state == UIST_CREATED ?
- uinput_inject_events(udev, buffer, count) :
- uinput_setup_device_legacy(udev, buffer, count);
- mutex_unlock(&udev->mutex);
- return retval;
- }
- static bool uinput_fetch_next_event(struct uinput_device *udev,
- struct input_event *event)
- {
- bool have_event;
- spin_lock_irq(&udev->dev->event_lock);
- have_event = udev->head != udev->tail;
- if (have_event) {
- *event = udev->buff[udev->tail];
- udev->tail = (udev->tail + 1) % UINPUT_BUFFER_SIZE;
- }
- spin_unlock_irq(&udev->dev->event_lock);
- return have_event;
- }
- static ssize_t uinput_events_to_user(struct uinput_device *udev,
- char __user *buffer, size_t count)
- {
- struct input_event event;
- size_t read = 0;
- while (read + input_event_size() <= count &&
- uinput_fetch_next_event(udev, &event)) {
- if (input_event_to_user(buffer + read, &event))
- return -EFAULT;
- read += input_event_size();
- }
- return read;
- }
- static ssize_t uinput_read(struct file *file, char __user *buffer,
- size_t count, loff_t *ppos)
- {
- struct uinput_device *udev = file->private_data;
- ssize_t retval;
- if (count != 0 && count < input_event_size())
- return -EINVAL;
- do {
- retval = mutex_lock_interruptible(&udev->mutex);
- if (retval)
- return retval;
- if (udev->state != UIST_CREATED)
- retval = -ENODEV;
- else if (udev->head == udev->tail &&
- (file->f_flags & O_NONBLOCK))
- retval = -EAGAIN;
- else
- retval = uinput_events_to_user(udev, buffer, count);
- mutex_unlock(&udev->mutex);
- if (retval || count == 0)
- break;
- if (!(file->f_flags & O_NONBLOCK))
- retval = wait_event_interruptible(udev->waitq,
- udev->head != udev->tail ||
- udev->state != UIST_CREATED);
- } while (retval == 0);
- return retval;
- }
- static __poll_t uinput_poll(struct file *file, poll_table *wait)
- {
- struct uinput_device *udev = file->private_data;
- __poll_t mask = EPOLLOUT | EPOLLWRNORM; /* uinput is always writable */
- poll_wait(file, &udev->waitq, wait);
- if (udev->head != udev->tail)
- mask |= EPOLLIN | EPOLLRDNORM;
- return mask;
- }
- static int uinput_release(struct inode *inode, struct file *file)
- {
- struct uinput_device *udev = file->private_data;
- uinput_destroy_device(udev);
- kfree(udev);
- return 0;
- }
- #ifdef CONFIG_COMPAT
- struct uinput_ff_upload_compat {
- __u32 request_id;
- __s32 retval;
- struct ff_effect_compat effect;
- struct ff_effect_compat old;
- };
- static int uinput_ff_upload_to_user(char __user *buffer,
- const struct uinput_ff_upload *ff_up)
- {
- if (in_compat_syscall()) {
- struct uinput_ff_upload_compat ff_up_compat;
- ff_up_compat.request_id = ff_up->request_id;
- ff_up_compat.retval = ff_up->retval;
- /*
- * It so happens that the pointer that gives us the trouble
- * is the last field in the structure. Since we don't support
- * custom waveforms in uinput anyway we can just copy the whole
- * thing (to the compat size) and ignore the pointer.
- */
- memcpy(&ff_up_compat.effect, &ff_up->effect,
- sizeof(struct ff_effect_compat));
- memcpy(&ff_up_compat.old, &ff_up->old,
- sizeof(struct ff_effect_compat));
- if (copy_to_user(buffer, &ff_up_compat,
- sizeof(struct uinput_ff_upload_compat)))
- return -EFAULT;
- } else {
- if (copy_to_user(buffer, ff_up,
- sizeof(struct uinput_ff_upload)))
- return -EFAULT;
- }
- return 0;
- }
- static int uinput_ff_upload_from_user(const char __user *buffer,
- struct uinput_ff_upload *ff_up)
- {
- if (in_compat_syscall()) {
- struct uinput_ff_upload_compat ff_up_compat;
- if (copy_from_user(&ff_up_compat, buffer,
- sizeof(struct uinput_ff_upload_compat)))
- return -EFAULT;
- ff_up->request_id = ff_up_compat.request_id;
- ff_up->retval = ff_up_compat.retval;
- memcpy(&ff_up->effect, &ff_up_compat.effect,
- sizeof(struct ff_effect_compat));
- memcpy(&ff_up->old, &ff_up_compat.old,
- sizeof(struct ff_effect_compat));
- } else {
- if (copy_from_user(ff_up, buffer,
- sizeof(struct uinput_ff_upload)))
- return -EFAULT;
- }
- return 0;
- }
- #else
- static int uinput_ff_upload_to_user(char __user *buffer,
- const struct uinput_ff_upload *ff_up)
- {
- if (copy_to_user(buffer, ff_up, sizeof(struct uinput_ff_upload)))
- return -EFAULT;
- return 0;
- }
- static int uinput_ff_upload_from_user(const char __user *buffer,
- struct uinput_ff_upload *ff_up)
- {
- if (copy_from_user(ff_up, buffer, sizeof(struct uinput_ff_upload)))
- return -EFAULT;
- return 0;
- }
- #endif
- #define uinput_set_bit(_arg, _bit, _max) \
- ({ \
- int __ret = 0; \
- if (udev->state == UIST_CREATED) \
- __ret = -EINVAL; \
- else if ((_arg) > (_max)) \
- __ret = -EINVAL; \
- else set_bit((_arg), udev->dev->_bit); \
- __ret; \
- })
- static int uinput_str_to_user(void __user *dest, const char *str,
- unsigned int maxlen)
- {
- char __user *p = dest;
- int len, ret;
- if (!str)
- return -ENOENT;
- if (maxlen == 0)
- return -EINVAL;
- len = strlen(str) + 1;
- if (len > maxlen)
- len = maxlen;
- ret = copy_to_user(p, str, len);
- if (ret)
- return -EFAULT;
- /* force terminating '\0' */
- ret = put_user(0, p + len - 1);
- return ret ? -EFAULT : len;
- }
- static long uinput_ioctl_handler(struct file *file, unsigned int cmd,
- unsigned long arg, void __user *p)
- {
- int retval;
- struct uinput_device *udev = file->private_data;
- struct uinput_ff_upload ff_up;
- struct uinput_ff_erase ff_erase;
- struct uinput_request *req;
- char *phys;
- const char *name;
- unsigned int size;
- retval = mutex_lock_interruptible(&udev->mutex);
- if (retval)
- return retval;
- if (!udev->dev) {
- udev->dev = input_allocate_device();
- if (!udev->dev) {
- retval = -ENOMEM;
- goto out;
- }
- }
- switch (cmd) {
- case UI_GET_VERSION:
- if (put_user(UINPUT_VERSION, (unsigned int __user *)p))
- retval = -EFAULT;
- goto out;
- case UI_DEV_CREATE:
- retval = uinput_create_device(udev);
- goto out;
- case UI_DEV_DESTROY:
- uinput_destroy_device(udev);
- goto out;
- case UI_DEV_SETUP:
- retval = uinput_dev_setup(udev, p);
- goto out;
- /* UI_ABS_SETUP is handled in the variable size ioctls */
- case UI_SET_EVBIT:
- retval = uinput_set_bit(arg, evbit, EV_MAX);
- goto out;
- case UI_SET_KEYBIT:
- retval = uinput_set_bit(arg, keybit, KEY_MAX);
- goto out;
- case UI_SET_RELBIT:
- retval = uinput_set_bit(arg, relbit, REL_MAX);
- goto out;
- case UI_SET_ABSBIT:
- retval = uinput_set_bit(arg, absbit, ABS_MAX);
- goto out;
- case UI_SET_MSCBIT:
- retval = uinput_set_bit(arg, mscbit, MSC_MAX);
- goto out;
- case UI_SET_LEDBIT:
- retval = uinput_set_bit(arg, ledbit, LED_MAX);
- goto out;
- case UI_SET_SNDBIT:
- retval = uinput_set_bit(arg, sndbit, SND_MAX);
- goto out;
- case UI_SET_FFBIT:
- retval = uinput_set_bit(arg, ffbit, FF_MAX);
- goto out;
- case UI_SET_SWBIT:
- retval = uinput_set_bit(arg, swbit, SW_MAX);
- goto out;
- case UI_SET_PROPBIT:
- retval = uinput_set_bit(arg, propbit, INPUT_PROP_MAX);
- goto out;
- case UI_SET_PHYS:
- if (udev->state == UIST_CREATED) {
- retval = -EINVAL;
- goto out;
- }
- phys = strndup_user(p, 1024);
- if (IS_ERR(phys)) {
- retval = PTR_ERR(phys);
- goto out;
- }
- kfree(udev->dev->phys);
- udev->dev->phys = phys;
- goto out;
- case UI_BEGIN_FF_UPLOAD:
- retval = uinput_ff_upload_from_user(p, &ff_up);
- if (retval)
- goto out;
- req = uinput_request_find(udev, ff_up.request_id);
- if (!req || req->code != UI_FF_UPLOAD ||
- !req->u.upload.effect) {
- retval = -EINVAL;
- goto out;
- }
- ff_up.retval = 0;
- ff_up.effect = *req->u.upload.effect;
- if (req->u.upload.old)
- ff_up.old = *req->u.upload.old;
- else
- memset(&ff_up.old, 0, sizeof(struct ff_effect));
- retval = uinput_ff_upload_to_user(p, &ff_up);
- goto out;
- case UI_BEGIN_FF_ERASE:
- if (copy_from_user(&ff_erase, p, sizeof(ff_erase))) {
- retval = -EFAULT;
- goto out;
- }
- req = uinput_request_find(udev, ff_erase.request_id);
- if (!req || req->code != UI_FF_ERASE) {
- retval = -EINVAL;
- goto out;
- }
- ff_erase.retval = 0;
- ff_erase.effect_id = req->u.effect_id;
- if (copy_to_user(p, &ff_erase, sizeof(ff_erase))) {
- retval = -EFAULT;
- goto out;
- }
- goto out;
- case UI_END_FF_UPLOAD:
- retval = uinput_ff_upload_from_user(p, &ff_up);
- if (retval)
- goto out;
- req = uinput_request_find(udev, ff_up.request_id);
- if (!req || req->code != UI_FF_UPLOAD ||
- !req->u.upload.effect) {
- retval = -EINVAL;
- goto out;
- }
- req->retval = ff_up.retval;
- complete(&req->done);
- goto out;
- case UI_END_FF_ERASE:
- if (copy_from_user(&ff_erase, p, sizeof(ff_erase))) {
- retval = -EFAULT;
- goto out;
- }
- req = uinput_request_find(udev, ff_erase.request_id);
- if (!req || req->code != UI_FF_ERASE) {
- retval = -EINVAL;
- goto out;
- }
- req->retval = ff_erase.retval;
- complete(&req->done);
- goto out;
- }
- size = _IOC_SIZE(cmd);
- /* Now check variable-length commands */
- switch (cmd & ~IOCSIZE_MASK) {
- case UI_GET_SYSNAME(0):
- if (udev->state != UIST_CREATED) {
- retval = -ENOENT;
- goto out;
- }
- name = dev_name(&udev->dev->dev);
- retval = uinput_str_to_user(p, name, size);
- goto out;
- case UI_ABS_SETUP & ~IOCSIZE_MASK:
- retval = uinput_abs_setup(udev, p, size);
- goto out;
- }
- retval = -EINVAL;
- out:
- mutex_unlock(&udev->mutex);
- return retval;
- }
- static long uinput_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
- {
- return uinput_ioctl_handler(file, cmd, arg, (void __user *)arg);
- }
- #ifdef CONFIG_COMPAT
- /*
- * These IOCTLs change their size and thus their numbers between
- * 32 and 64 bits.
- */
- #define UI_SET_PHYS_COMPAT \
- _IOW(UINPUT_IOCTL_BASE, 108, compat_uptr_t)
- #define UI_BEGIN_FF_UPLOAD_COMPAT \
- _IOWR(UINPUT_IOCTL_BASE, 200, struct uinput_ff_upload_compat)
- #define UI_END_FF_UPLOAD_COMPAT \
- _IOW(UINPUT_IOCTL_BASE, 201, struct uinput_ff_upload_compat)
- static long uinput_compat_ioctl(struct file *file,
- unsigned int cmd, unsigned long arg)
- {
- switch (cmd) {
- case UI_SET_PHYS_COMPAT:
- cmd = UI_SET_PHYS;
- break;
- case UI_BEGIN_FF_UPLOAD_COMPAT:
- cmd = UI_BEGIN_FF_UPLOAD;
- break;
- case UI_END_FF_UPLOAD_COMPAT:
- cmd = UI_END_FF_UPLOAD;
- break;
- }
- return uinput_ioctl_handler(file, cmd, arg, compat_ptr(arg));
- }
- #endif
- static const struct file_operations uinput_fops = {
- .owner = THIS_MODULE,
- .open = uinput_open,
- .release = uinput_release,
- .read = uinput_read,
- .write = uinput_write,
- .poll = uinput_poll,
- .unlocked_ioctl = uinput_ioctl,
- #ifdef CONFIG_COMPAT
- .compat_ioctl = uinput_compat_ioctl,
- #endif
- .llseek = no_llseek,
- };
- static struct miscdevice uinput_misc = {
- .fops = &uinput_fops,
- .minor = UINPUT_MINOR,
- .name = UINPUT_NAME,
- };
- module_misc_device(uinput_misc);
- MODULE_ALIAS_MISCDEV(UINPUT_MINOR);
- MODULE_ALIAS("devname:" UINPUT_NAME);
- MODULE_AUTHOR("Aristeu Sergio Rozanski Filho");
- MODULE_DESCRIPTION("User level driver support for input subsystem");
- MODULE_LICENSE("GPL");
|