[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / char / raw.c

/*
 * linux/drivers/char/raw.c
 *
 * Front-end raw character devices.  These can be bound to any block
 * devices to provide genuine Unix raw character device semantics.
 *
 * We reserve minor number 0 for a control interface.  ioctl()s on this
 * device are used to bind the other minor numbers to block devices.
 */

#include <linux/init.h>
#include <linux/fs.h>
#include <linux/major.h>
#include <linux/blkdev.h>
#include <linux/module.h>
#include <linux/raw.h>
#include <linux/capability.h>
#include <linux/uio.h>
#include <linux/cdev.h>
#include <linux/device.h>
#include <linux/mutex.h>
#include <linux/smp_lock.h>

#include <asm/uaccess.h>

struct raw_device_data {
	struct block_device *binding;
	int inuse;
};

static struct class *raw_class;
static struct raw_device_data raw_devices[MAX_RAW_MINORS];
static DEFINE_MUTEX(raw_mutex);
static const struct file_operations raw_ctl_fops; /* forward declaration */

/*
 * Open/close code for raw IO.
 *
 * We just rewrite the i_mapping for the /dev/raw/rawN file descriptor to
 * point at the blockdev's address_space and set the file handle to use
 * O_DIRECT.
 *
 * Set the device's soft blocksize to the minimum possible.  This gives the
 * finest possible alignment and has no adverse impact on performance.
 */
static int raw_open(struct inode *inode, struct file *filp)
{
	const int minor = iminor(inode);
	struct block_device *bdev;
	int err;

	if (minor == 0) {	/* It is the control device */
		filp->f_op = &raw_ctl_fops;
		return 0;
	}

	lock_kernel();
	mutex_lock(&raw_mutex);

	/*
	 * All we need to do on open is check that the device is bound.
	 */
	bdev = raw_devices[minor].binding;
	err = -ENODEV;
	if (!bdev)
		goto out;
	igrab(bdev->bd_inode);
	err = blkdev_get(bdev, filp->f_mode, 0);
	if (err)
		goto out;
	err = bd_claim(bdev, raw_open);
	if (err)
		goto out1;
	err = set_blocksize(bdev, bdev_hardsect_size(bdev));
	if (err)
		goto out2;
	filp->f_flags |= O_DIRECT;
	filp->f_mapping = bdev->bd_inode->i_mapping;
	if (++raw_devices[minor].inuse == 1)
		filp->f_path.dentry->d_inode->i_mapping =
			bdev->bd_inode->i_mapping;
	filp->private_data = bdev;
	mutex_unlock(&raw_mutex);
	unlock_kernel();
	return 0;

out2:
	bd_release(bdev);
out1:
	blkdev_put(bdev);
out:
	mutex_unlock(&raw_mutex);
	return err;
}

/*
 * When the final fd which refers to this character-special node is closed, we
 * make its ->mapping point back at its own i_data.
 */
static int raw_release(struct inode *inode, struct file *filp)
{
	const int minor= iminor(inode);
	struct block_device *bdev;

	mutex_lock(&raw_mutex);
	bdev = raw_devices[minor].binding;
	if (--raw_devices[minor].inuse == 0) {
		/* Here  inode->i_mapping == bdev->bd_inode->i_mapping  */
		inode->i_mapping = &inode->i_data;
		inode->i_mapping->backing_dev_info = &default_backing_dev_info;
	}
	mutex_unlock(&raw_mutex);

	bd_release(bdev);
	blkdev_put(bdev);
	return 0;
}

/*
 * Forward ioctls to the underlying block device.
 */
static int
raw_ioctl(struct inode *inode, struct file *filp,
		  unsigned int command, unsigned long arg)
{
	struct block_device *bdev = filp->private_data;

	return blkdev_ioctl(bdev->bd_inode, NULL, command, arg);
}

static void bind_device(struct raw_config_request *rq)
{
	device_destroy(raw_class, MKDEV(RAW_MAJOR, rq->raw_minor));
	device_create_drvdata(raw_class, NULL, MKDEV(RAW_MAJOR, rq->raw_minor),
			      NULL, "raw%d", rq->raw_minor);
}

/*
 * Deal with ioctls against the raw-device control interface, to bind
 * and unbind other raw devices.
 */
static int raw_ctl_ioctl(struct inode *inode, struct file *filp,
			unsigned int command, unsigned long arg)
{
	struct raw_config_request rq;
	struct raw_device_data *rawdev;
	int err = 0;

	switch (command) {
	case RAW_SETBIND:
	case RAW_GETBIND:

		/* First, find out which raw minor we want */

		if (copy_from_user(&rq, (void __user *) arg, sizeof(rq))) {
			err = -EFAULT;
			goto out;
		}

		if (rq.raw_minor <= 0 || rq.raw_minor >= MAX_RAW_MINORS) {
			err = -EINVAL;
			goto out;
		}
		rawdev = &raw_devices[rq.raw_minor];

		if (command == RAW_SETBIND) {
			dev_t dev;

			/*
			 * This is like making block devices, so demand the
			 * same capability
			 */
			if (!capable(CAP_SYS_ADMIN)) {
				err = -EPERM;
				goto out;
			}

			/*
			 * For now, we don't need to check that the underlying
			 * block device is present or not: we can do that when
			 * the raw device is opened.  Just check that the
			 * major/minor numbers make sense.
			 */

			dev = MKDEV(rq.block_major, rq.block_minor);
			if ((rq.block_major == 0 && rq.block_minor != 0) ||
					MAJOR(dev) != rq.block_major ||
					MINOR(dev) != rq.block_minor) {
				err = -EINVAL;
				goto out;
			}

			mutex_lock(&raw_mutex);
			if (rawdev->inuse) {
				mutex_unlock(&raw_mutex);
				err = -EBUSY;
				goto out;
			}
			if (rawdev->binding) {
				bdput(rawdev->binding);
				module_put(THIS_MODULE);
			}
			if (rq.block_major == 0 && rq.block_minor == 0) {
				/* unbind */
				rawdev->binding = NULL;
				device_destroy(raw_class,
						MKDEV(RAW_MAJOR, rq.raw_minor));
			} else {
				rawdev->binding = bdget(dev);
				if (rawdev->binding == NULL)
					err = -ENOMEM;
				else {
					__module_get(THIS_MODULE);
					bind_device(&rq);
				}
			}
			mutex_unlock(&raw_mutex);
		} else {
			struct block_device *bdev;

			mutex_lock(&raw_mutex);
			bdev = rawdev->binding;
			if (bdev) {
				rq.block_major = MAJOR(bdev->bd_dev);
				rq.block_minor = MINOR(bdev->bd_dev);
			} else {
				rq.block_major = rq.block_minor = 0;
			}
			mutex_unlock(&raw_mutex);
			if (copy_to_user((void __user *)arg, &rq, sizeof(rq))) {
				err = -EFAULT;
				goto out;
			}
		}
		break;
	default:
		err = -EINVAL;
		break;
	}
out:
	return err;
}

static const struct file_operations raw_fops = {
	.read	=	do_sync_read,
	.aio_read = 	generic_file_aio_read,
	.write	=	do_sync_write,
	.aio_write = 	generic_file_aio_write_nolock,
	.open	=	raw_open,
	.release=	raw_release,
	.ioctl	=	raw_ioctl,
	.owner	=	THIS_MODULE,
};

static const struct file_operations raw_ctl_fops = {
	.ioctl	=	raw_ctl_ioctl,
	.open	=	raw_open,
	.owner	=	THIS_MODULE,
};

static struct cdev raw_cdev;

static int __init raw_init(void)
{
	dev_t dev = MKDEV(RAW_MAJOR, 0);
	int ret;

	ret = register_chrdev_region(dev, MAX_RAW_MINORS, "raw");
	if (ret)
		goto error;

	cdev_init(&raw_cdev, &raw_fops);
	ret = cdev_add(&raw_cdev, dev, MAX_RAW_MINORS);
	if (ret) {
		kobject_put(&raw_cdev.kobj);
		goto error_region;
	}

	raw_class = class_create(THIS_MODULE, "raw");
	if (IS_ERR(raw_class)) {
		printk(KERN_ERR "Error creating raw class.\n");
		cdev_del(&raw_cdev);
		ret = PTR_ERR(raw_class);
		goto error_region;
	}
	device_create_drvdata(raw_class, NULL, MKDEV(RAW_MAJOR, 0), NULL,
			      "rawctl");

	return 0;

error_region:
	unregister_chrdev_region(dev, MAX_RAW_MINORS);
error:
	return ret;
}

static void __exit raw_exit(void)
{
	device_destroy(raw_class, MKDEV(RAW_MAJOR, 0));
	class_destroy(raw_class);
	cdev_del(&raw_cdev);
	unregister_chrdev_region(MKDEV(RAW_MAJOR, 0), MAX_RAW_MINORS);
}

module_init(raw_init);
module_exit(raw_exit);
MODULE_LICENSE("GPL");
Commit	Line	Data
1da177e4 LT	1	/*
	2	* linux/drivers/char/raw.c
	3	*
	4	* Front-end raw character devices. These can be bound to any block
	5	* devices to provide genuine Unix raw character device semantics.
	6	*
	7	* We reserve minor number 0 for a control interface. ioctl()s on this
	8	* device are used to bind the other minor numbers to block devices.
	9	*/
	10
	11	#include <linux/init.h>
	12	#include <linux/fs.h>
1da177e4 LT	13	#include <linux/major.h>
	14	#include <linux/blkdev.h>
	15	#include <linux/module.h>
	16	#include <linux/raw.h>
	17	#include <linux/capability.h>
	18	#include <linux/uio.h>
	19	#include <linux/cdev.h>
	20	#include <linux/device.h>
8ed965d6	21	#include <linux/mutex.h>
c0bed680	22	#include <linux/smp_lock.h>
1da177e4 LT	23
	24	#include <asm/uaccess.h>
	25
	26	struct raw_device_data {
	27	struct block_device *binding;
	28	int inuse;
	29	};
	30
ca8eca68	31	static struct class *raw_class;
1da177e4	32	static struct raw_device_data raw_devices[MAX_RAW_MINORS];
8ed965d6	33	static DEFINE_MUTEX(raw_mutex);
62322d25	34	static const struct file_operations raw_ctl_fops; /* forward declaration */
1da177e4 LT	35
	36	/*
	37	* Open/close code for raw IO.
	38	*
	39	* We just rewrite the i_mapping for the /dev/raw/rawN file descriptor to
	40	* point at the blockdev's address_space and set the file handle to use
	41	* O_DIRECT.
	42	*
	43	* Set the device's soft blocksize to the minimum possible. This gives the
	44	* finest possible alignment and has no adverse impact on performance.
	45	*/
	46	static int raw_open(struct inode inode, struct file filp)
	47	{
	48	const int minor = iminor(inode);
	49	struct block_device *bdev;
	50	int err;
	51
	52	if (minor == 0) { /* It is the control device */
	53	filp->f_op = &raw_ctl_fops;
	54	return 0;
	55	}
	56
c0bed680	57	lock_kernel();
8ed965d6	58	mutex_lock(&raw_mutex);
1da177e4 LT	59
	60	/*
	61	* All we need to do on open is check that the device is bound.
	62	*/
	63	bdev = raw_devices[minor].binding;
	64	err = -ENODEV;
	65	if (!bdev)
	66	goto out;
	67	igrab(bdev->bd_inode);
	68	err = blkdev_get(bdev, filp->f_mode, 0);
	69	if (err)
	70	goto out;
	71	err = bd_claim(bdev, raw_open);
	72	if (err)
	73	goto out1;
	74	err = set_blocksize(bdev, bdev_hardsect_size(bdev));
	75	if (err)
	76	goto out2;
	77	filp->f_flags \|= O_DIRECT;
	78	filp->f_mapping = bdev->bd_inode->i_mapping;
	79	if (++raw_devices[minor].inuse == 1)
a7113a96	80	filp->f_path.dentry->d_inode->i_mapping =
1da177e4 LT	81	bdev->bd_inode->i_mapping;
1da177e4 LT	82	filp->private_data = bdev;
8ed965d6	83	mutex_unlock(&raw_mutex);
c0bed680	84	unlock_kernel();
1da177e4 LT	85	return 0;
	86
	87	out2:
	88	bd_release(bdev);
	89	out1:
	90	blkdev_put(bdev);
	91	out:
8ed965d6	92	mutex_unlock(&raw_mutex);
1da177e4 LT	93	return err;
	94	}
	95
	96	/*
	97	* When the final fd which refers to this character-special node is closed, we
	98	* make its ->mapping point back at its own i_data.
	99	*/
	100	static int raw_release(struct inode inode, struct file filp)
	101	{
	102	const int minor= iminor(inode);
	103	struct block_device *bdev;
	104
8ed965d6	105	mutex_lock(&raw_mutex);
1da177e4 LT	106	bdev = raw_devices[minor].binding;
	107	if (--raw_devices[minor].inuse == 0) {
	108	/* Here inode->i_mapping == bdev->bd_inode->i_mapping */
	109	inode->i_mapping = &inode->i_data;
	110	inode->i_mapping->backing_dev_info = &default_backing_dev_info;
	111	}
8ed965d6	112	mutex_unlock(&raw_mutex);
1da177e4 LT	113
	114	bd_release(bdev);
	115	blkdev_put(bdev);
	116	return 0;
	117	}
	118
	119	/*
	120	* Forward ioctls to the underlying block device.
	121	*/
	122	static int
	123	raw_ioctl(struct inode inode, struct file filp,
	124	unsigned int command, unsigned long arg)
	125	{
	126	struct block_device *bdev = filp->private_data;
	127
e72022e1	128	return blkdev_ioctl(bdev->bd_inode, NULL, command, arg);
1da177e4 LT	129	}
	130
	131	static void bind_device(struct raw_config_request *rq)
	132	{
38ca6c34	133	device_destroy(raw_class, MKDEV(RAW_MAJOR, rq->raw_minor));
47aa5793 GKH	134	device_create_drvdata(raw_class, NULL, MKDEV(RAW_MAJOR, rq->raw_minor),
47aa5793 GKH	135	NULL, "raw%d", rq->raw_minor);
1da177e4 LT	136	}
	137
	138	/*
	139	* Deal with ioctls against the raw-device control interface, to bind
	140	* and unbind other raw devices.
	141	*/
	142	static int raw_ctl_ioctl(struct inode inode, struct file filp,
	143	unsigned int command, unsigned long arg)
	144	{
	145	struct raw_config_request rq;
	146	struct raw_device_data *rawdev;
	147	int err = 0;
	148
	149	switch (command) {
	150	case RAW_SETBIND:
	151	case RAW_GETBIND:
	152
	153	/* First, find out which raw minor we want */
	154
	155	if (copy_from_user(&rq, (void __user *) arg, sizeof(rq))) {
	156	err = -EFAULT;
	157	goto out;
	158	}
	159
38584c14	160	if (rq.raw_minor <= 0 \|\| rq.raw_minor >= MAX_RAW_MINORS) {
1da177e4 LT	161	err = -EINVAL;
	162	goto out;
	163	}
	164	rawdev = &raw_devices[rq.raw_minor];
	165
	166	if (command == RAW_SETBIND) {
	167	dev_t dev;
	168
	169	/*
	170	* This is like making block devices, so demand the
	171	* same capability
	172	*/
	173	if (!capable(CAP_SYS_ADMIN)) {
	174	err = -EPERM;
	175	goto out;
	176	}
	177
	178	/*
	179	* For now, we don't need to check that the underlying
	180	* block device is present or not: we can do that when
	181	* the raw device is opened. Just check that the
	182	* major/minor numbers make sense.
	183	*/
	184
	185	dev = MKDEV(rq.block_major, rq.block_minor);
	186	if ((rq.block_major == 0 && rq.block_minor != 0) \|\|
	187	MAJOR(dev) != rq.block_major \|\|
	188	MINOR(dev) != rq.block_minor) {
	189	err = -EINVAL;
	190	goto out;
	191	}
	192
8ed965d6	193	mutex_lock(&raw_mutex);
1da177e4	194	if (rawdev->inuse) {
8ed965d6	195	mutex_unlock(&raw_mutex);
1da177e4 LT	196	err = -EBUSY;
	197	goto out;
	198	}
	199	if (rawdev->binding) {
	200	bdput(rawdev->binding);
	201	module_put(THIS_MODULE);
	202	}
	203	if (rq.block_major == 0 && rq.block_minor == 0) {
	204	/* unbind */
	205	rawdev->binding = NULL;
38ca6c34	206	device_destroy(raw_class,
ca8eca68	207	MKDEV(RAW_MAJOR, rq.raw_minor));
1da177e4 LT	208	} else {
	209	rawdev->binding = bdget(dev);
	210	if (rawdev->binding == NULL)
	211	err = -ENOMEM;
	212	else {
	213	__module_get(THIS_MODULE);
	214	bind_device(&rq);
	215	}
	216	}
8ed965d6	217	mutex_unlock(&raw_mutex);
1da177e4 LT	218	} else {
	219	struct block_device *bdev;
	220
8ed965d6	221	mutex_lock(&raw_mutex);
1da177e4 LT	222	bdev = rawdev->binding;
	223	if (bdev) {
	224	rq.block_major = MAJOR(bdev->bd_dev);
	225	rq.block_minor = MINOR(bdev->bd_dev);
	226	} else {
	227	rq.block_major = rq.block_minor = 0;
	228	}
8ed965d6	229	mutex_unlock(&raw_mutex);
1da177e4 LT	230	if (copy_to_user((void __user *)arg, &rq, sizeof(rq))) {
	231	err = -EFAULT;
	232	goto out;
	233	}
	234	}
	235	break;
	236	default:
	237	err = -EINVAL;
	238	break;
	239	}
	240	out:
	241	return err;
	242	}
	243
62322d25	244	static const struct file_operations raw_fops = {
543ade1f	245	.read = do_sync_read,
1da177e4	246	.aio_read = generic_file_aio_read,
543ade1f	247	.write = do_sync_write,
027445c3	248	.aio_write = generic_file_aio_write_nolock,
1da177e4 LT	249	.open = raw_open,
	250	.release= raw_release,
	251	.ioctl = raw_ioctl,
1da177e4 LT	252	.owner = THIS_MODULE,
	253	};
	254
62322d25	255	static const struct file_operations raw_ctl_fops = {
1da177e4 LT	256	.ioctl = raw_ctl_ioctl,
	257	.open = raw_open,
	258	.owner = THIS_MODULE,
	259	};
	260
7e7654a9	261	static struct cdev raw_cdev;
1da177e4 LT	262
	263	static int __init raw_init(void)
	264	{
1da177e4	265	dev_t dev = MKDEV(RAW_MAJOR, 0);
3e26a423	266	int ret;
1da177e4	267
3e26a423 REB	268	ret = register_chrdev_region(dev, MAX_RAW_MINORS, "raw");
3e26a423 REB	269	if (ret)
1da177e4 LT	270	goto error;
	271
	272	cdev_init(&raw_cdev, &raw_fops);
3e26a423 REB	273	ret = cdev_add(&raw_cdev, dev, MAX_RAW_MINORS);
3e26a423 REB	274	if (ret) {
1da177e4	275	kobject_put(&raw_cdev.kobj);
3e26a423	276	goto error_region;
1da177e4 LT	277	}
1da177e4 LT	278
ca8eca68	279	raw_class = class_create(THIS_MODULE, "raw");
1da177e4 LT	280	if (IS_ERR(raw_class)) {
	281	printk(KERN_ERR "Error creating raw class.\n");
	282	cdev_del(&raw_cdev);
3e26a423 REB	283	ret = PTR_ERR(raw_class);
3e26a423 REB	284	goto error_region;
1da177e4	285	}
47aa5793 GKH	286	device_create_drvdata(raw_class, NULL, MKDEV(RAW_MAJOR, 0), NULL,
47aa5793 GKH	287	"rawctl");
1da177e4	288
1da177e4 LT	289	return 0;
1da177e4 LT	290
3e26a423 REB	291	error_region:
3e26a423 REB	292	unregister_chrdev_region(dev, MAX_RAW_MINORS);
1da177e4	293	error:
3e26a423	294	return ret;
1da177e4 LT	295	}
	296
	297	static void __exit raw_exit(void)
	298	{
38ca6c34	299	device_destroy(raw_class, MKDEV(RAW_MAJOR, 0));
ca8eca68	300	class_destroy(raw_class);
1da177e4 LT	301	cdev_del(&raw_cdev);
	302	unregister_chrdev_region(MKDEV(RAW_MAJOR, 0), MAX_RAW_MINORS);
	303	}
	304
	305	module_init(raw_init);
	306	module_exit(raw_exit);
	307	MODULE_LICENSE("GPL");