[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / input / joydev.c

/*
 * Joystick device driver for the input driver suite.
 *
 * Copyright (c) 1999-2002 Vojtech Pavlik
 * Copyright (c) 1999 Colin Van Dyke
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 */

#include <asm/io.h>
#include <asm/system.h>
#include <linux/delay.h>
#include <linux/errno.h>
#include <linux/joystick.h>
#include <linux/input.h>
#include <linux/kernel.h>
#include <linux/major.h>
#include <linux/slab.h>
#include <linux/mm.h>
#include <linux/miscdevice.h>
#include <linux/module.h>
#include <linux/poll.h>
#include <linux/init.h>
#include <linux/device.h>

MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
MODULE_DESCRIPTION("Joystick device interfaces");
MODULE_SUPPORTED_DEVICE("input/js");
MODULE_LICENSE("GPL");

#define JOYDEV_MINOR_BASE	0
#define JOYDEV_MINORS		16
#define JOYDEV_BUFFER_SIZE	64

struct joydev {
	int exist;
	int open;
	int minor;
	char name[16];
	struct input_handle handle;
	wait_queue_head_t wait;
	struct list_head client_list;
	struct js_corr corr[ABS_MAX + 1];
	struct JS_DATA_SAVE_TYPE glue;
	int nabs;
	int nkey;
	__u16 keymap[KEY_MAX - BTN_MISC + 1];
	__u16 keypam[KEY_MAX - BTN_MISC + 1];
	__u8 absmap[ABS_MAX + 1];
	__u8 abspam[ABS_MAX + 1];
	__s16 abs[ABS_MAX + 1];
};

struct joydev_client {
	struct js_event buffer[JOYDEV_BUFFER_SIZE];
	int head;
	int tail;
	int startup;
	struct fasync_struct *fasync;
	struct joydev *joydev;
	struct list_head node;
};

static struct joydev *joydev_table[JOYDEV_MINORS];

static int joydev_correct(int value, struct js_corr *corr)
{
	switch (corr->type) {
		case JS_CORR_NONE:
			break;
		case JS_CORR_BROKEN:
			value = value > corr->coef[0] ? (value < corr->coef[1] ? 0 :
				((corr->coef[3] * (value - corr->coef[1])) >> 14)) :
				((corr->coef[2] * (value - corr->coef[0])) >> 14);
			break;
		default:
			return 0;
	}

	return value < -32767 ? -32767 : (value > 32767 ? 32767 : value);
}

static void joydev_event(struct input_handle *handle, unsigned int type, unsigned int code, int value)
{
	struct joydev *joydev = handle->private;
	struct joydev_client *client;
	struct js_event event;

	switch (type) {

		case EV_KEY:
			if (code < BTN_MISC || value == 2)
				return;
			event.type = JS_EVENT_BUTTON;
			event.number = joydev->keymap[code - BTN_MISC];
			event.value = value;
			break;

		case EV_ABS:
			event.type = JS_EVENT_AXIS;
			event.number = joydev->absmap[code];
			event.value = joydev_correct(value, joydev->corr + event.number);
			if (event.value == joydev->abs[event.number])
				return;
			joydev->abs[event.number] = event.value;
			break;

		default:
			return;
	}

	event.time = jiffies_to_msecs(jiffies);

	list_for_each_entry(client, &joydev->client_list, node) {

		memcpy(client->buffer + client->head, &event, sizeof(struct js_event));

		if (client->startup == joydev->nabs + joydev->nkey)
			if (client->tail == (client->head = (client->head + 1) & (JOYDEV_BUFFER_SIZE - 1)))
				client->startup = 0;

		kill_fasync(&client->fasync, SIGIO, POLL_IN);
	}

	wake_up_interruptible(&joydev->wait);
}

static int joydev_fasync(int fd, struct file *file, int on)
{
	int retval;
	struct joydev_client *client = file->private_data;

	retval = fasync_helper(fd, file, on, &client->fasync);

	return retval < 0 ? retval : 0;
}

static void joydev_free(struct joydev *joydev)
{
	joydev_table[joydev->minor] = NULL;
	kfree(joydev);
}

static int joydev_release(struct inode *inode, struct file *file)
{
	struct joydev_client *client = file->private_data;
	struct joydev *joydev = client->joydev;

	joydev_fasync(-1, file, 0);

	list_del(&client->node);
	kfree(client);

	if (!--joydev->open) {
		if (joydev->exist)
			input_close_device(&joydev->handle);
		else
			joydev_free(joydev);
	}

	return 0;
}

static int joydev_open(struct inode *inode, struct file *file)
{
	struct joydev_client *client;
	struct joydev *joydev;
	int i = iminor(inode) - JOYDEV_MINOR_BASE;
	int error;

	if (i >= JOYDEV_MINORS)
		return -ENODEV;

	joydev = joydev_table[i];
	if (!joydev || !joydev->exist)
		return -ENODEV;

	client = kzalloc(sizeof(struct joydev_client), GFP_KERNEL);
	if (!client)
		return -ENOMEM;

	client->joydev = joydev;
	list_add_tail(&client->node, &joydev->client_list);

	if (!joydev->open++ && joydev->exist) {
		error = input_open_device(&joydev->handle);
		if (error) {
			list_del(&client->node);
			kfree(client);
			return error;
		}
	}

	file->private_data = client;
	return 0;
}

static ssize_t joydev_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
{
	return -EINVAL;
}

static ssize_t joydev_read(struct file *file, char __user *buf, size_t count, loff_t *ppos)
{
	struct joydev_client *client = file->private_data;
	struct joydev *joydev = client->joydev;
	struct input_dev *input = joydev->handle.dev;
	int retval = 0;

	if (!joydev->exist)
		return -ENODEV;

	if (count < sizeof(struct js_event))
		return -EINVAL;

	if (count == sizeof(struct JS_DATA_TYPE)) {

		struct JS_DATA_TYPE data;
		int i;

		for (data.buttons = i = 0; i < 32 && i < joydev->nkey; i++)
			data.buttons |= test_bit(joydev->keypam[i], input->key) ? (1 << i) : 0;
		data.x = (joydev->abs[0] / 256 + 128) >> joydev->glue.JS_CORR.x;
		data.y = (joydev->abs[1] / 256 + 128) >> joydev->glue.JS_CORR.y;

		if (copy_to_user(buf, &data, sizeof(struct JS_DATA_TYPE)))
			return -EFAULT;

		client->startup = 0;
		client->tail = client->head;

		return sizeof(struct JS_DATA_TYPE);
	}

	if (client->startup == joydev->nabs + joydev->nkey &&
	    client->head == client->tail && (file->f_flags & O_NONBLOCK))
		return -EAGAIN;

	retval = wait_event_interruptible(joydev->wait,
					  !joydev->exist ||
					  client->startup < joydev->nabs + joydev->nkey ||
					  client->head != client->tail);
	if (retval)
		return retval;

	if (!joydev->exist)
		return -ENODEV;

	while (client->startup < joydev->nabs + joydev->nkey && retval + sizeof(struct js_event) <= count) {

		struct js_event event;

		event.time = jiffies_to_msecs(jiffies);

		if (client->startup < joydev->nkey) {
			event.type = JS_EVENT_BUTTON | JS_EVENT_INIT;
			event.number = client->startup;
			event.value = !!test_bit(joydev->keypam[event.number], input->key);
		} else {
			event.type = JS_EVENT_AXIS | JS_EVENT_INIT;
			event.number = client->startup - joydev->nkey;
			event.value = joydev->abs[event.number];
		}

		if (copy_to_user(buf + retval, &event, sizeof(struct js_event)))
			return -EFAULT;

		client->startup++;
		retval += sizeof(struct js_event);
	}

	while (client->head != client->tail && retval + sizeof(struct js_event) <= count) {

		if (copy_to_user(buf + retval, client->buffer + client->tail, sizeof(struct js_event)))
			return -EFAULT;

		client->tail = (client->tail + 1) & (JOYDEV_BUFFER_SIZE - 1);
		retval += sizeof(struct js_event);
	}

	return retval;
}

/* No kernel lock - fine */
static unsigned int joydev_poll(struct file *file, poll_table *wait)
{
	struct joydev_client *client = file->private_data;
	struct joydev *joydev = client->joydev;

	poll_wait(file, &joydev->wait, wait);
	return ((client->head != client->tail || client->startup < joydev->nabs + joydev->nkey) ?
		(POLLIN | POLLRDNORM) : 0) | (joydev->exist ? 0 : (POLLHUP | POLLERR));
}

static int joydev_ioctl_common(struct joydev *joydev, unsigned int cmd, void __user *argp)
{
	struct input_dev *dev = joydev->handle.dev;
	int i, j;

	switch (cmd) {

		case JS_SET_CAL:
			return copy_from_user(&joydev->glue.JS_CORR, argp,
				sizeof(joydev->glue.JS_CORR)) ? -EFAULT : 0;

		case JS_GET_CAL:
			return copy_to_user(argp, &joydev->glue.JS_CORR,
				sizeof(joydev->glue.JS_CORR)) ? -EFAULT : 0;

		case JS_SET_TIMEOUT:
			return get_user(joydev->glue.JS_TIMEOUT, (s32 __user *) argp);

		case JS_GET_TIMEOUT:
			return put_user(joydev->glue.JS_TIMEOUT, (s32 __user *) argp);

		case JSIOCGVERSION:
			return put_user(JS_VERSION, (__u32 __user *) argp);

		case JSIOCGAXES:
			return put_user(joydev->nabs, (__u8 __user *) argp);

		case JSIOCGBUTTONS:
			return put_user(joydev->nkey, (__u8 __user *) argp);

		case JSIOCSCORR:
			if (copy_from_user(joydev->corr, argp,
				      sizeof(joydev->corr[0]) * joydev->nabs))
			    return -EFAULT;
			for (i = 0; i < joydev->nabs; i++) {
				j = joydev->abspam[i];
			        joydev->abs[i] = joydev_correct(dev->abs[j], joydev->corr + i);
			}
			return 0;

		case JSIOCGCORR:
			return copy_to_user(argp, joydev->corr,
						sizeof(joydev->corr[0]) * joydev->nabs) ? -EFAULT : 0;

		case JSIOCSAXMAP:
			if (copy_from_user(joydev->abspam, argp, sizeof(__u8) * (ABS_MAX + 1)))
				return -EFAULT;
			for (i = 0; i < joydev->nabs; i++) {
				if (joydev->abspam[i] > ABS_MAX)
					return -EINVAL;
				joydev->absmap[joydev->abspam[i]] = i;
			}
			return 0;

		case JSIOCGAXMAP:
			return copy_to_user(argp, joydev->abspam,
						sizeof(__u8) * (ABS_MAX + 1)) ? -EFAULT : 0;

		case JSIOCSBTNMAP:
			if (copy_from_user(joydev->keypam, argp, sizeof(__u16) * (KEY_MAX - BTN_MISC + 1)))
				return -EFAULT;
			for (i = 0; i < joydev->nkey; i++) {
				if (joydev->keypam[i] > KEY_MAX || joydev->keypam[i] < BTN_MISC)
					return -EINVAL;
				joydev->keymap[joydev->keypam[i] - BTN_MISC] = i;
			}
			return 0;

		case JSIOCGBTNMAP:
			return copy_to_user(argp, joydev->keypam,
						sizeof(__u16) * (KEY_MAX - BTN_MISC + 1)) ? -EFAULT : 0;

		default:
			if ((cmd & ~(_IOC_SIZEMASK << _IOC_SIZESHIFT)) == JSIOCGNAME(0)) {
				int len;
				if (!dev->name)
					return 0;
				len = strlen(dev->name) + 1;
				if (len > _IOC_SIZE(cmd))
					len = _IOC_SIZE(cmd);
				if (copy_to_user(argp, dev->name, len))
					return -EFAULT;
				return len;
			}
	}
	return -EINVAL;
}

#ifdef CONFIG_COMPAT
static long joydev_compat_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
	struct joydev_client *client = file->private_data;
	struct joydev *joydev = client->joydev;
	void __user *argp = (void __user *)arg;
	s32 tmp32;
	struct JS_DATA_SAVE_TYPE_32 ds32;
	int err;

	if (!joydev->exist)
		return -ENODEV;

	switch(cmd) {
	case JS_SET_TIMELIMIT:
		err = get_user(tmp32, (s32 __user *) arg);
		if (err == 0)
			joydev->glue.JS_TIMELIMIT = tmp32;
		break;
	case JS_GET_TIMELIMIT:
		tmp32 = joydev->glue.JS_TIMELIMIT;
		err = put_user(tmp32, (s32 __user *) arg);
		break;

	case JS_SET_ALL:
		err = copy_from_user(&ds32, argp,
				     sizeof(ds32)) ? -EFAULT : 0;
		if (err == 0) {
			joydev->glue.JS_TIMEOUT    = ds32.JS_TIMEOUT;
			joydev->glue.BUSY          = ds32.BUSY;
			joydev->glue.JS_EXPIRETIME = ds32.JS_EXPIRETIME;
			joydev->glue.JS_TIMELIMIT  = ds32.JS_TIMELIMIT;
			joydev->glue.JS_SAVE       = ds32.JS_SAVE;
			joydev->glue.JS_CORR       = ds32.JS_CORR;
		}
		break;

	case JS_GET_ALL:
		ds32.JS_TIMEOUT    = joydev->glue.JS_TIMEOUT;
		ds32.BUSY          = joydev->glue.BUSY;
		ds32.JS_EXPIRETIME = joydev->glue.JS_EXPIRETIME;
		ds32.JS_TIMELIMIT  = joydev->glue.JS_TIMELIMIT;
		ds32.JS_SAVE       = joydev->glue.JS_SAVE;
		ds32.JS_CORR       = joydev->glue.JS_CORR;

		err = copy_to_user(argp, &ds32, sizeof(ds32)) ? -EFAULT : 0;
		break;

	default:
		err = joydev_ioctl_common(joydev, cmd, argp);
	}
	return err;
}
#endif /* CONFIG_COMPAT */

static int joydev_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
{
	struct joydev_client *client = file->private_data;
	struct joydev *joydev = client->joydev;
	void __user *argp = (void __user *)arg;

	if (!joydev->exist)
		return -ENODEV;

	switch(cmd) {
		case JS_SET_TIMELIMIT:
			return get_user(joydev->glue.JS_TIMELIMIT, (long __user *) arg);
		case JS_GET_TIMELIMIT:
			return put_user(joydev->glue.JS_TIMELIMIT, (long __user *) arg);
		case JS_SET_ALL:
			return copy_from_user(&joydev->glue, argp,
						sizeof(joydev->glue)) ? -EFAULT : 0;
		case JS_GET_ALL:
			return copy_to_user(argp, &joydev->glue,
						sizeof(joydev->glue)) ? -EFAULT : 0;
		default:
			return joydev_ioctl_common(joydev, cmd, argp);
	}
}

static const struct file_operations joydev_fops = {
	.owner =	THIS_MODULE,
	.read =		joydev_read,
	.write =	joydev_write,
	.poll =		joydev_poll,
	.open =		joydev_open,
	.release =	joydev_release,
	.ioctl =	joydev_ioctl,
#ifdef CONFIG_COMPAT
	.compat_ioctl =	joydev_compat_ioctl,
#endif
	.fasync =	joydev_fasync,
};

static int joydev_connect(struct input_handler *handler, struct input_dev *dev,
			  const struct input_device_id *id)
{
	struct joydev *joydev;
	struct class_device *cdev;
	dev_t devt;
	int i, j, t, minor;
	int error;

	for (minor = 0; minor < JOYDEV_MINORS && joydev_table[minor]; minor++);
	if (minor == JOYDEV_MINORS) {
		printk(KERN_ERR "joydev: no more free joydev devices\n");
		return -ENFILE;
	}

	joydev = kzalloc(sizeof(struct joydev), GFP_KERNEL);
	if (!joydev)
		return -ENOMEM;

	INIT_LIST_HEAD(&joydev->client_list);
	init_waitqueue_head(&joydev->wait);

	joydev->minor = minor;
	joydev->exist = 1;
	joydev->handle.dev = dev;
	joydev->handle.name = joydev->name;
	joydev->handle.handler = handler;
	joydev->handle.private = joydev;
	sprintf(joydev->name, "js%d", minor);

	for (i = 0; i < ABS_MAX + 1; i++)
		if (test_bit(i, dev->absbit)) {
			joydev->absmap[i] = joydev->nabs;
			joydev->abspam[joydev->nabs] = i;
			joydev->nabs++;
		}

	for (i = BTN_JOYSTICK - BTN_MISC; i < KEY_MAX - BTN_MISC + 1; i++)
		if (test_bit(i + BTN_MISC, dev->keybit)) {
			joydev->keymap[i] = joydev->nkey;
			joydev->keypam[joydev->nkey] = i + BTN_MISC;
			joydev->nkey++;
		}

	for (i = 0; i < BTN_JOYSTICK - BTN_MISC; i++)
		if (test_bit(i + BTN_MISC, dev->keybit)) {
			joydev->keymap[i] = joydev->nkey;
			joydev->keypam[joydev->nkey] = i + BTN_MISC;
			joydev->nkey++;
		}

	for (i = 0; i < joydev->nabs; i++) {
		j = joydev->abspam[i];
		if (dev->absmax[j] == dev->absmin[j]) {
			joydev->corr[i].type = JS_CORR_NONE;
			joydev->abs[i] = dev->abs[j];
			continue;
		}
		joydev->corr[i].type = JS_CORR_BROKEN;
		joydev->corr[i].prec = dev->absfuzz[j];
		joydev->corr[i].coef[0] = (dev->absmax[j] + dev->absmin[j]) / 2 - dev->absflat[j];
		joydev->corr[i].coef[1] = (dev->absmax[j] + dev->absmin[j]) / 2 + dev->absflat[j];
		if (!(t = ((dev->absmax[j] - dev->absmin[j]) / 2 - 2 * dev->absflat[j])))
			continue;
		joydev->corr[i].coef[2] = (1 << 29) / t;
		joydev->corr[i].coef[3] = (1 << 29) / t;

		joydev->abs[i] = joydev_correct(dev->abs[j], joydev->corr + i);
	}

	joydev_table[minor] = joydev;

	devt = MKDEV(INPUT_MAJOR, JOYDEV_MINOR_BASE + minor),

	cdev = class_device_create(&input_class, &dev->cdev, devt,
				   dev->cdev.dev, joydev->name);
	if (IS_ERR(cdev)) {
		error = PTR_ERR(cdev);
		goto err_free_joydev;
	}

	/* temporary symlink to keep userspace happy */
	error = sysfs_create_link(&input_class.subsys.kobj,
				  &cdev->kobj, joydev->name);
	if (error)
		goto err_cdev_destroy;

	error = input_register_handle(&joydev->handle);
	if (error)
		goto err_remove_link;

	return 0;

 err_remove_link:
	sysfs_remove_link(&input_class.subsys.kobj, joydev->name);
 err_cdev_destroy:
	class_device_destroy(&input_class, devt);
 err_free_joydev:
	joydev_table[minor] = NULL;
	kfree(joydev);
	return error;
}


static void joydev_disconnect(struct input_handle *handle)
{
	struct joydev *joydev = handle->private;
	struct joydev_client *client;

	input_unregister_handle(handle);

	sysfs_remove_link(&input_class.subsys.kobj, joydev->name);
	class_device_destroy(&input_class, MKDEV(INPUT_MAJOR, JOYDEV_MINOR_BASE + joydev->minor));
	joydev->exist = 0;

	if (joydev->open) {
		input_close_device(handle);
		list_for_each_entry(client, &joydev->client_list, node)
			kill_fasync(&client->fasync, SIGIO, POLL_HUP);
		wake_up_interruptible(&joydev->wait);
	} else
		joydev_free(joydev);
}

static const struct input_device_id joydev_blacklist[] = {
	{
		.flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_KEYBIT,
		.evbit = { BIT(EV_KEY) },
		.keybit = { [LONG(BTN_TOUCH)] = BIT(BTN_TOUCH) },
	},	/* Avoid itouchpads, touchscreens and tablets */
	{ }	/* Terminating entry */
};

static const struct input_device_id joydev_ids[] = {
	{
		.flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_ABSBIT,
		.evbit = { BIT(EV_ABS) },
		.absbit = { BIT(ABS_X) },
	},
	{
		.flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_ABSBIT,
		.evbit = { BIT(EV_ABS) },
		.absbit = { BIT(ABS_WHEEL) },
	},
	{
		.flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_ABSBIT,
		.evbit = { BIT(EV_ABS) },
		.absbit = { BIT(ABS_THROTTLE) },
	},
	{ }	/* Terminating entry */
};

MODULE_DEVICE_TABLE(input, joydev_ids);

static struct input_handler joydev_handler = {
	.event =	joydev_event,
	.connect =	joydev_connect,
	.disconnect =	joydev_disconnect,
	.fops =		&joydev_fops,
	.minor =	JOYDEV_MINOR_BASE,
	.name =		"joydev",
	.id_table =	joydev_ids,
	.blacklist =	joydev_blacklist,
};

static int __init joydev_init(void)
{
	return input_register_handler(&joydev_handler);
}

static void __exit joydev_exit(void)
{
	input_unregister_handler(&joydev_handler);
}

module_init(joydev_init);
module_exit(joydev_exit);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* Joystick device driver for the input driver suite.
	3	*
	4	* Copyright (c) 1999-2002 Vojtech Pavlik
	5	* Copyright (c) 1999 Colin Van Dyke
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License as published by
	9	* the Free Software Foundation; either version 2 of the License, or
	10	* (at your option) any later version.
	11	*/
	12
	13	#include <asm/io.h>
	14	#include <asm/system.h>
	15	#include <linux/delay.h>
	16	#include <linux/errno.h>
	17	#include <linux/joystick.h>
	18	#include <linux/input.h>
	19	#include <linux/kernel.h>
	20	#include <linux/major.h>
	21	#include <linux/slab.h>
	22	#include <linux/mm.h>
	23	#include <linux/miscdevice.h>
	24	#include <linux/module.h>
	25	#include <linux/poll.h>
	26	#include <linux/init.h>
1da177e4	27	#include <linux/device.h>
1da177e4 LT	28
	29	MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
	30	MODULE_DESCRIPTION("Joystick device interfaces");
	31	MODULE_SUPPORTED_DEVICE("input/js");
	32	MODULE_LICENSE("GPL");
	33
	34	#define JOYDEV_MINOR_BASE 0
	35	#define JOYDEV_MINORS 16
	36	#define JOYDEV_BUFFER_SIZE 64
	37
1da177e4 LT	38	struct joydev {
	39	int exist;
	40	int open;
	41	int minor;
	42	char name[16];
	43	struct input_handle handle;
	44	wait_queue_head_t wait;
d0ffb9be	45	struct list_head client_list;
1da177e4 LT	46	struct js_corr corr[ABS_MAX + 1];
	47	struct JS_DATA_SAVE_TYPE glue;
	48	int nabs;
	49	int nkey;
	50	__u16 keymap[KEY_MAX - BTN_MISC + 1];
	51	__u16 keypam[KEY_MAX - BTN_MISC + 1];
	52	__u8 absmap[ABS_MAX + 1];
	53	__u8 abspam[ABS_MAX + 1];
	54	__s16 abs[ABS_MAX + 1];
	55	};
	56
d0ffb9be	57	struct joydev_client {
1da177e4 LT	58	struct js_event buffer[JOYDEV_BUFFER_SIZE];
	59	int head;
	60	int tail;
	61	int startup;
	62	struct fasync_struct *fasync;
	63	struct joydev *joydev;
	64	struct list_head node;
	65	};
	66
	67	static struct joydev *joydev_table[JOYDEV_MINORS];
	68
	69	static int joydev_correct(int value, struct js_corr *corr)
	70	{
	71	switch (corr->type) {
	72	case JS_CORR_NONE:
	73	break;
	74	case JS_CORR_BROKEN:
	75	value = value > corr->coef[0] ? (value < corr->coef[1] ? 0 :
	76	((corr->coef[3] * (value - corr->coef[1])) >> 14)) :
	77	((corr->coef[2] * (value - corr->coef[0])) >> 14);
	78	break;
	79	default:
	80	return 0;
	81	}
	82
1e0afb28	83	return value < -32767 ? -32767 : (value > 32767 ? 32767 : value);
1da177e4 LT	84	}
	85
	86	static void joydev_event(struct input_handle *handle, unsigned int type, unsigned int code, int value)
	87	{
	88	struct joydev *joydev = handle->private;
d0ffb9be	89	struct joydev_client *client;
1da177e4 LT	90	struct js_event event;
	91
	92	switch (type) {
	93
	94	case EV_KEY:
1e0afb28 DT	95	if (code < BTN_MISC \|\| value == 2)
1e0afb28 DT	96	return;
1da177e4 LT	97	event.type = JS_EVENT_BUTTON;
	98	event.number = joydev->keymap[code - BTN_MISC];
	99	event.value = value;
	100	break;
	101
	102	case EV_ABS:
	103	event.type = JS_EVENT_AXIS;
	104	event.number = joydev->absmap[code];
	105	event.value = joydev_correct(value, joydev->corr + event.number);
1e0afb28 DT	106	if (event.value == joydev->abs[event.number])
1e0afb28 DT	107	return;
1da177e4 LT	108	joydev->abs[event.number] = event.value;
	109	break;
	110
	111	default:
	112	return;
	113	}
	114
6f5eacfc	115	event.time = jiffies_to_msecs(jiffies);
1da177e4	116
d0ffb9be	117	list_for_each_entry(client, &joydev->client_list, node) {
1da177e4	118
d0ffb9be	119	memcpy(client->buffer + client->head, &event, sizeof(struct js_event));
1da177e4	120
d0ffb9be DT	121	if (client->startup == joydev->nabs + joydev->nkey)
	122	if (client->tail == (client->head = (client->head + 1) & (JOYDEV_BUFFER_SIZE - 1)))
	123	client->startup = 0;
1da177e4	124
d0ffb9be	125	kill_fasync(&client->fasync, SIGIO, POLL_IN);
1da177e4 LT	126	}
	127
	128	wake_up_interruptible(&joydev->wait);
	129	}
	130
	131	static int joydev_fasync(int fd, struct file *file, int on)
	132	{
	133	int retval;
d0ffb9be	134	struct joydev_client *client = file->private_data;
1e0afb28	135
d0ffb9be	136	retval = fasync_helper(fd, file, on, &client->fasync);
1e0afb28	137
1da177e4 LT	138	return retval < 0 ? retval : 0;
	139	}
	140
	141	static void joydev_free(struct joydev *joydev)
	142	{
	143	joydev_table[joydev->minor] = NULL;
	144	kfree(joydev);
	145	}
	146
d0ffb9be	147	static int joydev_release(struct inode inode, struct file file)
1da177e4	148	{
d0ffb9be DT	149	struct joydev_client *client = file->private_data;
d0ffb9be DT	150	struct joydev *joydev = client->joydev;
1da177e4 LT	151
	152	joydev_fasync(-1, file, 0);
	153
d0ffb9be DT	154	list_del(&client->node);
d0ffb9be DT	155	kfree(client);
1da177e4	156
d0ffb9be DT	157	if (!--joydev->open) {
	158	if (joydev->exist)
	159	input_close_device(&joydev->handle);
1da177e4	160	else
d0ffb9be	161	joydev_free(joydev);
1da177e4 LT	162	}
1da177e4 LT	163
1da177e4 LT	164	return 0;
	165	}
	166
	167	static int joydev_open(struct inode inode, struct file file)
	168	{
d0ffb9be DT	169	struct joydev_client *client;
d0ffb9be DT	170	struct joydev *joydev;
1da177e4	171	int i = iminor(inode) - JOYDEV_MINOR_BASE;
d542ed82	172	int error;
1da177e4	173
d0ffb9be DT	174	if (i >= JOYDEV_MINORS)
d0ffb9be DT	175	return -ENODEV;
1da177e4	176
d0ffb9be DT	177	joydev = joydev_table[i];
d0ffb9be DT	178	if (!joydev \|\| !joydev->exist)
1da177e4 LT	179	return -ENODEV;
1da177e4 LT	180
d0ffb9be DT	181	client = kzalloc(sizeof(struct joydev_client), GFP_KERNEL);
d0ffb9be DT	182	if (!client)
1da177e4	183	return -ENOMEM;
1da177e4	184
d0ffb9be DT	185	client->joydev = joydev;
d0ffb9be DT	186	list_add_tail(&client->node, &joydev->client_list);
1da177e4	187
d542ed82 DT	188	if (!joydev->open++ && joydev->exist) {
	189	error = input_open_device(&joydev->handle);
	190	if (error) {
	191	list_del(&client->node);
	192	kfree(client);
	193	return error;
	194	}
	195	}
1da177e4	196
d0ffb9be	197	file->private_data = client;
1da177e4 LT	198	return 0;
	199	}
	200
d0ffb9be	201	static ssize_t joydev_write(struct file file, const char __user buffer, size_t count, loff_t *ppos)
1da177e4 LT	202	{
	203	return -EINVAL;
	204	}
	205
	206	static ssize_t joydev_read(struct file file, char __user buf, size_t count, loff_t *ppos)
	207	{
d0ffb9be DT	208	struct joydev_client *client = file->private_data;
d0ffb9be DT	209	struct joydev *joydev = client->joydev;
1da177e4 LT	210	struct input_dev *input = joydev->handle.dev;
	211	int retval = 0;
	212
d0ffb9be	213	if (!joydev->exist)
1da177e4 LT	214	return -ENODEV;
	215
	216	if (count < sizeof(struct js_event))
	217	return -EINVAL;
	218
	219	if (count == sizeof(struct JS_DATA_TYPE)) {
	220
	221	struct JS_DATA_TYPE data;
	222	int i;
	223
	224	for (data.buttons = i = 0; i < 32 && i < joydev->nkey; i++)
	225	data.buttons \|= test_bit(joydev->keypam[i], input->key) ? (1 << i) : 0;
	226	data.x = (joydev->abs[0] / 256 + 128) >> joydev->glue.JS_CORR.x;
	227	data.y = (joydev->abs[1] / 256 + 128) >> joydev->glue.JS_CORR.y;
	228
	229	if (copy_to_user(buf, &data, sizeof(struct JS_DATA_TYPE)))
	230	return -EFAULT;
	231
d0ffb9be DT	232	client->startup = 0;
d0ffb9be DT	233	client->tail = client->head;
1da177e4 LT	234
	235	return sizeof(struct JS_DATA_TYPE);
	236	}
	237
d0ffb9be DT	238	if (client->startup == joydev->nabs + joydev->nkey &&
d0ffb9be DT	239	client->head == client->tail && (file->f_flags & O_NONBLOCK))
1e0afb28	240	return -EAGAIN;
1da177e4	241
d0ffb9be DT	242	retval = wait_event_interruptible(joydev->wait,
	243	!joydev->exist \|\|
	244	client->startup < joydev->nabs + joydev->nkey \|\|
	245	client->head != client->tail);
1da177e4 LT	246	if (retval)
	247	return retval;
	248
d0ffb9be	249	if (!joydev->exist)
1da177e4 LT	250	return -ENODEV;
1da177e4 LT	251
d0ffb9be	252	while (client->startup < joydev->nabs + joydev->nkey && retval + sizeof(struct js_event) <= count) {
1da177e4 LT	253
	254	struct js_event event;
	255
6f5eacfc	256	event.time = jiffies_to_msecs(jiffies);
1da177e4	257
d0ffb9be	258	if (client->startup < joydev->nkey) {
1da177e4	259	event.type = JS_EVENT_BUTTON \| JS_EVENT_INIT;
d0ffb9be	260	event.number = client->startup;
1da177e4 LT	261	event.value = !!test_bit(joydev->keypam[event.number], input->key);
	262	} else {
	263	event.type = JS_EVENT_AXIS \| JS_EVENT_INIT;
d0ffb9be	264	event.number = client->startup - joydev->nkey;
1da177e4 LT	265	event.value = joydev->abs[event.number];
	266	}
	267
	268	if (copy_to_user(buf + retval, &event, sizeof(struct js_event)))
	269	return -EFAULT;
	270
d0ffb9be	271	client->startup++;
1da177e4 LT	272	retval += sizeof(struct js_event);
	273	}
	274
d0ffb9be	275	while (client->head != client->tail && retval + sizeof(struct js_event) <= count) {
1da177e4	276
d0ffb9be	277	if (copy_to_user(buf + retval, client->buffer + client->tail, sizeof(struct js_event)))
1da177e4 LT	278	return -EFAULT;
1da177e4 LT	279
d0ffb9be	280	client->tail = (client->tail + 1) & (JOYDEV_BUFFER_SIZE - 1);
1da177e4 LT	281	retval += sizeof(struct js_event);
	282	}
	283
	284	return retval;
	285	}
	286
	287	/* No kernel lock - fine */
	288	static unsigned int joydev_poll(struct file file, poll_table wait)
	289	{
d0ffb9be DT	290	struct joydev_client *client = file->private_data;
d0ffb9be DT	291	struct joydev *joydev = client->joydev;
1e0afb28	292
d0ffb9be DT	293	poll_wait(file, &joydev->wait, wait);
	294	return ((client->head != client->tail \|\| client->startup < joydev->nabs + joydev->nkey) ?
	295	(POLLIN \| POLLRDNORM) : 0) \| (joydev->exist ? 0 : (POLLHUP \| POLLERR));
1da177e4 LT	296	}
1da177e4 LT	297
024ac44c	298	static int joydev_ioctl_common(struct joydev joydev, unsigned int cmd, void __user argp)
1da177e4	299	{
1da177e4	300	struct input_dev *dev = joydev->handle.dev;
1da177e4 LT	301	int i, j;
1da177e4 LT	302
1da177e4 LT	303	switch (cmd) {
	304
	305	case JS_SET_CAL:
	306	return copy_from_user(&joydev->glue.JS_CORR, argp,
024ac44c	307	sizeof(joydev->glue.JS_CORR)) ? -EFAULT : 0;
1e0afb28	308
1da177e4 LT	309	case JS_GET_CAL:
1da177e4 LT	310	return copy_to_user(argp, &joydev->glue.JS_CORR,
024ac44c	311	sizeof(joydev->glue.JS_CORR)) ? -EFAULT : 0;
1e0afb28	312
1da177e4	313	case JS_SET_TIMEOUT:
024ac44c	314	return get_user(joydev->glue.JS_TIMEOUT, (s32 __user *) argp);
1e0afb28	315
1da177e4	316	case JS_GET_TIMEOUT:
024ac44c	317	return put_user(joydev->glue.JS_TIMEOUT, (s32 __user *) argp);
1da177e4 LT	318
1da177e4 LT	319	case JSIOCGVERSION:
024ac44c	320	return put_user(JS_VERSION, (__u32 __user *) argp);
1e0afb28	321
1da177e4	322	case JSIOCGAXES:
024ac44c	323	return put_user(joydev->nabs, (__u8 __user *) argp);
1e0afb28	324
1da177e4	325	case JSIOCGBUTTONS:
024ac44c	326	return put_user(joydev->nkey, (__u8 __user *) argp);
1e0afb28	327
1da177e4 LT	328	case JSIOCSCORR:
1da177e4 LT	329	if (copy_from_user(joydev->corr, argp,
024ac44c	330	sizeof(joydev->corr[0]) * joydev->nabs))
1da177e4 LT	331	return -EFAULT;
	332	for (i = 0; i < joydev->nabs; i++) {
	333	j = joydev->abspam[i];
	334	joydev->abs[i] = joydev_correct(dev->abs[j], joydev->corr + i);
	335	}
	336	return 0;
1e0afb28	337
1da177e4 LT	338	case JSIOCGCORR:
1da177e4 LT	339	return copy_to_user(argp, joydev->corr,
024ac44c	340	sizeof(joydev->corr[0]) * joydev->nabs) ? -EFAULT : 0;
1e0afb28	341
1da177e4 LT	342	case JSIOCSAXMAP:
	343	if (copy_from_user(joydev->abspam, argp, sizeof(__u8) * (ABS_MAX + 1)))
	344	return -EFAULT;
	345	for (i = 0; i < joydev->nabs; i++) {
1e0afb28 DT	346	if (joydev->abspam[i] > ABS_MAX)
1e0afb28 DT	347	return -EINVAL;
1da177e4 LT	348	joydev->absmap[joydev->abspam[i]] = i;
	349	}
	350	return 0;
1e0afb28	351
1da177e4 LT	352	case JSIOCGAXMAP:
	353	return copy_to_user(argp, joydev->abspam,
	354	sizeof(__u8) * (ABS_MAX + 1)) ? -EFAULT : 0;
1e0afb28	355
1da177e4 LT	356	case JSIOCSBTNMAP:
	357	if (copy_from_user(joydev->keypam, argp, sizeof(__u16) * (KEY_MAX - BTN_MISC + 1)))
	358	return -EFAULT;
	359	for (i = 0; i < joydev->nkey; i++) {
1e0afb28 DT	360	if (joydev->keypam[i] > KEY_MAX \|\| joydev->keypam[i] < BTN_MISC)
1e0afb28 DT	361	return -EINVAL;
1da177e4 LT	362	joydev->keymap[joydev->keypam[i] - BTN_MISC] = i;
	363	}
	364	return 0;
1e0afb28	365
1da177e4 LT	366	case JSIOCGBTNMAP:
	367	return copy_to_user(argp, joydev->keypam,
	368	sizeof(__u16) * (KEY_MAX - BTN_MISC + 1)) ? -EFAULT : 0;
1e0afb28	369
1da177e4 LT	370	default:
	371	if ((cmd & ~(_IOC_SIZEMASK << _IOC_SIZESHIFT)) == JSIOCGNAME(0)) {
	372	int len;
1e0afb28 DT	373	if (!dev->name)
1e0afb28 DT	374	return 0;
1da177e4	375	len = strlen(dev->name) + 1;
1e0afb28 DT	376	if (len > _IOC_SIZE(cmd))
	377	len = _IOC_SIZE(cmd);
	378	if (copy_to_user(argp, dev->name, len))
	379	return -EFAULT;
1da177e4 LT	380	return len;
	381	}
	382	}
	383	return -EINVAL;
	384	}
	385
024ac44c JF	386	#ifdef CONFIG_COMPAT
	387	static long joydev_compat_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
	388	{
d0ffb9be DT	389	struct joydev_client *client = file->private_data;
d0ffb9be DT	390	struct joydev *joydev = client->joydev;
024ac44c JF	391	void __user argp = (void __user )arg;
	392	s32 tmp32;
	393	struct JS_DATA_SAVE_TYPE_32 ds32;
	394	int err;
	395
1e0afb28 DT	396	if (!joydev->exist)
	397	return -ENODEV;
	398
024ac44c JF	399	switch(cmd) {
	400	case JS_SET_TIMELIMIT:
	401	err = get_user(tmp32, (s32 __user *) arg);
	402	if (err == 0)
	403	joydev->glue.JS_TIMELIMIT = tmp32;
	404	break;
	405	case JS_GET_TIMELIMIT:
	406	tmp32 = joydev->glue.JS_TIMELIMIT;
	407	err = put_user(tmp32, (s32 __user *) arg);
	408	break;
	409
	410	case JS_SET_ALL:
	411	err = copy_from_user(&ds32, argp,
	412	sizeof(ds32)) ? -EFAULT : 0;
	413	if (err == 0) {
	414	joydev->glue.JS_TIMEOUT = ds32.JS_TIMEOUT;
	415	joydev->glue.BUSY = ds32.BUSY;
	416	joydev->glue.JS_EXPIRETIME = ds32.JS_EXPIRETIME;
	417	joydev->glue.JS_TIMELIMIT = ds32.JS_TIMELIMIT;
	418	joydev->glue.JS_SAVE = ds32.JS_SAVE;
	419	joydev->glue.JS_CORR = ds32.JS_CORR;
	420	}
	421	break;
	422
	423	case JS_GET_ALL:
	424	ds32.JS_TIMEOUT = joydev->glue.JS_TIMEOUT;
	425	ds32.BUSY = joydev->glue.BUSY;
	426	ds32.JS_EXPIRETIME = joydev->glue.JS_EXPIRETIME;
	427	ds32.JS_TIMELIMIT = joydev->glue.JS_TIMELIMIT;
	428	ds32.JS_SAVE = joydev->glue.JS_SAVE;
	429	ds32.JS_CORR = joydev->glue.JS_CORR;
	430
1e0afb28	431	err = copy_to_user(argp, &ds32, sizeof(ds32)) ? -EFAULT : 0;
024ac44c JF	432	break;
	433
	434	default:
	435	err = joydev_ioctl_common(joydev, cmd, argp);
	436	}
	437	return err;
	438	}
	439	#endif /* CONFIG_COMPAT */
	440
	441	static int joydev_ioctl(struct inode inode, struct file file, unsigned int cmd, unsigned long arg)
	442	{
d0ffb9be DT	443	struct joydev_client *client = file->private_data;
d0ffb9be DT	444	struct joydev *joydev = client->joydev;
024ac44c JF	445	void __user argp = (void __user )arg;
024ac44c JF	446
1e0afb28 DT	447	if (!joydev->exist)
1e0afb28 DT	448	return -ENODEV;
024ac44c JF	449
	450	switch(cmd) {
	451	case JS_SET_TIMELIMIT:
	452	return get_user(joydev->glue.JS_TIMELIMIT, (long __user *) arg);
	453	case JS_GET_TIMELIMIT:
	454	return put_user(joydev->glue.JS_TIMELIMIT, (long __user *) arg);
	455	case JS_SET_ALL:
	456	return copy_from_user(&joydev->glue, argp,
	457	sizeof(joydev->glue)) ? -EFAULT : 0;
	458	case JS_GET_ALL:
	459	return copy_to_user(argp, &joydev->glue,
	460	sizeof(joydev->glue)) ? -EFAULT : 0;
	461	default:
	462	return joydev_ioctl_common(joydev, cmd, argp);
	463	}
	464	}
	465
66e66118	466	static const struct file_operations joydev_fops = {
1da177e4 LT	467	.owner = THIS_MODULE,
	468	.read = joydev_read,
	469	.write = joydev_write,
	470	.poll = joydev_poll,
	471	.open = joydev_open,
	472	.release = joydev_release,
	473	.ioctl = joydev_ioctl,
024ac44c JF	474	#ifdef CONFIG_COMPAT
	475	.compat_ioctl = joydev_compat_ioctl,
	476	#endif
1da177e4 LT	477	.fasync = joydev_fasync,
	478	};
	479
5b2a0826 DT	480	static int joydev_connect(struct input_handler handler, struct input_dev dev,
5b2a0826 DT	481	const struct input_device_id *id)
1da177e4 LT	482	{
1da177e4 LT	483	struct joydev *joydev;
c9bcd582	484	struct class_device *cdev;
5b2a0826	485	dev_t devt;
1da177e4	486	int i, j, t, minor;
5b2a0826	487	int error;
1da177e4 LT	488
	489	for (minor = 0; minor < JOYDEV_MINORS && joydev_table[minor]; minor++);
	490	if (minor == JOYDEV_MINORS) {
	491	printk(KERN_ERR "joydev: no more free joydev devices\n");
5b2a0826	492	return -ENFILE;
1da177e4 LT	493	}
1da177e4 LT	494
5b2a0826 DT	495	joydev = kzalloc(sizeof(struct joydev), GFP_KERNEL);
	496	if (!joydev)
	497	return -ENOMEM;
1da177e4	498
d0ffb9be	499	INIT_LIST_HEAD(&joydev->client_list);
1da177e4 LT	500	init_waitqueue_head(&joydev->wait);
	501
	502	joydev->minor = minor;
	503	joydev->exist = 1;
	504	joydev->handle.dev = dev;
	505	joydev->handle.name = joydev->name;
	506	joydev->handle.handler = handler;
	507	joydev->handle.private = joydev;
	508	sprintf(joydev->name, "js%d", minor);
	509
	510	for (i = 0; i < ABS_MAX + 1; i++)
	511	if (test_bit(i, dev->absbit)) {
	512	joydev->absmap[i] = joydev->nabs;
	513	joydev->abspam[joydev->nabs] = i;
	514	joydev->nabs++;
	515	}
	516
	517	for (i = BTN_JOYSTICK - BTN_MISC; i < KEY_MAX - BTN_MISC + 1; i++)
	518	if (test_bit(i + BTN_MISC, dev->keybit)) {
	519	joydev->keymap[i] = joydev->nkey;
	520	joydev->keypam[joydev->nkey] = i + BTN_MISC;
	521	joydev->nkey++;
	522	}
	523
f24949e8	524	for (i = 0; i < BTN_JOYSTICK - BTN_MISC; i++)
1da177e4 LT	525	if (test_bit(i + BTN_MISC, dev->keybit)) {
	526	joydev->keymap[i] = joydev->nkey;
	527	joydev->keypam[joydev->nkey] = i + BTN_MISC;
	528	joydev->nkey++;
	529	}
	530
	531	for (i = 0; i < joydev->nabs; i++) {
	532	j = joydev->abspam[i];
	533	if (dev->absmax[j] == dev->absmin[j]) {
	534	joydev->corr[i].type = JS_CORR_NONE;
	535	joydev->abs[i] = dev->abs[j];
	536	continue;
	537	}
	538	joydev->corr[i].type = JS_CORR_BROKEN;
	539	joydev->corr[i].prec = dev->absfuzz[j];
	540	joydev->corr[i].coef[0] = (dev->absmax[j] + dev->absmin[j]) / 2 - dev->absflat[j];
	541	joydev->corr[i].coef[1] = (dev->absmax[j] + dev->absmin[j]) / 2 + dev->absflat[j];
	542	if (!(t = ((dev->absmax[j] - dev->absmin[j]) / 2 - 2 * dev->absflat[j])))
	543	continue;
	544	joydev->corr[i].coef[2] = (1 << 29) / t;
	545	joydev->corr[i].coef[3] = (1 << 29) / t;
	546
	547	joydev->abs[i] = joydev_correct(dev->abs[j], joydev->corr + i);
	548	}
	549
	550	joydev_table[minor] = joydev;
	551
5b2a0826 DT	552	devt = MKDEV(INPUT_MAJOR, JOYDEV_MINOR_BASE + minor),
	553
	554	cdev = class_device_create(&input_class, &dev->cdev, devt,
	555	dev->cdev.dev, joydev->name);
	556	if (IS_ERR(cdev)) {
	557	error = PTR_ERR(cdev);
	558	goto err_free_joydev;
	559	}
c9bcd582 GKH	560
c9bcd582 GKH	561	/* temporary symlink to keep userspace happy */
a3d52136	562	error = sysfs_create_link(&input_class.subsys.kobj,
5b2a0826 DT	563	&cdev->kobj, joydev->name);
	564	if (error)
	565	goto err_cdev_destroy;
	566
	567	error = input_register_handle(&joydev->handle);
	568	if (error)
	569	goto err_remove_link;
	570
	571	return 0;
1da177e4	572
5b2a0826	573	err_remove_link:
a3d52136	574	sysfs_remove_link(&input_class.subsys.kobj, joydev->name);
5b2a0826 DT	575	err_cdev_destroy:
	576	class_device_destroy(&input_class, devt);
	577	err_free_joydev:
	578	joydev_table[minor] = NULL;
	579	kfree(joydev);
	580	return error;
1da177e4 LT	581	}
1da177e4 LT	582
5b2a0826	583
1da177e4 LT	584	static void joydev_disconnect(struct input_handle *handle)
	585	{
	586	struct joydev *joydev = handle->private;
d0ffb9be	587	struct joydev_client *client;
1da177e4	588
5b2a0826	589	input_unregister_handle(handle);
1da177e4	590
823bccfc	591	sysfs_remove_link(&input_class.subsys.kobj, joydev->name);
ea9f240b	592	class_device_destroy(&input_class, MKDEV(INPUT_MAJOR, JOYDEV_MINOR_BASE + joydev->minor));
1da177e4 LT	593	joydev->exist = 0;
	594
	595	if (joydev->open) {
	596	input_close_device(handle);
d0ffb9be DT	597	list_for_each_entry(client, &joydev->client_list, node)
d0ffb9be DT	598	kill_fasync(&client->fasync, SIGIO, POLL_HUP);
1dfa2812	599	wake_up_interruptible(&joydev->wait);
1da177e4 LT	600	} else
	601	joydev_free(joydev);
	602	}
	603
66e66118	604	static const struct input_device_id joydev_blacklist[] = {
1da177e4 LT	605	{
	606	.flags = INPUT_DEVICE_ID_MATCH_EVBIT \| INPUT_DEVICE_ID_MATCH_KEYBIT,
	607	.evbit = { BIT(EV_KEY) },
	608	.keybit = { [LONG(BTN_TOUCH)] = BIT(BTN_TOUCH) },
1e0afb28 DT	609	}, /* Avoid itouchpads, touchscreens and tablets */
1e0afb28 DT	610	{ } /* Terminating entry */
1da177e4 LT	611	};
1da177e4 LT	612
66e66118	613	static const struct input_device_id joydev_ids[] = {
1da177e4 LT	614	{
	615	.flags = INPUT_DEVICE_ID_MATCH_EVBIT \| INPUT_DEVICE_ID_MATCH_ABSBIT,
	616	.evbit = { BIT(EV_ABS) },
	617	.absbit = { BIT(ABS_X) },
	618	},
	619	{
	620	.flags = INPUT_DEVICE_ID_MATCH_EVBIT \| INPUT_DEVICE_ID_MATCH_ABSBIT,
	621	.evbit = { BIT(EV_ABS) },
	622	.absbit = { BIT(ABS_WHEEL) },
	623	},
	624	{
	625	.flags = INPUT_DEVICE_ID_MATCH_EVBIT \| INPUT_DEVICE_ID_MATCH_ABSBIT,
	626	.evbit = { BIT(EV_ABS) },
	627	.absbit = { BIT(ABS_THROTTLE) },
	628	},
1e0afb28	629	{ } /* Terminating entry */
1da177e4 LT	630	};
	631
	632	MODULE_DEVICE_TABLE(input, joydev_ids);
	633
	634	static struct input_handler joydev_handler = {
	635	.event = joydev_event,
	636	.connect = joydev_connect,
	637	.disconnect = joydev_disconnect,
	638	.fops = &joydev_fops,
	639	.minor = JOYDEV_MINOR_BASE,
	640	.name = "joydev",
	641	.id_table = joydev_ids,
1e0afb28	642	.blacklist = joydev_blacklist,
1da177e4 LT	643	};
	644
	645	static int __init joydev_init(void)
	646	{
4263cf0f	647	return input_register_handler(&joydev_handler);
1da177e4 LT	648	}
	649
	650	static void __exit joydev_exit(void)
	651	{
	652	input_unregister_handler(&joydev_handler);
	653	}
	654
	655	module_init(joydev_init);
	656	module_exit(joydev_exit);