[mirror_ubuntu-artful-kernel.git] / drivers / input / serio / serio_raw.c

/*
 * Raw serio device providing access to a raw byte stream from underlying
 * serio port. Closely emulates behavior of pre-2.6 /dev/psaux device
 *
 * Copyright (c) 2004 Dmitry Torokhov
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published by
 * the Free Software Foundation.
 */

#include <linux/kref.h>
#include <linux/sched.h>
#include <linux/slab.h>
#include <linux/poll.h>
#include <linux/module.h>
#include <linux/serio.h>
#include <linux/init.h>
#include <linux/major.h>
#include <linux/device.h>
#include <linux/miscdevice.h>
#include <linux/wait.h>
#include <linux/mutex.h>

#define DRIVER_DESC	"Raw serio driver"

MODULE_AUTHOR("Dmitry Torokhov <dtor@mail.ru>");
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE("GPL");

#define SERIO_RAW_QUEUE_LEN	64
struct serio_raw {
	unsigned char queue[SERIO_RAW_QUEUE_LEN];
	unsigned int tail, head;

	char name[16];
	struct kref kref;
	struct serio *serio;
	struct miscdevice dev;
	wait_queue_head_t wait;
	struct list_head client_list;
	struct list_head node;
};

struct serio_raw_client {
	struct fasync_struct *fasync;
	struct serio_raw *serio_raw;
	struct list_head node;
};

static DEFINE_MUTEX(serio_raw_mutex);
static LIST_HEAD(serio_raw_list);
static unsigned int serio_raw_no;

/*********************************************************************
 *             Interface with userspace (file operations)            *
 *********************************************************************/

static int serio_raw_fasync(int fd, struct file *file, int on)
{
	struct serio_raw_client *client = file->private_data;

	return fasync_helper(fd, file, on, &client->fasync);
}

static struct serio_raw *serio_raw_locate(int minor)
{
	struct serio_raw *serio_raw;

	list_for_each_entry(serio_raw, &serio_raw_list, node) {
		if (serio_raw->dev.minor == minor)
			return serio_raw;
	}

	return NULL;
}

static int serio_raw_open(struct inode *inode, struct file *file)
{
	struct serio_raw *serio_raw;
	struct serio_raw_client *client;
	int retval;

	retval = mutex_lock_interruptible(&serio_raw_mutex);
	if (retval)
		return retval;

	serio_raw = serio_raw_locate(iminor(inode));
	if (!serio_raw) {
		retval = -ENODEV;
		goto out;
	}

	if (!serio_raw->serio) {
		retval = -ENODEV;
		goto out;
	}

	client = kzalloc(sizeof(struct serio_raw_client), GFP_KERNEL);
	if (!client) {
		retval = -ENOMEM;
		goto out;
	}

	client->serio_raw = serio_raw;
	file->private_data = client;

	kref_get(&serio_raw->kref);
	list_add_tail(&client->node, &serio_raw->client_list);

out:
	mutex_unlock(&serio_raw_mutex);
	return retval;
}

static void serio_raw_cleanup(struct kref *kref)
{
	struct serio_raw *serio_raw =
			container_of(kref, struct serio_raw, kref);

	misc_deregister(&serio_raw->dev);
	list_del_init(&serio_raw->node);
	kfree(serio_raw);
}

static int serio_raw_release(struct inode *inode, struct file *file)
{
	struct serio_raw_client *client = file->private_data;
	struct serio_raw *serio_raw = client->serio_raw;

	mutex_lock(&serio_raw_mutex);

	kref_put(&serio_raw->kref, serio_raw_cleanup);

	mutex_unlock(&serio_raw_mutex);
	return 0;
}

static int serio_raw_fetch_byte(struct serio_raw *serio_raw, char *c)
{
	unsigned long flags;
	int empty;

	spin_lock_irqsave(&serio_raw->serio->lock, flags);

	empty = serio_raw->head == serio_raw->tail;
	if (!empty) {
		*c = serio_raw->queue[serio_raw->tail];
		serio_raw->tail = (serio_raw->tail + 1) % SERIO_RAW_QUEUE_LEN;
	}

	spin_unlock_irqrestore(&serio_raw->serio->lock, flags);

	return !empty;
}

static ssize_t serio_raw_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos)
{
	struct serio_raw_client *client = file->private_data;
	struct serio_raw *serio_raw = client->serio_raw;
	char uninitialized_var(c);
	ssize_t retval = 0;

	if (!serio_raw->serio)
		return -ENODEV;

	if (serio_raw->head == serio_raw->tail && (file->f_flags & O_NONBLOCK))
		return -EAGAIN;

	retval = wait_event_interruptible(serio_raw->wait,
					  serio_raw->head != serio_raw->tail ||
						!serio_raw->serio);
	if (retval)
		return retval;

	if (!serio_raw->serio)
		return -ENODEV;

	while (retval < count && serio_raw_fetch_byte(serio_raw, &c)) {
		if (put_user(c, buffer++))
			return -EFAULT;
		retval++;
	}

	return retval;
}

static ssize_t serio_raw_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
{
	struct serio_raw_client *client = file->private_data;
	struct serio_raw *serio_raw = client->serio_raw;
	ssize_t written = 0;
	int retval;
	unsigned char c;

	retval = mutex_lock_interruptible(&serio_raw_mutex);
	if (retval)
		return retval;

	if (!serio_raw->serio) {
		retval = -ENODEV;
		goto out;
	}

	if (count > 32)
		count = 32;

	while (count--) {
		if (get_user(c, buffer++)) {
			retval = -EFAULT;
			goto out;
		}
		if (serio_write(serio_raw->serio, c)) {
			retval = -EIO;
			goto out;
		}
		written++;
	};

out:
	mutex_unlock(&serio_raw_mutex);
	return written;
}

static unsigned int serio_raw_poll(struct file *file, poll_table *wait)
{
	struct serio_raw_client *client = file->private_data;
	struct serio_raw *serio_raw = client->serio_raw;

	poll_wait(file, &serio_raw->wait, wait);

	if (serio_raw->head != serio_raw->tail)
		return POLLIN | POLLRDNORM;

	return 0;
}

static const struct file_operations serio_raw_fops = {
	.owner		= THIS_MODULE,
	.open		= serio_raw_open,
	.release	= serio_raw_release,
	.read		= serio_raw_read,
	.write		= serio_raw_write,
	.poll		= serio_raw_poll,
	.fasync		= serio_raw_fasync,
	.llseek		= noop_llseek,
};


/*********************************************************************
 *                   Interface with serio port   	             *
 *********************************************************************/

static irqreturn_t serio_raw_interrupt(struct serio *serio, unsigned char data,
					unsigned int dfl)
{
	struct serio_raw *serio_raw = serio_get_drvdata(serio);
	struct serio_raw_client *client;
	unsigned int head = serio_raw->head;

	/* we are holding serio->lock here so we are protected */
	serio_raw->queue[head] = data;
	head = (head + 1) % SERIO_RAW_QUEUE_LEN;
	if (likely(head != serio_raw->tail)) {
		serio_raw->head = head;
		list_for_each_entry(client, &serio_raw->client_list, node)
			kill_fasync(&client->fasync, SIGIO, POLL_IN);
		wake_up_interruptible(&serio_raw->wait);
	}

	return IRQ_HANDLED;
}

static int serio_raw_connect(struct serio *serio, struct serio_driver *drv)
{
	struct serio_raw *serio_raw;
	int err;

	if (!(serio_raw = kzalloc(sizeof(struct serio_raw), GFP_KERNEL))) {
		printk(KERN_ERR "serio_raw.c: can't allocate memory for a device\n");
		return -ENOMEM;
	}

	mutex_lock(&serio_raw_mutex);

	snprintf(serio_raw->name, sizeof(serio_raw->name), "serio_raw%d", serio_raw_no++);
	kref_init(&serio_raw->kref);
	serio_raw->serio = serio;
	INIT_LIST_HEAD(&serio_raw->client_list);
	init_waitqueue_head(&serio_raw->wait);

	serio_set_drvdata(serio, serio_raw);

	err = serio_open(serio, drv);
	if (err)
		goto out_free;

	list_add_tail(&serio_raw->node, &serio_raw_list);

	serio_raw->dev.minor = PSMOUSE_MINOR;
	serio_raw->dev.name = serio_raw->name;
	serio_raw->dev.parent = &serio->dev;
	serio_raw->dev.fops = &serio_raw_fops;

	err = misc_register(&serio_raw->dev);
	if (err) {
		serio_raw->dev.minor = MISC_DYNAMIC_MINOR;
		err = misc_register(&serio_raw->dev);
	}

	if (err) {
		printk(KERN_INFO "serio_raw: failed to register raw access device for %s\n",
			serio->phys);
		goto out_close;
	}

	printk(KERN_INFO "serio_raw: raw access enabled on %s (%s, minor %d)\n",
		serio->phys, serio_raw->name, serio_raw->dev.minor);
	goto out;

out_close:
	serio_close(serio);
	list_del_init(&serio_raw->node);
out_free:
	serio_set_drvdata(serio, NULL);
	kfree(serio_raw);
out:
	mutex_unlock(&serio_raw_mutex);
	return err;
}

static int serio_raw_reconnect(struct serio *serio)
{
	struct serio_raw *serio_raw = serio_get_drvdata(serio);
	struct serio_driver *drv = serio->drv;

	if (!drv || !serio_raw) {
		printk(KERN_DEBUG "serio_raw: reconnect request, but serio is disconnected, ignoring...\n");
		return -1;
	}

	/*
	 * Nothing needs to be done here, we just need this method to
	 * keep the same device.
	 */
	return 0;
}

static void serio_raw_disconnect(struct serio *serio)
{
	struct serio_raw *serio_raw;

	mutex_lock(&serio_raw_mutex);

	serio_raw = serio_get_drvdata(serio);

	serio_close(serio);
	serio_set_drvdata(serio, NULL);

	serio_raw->serio = NULL;
	wake_up_interruptible(&serio_raw->wait);
	kref_put(&serio_raw->kref, serio_raw_cleanup);

	mutex_unlock(&serio_raw_mutex);
}

static struct serio_device_id serio_raw_serio_ids[] = {
	{
		.type	= SERIO_8042,
		.proto	= SERIO_ANY,
		.id	= SERIO_ANY,
		.extra	= SERIO_ANY,
	},
	{
		.type	= SERIO_8042_XL,
		.proto	= SERIO_ANY,
		.id	= SERIO_ANY,
		.extra	= SERIO_ANY,
	},
	{ 0 }
};

MODULE_DEVICE_TABLE(serio, serio_raw_serio_ids);

static struct serio_driver serio_raw_drv = {
	.driver		= {
		.name	= "serio_raw",
	},
	.description	= DRIVER_DESC,
	.id_table	= serio_raw_serio_ids,
	.interrupt	= serio_raw_interrupt,
	.connect	= serio_raw_connect,
	.reconnect	= serio_raw_reconnect,
	.disconnect	= serio_raw_disconnect,
	.manual_bind	= 1,
};

static int __init serio_raw_init(void)
{
	return serio_register_driver(&serio_raw_drv);
}

static void __exit serio_raw_exit(void)
{
	serio_unregister_driver(&serio_raw_drv);
}

module_init(serio_raw_init);
module_exit(serio_raw_exit);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* Raw serio device providing access to a raw byte stream from underlying
	3	* serio port. Closely emulates behavior of pre-2.6 /dev/psaux device
	4	*
	5	* Copyright (c) 2004 Dmitry Torokhov
	6	*
	7	* This program is free software; you can redistribute it and/or modify it
	8	* under the terms of the GNU General Public License version 2 as published by
	9	* the Free Software Foundation.
	10	*/
	11
ba538cd2	12	#include <linux/kref.h>
d43c36dc	13	#include <linux/sched.h>
1da177e4 LT	14	#include <linux/slab.h>
	15	#include <linux/poll.h>
	16	#include <linux/module.h>
	17	#include <linux/serio.h>
	18	#include <linux/init.h>
	19	#include <linux/major.h>
	20	#include <linux/device.h>
1da177e4 LT	21	#include <linux/miscdevice.h>
1da177e4 LT	22	#include <linux/wait.h>
c4e32e9f	23	#include <linux/mutex.h>
1da177e4 LT	24
	25	#define DRIVER_DESC "Raw serio driver"
	26
	27	MODULE_AUTHOR("Dmitry Torokhov <dtor@mail.ru>");
	28	MODULE_DESCRIPTION(DRIVER_DESC);
	29	MODULE_LICENSE("GPL");
	30
	31	#define SERIO_RAW_QUEUE_LEN 64
	32	struct serio_raw {
	33	unsigned char queue[SERIO_RAW_QUEUE_LEN];
	34	unsigned int tail, head;
	35
	36	char name[16];
ba538cd2	37	struct kref kref;
1da177e4 LT	38	struct serio *serio;
	39	struct miscdevice dev;
	40	wait_queue_head_t wait;
7c5bbb2e	41	struct list_head client_list;
1da177e4 LT	42	struct list_head node;
	43	};
	44
7c5bbb2e	45	struct serio_raw_client {
1da177e4 LT	46	struct fasync_struct *fasync;
	47	struct serio_raw *serio_raw;
	48	struct list_head node;
	49	};
	50
c4e32e9f	51	static DEFINE_MUTEX(serio_raw_mutex);
1da177e4 LT	52	static LIST_HEAD(serio_raw_list);
	53	static unsigned int serio_raw_no;
	54
	55	/*********************************************************************
	56	* Interface with userspace (file operations) *
	57	*********************************************************************/
	58
	59	static int serio_raw_fasync(int fd, struct file *file, int on)
	60	{
7c5bbb2e	61	struct serio_raw_client *client = file->private_data;
1da177e4	62
7c5bbb2e	63	return fasync_helper(fd, file, on, &client->fasync);
1da177e4 LT	64	}
	65
	66	static struct serio_raw *serio_raw_locate(int minor)
	67	{
	68	struct serio_raw *serio_raw;
	69
	70	list_for_each_entry(serio_raw, &serio_raw_list, node) {
	71	if (serio_raw->dev.minor == minor)
	72	return serio_raw;
	73	}
	74
	75	return NULL;
	76	}
	77
	78	static int serio_raw_open(struct inode inode, struct file file)
	79	{
	80	struct serio_raw *serio_raw;
7c5bbb2e DT	81	struct serio_raw_client *client;
7c5bbb2e DT	82	int retval;
1da177e4	83
c4e32e9f	84	retval = mutex_lock_interruptible(&serio_raw_mutex);
1da177e4	85	if (retval)
77554b4d	86	return retval;
1da177e4	87
77554b4d TLSC	88	serio_raw = serio_raw_locate(iminor(inode));
77554b4d TLSC	89	if (!serio_raw) {
1da177e4 LT	90	retval = -ENODEV;
	91	goto out;
	92	}
	93
	94	if (!serio_raw->serio) {
	95	retval = -ENODEV;
	96	goto out;
	97	}
	98
7c5bbb2e DT	99	client = kzalloc(sizeof(struct serio_raw_client), GFP_KERNEL);
7c5bbb2e DT	100	if (!client) {
1da177e4 LT	101	retval = -ENOMEM;
	102	goto out;
	103	}
	104
7c5bbb2e DT	105	client->serio_raw = serio_raw;
7c5bbb2e DT	106	file->private_data = client;
1da177e4	107
ba538cd2	108	kref_get(&serio_raw->kref);
7c5bbb2e	109	list_add_tail(&client->node, &serio_raw->client_list);
1da177e4 LT	110
1da177e4 LT	111	out:
c4e32e9f	112	mutex_unlock(&serio_raw_mutex);
1da177e4 LT	113	return retval;
	114	}
	115
ba538cd2	116	static void serio_raw_cleanup(struct kref *kref)
1da177e4	117	{
ba538cd2 DT	118	struct serio_raw *serio_raw =
ba538cd2 DT	119	container_of(kref, struct serio_raw, kref);
1da177e4	120
ba538cd2 DT	121	misc_deregister(&serio_raw->dev);
	122	list_del_init(&serio_raw->node);
	123	kfree(serio_raw);
1da177e4 LT	124	}
	125
	126	static int serio_raw_release(struct inode inode, struct file file)
	127	{
7c5bbb2e DT	128	struct serio_raw_client *client = file->private_data;
7c5bbb2e DT	129	struct serio_raw *serio_raw = client->serio_raw;
1da177e4	130
c4e32e9f	131	mutex_lock(&serio_raw_mutex);
1da177e4	132
ba538cd2	133	kref_put(&serio_raw->kref, serio_raw_cleanup);
1da177e4	134
c4e32e9f	135	mutex_unlock(&serio_raw_mutex);
1da177e4 LT	136	return 0;
	137	}
	138
	139	static int serio_raw_fetch_byte(struct serio_raw serio_raw, char c)
	140	{
	141	unsigned long flags;
	142	int empty;
	143
	144	spin_lock_irqsave(&serio_raw->serio->lock, flags);
	145
	146	empty = serio_raw->head == serio_raw->tail;
	147	if (!empty) {
	148	*c = serio_raw->queue[serio_raw->tail];
	149	serio_raw->tail = (serio_raw->tail + 1) % SERIO_RAW_QUEUE_LEN;
	150	}
	151
	152	spin_unlock_irqrestore(&serio_raw->serio->lock, flags);
	153
	154	return !empty;
	155	}
	156
	157	static ssize_t serio_raw_read(struct file file, char __user buffer, size_t count, loff_t *ppos)
	158	{
7c5bbb2e DT	159	struct serio_raw_client *client = file->private_data;
7c5bbb2e DT	160	struct serio_raw *serio_raw = client->serio_raw;
4f179f71	161	char uninitialized_var(c);
1da177e4 LT	162	ssize_t retval = 0;
	163
	164	if (!serio_raw->serio)
	165	return -ENODEV;
	166
	167	if (serio_raw->head == serio_raw->tail && (file->f_flags & O_NONBLOCK))
	168	return -EAGAIN;
	169
7c5bbb2e DT	170	retval = wait_event_interruptible(serio_raw->wait,
	171	serio_raw->head != serio_raw->tail \|\|
	172	!serio_raw->serio);
1da177e4 LT	173	if (retval)
	174	return retval;
	175
	176	if (!serio_raw->serio)
	177	return -ENODEV;
	178
	179	while (retval < count && serio_raw_fetch_byte(serio_raw, &c)) {
	180	if (put_user(c, buffer++))
	181	return -EFAULT;
	182	retval++;
	183	}
	184
	185	return retval;
	186	}
	187
	188	static ssize_t serio_raw_write(struct file file, const char __user buffer, size_t count, loff_t *ppos)
	189	{
7c5bbb2e DT	190	struct serio_raw_client *client = file->private_data;
7c5bbb2e DT	191	struct serio_raw *serio_raw = client->serio_raw;
1da177e4 LT	192	ssize_t written = 0;
	193	int retval;
	194	unsigned char c;
	195
c4e32e9f	196	retval = mutex_lock_interruptible(&serio_raw_mutex);
1da177e4 LT	197	if (retval)
	198	return retval;
	199
7c5bbb2e	200	if (!serio_raw->serio) {
1da177e4 LT	201	retval = -ENODEV;
	202	goto out;
	203	}
	204
	205	if (count > 32)
	206	count = 32;
	207
	208	while (count--) {
	209	if (get_user(c, buffer++)) {
	210	retval = -EFAULT;
	211	goto out;
	212	}
7c5bbb2e	213	if (serio_write(serio_raw->serio, c)) {
1da177e4 LT	214	retval = -EIO;
	215	goto out;
	216	}
	217	written++;
	218	};
	219
	220	out:
c4e32e9f	221	mutex_unlock(&serio_raw_mutex);
1da177e4 LT	222	return written;
	223	}
	224
	225	static unsigned int serio_raw_poll(struct file file, poll_table wait)
	226	{
7c5bbb2e DT	227	struct serio_raw_client *client = file->private_data;
7c5bbb2e DT	228	struct serio_raw *serio_raw = client->serio_raw;
1da177e4	229
7c5bbb2e	230	poll_wait(file, &serio_raw->wait, wait);
1da177e4	231
7c5bbb2e	232	if (serio_raw->head != serio_raw->tail)
1da177e4 LT	233	return POLLIN \| POLLRDNORM;
	234
	235	return 0;
	236	}
	237
2b8693c0	238	static const struct file_operations serio_raw_fops = {
7c5bbb2e DT	239	.owner = THIS_MODULE,
	240	.open = serio_raw_open,
	241	.release = serio_raw_release,
	242	.read = serio_raw_read,
	243	.write = serio_raw_write,
	244	.poll = serio_raw_poll,
	245	.fasync = serio_raw_fasync,
	246	.llseek = noop_llseek,
1da177e4 LT	247	};
	248
	249
	250	/*********************************************************************
	251	* Interface with serio port *
	252	*********************************************************************/
	253
	254	static irqreturn_t serio_raw_interrupt(struct serio *serio, unsigned char data,
7d12e780	255	unsigned int dfl)
1da177e4 LT	256	{
1da177e4 LT	257	struct serio_raw *serio_raw = serio_get_drvdata(serio);
7c5bbb2e	258	struct serio_raw_client *client;
1da177e4 LT	259	unsigned int head = serio_raw->head;
1da177e4 LT	260
7c5bbb2e	261	/* we are holding serio->lock here so we are protected */
1da177e4 LT	262	serio_raw->queue[head] = data;
	263	head = (head + 1) % SERIO_RAW_QUEUE_LEN;
	264	if (likely(head != serio_raw->tail)) {
	265	serio_raw->head = head;
7c5bbb2e DT	266	list_for_each_entry(client, &serio_raw->client_list, node)
7c5bbb2e DT	267	kill_fasync(&client->fasync, SIGIO, POLL_IN);
1da177e4 LT	268	wake_up_interruptible(&serio_raw->wait);
	269	}
	270
	271	return IRQ_HANDLED;
	272	}
	273
	274	static int serio_raw_connect(struct serio serio, struct serio_driver drv)
	275	{
	276	struct serio_raw *serio_raw;
	277	int err;
	278
b39787a9	279	if (!(serio_raw = kzalloc(sizeof(struct serio_raw), GFP_KERNEL))) {
1da177e4 LT	280	printk(KERN_ERR "serio_raw.c: can't allocate memory for a device\n");
	281	return -ENOMEM;
	282	}
	283
c4e32e9f	284	mutex_lock(&serio_raw_mutex);
1da177e4	285
1da177e4	286	snprintf(serio_raw->name, sizeof(serio_raw->name), "serio_raw%d", serio_raw_no++);
ba538cd2	287	kref_init(&serio_raw->kref);
1da177e4	288	serio_raw->serio = serio;
7c5bbb2e	289	INIT_LIST_HEAD(&serio_raw->client_list);
1da177e4 LT	290	init_waitqueue_head(&serio_raw->wait);
	291
	292	serio_set_drvdata(serio, serio_raw);
	293
	294	err = serio_open(serio, drv);
	295	if (err)
	296	goto out_free;
	297
	298	list_add_tail(&serio_raw->node, &serio_raw_list);
	299
	300	serio_raw->dev.minor = PSMOUSE_MINOR;
	301	serio_raw->dev.name = serio_raw->name;
94fbcded	302	serio_raw->dev.parent = &serio->dev;
1da177e4 LT	303	serio_raw->dev.fops = &serio_raw_fops;
	304
	305	err = misc_register(&serio_raw->dev);
	306	if (err) {
	307	serio_raw->dev.minor = MISC_DYNAMIC_MINOR;
	308	err = misc_register(&serio_raw->dev);
	309	}
	310
	311	if (err) {
	312	printk(KERN_INFO "serio_raw: failed to register raw access device for %s\n",
	313	serio->phys);
	314	goto out_close;
	315	}
	316
	317	printk(KERN_INFO "serio_raw: raw access enabled on %s (%s, minor %d)\n",
	318	serio->phys, serio_raw->name, serio_raw->dev.minor);
	319	goto out;
	320
	321	out_close:
	322	serio_close(serio);
	323	list_del_init(&serio_raw->node);
	324	out_free:
	325	serio_set_drvdata(serio, NULL);
	326	kfree(serio_raw);
	327	out:
c4e32e9f	328	mutex_unlock(&serio_raw_mutex);
1da177e4 LT	329	return err;
	330	}
	331
	332	static int serio_raw_reconnect(struct serio *serio)
	333	{
	334	struct serio_raw *serio_raw = serio_get_drvdata(serio);
	335	struct serio_driver *drv = serio->drv;
	336
	337	if (!drv \|\| !serio_raw) {
	338	printk(KERN_DEBUG "serio_raw: reconnect request, but serio is disconnected, ignoring...\n");
	339	return -1;
	340	}
	341
	342	/*
	343	* Nothing needs to be done here, we just need this method to
	344	* keep the same device.
	345	*/
	346	return 0;
	347	}
	348
	349	static void serio_raw_disconnect(struct serio *serio)
	350	{
	351	struct serio_raw *serio_raw;
	352
c4e32e9f	353	mutex_lock(&serio_raw_mutex);
1da177e4 LT	354
	355	serio_raw = serio_get_drvdata(serio);
	356
	357	serio_close(serio);
	358	serio_set_drvdata(serio, NULL);
	359
	360	serio_raw->serio = NULL;
ba538cd2 DT	361	wake_up_interruptible(&serio_raw->wait);
ba538cd2 DT	362	kref_put(&serio_raw->kref, serio_raw_cleanup);
1da177e4	363
c4e32e9f	364	mutex_unlock(&serio_raw_mutex);
1da177e4 LT	365	}
	366
	367	static struct serio_device_id serio_raw_serio_ids[] = {
	368	{
	369	.type = SERIO_8042,
	370	.proto = SERIO_ANY,
	371	.id = SERIO_ANY,
	372	.extra = SERIO_ANY,
	373	},
d19497e2 NV	374	{
	375	.type = SERIO_8042_XL,
	376	.proto = SERIO_ANY,
	377	.id = SERIO_ANY,
	378	.extra = SERIO_ANY,
	379	},
1da177e4 LT	380	{ 0 }
	381	};
	382
	383	MODULE_DEVICE_TABLE(serio, serio_raw_serio_ids);
	384
	385	static struct serio_driver serio_raw_drv = {
	386	.driver = {
	387	.name = "serio_raw",
	388	},
	389	.description = DRIVER_DESC,
	390	.id_table = serio_raw_serio_ids,
	391	.interrupt = serio_raw_interrupt,
	392	.connect = serio_raw_connect,
	393	.reconnect = serio_raw_reconnect,
	394	.disconnect = serio_raw_disconnect,
	395	.manual_bind = 1,
	396	};
	397
	398	static int __init serio_raw_init(void)
	399	{
153a9df0	400	return serio_register_driver(&serio_raw_drv);
1da177e4 LT	401	}
	402
	403	static void __exit serio_raw_exit(void)
	404	{
	405	serio_unregister_driver(&serio_raw_drv);
	406	}
	407
	408	module_init(serio_raw_init);
	409	module_exit(serio_raw_exit);