[linux-2.6-block.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/smp_lock.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 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_list {
	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_list *list;
	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(list, &joydev->list, node) {

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

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

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

	wake_up_interruptible(&joydev->wait);
}

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

	retval = fasync_helper(fd, file, on, &list->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_list *list = file->private_data;

	joydev_fasync(-1, file, 0);

	list_del(&list->node);

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

	kfree(list);
	return 0;
}

static int joydev_open(struct inode *inode, struct file *file)
{
	struct joydev_list *list;
	int i = iminor(inode) - JOYDEV_MINOR_BASE;

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

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

	list->joydev = joydev_table[i];
	list_add_tail(&list->node, &joydev_table[i]->list);
	file->private_data = list;

	if (!list->joydev->open++)
		if (list->joydev->exist)
			input_open_device(&list->joydev->handle);

	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_list *list = file->private_data;
	struct joydev *joydev = list->joydev;
	struct input_dev *input = joydev->handle.dev;
	int retval = 0;

	if (!list->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;

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

		return sizeof(struct JS_DATA_TYPE);
	}

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

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

	if (retval)
		return retval;

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

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

		struct js_event event;

		event.time = jiffies_to_msecs(jiffies);

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

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

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

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

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

		list->tail = (list->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_list *list = file->private_data;

	poll_wait(file, &list->joydev->wait, wait);
	return ((list->head != list->tail || list->startup < list->joydev->nabs + list->joydev->nkey) ?
		(POLLIN | POLLRDNORM) : 0) | (list->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_list *list = file->private_data;
	struct joydev *joydev = list->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_list *list = file->private_data;
	struct joydev *joydev = list->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->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.kset.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.kset.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_list *list;

	input_unregister_handle(handle);

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