[mirror_ubuntu-artful-kernel.git] / net / bluetooth / hidp / sock.c

/*
   HIDP implementation for Linux Bluetooth stack (BlueZ).
   Copyright (C) 2003-2004 Marcel Holtmann <marcel@holtmann.org>

   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;

   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
   OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
   FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
   IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
   CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
   WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
   ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
   OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.

   ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
   COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
   SOFTWARE IS DISCLAIMED.
*/

#include <linux/export.h>
#include <linux/file.h>

#include "hidp.h"

static struct bt_sock_list hidp_sk_list = {
	.lock = __RW_LOCK_UNLOCKED(hidp_sk_list.lock)
};

static int hidp_sock_release(struct socket *sock)
{
	struct sock *sk = sock->sk;

	BT_DBG("sock %p sk %p", sock, sk);

	if (!sk)
		return 0;

	bt_sock_unlink(&hidp_sk_list, sk);

	sock_orphan(sk);
	sock_put(sk);

	return 0;
}

static int hidp_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
{
	void __user *argp = (void __user *) arg;
	struct hidp_connadd_req ca;
	struct hidp_conndel_req cd;
	struct hidp_connlist_req cl;
	struct hidp_conninfo ci;
	struct socket *csock;
	struct socket *isock;
	int err;

	BT_DBG("cmd %x arg %lx", cmd, arg);

	switch (cmd) {
	case HIDPCONNADD:
		if (!capable(CAP_NET_ADMIN))
			return -EPERM;

		if (copy_from_user(&ca, argp, sizeof(ca)))
			return -EFAULT;

		csock = sockfd_lookup(ca.ctrl_sock, &err);
		if (!csock)
			return err;

		isock = sockfd_lookup(ca.intr_sock, &err);
		if (!isock) {
			sockfd_put(csock);
			return err;
		}

		err = hidp_connection_add(&ca, csock, isock);
		if (!err && copy_to_user(argp, &ca, sizeof(ca)))
			err = -EFAULT;

		sockfd_put(csock);
		sockfd_put(isock);

		return err;

	case HIDPCONNDEL:
		if (!capable(CAP_NET_ADMIN))
			return -EPERM;

		if (copy_from_user(&cd, argp, sizeof(cd)))
			return -EFAULT;

		return hidp_connection_del(&cd);

	case HIDPGETCONNLIST:
		if (copy_from_user(&cl, argp, sizeof(cl)))
			return -EFAULT;

		if (cl.cnum <= 0)
			return -EINVAL;

		err = hidp_get_connlist(&cl);
		if (!err && copy_to_user(argp, &cl, sizeof(cl)))
			return -EFAULT;

		return err;

	case HIDPGETCONNINFO:
		if (copy_from_user(&ci, argp, sizeof(ci)))
			return -EFAULT;

		err = hidp_get_conninfo(&ci);
		if (!err && copy_to_user(argp, &ci, sizeof(ci)))
			return -EFAULT;

		return err;
	}

	return -EINVAL;
}

#ifdef CONFIG_COMPAT
struct compat_hidp_connadd_req {
	int   ctrl_sock;	/* Connected control socket */
	int   intr_sock;	/* Connected interrupt socket */
	__u16 parser;
	__u16 rd_size;
	compat_uptr_t rd_data;
	__u8  country;
	__u8  subclass;
	__u16 vendor;
	__u16 product;
	__u16 version;
	__u32 flags;
	__u32 idle_to;
	char  name[128];
};

static int hidp_sock_compat_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
{
	if (cmd == HIDPGETCONNLIST) {
		struct hidp_connlist_req cl;
		u32 uci;
		int err;

		if (get_user(cl.cnum, (u32 __user *) arg) ||
				get_user(uci, (u32 __user *) (arg + 4)))
			return -EFAULT;

		cl.ci = compat_ptr(uci);

		if (cl.cnum <= 0)
			return -EINVAL;

		err = hidp_get_connlist(&cl);

		if (!err && put_user(cl.cnum, (u32 __user *) arg))
			err = -EFAULT;

		return err;
	} else if (cmd == HIDPCONNADD) {
		struct compat_hidp_connadd_req ca;
		struct hidp_connadd_req __user *uca;

		uca = compat_alloc_user_space(sizeof(*uca));

		if (copy_from_user(&ca, (void __user *) arg, sizeof(ca)))
			return -EFAULT;

		if (put_user(ca.ctrl_sock, &uca->ctrl_sock) ||
				put_user(ca.intr_sock, &uca->intr_sock) ||
				put_user(ca.parser, &uca->parser) ||
				put_user(ca.rd_size, &uca->rd_size) ||
				put_user(compat_ptr(ca.rd_data), &uca->rd_data) ||
				put_user(ca.country, &uca->country) ||
				put_user(ca.subclass, &uca->subclass) ||
				put_user(ca.vendor, &uca->vendor) ||
				put_user(ca.product, &uca->product) ||
				put_user(ca.version, &uca->version) ||
				put_user(ca.flags, &uca->flags) ||
				put_user(ca.idle_to, &uca->idle_to) ||
				copy_to_user(&uca->name[0], &ca.name[0], 128))
			return -EFAULT;

		arg = (unsigned long) uca;

		/* Fall through. We don't actually write back any _changes_
		   to the structure anyway, so there's no need to copy back
		   into the original compat version */
	}

	return hidp_sock_ioctl(sock, cmd, arg);
}
#endif

static const struct proto_ops hidp_sock_ops = {
	.family		= PF_BLUETOOTH,
	.owner		= THIS_MODULE,
	.release	= hidp_sock_release,
	.ioctl		= hidp_sock_ioctl,
#ifdef CONFIG_COMPAT
	.compat_ioctl	= hidp_sock_compat_ioctl,
#endif
	.bind		= sock_no_bind,
	.getname	= sock_no_getname,
	.sendmsg	= sock_no_sendmsg,
	.recvmsg	= sock_no_recvmsg,
	.poll		= sock_no_poll,
	.listen		= sock_no_listen,
	.shutdown	= sock_no_shutdown,
	.setsockopt	= sock_no_setsockopt,
	.getsockopt	= sock_no_getsockopt,
	.connect	= sock_no_connect,
	.socketpair	= sock_no_socketpair,
	.accept		= sock_no_accept,
	.mmap		= sock_no_mmap
};

static struct proto hidp_proto = {
	.name		= "HIDP",
	.owner		= THIS_MODULE,
	.obj_size	= sizeof(struct bt_sock)
};

static int hidp_sock_create(struct net *net, struct socket *sock, int protocol,
			    int kern)
{
	struct sock *sk;

	BT_DBG("sock %p", sock);

	if (sock->type != SOCK_RAW)
		return -ESOCKTNOSUPPORT;

	sk = sk_alloc(net, PF_BLUETOOTH, GFP_ATOMIC, &hidp_proto);
	if (!sk)
		return -ENOMEM;

	sock_init_data(sock, sk);

	sock->ops = &hidp_sock_ops;

	sock->state = SS_UNCONNECTED;

	sock_reset_flag(sk, SOCK_ZAPPED);

	sk->sk_protocol = protocol;
	sk->sk_state	= BT_OPEN;

	bt_sock_link(&hidp_sk_list, sk);

	return 0;
}

static const struct net_proto_family hidp_sock_family_ops = {
	.family	= PF_BLUETOOTH,
	.owner	= THIS_MODULE,
	.create	= hidp_sock_create
};

int __init hidp_init_sockets(void)
{
	int err;

	err = proto_register(&hidp_proto, 0);
	if (err < 0)
		return err;

	err = bt_sock_register(BTPROTO_HIDP, &hidp_sock_family_ops);
	if (err < 0) {
		BT_ERR("Can't register HIDP socket");
		goto error;
	}

	err = bt_procfs_init(&init_net, "hidp", &hidp_sk_list, NULL);
	if (err < 0) {
		BT_ERR("Failed to create HIDP proc file");
		bt_sock_unregister(BTPROTO_HIDP);
		goto error;
	}

	BT_INFO("HIDP socket layer initialized");

	return 0;

error:
	proto_unregister(&hidp_proto);
	return err;
}

void __exit hidp_cleanup_sockets(void)
{
	bt_procfs_cleanup(&init_net, "hidp");
	bt_sock_unregister(BTPROTO_HIDP);
	proto_unregister(&hidp_proto);
}
Commit	Line	Data
8e87d142	1	/*
1da177e4 LT	2	HIDP implementation for Linux Bluetooth stack (BlueZ).
	3	Copyright (C) 2003-2004 Marcel Holtmann <marcel@holtmann.org>
	4
	5	This program is free software; you can redistribute it and/or modify
	6	it under the terms of the GNU General Public License version 2 as
	7	published by the Free Software Foundation;
	8
	9	THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
	10	OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	11	FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
	12	IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
8e87d142 YH	13	CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
	14	WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
	15	ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
1da177e4 LT	16	OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
1da177e4 LT	17
8e87d142 YH	18	ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
8e87d142 YH	19	COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
1da177e4 LT	20	SOFTWARE IS DISCLAIMED.
	21	*/
	22
8c520a59	23	#include <linux/export.h>
1da177e4	24	#include <linux/file.h>
1da177e4 LT	25
	26	#include "hidp.h"
	27
5c6ad8ee MY	28	static struct bt_sock_list hidp_sk_list = {
	29	.lock = __RW_LOCK_UNLOCKED(hidp_sk_list.lock)
	30	};
	31
1da177e4 LT	32	static int hidp_sock_release(struct socket *sock)
	33	{
	34	struct sock *sk = sock->sk;
	35
	36	BT_DBG("sock %p sk %p", sock, sk);
	37
	38	if (!sk)
	39	return 0;
	40
5c6ad8ee MY	41	bt_sock_unlink(&hidp_sk_list, sk);
5c6ad8ee MY	42
1da177e4 LT	43	sock_orphan(sk);
	44	sock_put(sk);
	45
	46	return 0;
	47	}
	48
	49	static int hidp_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
	50	{
	51	void __user argp = (void __user ) arg;
	52	struct hidp_connadd_req ca;
	53	struct hidp_conndel_req cd;
	54	struct hidp_connlist_req cl;
	55	struct hidp_conninfo ci;
	56	struct socket *csock;
	57	struct socket *isock;
	58	int err;
	59
	60	BT_DBG("cmd %x arg %lx", cmd, arg);
	61
	62	switch (cmd) {
	63	case HIDPCONNADD:
	64	if (!capable(CAP_NET_ADMIN))
bf5b30b8	65	return -EPERM;
1da177e4 LT	66
	67	if (copy_from_user(&ca, argp, sizeof(ca)))
	68	return -EFAULT;
	69
	70	csock = sockfd_lookup(ca.ctrl_sock, &err);
	71	if (!csock)
	72	return err;
	73
	74	isock = sockfd_lookup(ca.intr_sock, &err);
	75	if (!isock) {
67b23219	76	sockfd_put(csock);
1da177e4 LT	77	return err;
	78	}
	79
5205185d DH	80	err = hidp_connection_add(&ca, csock, isock);
	81	if (!err && copy_to_user(argp, &ca, sizeof(ca)))
	82	err = -EFAULT;
1da177e4	83
5205185d DH	84	sockfd_put(csock);
5205185d DH	85	sockfd_put(isock);
1da177e4 LT	86
	87	return err;
	88
	89	case HIDPCONNDEL:
	90	if (!capable(CAP_NET_ADMIN))
bf5b30b8	91	return -EPERM;
1da177e4 LT	92
	93	if (copy_from_user(&cd, argp, sizeof(cd)))
	94	return -EFAULT;
	95
5205185d	96	return hidp_connection_del(&cd);
1da177e4 LT	97
	98	case HIDPGETCONNLIST:
	99	if (copy_from_user(&cl, argp, sizeof(cl)))
	100	return -EFAULT;
	101
	102	if (cl.cnum <= 0)
	103	return -EINVAL;
	104
	105	err = hidp_get_connlist(&cl);
	106	if (!err && copy_to_user(argp, &cl, sizeof(cl)))
	107	return -EFAULT;
	108
	109	return err;
	110
	111	case HIDPGETCONNINFO:
	112	if (copy_from_user(&ci, argp, sizeof(ci)))
	113	return -EFAULT;
	114
	115	err = hidp_get_conninfo(&ci);
	116	if (!err && copy_to_user(argp, &ci, sizeof(ci)))
	117	return -EFAULT;
	118
	119	return err;
	120	}
	121
	122	return -EINVAL;
	123	}
	124
e9c5702e MH	125	#ifdef CONFIG_COMPAT
e9c5702e MH	126	struct compat_hidp_connadd_req {
17f09a7e SJ	127	int ctrl_sock; /* Connected control socket */
17f09a7e SJ	128	int intr_sock; /* Connected interrupt socket */
e9c5702e MH	129	__u16 parser;
	130	__u16 rd_size;
	131	compat_uptr_t rd_data;
	132	__u8 country;
	133	__u8 subclass;
	134	__u16 vendor;
	135	__u16 product;
	136	__u16 version;
	137	__u32 flags;
	138	__u32 idle_to;
	139	char name[128];
	140	};
	141
	142	static int hidp_sock_compat_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
	143	{
	144	if (cmd == HIDPGETCONNLIST) {
	145	struct hidp_connlist_req cl;
816a11d5	146	u32 uci;
e9c5702e MH	147	int err;
e9c5702e MH	148
816a11d5	149	if (get_user(cl.cnum, (u32 __user *) arg) \|\|
e9c5702e MH	150	get_user(uci, (u32 __user *) (arg + 4)))
	151	return -EFAULT;
	152
	153	cl.ci = compat_ptr(uci);
	154
	155	if (cl.cnum <= 0)
	156	return -EINVAL;
	157
	158	err = hidp_get_connlist(&cl);
	159
816a11d5	160	if (!err && put_user(cl.cnum, (u32 __user *) arg))
e9c5702e MH	161	err = -EFAULT;
	162
	163	return err;
	164	} else if (cmd == HIDPCONNADD) {
	165	struct compat_hidp_connadd_req ca;
	166	struct hidp_connadd_req __user *uca;
	167
	168	uca = compat_alloc_user_space(sizeof(*uca));
	169
55e74744	170	if (copy_from_user(&ca, (void __user *) arg, sizeof(ca)))
e9c5702e MH	171	return -EFAULT;
	172
	173	if (put_user(ca.ctrl_sock, &uca->ctrl_sock) \|\|
	174	put_user(ca.intr_sock, &uca->intr_sock) \|\|
	175	put_user(ca.parser, &uca->parser) \|\|
a83d6c0d	176	put_user(ca.rd_size, &uca->rd_size) \|\|
e9c5702e MH	177	put_user(compat_ptr(ca.rd_data), &uca->rd_data) \|\|
	178	put_user(ca.country, &uca->country) \|\|
	179	put_user(ca.subclass, &uca->subclass) \|\|
	180	put_user(ca.vendor, &uca->vendor) \|\|
	181	put_user(ca.product, &uca->product) \|\|
	182	put_user(ca.version, &uca->version) \|\|
	183	put_user(ca.flags, &uca->flags) \|\|
	184	put_user(ca.idle_to, &uca->idle_to) \|\|
	185	copy_to_user(&uca->name[0], &ca.name[0], 128))
	186	return -EFAULT;
8e87d142	187
e9c5702e MH	188	arg = (unsigned long) uca;
	189
	190	/* Fall through. We don't actually write back any _changes_
	191	to the structure anyway, so there's no need to copy back
	192	into the original compat version */
	193	}
	194
	195	return hidp_sock_ioctl(sock, cmd, arg);
	196	}
	197	#endif
	198
90ddc4f0	199	static const struct proto_ops hidp_sock_ops = {
1da177e4 LT	200	.family = PF_BLUETOOTH,
	201	.owner = THIS_MODULE,
	202	.release = hidp_sock_release,
	203	.ioctl = hidp_sock_ioctl,
e9c5702e MH	204	#ifdef CONFIG_COMPAT
	205	.compat_ioctl = hidp_sock_compat_ioctl,
	206	#endif
1da177e4 LT	207	.bind = sock_no_bind,
	208	.getname = sock_no_getname,
	209	.sendmsg = sock_no_sendmsg,
	210	.recvmsg = sock_no_recvmsg,
	211	.poll = sock_no_poll,
	212	.listen = sock_no_listen,
	213	.shutdown = sock_no_shutdown,
	214	.setsockopt = sock_no_setsockopt,
	215	.getsockopt = sock_no_getsockopt,
	216	.connect = sock_no_connect,
	217	.socketpair = sock_no_socketpair,
	218	.accept = sock_no_accept,
	219	.mmap = sock_no_mmap
	220	};
	221
	222	static struct proto hidp_proto = {
	223	.name = "HIDP",
	224	.owner = THIS_MODULE,
	225	.obj_size = sizeof(struct bt_sock)
	226	};
	227
3f378b68 EP	228	static int hidp_sock_create(struct net net, struct socket sock, int protocol,
3f378b68 EP	229	int kern)
1da177e4 LT	230	{
	231	struct sock *sk;
	232
	233	BT_DBG("sock %p", sock);
	234
	235	if (sock->type != SOCK_RAW)
	236	return -ESOCKTNOSUPPORT;
	237
6257ff21	238	sk = sk_alloc(net, PF_BLUETOOTH, GFP_ATOMIC, &hidp_proto);
1da177e4 LT	239	if (!sk)
	240	return -ENOMEM;
	241
	242	sock_init_data(sock, sk);
	243
	244	sock->ops = &hidp_sock_ops;
	245
	246	sock->state = SS_UNCONNECTED;
	247
	248	sock_reset_flag(sk, SOCK_ZAPPED);
	249
	250	sk->sk_protocol = protocol;
	251	sk->sk_state = BT_OPEN;
	252
5c6ad8ee MY	253	bt_sock_link(&hidp_sk_list, sk);
5c6ad8ee MY	254
1da177e4 LT	255	return 0;
	256	}
	257
ec1b4cf7	258	static const struct net_proto_family hidp_sock_family_ops = {
1da177e4 LT	259	.family = PF_BLUETOOTH,
	260	.owner = THIS_MODULE,
	261	.create = hidp_sock_create
	262	};
	263
	264	int __init hidp_init_sockets(void)
	265	{
	266	int err;
	267
	268	err = proto_register(&hidp_proto, 0);
	269	if (err < 0)
	270	return err;
	271
	272	err = bt_sock_register(BTPROTO_HIDP, &hidp_sock_family_ops);
5c6ad8ee MY	273	if (err < 0) {
5c6ad8ee MY	274	BT_ERR("Can't register HIDP socket");
1da177e4	275	goto error;
5c6ad8ee MY	276	}
5c6ad8ee MY	277
b0316615	278	err = bt_procfs_init(&init_net, "hidp", &hidp_sk_list, NULL);
5c6ad8ee MY	279	if (err < 0) {
	280	BT_ERR("Failed to create HIDP proc file");
	281	bt_sock_unregister(BTPROTO_HIDP);
	282	goto error;
	283	}
	284
	285	BT_INFO("HIDP socket layer initialized");
1da177e4 LT	286
	287	return 0;
	288
	289	error:
1da177e4 LT	290	proto_unregister(&hidp_proto);
	291	return err;
	292	}
	293
	294	void __exit hidp_cleanup_sockets(void)
	295	{
5c6ad8ee	296	bt_procfs_cleanup(&init_net, "hidp");
5e9d7f86	297	bt_sock_unregister(BTPROTO_HIDP);
1da177e4 LT	298	proto_unregister(&hidp_proto);
1da177e4 LT	299	}