[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;
	bool dead;
};

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->dead) {
		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);

	serio_pause_rx(serio_raw->serio);
	list_add_tail(&client->node, &serio_raw->client_list);
	serio_continue_rx(serio_raw->serio);

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);

	put_device(&serio_raw->serio->dev);
	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 bool serio_raw_fetch_byte(struct serio_raw *serio_raw, char *c)
{
	bool empty;

	serio_pause_rx(serio_raw->serio);

	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;
	}

	serio_continue_rx(serio_raw->serio);

	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->dead)
		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->dead);
	if (retval)
		return retval;

	if (serio_raw->dead)
		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->dead) {
		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;
	unsigned int mask;

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

	mask = serio_raw->dead ? POLLHUP | POLLERR : POLLOUT | POLLWRNORM;
	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;

	serio_raw = kzalloc(sizeof(struct serio_raw), GFP_KERNEL);
	if (!serio_raw) {
		dev_dbg(&serio->dev, "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);
	INIT_LIST_HEAD(&serio_raw->client_list);
	init_waitqueue_head(&serio_raw->wait);

	serio_raw->serio = serio;
	get_device(&serio->dev);

	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) {
		dev_err(&serio->dev,
			"failed to register raw access device for %s\n",
			serio->phys);
		goto out_close;
	}

	dev_info(&serio->dev, "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);
	put_device(&serio->dev);
	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) {
		dev_dbg(&serio->dev,
			"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;
}

/*
 * Wake up users waiting for IO so they can disconnect from
 * dead device.
 */
static void serio_raw_hangup(struct serio_raw *serio_raw)
{
	struct serio_raw_client *client;

	serio_pause_rx(serio_raw->serio);
	list_for_each_entry(client, &serio_raw->client_list, node)
		kill_fasync(&client->fasync, SIGIO, POLL_HUP);
	serio_continue_rx(serio_raw->serio);

	wake_up_interruptible(&serio_raw->wait);
}


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

	mutex_lock(&serio_raw_mutex);

	serio_close(serio);
	serio_raw->dead = true;
	serio_raw_hangup(serio_raw);
	kref_put(&serio_raw->kref, serio_raw_cleanup);

	mutex_unlock(&serio_raw_mutex);

	serio_set_drvdata(serio, NULL);
}

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	= true,
};

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	42	struct list_head node;
85f5b35d	43	bool dead;
1da177e4 LT	44	};
1da177e4 LT	45
7c5bbb2e	46	struct serio_raw_client {
1da177e4 LT	47	struct fasync_struct *fasync;
	48	struct serio_raw *serio_raw;
	49	struct list_head node;
	50	};
	51
c4e32e9f	52	static DEFINE_MUTEX(serio_raw_mutex);
1da177e4 LT	53	static LIST_HEAD(serio_raw_list);
	54	static unsigned int serio_raw_no;
	55
	56	/*********************************************************************
	57	* Interface with userspace (file operations) *
	58	*********************************************************************/
	59
	60	static int serio_raw_fasync(int fd, struct file *file, int on)
	61	{
7c5bbb2e	62	struct serio_raw_client *client = file->private_data;
1da177e4	63
7c5bbb2e	64	return fasync_helper(fd, file, on, &client->fasync);
1da177e4 LT	65	}
	66
	67	static struct serio_raw *serio_raw_locate(int minor)
	68	{
	69	struct serio_raw *serio_raw;
	70
	71	list_for_each_entry(serio_raw, &serio_raw_list, node) {
	72	if (serio_raw->dev.minor == minor)
	73	return serio_raw;
	74	}
	75
	76	return NULL;
	77	}
	78
	79	static int serio_raw_open(struct inode inode, struct file file)
	80	{
	81	struct serio_raw *serio_raw;
7c5bbb2e DT	82	struct serio_raw_client *client;
7c5bbb2e DT	83	int retval;
1da177e4	84
c4e32e9f	85	retval = mutex_lock_interruptible(&serio_raw_mutex);
1da177e4	86	if (retval)
77554b4d	87	return retval;
1da177e4	88
77554b4d TLSC	89	serio_raw = serio_raw_locate(iminor(inode));
77554b4d TLSC	90	if (!serio_raw) {
1da177e4 LT	91	retval = -ENODEV;
	92	goto out;
	93	}
	94
85f5b35d	95	if (serio_raw->dead) {
1da177e4 LT	96	retval = -ENODEV;
	97	goto out;
	98	}
	99
7c5bbb2e DT	100	client = kzalloc(sizeof(struct serio_raw_client), GFP_KERNEL);
7c5bbb2e DT	101	if (!client) {
1da177e4 LT	102	retval = -ENOMEM;
	103	goto out;
	104	}
	105
7c5bbb2e DT	106	client->serio_raw = serio_raw;
7c5bbb2e DT	107	file->private_data = client;
1da177e4	108
ba538cd2	109	kref_get(&serio_raw->kref);
843e784a DT	110
843e784a DT	111	serio_pause_rx(serio_raw->serio);
7c5bbb2e	112	list_add_tail(&client->node, &serio_raw->client_list);
843e784a	113	serio_continue_rx(serio_raw->serio);
1da177e4 LT	114
1da177e4 LT	115	out:
c4e32e9f	116	mutex_unlock(&serio_raw_mutex);
1da177e4 LT	117	return retval;
	118	}
	119
ba538cd2	120	static void serio_raw_cleanup(struct kref *kref)
1da177e4	121	{
ba538cd2 DT	122	struct serio_raw *serio_raw =
ba538cd2 DT	123	container_of(kref, struct serio_raw, kref);
1da177e4	124
ba538cd2 DT	125	misc_deregister(&serio_raw->dev);
ba538cd2 DT	126	list_del_init(&serio_raw->node);
85f5b35d DT	127
85f5b35d DT	128	put_device(&serio_raw->serio->dev);
ba538cd2	129	kfree(serio_raw);
1da177e4 LT	130	}
	131
	132	static int serio_raw_release(struct inode inode, struct file file)
	133	{
7c5bbb2e DT	134	struct serio_raw_client *client = file->private_data;
7c5bbb2e DT	135	struct serio_raw *serio_raw = client->serio_raw;
1da177e4	136
c4e32e9f	137	mutex_lock(&serio_raw_mutex);
1da177e4	138
ba538cd2	139	kref_put(&serio_raw->kref, serio_raw_cleanup);
1da177e4	140
c4e32e9f	141	mutex_unlock(&serio_raw_mutex);
1da177e4 LT	142	return 0;
	143	}
	144
8c31eb01	145	static bool serio_raw_fetch_byte(struct serio_raw serio_raw, char c)
1da177e4	146	{
8c31eb01	147	bool empty;
1da177e4	148
843e784a	149	serio_pause_rx(serio_raw->serio);
1da177e4 LT	150
	151	empty = serio_raw->head == serio_raw->tail;
	152	if (!empty) {
	153	*c = serio_raw->queue[serio_raw->tail];
	154	serio_raw->tail = (serio_raw->tail + 1) % SERIO_RAW_QUEUE_LEN;
	155	}
	156
843e784a	157	serio_continue_rx(serio_raw->serio);
1da177e4 LT	158
	159	return !empty;
	160	}
	161
15a564d8 DT	162	static ssize_t serio_raw_read(struct file file, char __user buffer,
15a564d8 DT	163	size_t count, loff_t *ppos)
1da177e4	164	{
7c5bbb2e DT	165	struct serio_raw_client *client = file->private_data;
7c5bbb2e DT	166	struct serio_raw *serio_raw = client->serio_raw;
4f179f71	167	char uninitialized_var(c);
1da177e4 LT	168	ssize_t retval = 0;
1da177e4 LT	169
85f5b35d	170	if (serio_raw->dead)
1da177e4 LT	171	return -ENODEV;
	172
	173	if (serio_raw->head == serio_raw->tail && (file->f_flags & O_NONBLOCK))
	174	return -EAGAIN;
	175
7c5bbb2e	176	retval = wait_event_interruptible(serio_raw->wait,
85f5b35d	177	serio_raw->head != serio_raw->tail \|\| serio_raw->dead);
1da177e4 LT	178	if (retval)
	179	return retval;
	180
85f5b35d	181	if (serio_raw->dead)
1da177e4 LT	182	return -ENODEV;
	183
	184	while (retval < count && serio_raw_fetch_byte(serio_raw, &c)) {
	185	if (put_user(c, buffer++))
	186	return -EFAULT;
	187	retval++;
	188	}
	189
	190	return retval;
	191	}
	192
15a564d8 DT	193	static ssize_t serio_raw_write(struct file file, const char __user buffer,
15a564d8 DT	194	size_t count, loff_t *ppos)
1da177e4	195	{
7c5bbb2e DT	196	struct serio_raw_client *client = file->private_data;
7c5bbb2e DT	197	struct serio_raw *serio_raw = client->serio_raw;
1da177e4 LT	198	ssize_t written = 0;
	199	int retval;
	200	unsigned char c;
	201
c4e32e9f	202	retval = mutex_lock_interruptible(&serio_raw_mutex);
1da177e4 LT	203	if (retval)
	204	return retval;
	205
85f5b35d	206	if (serio_raw->dead) {
1da177e4 LT	207	retval = -ENODEV;
	208	goto out;
	209	}
	210
	211	if (count > 32)
	212	count = 32;
	213
	214	while (count--) {
	215	if (get_user(c, buffer++)) {
	216	retval = -EFAULT;
	217	goto out;
	218	}
7c5bbb2e	219	if (serio_write(serio_raw->serio, c)) {
1da177e4 LT	220	retval = -EIO;
	221	goto out;
	222	}
	223	written++;
	224	};
	225
	226	out:
c4e32e9f	227	mutex_unlock(&serio_raw_mutex);
1da177e4 LT	228	return written;
	229	}
	230
	231	static unsigned int serio_raw_poll(struct file file, poll_table wait)
	232	{
7c5bbb2e DT	233	struct serio_raw_client *client = file->private_data;
7c5bbb2e DT	234	struct serio_raw *serio_raw = client->serio_raw;
8c1c10d5	235	unsigned int mask;
1da177e4	236
7c5bbb2e	237	poll_wait(file, &serio_raw->wait, wait);
1da177e4	238
8c1c10d5	239	mask = serio_raw->dead ? POLLHUP \| POLLERR : POLLOUT \| POLLWRNORM;
7c5bbb2e	240	if (serio_raw->head != serio_raw->tail)
1da177e4 LT	241	return POLLIN \| POLLRDNORM;
	242
	243	return 0;
	244	}
	245
2b8693c0	246	static const struct file_operations serio_raw_fops = {
7c5bbb2e DT	247	.owner = THIS_MODULE,
	248	.open = serio_raw_open,
	249	.release = serio_raw_release,
	250	.read = serio_raw_read,
	251	.write = serio_raw_write,
	252	.poll = serio_raw_poll,
	253	.fasync = serio_raw_fasync,
	254	.llseek = noop_llseek,
1da177e4 LT	255	};
	256
	257
	258	/*********************************************************************
15a564d8	259	* Interface with serio port *
1da177e4 LT	260	*********************************************************************/
	261
	262	static irqreturn_t serio_raw_interrupt(struct serio *serio, unsigned char data,
7d12e780	263	unsigned int dfl)
1da177e4 LT	264	{
1da177e4 LT	265	struct serio_raw *serio_raw = serio_get_drvdata(serio);
7c5bbb2e	266	struct serio_raw_client *client;
1da177e4 LT	267	unsigned int head = serio_raw->head;
1da177e4 LT	268
7c5bbb2e	269	/* we are holding serio->lock here so we are protected */
1da177e4 LT	270	serio_raw->queue[head] = data;
	271	head = (head + 1) % SERIO_RAW_QUEUE_LEN;
	272	if (likely(head != serio_raw->tail)) {
	273	serio_raw->head = head;
7c5bbb2e DT	274	list_for_each_entry(client, &serio_raw->client_list, node)
7c5bbb2e DT	275	kill_fasync(&client->fasync, SIGIO, POLL_IN);
1da177e4 LT	276	wake_up_interruptible(&serio_raw->wait);
	277	}
	278
	279	return IRQ_HANDLED;
	280	}
	281
	282	static int serio_raw_connect(struct serio serio, struct serio_driver drv)
	283	{
	284	struct serio_raw *serio_raw;
	285	int err;
	286
15a564d8 DT	287	serio_raw = kzalloc(sizeof(struct serio_raw), GFP_KERNEL);
15a564d8 DT	288	if (!serio_raw) {
8d928477	289	dev_dbg(&serio->dev, "can't allocate memory for a device\n");
1da177e4 LT	290	return -ENOMEM;
	291	}
	292
c4e32e9f	293	mutex_lock(&serio_raw_mutex);
1da177e4	294
15a564d8 DT	295	snprintf(serio_raw->name, sizeof(serio_raw->name),
15a564d8 DT	296	"serio_raw%d", serio_raw_no++);
ba538cd2	297	kref_init(&serio_raw->kref);
7c5bbb2e	298	INIT_LIST_HEAD(&serio_raw->client_list);
1da177e4 LT	299	init_waitqueue_head(&serio_raw->wait);
1da177e4 LT	300
85f5b35d DT	301	serio_raw->serio = serio;
	302	get_device(&serio->dev);
	303
1da177e4 LT	304	serio_set_drvdata(serio, serio_raw);
	305
	306	err = serio_open(serio, drv);
	307	if (err)
	308	goto out_free;
	309
	310	list_add_tail(&serio_raw->node, &serio_raw_list);
	311
	312	serio_raw->dev.minor = PSMOUSE_MINOR;
	313	serio_raw->dev.name = serio_raw->name;
94fbcded	314	serio_raw->dev.parent = &serio->dev;
1da177e4 LT	315	serio_raw->dev.fops = &serio_raw_fops;
	316
	317	err = misc_register(&serio_raw->dev);
	318	if (err) {
	319	serio_raw->dev.minor = MISC_DYNAMIC_MINOR;
	320	err = misc_register(&serio_raw->dev);
	321	}
	322
	323	if (err) {
8d928477 DT	324	dev_err(&serio->dev,
8d928477 DT	325	"failed to register raw access device for %s\n",
1da177e4 LT	326	serio->phys);
	327	goto out_close;
	328	}
	329
8d928477 DT	330	dev_info(&serio->dev, "raw access enabled on %s (%s, minor %d)\n",
8d928477 DT	331	serio->phys, serio_raw->name, serio_raw->dev.minor);
1da177e4 LT	332	goto out;
	333
	334	out_close:
	335	serio_close(serio);
	336	list_del_init(&serio_raw->node);
	337	out_free:
	338	serio_set_drvdata(serio, NULL);
85f5b35d	339	put_device(&serio->dev);
1da177e4 LT	340	kfree(serio_raw);
1da177e4 LT	341	out:
c4e32e9f	342	mutex_unlock(&serio_raw_mutex);
1da177e4 LT	343	return err;
	344	}
	345
	346	static int serio_raw_reconnect(struct serio *serio)
	347	{
	348	struct serio_raw *serio_raw = serio_get_drvdata(serio);
	349	struct serio_driver *drv = serio->drv;
	350
	351	if (!drv \|\| !serio_raw) {
8d928477 DT	352	dev_dbg(&serio->dev,
8d928477 DT	353	"reconnect request, but serio is disconnected, ignoring...\n");
1da177e4 LT	354	return -1;
	355	}
	356
	357	/*
	358	* Nothing needs to be done here, we just need this method to
	359	* keep the same device.
	360	*/
	361	return 0;
	362	}
	363
8c1c10d5 DT	364	/*
	365	* Wake up users waiting for IO so they can disconnect from
	366	* dead device.
	367	*/
	368	static void serio_raw_hangup(struct serio_raw *serio_raw)
	369	{
	370	struct serio_raw_client *client;
	371
	372	serio_pause_rx(serio_raw->serio);
	373	list_for_each_entry(client, &serio_raw->client_list, node)
	374	kill_fasync(&client->fasync, SIGIO, POLL_HUP);
	375	serio_continue_rx(serio_raw->serio);
	376
	377	wake_up_interruptible(&serio_raw->wait);
	378	}
	379
	380
1da177e4 LT	381	static void serio_raw_disconnect(struct serio *serio)
1da177e4 LT	382	{
8c1c10d5	383	struct serio_raw *serio_raw = serio_get_drvdata(serio);
1da177e4	384
c4e32e9f	385	mutex_lock(&serio_raw_mutex);
1da177e4	386
1da177e4	387	serio_close(serio);
85f5b35d	388	serio_raw->dead = true;
8c1c10d5	389	serio_raw_hangup(serio_raw);
ba538cd2	390	kref_put(&serio_raw->kref, serio_raw_cleanup);
1da177e4	391
c4e32e9f	392	mutex_unlock(&serio_raw_mutex);
8c1c10d5 DT	393
8c1c10d5 DT	394	serio_set_drvdata(serio, NULL);
1da177e4 LT	395	}
	396
	397	static struct serio_device_id serio_raw_serio_ids[] = {
	398	{
	399	.type = SERIO_8042,
	400	.proto = SERIO_ANY,
	401	.id = SERIO_ANY,
	402	.extra = SERIO_ANY,
	403	},
d19497e2 NV	404	{
	405	.type = SERIO_8042_XL,
	406	.proto = SERIO_ANY,
	407	.id = SERIO_ANY,
	408	.extra = SERIO_ANY,
	409	},
1da177e4 LT	410	{ 0 }
	411	};
	412
	413	MODULE_DEVICE_TABLE(serio, serio_raw_serio_ids);
	414
	415	static struct serio_driver serio_raw_drv = {
	416	.driver = {
	417	.name = "serio_raw",
	418	},
	419	.description = DRIVER_DESC,
	420	.id_table = serio_raw_serio_ids,
	421	.interrupt = serio_raw_interrupt,
	422	.connect = serio_raw_connect,
	423	.reconnect = serio_raw_reconnect,
	424	.disconnect = serio_raw_disconnect,
8c31eb01	425	.manual_bind = true,
1da177e4 LT	426	};
	427
	428	static int __init serio_raw_init(void)
	429	{
153a9df0	430	return serio_register_driver(&serio_raw_drv);
1da177e4 LT	431	}
	432
	433	static void __exit serio_raw_exit(void)
	434	{
	435	serio_unregister_driver(&serio_raw_drv);
	436	}
	437
	438	module_init(serio_raw_init);
	439	module_exit(serio_raw_exit);