[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / bluetooth / af_bluetooth.c

/*
   BlueZ - Bluetooth protocol stack for Linux
   Copyright (C) 2000-2001 Qualcomm Incorporated

   Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>

   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.
*/

/* Bluetooth address family and sockets. */

#include <linux/module.h>
#include <asm/ioctls.h>

#include <net/bluetooth/bluetooth.h>
#include <linux/proc_fs.h>

#define VERSION "2.16"

/* Bluetooth sockets */
#define BT_MAX_PROTO	8
static const struct net_proto_family *bt_proto[BT_MAX_PROTO];
static DEFINE_RWLOCK(bt_proto_lock);

static struct lock_class_key bt_lock_key[BT_MAX_PROTO];
static const char *const bt_key_strings[BT_MAX_PROTO] = {
	"sk_lock-AF_BLUETOOTH-BTPROTO_L2CAP",
	"sk_lock-AF_BLUETOOTH-BTPROTO_HCI",
	"sk_lock-AF_BLUETOOTH-BTPROTO_SCO",
	"sk_lock-AF_BLUETOOTH-BTPROTO_RFCOMM",
	"sk_lock-AF_BLUETOOTH-BTPROTO_BNEP",
	"sk_lock-AF_BLUETOOTH-BTPROTO_CMTP",
	"sk_lock-AF_BLUETOOTH-BTPROTO_HIDP",
	"sk_lock-AF_BLUETOOTH-BTPROTO_AVDTP",
};

static struct lock_class_key bt_slock_key[BT_MAX_PROTO];
static const char *const bt_slock_key_strings[BT_MAX_PROTO] = {
	"slock-AF_BLUETOOTH-BTPROTO_L2CAP",
	"slock-AF_BLUETOOTH-BTPROTO_HCI",
	"slock-AF_BLUETOOTH-BTPROTO_SCO",
	"slock-AF_BLUETOOTH-BTPROTO_RFCOMM",
	"slock-AF_BLUETOOTH-BTPROTO_BNEP",
	"slock-AF_BLUETOOTH-BTPROTO_CMTP",
	"slock-AF_BLUETOOTH-BTPROTO_HIDP",
	"slock-AF_BLUETOOTH-BTPROTO_AVDTP",
};

void bt_sock_reclassify_lock(struct sock *sk, int proto)
{
	BUG_ON(!sk);
	BUG_ON(sock_owned_by_user(sk));

	sock_lock_init_class_and_name(sk,
			bt_slock_key_strings[proto], &bt_slock_key[proto],
				bt_key_strings[proto], &bt_lock_key[proto]);
}
EXPORT_SYMBOL(bt_sock_reclassify_lock);

int bt_sock_register(int proto, const struct net_proto_family *ops)
{
	int err = 0;

	if (proto < 0 || proto >= BT_MAX_PROTO)
		return -EINVAL;

	write_lock(&bt_proto_lock);

	if (bt_proto[proto])
		err = -EEXIST;
	else
		bt_proto[proto] = ops;

	write_unlock(&bt_proto_lock);

	return err;
}
EXPORT_SYMBOL(bt_sock_register);

int bt_sock_unregister(int proto)
{
	int err = 0;

	if (proto < 0 || proto >= BT_MAX_PROTO)
		return -EINVAL;

	write_lock(&bt_proto_lock);

	if (!bt_proto[proto])
		err = -ENOENT;
	else
		bt_proto[proto] = NULL;

	write_unlock(&bt_proto_lock);

	return err;
}
EXPORT_SYMBOL(bt_sock_unregister);

static int bt_sock_create(struct net *net, struct socket *sock, int proto,
			  int kern)
{
	int err;

	if (net != &init_net)
		return -EAFNOSUPPORT;

	if (proto < 0 || proto >= BT_MAX_PROTO)
		return -EINVAL;

	if (!bt_proto[proto])
		request_module("bt-proto-%d", proto);

	err = -EPROTONOSUPPORT;

	read_lock(&bt_proto_lock);

	if (bt_proto[proto] && try_module_get(bt_proto[proto]->owner)) {
		err = bt_proto[proto]->create(net, sock, proto, kern);
		if (!err)
			bt_sock_reclassify_lock(sock->sk, proto);
		module_put(bt_proto[proto]->owner);
	}

	read_unlock(&bt_proto_lock);

	return err;
}

void bt_sock_link(struct bt_sock_list *l, struct sock *sk)
{
	write_lock(&l->lock);
	sk_add_node(sk, &l->head);
	write_unlock(&l->lock);
}
EXPORT_SYMBOL(bt_sock_link);

void bt_sock_unlink(struct bt_sock_list *l, struct sock *sk)
{
	write_lock(&l->lock);
	sk_del_node_init(sk);
	write_unlock(&l->lock);
}
EXPORT_SYMBOL(bt_sock_unlink);

void bt_accept_enqueue(struct sock *parent, struct sock *sk)
{
	BT_DBG("parent %p, sk %p", parent, sk);

	sock_hold(sk);
	list_add_tail(&bt_sk(sk)->accept_q, &bt_sk(parent)->accept_q);
	bt_sk(sk)->parent = parent;
	parent->sk_ack_backlog++;
}
EXPORT_SYMBOL(bt_accept_enqueue);

void bt_accept_unlink(struct sock *sk)
{
	BT_DBG("sk %p state %d", sk, sk->sk_state);

	list_del_init(&bt_sk(sk)->accept_q);
	bt_sk(sk)->parent->sk_ack_backlog--;
	bt_sk(sk)->parent = NULL;
	sock_put(sk);
}
EXPORT_SYMBOL(bt_accept_unlink);

struct sock *bt_accept_dequeue(struct sock *parent, struct socket *newsock)
{
	struct list_head *p, *n;
	struct sock *sk;

	BT_DBG("parent %p", parent);

	list_for_each_safe(p, n, &bt_sk(parent)->accept_q) {
		sk = (struct sock *) list_entry(p, struct bt_sock, accept_q);

		lock_sock(sk);

		/* FIXME: Is this check still needed */
		if (sk->sk_state == BT_CLOSED) {
			release_sock(sk);
			bt_accept_unlink(sk);
			continue;
		}

		if (sk->sk_state == BT_CONNECTED || !newsock ||
		    test_bit(BT_SK_DEFER_SETUP, &bt_sk(parent)->flags)) {
			bt_accept_unlink(sk);
			if (newsock)
				sock_graft(sk, newsock);

			release_sock(sk);
			return sk;
		}

		release_sock(sk);
	}

	return NULL;
}
EXPORT_SYMBOL(bt_accept_dequeue);

int bt_sock_recvmsg(struct kiocb *iocb, struct socket *sock,
				struct msghdr *msg, size_t len, int flags)
{
	int noblock = flags & MSG_DONTWAIT;
	struct sock *sk = sock->sk;
	struct sk_buff *skb;
	size_t copied;
	int err;

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

	if (flags & (MSG_OOB))
		return -EOPNOTSUPP;

	skb = skb_recv_datagram(sk, flags, noblock, &err);
	if (!skb) {
		if (sk->sk_shutdown & RCV_SHUTDOWN)
			return 0;
		return err;
	}

	msg->msg_namelen = 0;

	copied = skb->len;
	if (len < copied) {
		msg->msg_flags |= MSG_TRUNC;
		copied = len;
	}

	skb_reset_transport_header(skb);
	err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
	if (err == 0)
		sock_recv_ts_and_drops(msg, sk, skb);

	skb_free_datagram(sk, skb);

	return err ? : copied;
}
EXPORT_SYMBOL(bt_sock_recvmsg);

static long bt_sock_data_wait(struct sock *sk, long timeo)
{
	DECLARE_WAITQUEUE(wait, current);

	add_wait_queue(sk_sleep(sk), &wait);
	for (;;) {
		set_current_state(TASK_INTERRUPTIBLE);

		if (!skb_queue_empty(&sk->sk_receive_queue))
			break;

		if (sk->sk_err || (sk->sk_shutdown & RCV_SHUTDOWN))
			break;

		if (signal_pending(current) || !timeo)
			break;

		set_bit(SOCK_ASYNC_WAITDATA, &sk->sk_socket->flags);
		release_sock(sk);
		timeo = schedule_timeout(timeo);
		lock_sock(sk);
		clear_bit(SOCK_ASYNC_WAITDATA, &sk->sk_socket->flags);
	}

	__set_current_state(TASK_RUNNING);
	remove_wait_queue(sk_sleep(sk), &wait);
	return timeo;
}

int bt_sock_stream_recvmsg(struct kiocb *iocb, struct socket *sock,
			       struct msghdr *msg, size_t size, int flags)
{
	struct sock *sk = sock->sk;
	int err = 0;
	size_t target, copied = 0;
	long timeo;

	if (flags & MSG_OOB)
		return -EOPNOTSUPP;

	msg->msg_namelen = 0;

	BT_DBG("sk %p size %zu", sk, size);

	lock_sock(sk);

	target = sock_rcvlowat(sk, flags & MSG_WAITALL, size);
	timeo  = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);

	do {
		struct sk_buff *skb;
		int chunk;

		skb = skb_dequeue(&sk->sk_receive_queue);
		if (!skb) {
			if (copied >= target)
				break;

			err = sock_error(sk);
			if (err)
				break;
			if (sk->sk_shutdown & RCV_SHUTDOWN)
				break;

			err = -EAGAIN;
			if (!timeo)
				break;

			timeo = bt_sock_data_wait(sk, timeo);

			if (signal_pending(current)) {
				err = sock_intr_errno(timeo);
				goto out;
			}
			continue;
		}

		chunk = min_t(unsigned int, skb->len, size);
		if (skb_copy_datagram_iovec(skb, 0, msg->msg_iov, chunk)) {
			skb_queue_head(&sk->sk_receive_queue, skb);
			if (!copied)
				copied = -EFAULT;
			break;
		}
		copied += chunk;
		size   -= chunk;

		sock_recv_ts_and_drops(msg, sk, skb);

		if (!(flags & MSG_PEEK)) {
			int skb_len = skb_headlen(skb);

			if (chunk <= skb_len) {
				__skb_pull(skb, chunk);
			} else {
				struct sk_buff *frag;

				__skb_pull(skb, skb_len);
				chunk -= skb_len;

				skb_walk_frags(skb, frag) {
					if (chunk <= frag->len) {
						/* Pulling partial data */
						skb->len -= chunk;
						skb->data_len -= chunk;
						__skb_pull(frag, chunk);
						break;
					} else if (frag->len) {
						/* Pulling all frag data */
						chunk -= frag->len;
						skb->len -= frag->len;
						skb->data_len -= frag->len;
						__skb_pull(frag, frag->len);
					}
				}
			}

			if (skb->len) {
				skb_queue_head(&sk->sk_receive_queue, skb);
				break;
			}
			kfree_skb(skb);

		} else {
			/* put message back and return */
			skb_queue_head(&sk->sk_receive_queue, skb);
			break;
		}
	} while (size);

out:
	release_sock(sk);
	return copied ? : err;
}
EXPORT_SYMBOL(bt_sock_stream_recvmsg);

static inline unsigned int bt_accept_poll(struct sock *parent)
{
	struct list_head *p, *n;
	struct sock *sk;

	list_for_each_safe(p, n, &bt_sk(parent)->accept_q) {
		sk = (struct sock *) list_entry(p, struct bt_sock, accept_q);
		if (sk->sk_state == BT_CONNECTED ||
		    (test_bit(BT_SK_DEFER_SETUP, &bt_sk(parent)->flags) &&
		     sk->sk_state == BT_CONNECT2))
			return POLLIN | POLLRDNORM;
	}

	return 0;
}

unsigned int bt_sock_poll(struct file *file, struct socket *sock,
			  poll_table *wait)
{
	struct sock *sk = sock->sk;
	unsigned int mask = 0;

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

	poll_wait(file, sk_sleep(sk), wait);

	if (sk->sk_state == BT_LISTEN)
		return bt_accept_poll(sk);

	if (sk->sk_err || !skb_queue_empty(&sk->sk_error_queue))
		mask |= POLLERR;

	if (sk->sk_shutdown & RCV_SHUTDOWN)
		mask |= POLLRDHUP | POLLIN | POLLRDNORM;

	if (sk->sk_shutdown == SHUTDOWN_MASK)
		mask |= POLLHUP;

	if (!skb_queue_empty(&sk->sk_receive_queue))
		mask |= POLLIN | POLLRDNORM;

	if (sk->sk_state == BT_CLOSED)
		mask |= POLLHUP;

	if (sk->sk_state == BT_CONNECT ||
			sk->sk_state == BT_CONNECT2 ||
			sk->sk_state == BT_CONFIG)
		return mask;

	if (!test_bit(BT_SK_SUSPEND, &bt_sk(sk)->flags) && sock_writeable(sk))
		mask |= POLLOUT | POLLWRNORM | POLLWRBAND;
	else
		set_bit(SOCK_ASYNC_NOSPACE, &sk->sk_socket->flags);

	return mask;
}
EXPORT_SYMBOL(bt_sock_poll);

int bt_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
{
	struct sock *sk = sock->sk;
	struct sk_buff *skb;
	long amount;
	int err;

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

	switch (cmd) {
	case TIOCOUTQ:
		if (sk->sk_state == BT_LISTEN)
			return -EINVAL;

		amount = sk->sk_sndbuf - sk_wmem_alloc_get(sk);
		if (amount < 0)
			amount = 0;
		err = put_user(amount, (int __user *) arg);
		break;

	case TIOCINQ:
		if (sk->sk_state == BT_LISTEN)
			return -EINVAL;

		lock_sock(sk);
		skb = skb_peek(&sk->sk_receive_queue);
		amount = skb ? skb->len : 0;
		release_sock(sk);
		err = put_user(amount, (int __user *) arg);
		break;

	case SIOCGSTAMP:
		err = sock_get_timestamp(sk, (struct timeval __user *) arg);
		break;

	case SIOCGSTAMPNS:
		err = sock_get_timestampns(sk, (struct timespec __user *) arg);
		break;

	default:
		err = -ENOIOCTLCMD;
		break;
	}

	return err;
}
EXPORT_SYMBOL(bt_sock_ioctl);

int bt_sock_wait_state(struct sock *sk, int state, unsigned long timeo)
{
	DECLARE_WAITQUEUE(wait, current);
	int err = 0;

	BT_DBG("sk %p", sk);

	add_wait_queue(sk_sleep(sk), &wait);
	set_current_state(TASK_INTERRUPTIBLE);
	while (sk->sk_state != state) {
		if (!timeo) {
			err = -EINPROGRESS;
			break;
		}

		if (signal_pending(current)) {
			err = sock_intr_errno(timeo);
			break;
		}

		release_sock(sk);
		timeo = schedule_timeout(timeo);
		lock_sock(sk);
		set_current_state(TASK_INTERRUPTIBLE);

		err = sock_error(sk);
		if (err)
			break;
	}
	__set_current_state(TASK_RUNNING);
	remove_wait_queue(sk_sleep(sk), &wait);
	return err;
}
EXPORT_SYMBOL(bt_sock_wait_state);

#ifdef CONFIG_PROC_FS
struct bt_seq_state {
	struct bt_sock_list *l;
};

static void *bt_seq_start(struct seq_file *seq, loff_t *pos)
	__acquires(seq->private->l->lock)
{
	struct bt_seq_state *s = seq->private;
	struct bt_sock_list *l = s->l;

	read_lock(&l->lock);
	return seq_hlist_start_head(&l->head, *pos);
}

static void *bt_seq_next(struct seq_file *seq, void *v, loff_t *pos)
{
	struct bt_seq_state *s = seq->private;
	struct bt_sock_list *l = s->l;

	return seq_hlist_next(v, &l->head, pos);
}

static void bt_seq_stop(struct seq_file *seq, void *v)
	__releases(seq->private->l->lock)
{
	struct bt_seq_state *s = seq->private;
	struct bt_sock_list *l = s->l;

	read_unlock(&l->lock);
}

static int bt_seq_show(struct seq_file *seq, void *v)
{
	struct bt_seq_state *s = seq->private;
	struct bt_sock_list *l = s->l;

	if (v == SEQ_START_TOKEN) {
		seq_puts(seq ,"sk               RefCnt Rmem   Wmem   User   Inode  Src Dst Parent");

		if (l->custom_seq_show) {
			seq_putc(seq, ' ');
			l->custom_seq_show(seq, v);
		}

		seq_putc(seq, '\n');
	} else {
		struct sock *sk = sk_entry(v);
		struct bt_sock *bt = bt_sk(sk);

		seq_printf(seq,
			   "%pK %-6d %-6u %-6u %-6u %-6lu %pMR %pMR %-6lu",
			   sk,
			   atomic_read(&sk->sk_refcnt),
			   sk_rmem_alloc_get(sk),
			   sk_wmem_alloc_get(sk),
			   from_kuid(seq_user_ns(seq), sock_i_uid(sk)),
			   sock_i_ino(sk),
			   &bt->src,
			   &bt->dst,
			   bt->parent? sock_i_ino(bt->parent): 0LU);

		if (l->custom_seq_show) {
			seq_putc(seq, ' ');
			l->custom_seq_show(seq, v);
		}

		seq_putc(seq, '\n');
	}
	return 0;
}

static struct seq_operations bt_seq_ops = {
	.start = bt_seq_start,
	.next  = bt_seq_next,
	.stop  = bt_seq_stop,
	.show  = bt_seq_show,
};

static int bt_seq_open(struct inode *inode, struct file *file)
{
	struct bt_sock_list *sk_list;
	struct bt_seq_state *s;

	sk_list = PDE_DATA(inode);
	s = __seq_open_private(file, &bt_seq_ops,
			       sizeof(struct bt_seq_state));
	if (!s)
		return -ENOMEM;

	s->l = sk_list;
	return 0;
}

static const struct file_operations bt_fops = {
	.open = bt_seq_open,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = seq_release_private
};

int bt_procfs_init(struct net *net, const char *name,
		   struct bt_sock_list* sk_list,
		   int (* seq_show)(struct seq_file *, void *))
{
	struct proc_dir_entry * pde;

	sk_list->custom_seq_show = seq_show;

	pde = proc_create(name, 0, net->proc_net, &bt_fops);
	if (!pde)
		return -ENOMEM;

	pde->data = sk_list;

	return 0;
}

void bt_procfs_cleanup(struct net *net, const char *name)
{
	remove_proc_entry(name, net->proc_net);
}
#else
int bt_procfs_init(struct net *net, const char *name,
		   struct bt_sock_list* sk_list,
		   int (* seq_show)(struct seq_file *, void *))
{
	return 0;
}

void bt_procfs_cleanup(struct net *net, const char *name)
{
}
#endif
EXPORT_SYMBOL(bt_procfs_init);
EXPORT_SYMBOL(bt_procfs_cleanup);

static struct net_proto_family bt_sock_family_ops = {
	.owner	= THIS_MODULE,
	.family	= PF_BLUETOOTH,
	.create	= bt_sock_create,
};

static int __init bt_init(void)
{
	int err;

	BT_INFO("Core ver %s", VERSION);

	err = bt_sysfs_init();
	if (err < 0)
		return err;

	err = sock_register(&bt_sock_family_ops);
	if (err < 0) {
		bt_sysfs_cleanup();
		return err;
	}

	BT_INFO("HCI device and connection manager initialized");

	err = hci_sock_init();
	if (err < 0)
		goto error;

	err = l2cap_init();
	if (err < 0)
		goto sock_err;

	err = sco_init();
	if (err < 0) {
		l2cap_exit();
		goto sock_err;
	}

	return 0;

sock_err:
	hci_sock_cleanup();

error:
	sock_unregister(PF_BLUETOOTH);
	bt_sysfs_cleanup();

	return err;
}

static void __exit bt_exit(void)
{

	sco_exit();

	l2cap_exit();

	hci_sock_cleanup();

	sock_unregister(PF_BLUETOOTH);

	bt_sysfs_cleanup();
}

subsys_initcall(bt_init);
module_exit(bt_exit);

MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
MODULE_DESCRIPTION("Bluetooth Core ver " VERSION);
MODULE_VERSION(VERSION);
MODULE_LICENSE("GPL");
MODULE_ALIAS_NETPROTO(PF_BLUETOOTH);
Commit	Line	Data
8e87d142	1	/*
1da177e4 LT	2	BlueZ - Bluetooth protocol stack for Linux
	3	Copyright (C) 2000-2001 Qualcomm Incorporated
	4
	5	Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
	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 version 2 as
	9	published by the Free Software Foundation;
	10
	11	THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
	12	OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	13	FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
	14	IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
8e87d142 YH	15	CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
	16	WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
	17	ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
1da177e4 LT	18	OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
1da177e4 LT	19
8e87d142 YH	20	ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
8e87d142 YH	21	COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
1da177e4 LT	22	SOFTWARE IS DISCLAIMED.
	23	*/
	24
	25	/* Bluetooth address family and sockets. */
	26
1da177e4	27	#include <linux/module.h>
3241ad82	28	#include <asm/ioctls.h>
1da177e4 LT	29
1da177e4 LT	30	#include <net/bluetooth/bluetooth.h>
256a06c8	31	#include <linux/proc_fs.h>
1da177e4	32
64274518	33	#define VERSION "2.16"
1da177e4 LT	34
	35	/* Bluetooth sockets */
	36	#define BT_MAX_PROTO 8
ec1b4cf7	37	static const struct net_proto_family *bt_proto[BT_MAX_PROTO];
db7aa1c2	38	static DEFINE_RWLOCK(bt_proto_lock);
68845cb2	39
68845cb2	40	static struct lock_class_key bt_lock_key[BT_MAX_PROTO];
36cbd3dc	41	static const char *const bt_key_strings[BT_MAX_PROTO] = {
68845cb2 DY	42	"sk_lock-AF_BLUETOOTH-BTPROTO_L2CAP",
	43	"sk_lock-AF_BLUETOOTH-BTPROTO_HCI",
	44	"sk_lock-AF_BLUETOOTH-BTPROTO_SCO",
	45	"sk_lock-AF_BLUETOOTH-BTPROTO_RFCOMM",
	46	"sk_lock-AF_BLUETOOTH-BTPROTO_BNEP",
	47	"sk_lock-AF_BLUETOOTH-BTPROTO_CMTP",
	48	"sk_lock-AF_BLUETOOTH-BTPROTO_HIDP",
	49	"sk_lock-AF_BLUETOOTH-BTPROTO_AVDTP",
	50	};
	51
db7aa1c2	52	static struct lock_class_key bt_slock_key[BT_MAX_PROTO];
36cbd3dc	53	static const char *const bt_slock_key_strings[BT_MAX_PROTO] = {
68845cb2 DY	54	"slock-AF_BLUETOOTH-BTPROTO_L2CAP",
	55	"slock-AF_BLUETOOTH-BTPROTO_HCI",
	56	"slock-AF_BLUETOOTH-BTPROTO_SCO",
	57	"slock-AF_BLUETOOTH-BTPROTO_RFCOMM",
	58	"slock-AF_BLUETOOTH-BTPROTO_BNEP",
	59	"slock-AF_BLUETOOTH-BTPROTO_CMTP",
	60	"slock-AF_BLUETOOTH-BTPROTO_HIDP",
	61	"slock-AF_BLUETOOTH-BTPROTO_AVDTP",
	62	};
db7aa1c2	63
b5a30dda	64	void bt_sock_reclassify_lock(struct sock *sk, int proto)
db7aa1c2	65	{
b5a30dda	66	BUG_ON(!sk);
db7aa1c2 MH	67	BUG_ON(sock_owned_by_user(sk));
	68
	69	sock_lock_init_class_and_name(sk,
	70	bt_slock_key_strings[proto], &bt_slock_key[proto],
	71	bt_key_strings[proto], &bt_lock_key[proto]);
	72	}
b5a30dda	73	EXPORT_SYMBOL(bt_sock_reclassify_lock);
1da177e4	74
ec1b4cf7	75	int bt_sock_register(int proto, const struct net_proto_family *ops)
1da177e4	76	{
74da626a MH	77	int err = 0;
74da626a MH	78
1da177e4 LT	79	if (proto < 0 \|\| proto >= BT_MAX_PROTO)
	80	return -EINVAL;
	81
74da626a MH	82	write_lock(&bt_proto_lock);
74da626a MH	83
1da177e4	84	if (bt_proto[proto])
74da626a MH	85	err = -EEXIST;
	86	else
	87	bt_proto[proto] = ops;
	88
	89	write_unlock(&bt_proto_lock);
1da177e4	90
74da626a	91	return err;
1da177e4 LT	92	}
	93	EXPORT_SYMBOL(bt_sock_register);
	94
	95	int bt_sock_unregister(int proto)
	96	{
74da626a MH	97	int err = 0;
74da626a MH	98
1da177e4 LT	99	if (proto < 0 \|\| proto >= BT_MAX_PROTO)
	100	return -EINVAL;
	101
74da626a MH	102	write_lock(&bt_proto_lock);
74da626a MH	103
1da177e4	104	if (!bt_proto[proto])
74da626a MH	105	err = -ENOENT;
	106	else
	107	bt_proto[proto] = NULL;
1da177e4	108
74da626a MH	109	write_unlock(&bt_proto_lock);
	110
	111	return err;
1da177e4 LT	112	}
	113	EXPORT_SYMBOL(bt_sock_unregister);
	114
3f378b68 EP	115	static int bt_sock_create(struct net net, struct socket sock, int proto,
3f378b68 EP	116	int kern)
1da177e4	117	{
74da626a	118	int err;
1da177e4	119
1b8d7ae4 EB	120	if (net != &init_net)
	121	return -EAFNOSUPPORT;
	122
1da177e4 LT	123	if (proto < 0 \|\| proto >= BT_MAX_PROTO)
	124	return -EINVAL;
	125
95a5afca	126	if (!bt_proto[proto])
1da177e4	127	request_module("bt-proto-%d", proto);
74da626a	128
1da177e4	129	err = -EPROTONOSUPPORT;
74da626a MH	130
	131	read_lock(&bt_proto_lock);
	132
1da177e4	133	if (bt_proto[proto] && try_module_get(bt_proto[proto]->owner)) {
3f378b68	134	err = bt_proto[proto]->create(net, sock, proto, kern);
b5a30dda OP	135	if (!err)
b5a30dda OP	136	bt_sock_reclassify_lock(sock->sk, proto);
1da177e4 LT	137	module_put(bt_proto[proto]->owner);
1da177e4 LT	138	}
74da626a MH	139
	140	read_unlock(&bt_proto_lock);
	141
8e87d142	142	return err;
1da177e4 LT	143	}
	144
	145	void bt_sock_link(struct bt_sock_list l, struct sock sk)
	146	{
94f5bfb8	147	write_lock(&l->lock);
1da177e4	148	sk_add_node(sk, &l->head);
94f5bfb8	149	write_unlock(&l->lock);
1da177e4 LT	150	}
	151	EXPORT_SYMBOL(bt_sock_link);
	152
	153	void bt_sock_unlink(struct bt_sock_list l, struct sock sk)
	154	{
94f5bfb8	155	write_lock(&l->lock);
1da177e4	156	sk_del_node_init(sk);
94f5bfb8	157	write_unlock(&l->lock);
1da177e4 LT	158	}
	159	EXPORT_SYMBOL(bt_sock_unlink);
	160
	161	void bt_accept_enqueue(struct sock parent, struct sock sk)
	162	{
	163	BT_DBG("parent %p, sk %p", parent, sk);
	164
	165	sock_hold(sk);
	166	list_add_tail(&bt_sk(sk)->accept_q, &bt_sk(parent)->accept_q);
	167	bt_sk(sk)->parent = parent;
	168	parent->sk_ack_backlog++;
	169	}
	170	EXPORT_SYMBOL(bt_accept_enqueue);
	171
	172	void bt_accept_unlink(struct sock *sk)
	173	{
	174	BT_DBG("sk %p state %d", sk, sk->sk_state);
	175
	176	list_del_init(&bt_sk(sk)->accept_q);
	177	bt_sk(sk)->parent->sk_ack_backlog--;
	178	bt_sk(sk)->parent = NULL;
	179	sock_put(sk);
	180	}
	181	EXPORT_SYMBOL(bt_accept_unlink);
	182
	183	struct sock bt_accept_dequeue(struct sock parent, struct socket *newsock)
	184	{
	185	struct list_head p, n;
	186	struct sock *sk;
	187
	188	BT_DBG("parent %p", parent);
	189
	190	list_for_each_safe(p, n, &bt_sk(parent)->accept_q) {
	191	sk = (struct sock *) list_entry(p, struct bt_sock, accept_q);
	192
8a154a8f	193	lock_sock(sk);
1da177e4 LT	194
	195	/* FIXME: Is this check still needed */
	196	if (sk->sk_state == BT_CLOSED) {
8a154a8f	197	release_sock(sk);
1da177e4 LT	198	bt_accept_unlink(sk);
	199	continue;
	200	}
	201
c4f912e1	202	if (sk->sk_state == BT_CONNECTED \|\| !newsock \|\|
d060991f	203	test_bit(BT_SK_DEFER_SETUP, &bt_sk(parent)->flags)) {
1da177e4 LT	204	bt_accept_unlink(sk);
	205	if (newsock)
	206	sock_graft(sk, newsock);
d37f50e1	207
8a154a8f	208	release_sock(sk);
1da177e4 LT	209	return sk;
	210	}
	211
8a154a8f	212	release_sock(sk);
1da177e4	213	}
d37f50e1	214
1da177e4 LT	215	return NULL;
	216	}
	217	EXPORT_SYMBOL(bt_accept_dequeue);
	218
	219	int bt_sock_recvmsg(struct kiocb iocb, struct socket sock,
c4f912e1	220	struct msghdr *msg, size_t len, int flags)
1da177e4 LT	221	{
	222	int noblock = flags & MSG_DONTWAIT;
	223	struct sock *sk = sock->sk;
	224	struct sk_buff *skb;
	225	size_t copied;
	226	int err;
	227
a418b893	228	BT_DBG("sock %p sk %p len %zu", sock, sk, len);
1da177e4 LT	229
	230	if (flags & (MSG_OOB))
	231	return -EOPNOTSUPP;
	232
5a08ecce AE	233	skb = skb_recv_datagram(sk, flags, noblock, &err);
5a08ecce AE	234	if (!skb) {
1da177e4 LT	235	if (sk->sk_shutdown & RCV_SHUTDOWN)
	236	return 0;
	237	return err;
	238	}
	239
	240	msg->msg_namelen = 0;
	241
	242	copied = skb->len;
	243	if (len < copied) {
	244	msg->msg_flags \|= MSG_TRUNC;
	245	copied = len;
	246	}
	247
badff6d0	248	skb_reset_transport_header(skb);
1da177e4	249	err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
3241ad82	250	if (err == 0)
3b885787	251	sock_recv_ts_and_drops(msg, sk, skb);
1da177e4 LT	252
	253	skb_free_datagram(sk, skb);
	254
	255	return err ? : copied;
	256	}
	257	EXPORT_SYMBOL(bt_sock_recvmsg);
	258
796c86ee MM	259	static long bt_sock_data_wait(struct sock *sk, long timeo)
	260	{
	261	DECLARE_WAITQUEUE(wait, current);
	262
	263	add_wait_queue(sk_sleep(sk), &wait);
	264	for (;;) {
	265	set_current_state(TASK_INTERRUPTIBLE);
	266
	267	if (!skb_queue_empty(&sk->sk_receive_queue))
	268	break;
	269
	270	if (sk->sk_err \|\| (sk->sk_shutdown & RCV_SHUTDOWN))
	271	break;
	272
	273	if (signal_pending(current) \|\| !timeo)
	274	break;
	275
	276	set_bit(SOCK_ASYNC_WAITDATA, &sk->sk_socket->flags);
	277	release_sock(sk);
	278	timeo = schedule_timeout(timeo);
	279	lock_sock(sk);
	280	clear_bit(SOCK_ASYNC_WAITDATA, &sk->sk_socket->flags);
	281	}
	282
	283	__set_current_state(TASK_RUNNING);
	284	remove_wait_queue(sk_sleep(sk), &wait);
	285	return timeo;
	286	}
	287
	288	int bt_sock_stream_recvmsg(struct kiocb iocb, struct socket sock,
	289	struct msghdr *msg, size_t size, int flags)
	290	{
	291	struct sock *sk = sock->sk;
	292	int err = 0;
	293	size_t target, copied = 0;
	294	long timeo;
	295
	296	if (flags & MSG_OOB)
	297	return -EOPNOTSUPP;
	298
	299	msg->msg_namelen = 0;
	300
	301	BT_DBG("sk %p size %zu", sk, size);
	302
	303	lock_sock(sk);
	304
	305	target = sock_rcvlowat(sk, flags & MSG_WAITALL, size);
	306	timeo = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
	307
	308	do {
	309	struct sk_buff *skb;
	310	int chunk;
	311
	312	skb = skb_dequeue(&sk->sk_receive_queue);
	313	if (!skb) {
	314	if (copied >= target)
	315	break;
	316
5a08ecce AE	317	err = sock_error(sk);
5a08ecce AE	318	if (err)
796c86ee MM	319	break;
	320	if (sk->sk_shutdown & RCV_SHUTDOWN)
	321	break;
	322
	323	err = -EAGAIN;
	324	if (!timeo)
	325	break;
	326
	327	timeo = bt_sock_data_wait(sk, timeo);
	328
	329	if (signal_pending(current)) {
	330	err = sock_intr_errno(timeo);
	331	goto out;
	332	}
	333	continue;
	334	}
	335
	336	chunk = min_t(unsigned int, skb->len, size);
5b668eb3	337	if (skb_copy_datagram_iovec(skb, 0, msg->msg_iov, chunk)) {
796c86ee MM	338	skb_queue_head(&sk->sk_receive_queue, skb);
	339	if (!copied)
	340	copied = -EFAULT;
	341	break;
	342	}
	343	copied += chunk;
	344	size -= chunk;
	345
	346	sock_recv_ts_and_drops(msg, sk, skb);
	347
	348	if (!(flags & MSG_PEEK)) {
5b668eb3 MM	349	int skb_len = skb_headlen(skb);
	350
	351	if (chunk <= skb_len) {
	352	__skb_pull(skb, chunk);
	353	} else {
	354	struct sk_buff *frag;
	355
	356	__skb_pull(skb, skb_len);
	357	chunk -= skb_len;
	358
	359	skb_walk_frags(skb, frag) {
	360	if (chunk <= frag->len) {
	361	/* Pulling partial data */
	362	skb->len -= chunk;
	363	skb->data_len -= chunk;
	364	__skb_pull(frag, chunk);
	365	break;
	366	} else if (frag->len) {
	367	/* Pulling all frag data */
	368	chunk -= frag->len;
	369	skb->len -= frag->len;
	370	skb->data_len -= frag->len;
	371	__skb_pull(frag, frag->len);
	372	}
	373	}
	374	}
	375
796c86ee MM	376	if (skb->len) {
	377	skb_queue_head(&sk->sk_receive_queue, skb);
	378	break;
	379	}
	380	kfree_skb(skb);
	381
	382	} else {
	383	/* put message back and return */
	384	skb_queue_head(&sk->sk_receive_queue, skb);
	385	break;
	386	}
	387	} while (size);
	388
	389	out:
	390	release_sock(sk);
	391	return copied ? : err;
	392	}
	393	EXPORT_SYMBOL(bt_sock_stream_recvmsg);
	394
1da177e4 LT	395	static inline unsigned int bt_accept_poll(struct sock *parent)
	396	{
	397	struct list_head p, n;
	398	struct sock *sk;
	399
	400	list_for_each_safe(p, n, &bt_sk(parent)->accept_q) {
	401	sk = (struct sock *) list_entry(p, struct bt_sock, accept_q);
d5f2d2be	402	if (sk->sk_state == BT_CONNECTED \|\|
c5daa683 GP	403	(test_bit(BT_SK_DEFER_SETUP, &bt_sk(parent)->flags) &&
c5daa683 GP	404	sk->sk_state == BT_CONNECT2))
1da177e4 LT	405	return POLLIN \| POLLRDNORM;
	406	}
	407
	408	return 0;
	409	}
	410
8fc9ced3 GP	411	unsigned int bt_sock_poll(struct file file, struct socket sock,
8fc9ced3 GP	412	poll_table *wait)
1da177e4 LT	413	{
	414	struct sock *sk = sock->sk;
	415	unsigned int mask = 0;
	416
	417	BT_DBG("sock %p, sk %p", sock, sk);
	418
aa395145	419	poll_wait(file, sk_sleep(sk), wait);
1da177e4 LT	420
	421	if (sk->sk_state == BT_LISTEN)
	422	return bt_accept_poll(sk);
	423
	424	if (sk->sk_err \|\| !skb_queue_empty(&sk->sk_error_queue))
	425	mask \|= POLLERR;
	426
f348d70a	427	if (sk->sk_shutdown & RCV_SHUTDOWN)
db40980f	428	mask \|= POLLRDHUP \| POLLIN \| POLLRDNORM;
f348d70a	429
1da177e4 LT	430	if (sk->sk_shutdown == SHUTDOWN_MASK)
	431	mask \|= POLLHUP;
	432
db40980f	433	if (!skb_queue_empty(&sk->sk_receive_queue))
1da177e4 LT	434	mask \|= POLLIN \| POLLRDNORM;
	435
	436	if (sk->sk_state == BT_CLOSED)
	437	mask \|= POLLHUP;
	438
	439	if (sk->sk_state == BT_CONNECT \|\|
	440	sk->sk_state == BT_CONNECT2 \|\|
	441	sk->sk_state == BT_CONFIG)
	442	return mask;
	443
c5daa683	444	if (!test_bit(BT_SK_SUSPEND, &bt_sk(sk)->flags) && sock_writeable(sk))
1da177e4 LT	445	mask \|= POLLOUT \| POLLWRNORM \| POLLWRBAND;
	446	else
	447	set_bit(SOCK_ASYNC_NOSPACE, &sk->sk_socket->flags);
	448
	449	return mask;
	450	}
	451	EXPORT_SYMBOL(bt_sock_poll);
	452
3241ad82 MH	453	int bt_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
	454	{
	455	struct sock *sk = sock->sk;
43cbeee9 MH	456	struct sk_buff *skb;
43cbeee9 MH	457	long amount;
3241ad82 MH	458	int err;
	459
	460	BT_DBG("sk %p cmd %x arg %lx", sk, cmd, arg);
	461
	462	switch (cmd) {
43cbeee9 MH	463	case TIOCOUTQ:
	464	if (sk->sk_state == BT_LISTEN)
	465	return -EINVAL;
	466
31e6d363	467	amount = sk->sk_sndbuf - sk_wmem_alloc_get(sk);
43cbeee9 MH	468	if (amount < 0)
	469	amount = 0;
	470	err = put_user(amount, (int __user *) arg);
	471	break;
	472
	473	case TIOCINQ:
	474	if (sk->sk_state == BT_LISTEN)
	475	return -EINVAL;
	476
	477	lock_sock(sk);
	478	skb = skb_peek(&sk->sk_receive_queue);
	479	amount = skb ? skb->len : 0;
	480	release_sock(sk);
	481	err = put_user(amount, (int __user *) arg);
	482	break;
	483
3241ad82 MH	484	case SIOCGSTAMP:
	485	err = sock_get_timestamp(sk, (struct timeval __user *) arg);
	486	break;
	487
	488	case SIOCGSTAMPNS:
	489	err = sock_get_timestampns(sk, (struct timespec __user *) arg);
	490	break;
	491
	492	default:
	493	err = -ENOIOCTLCMD;
	494	break;
	495	}
	496
	497	return err;
	498	}
	499	EXPORT_SYMBOL(bt_sock_ioctl);
	500
1da177e4 LT	501	int bt_sock_wait_state(struct sock *sk, int state, unsigned long timeo)
	502	{
	503	DECLARE_WAITQUEUE(wait, current);
	504	int err = 0;
	505
	506	BT_DBG("sk %p", sk);
	507
aa395145	508	add_wait_queue(sk_sleep(sk), &wait);
9be4e3fb	509	set_current_state(TASK_INTERRUPTIBLE);
1da177e4	510	while (sk->sk_state != state) {
1da177e4	511	if (!timeo) {
b4c612a4	512	err = -EINPROGRESS;
1da177e4 LT	513	break;
	514	}
	515
	516	if (signal_pending(current)) {
	517	err = sock_intr_errno(timeo);
	518	break;
	519	}
	520
	521	release_sock(sk);
	522	timeo = schedule_timeout(timeo);
	523	lock_sock(sk);
9be4e3fb	524	set_current_state(TASK_INTERRUPTIBLE);
1da177e4	525
c1cbe4b7 BL	526	err = sock_error(sk);
c1cbe4b7 BL	527	if (err)
1da177e4	528	break;
1da177e4	529	}
9be4e3fb	530	__set_current_state(TASK_RUNNING);
aa395145	531	remove_wait_queue(sk_sleep(sk), &wait);
1da177e4 LT	532	return err;
	533	}
	534	EXPORT_SYMBOL(bt_sock_wait_state);
	535
256a06c8 MY	536	#ifdef CONFIG_PROC_FS
	537	struct bt_seq_state {
	538	struct bt_sock_list *l;
	539	};
	540
	541	static void bt_seq_start(struct seq_file seq, loff_t *pos)
	542	__acquires(seq->private->l->lock)
	543	{
	544	struct bt_seq_state *s = seq->private;
	545	struct bt_sock_list *l = s->l;
	546
	547	read_lock(&l->lock);
	548	return seq_hlist_start_head(&l->head, *pos);
	549	}
	550
	551	static void bt_seq_next(struct seq_file seq, void v, loff_t pos)
	552	{
	553	struct bt_seq_state *s = seq->private;
	554	struct bt_sock_list *l = s->l;
	555
	556	return seq_hlist_next(v, &l->head, pos);
	557	}
	558
	559	static void bt_seq_stop(struct seq_file seq, void v)
	560	__releases(seq->private->l->lock)
	561	{
	562	struct bt_seq_state *s = seq->private;
	563	struct bt_sock_list *l = s->l;
	564
	565	read_unlock(&l->lock);
	566	}
	567
	568	static int bt_seq_show(struct seq_file seq, void v)
	569	{
256a06c8 MY	570	struct bt_seq_state *s = seq->private;
256a06c8 MY	571	struct bt_sock_list *l = s->l;
256a06c8 MY	572
	573	if (v == SEQ_START_TOKEN) {
	574	seq_puts(seq ,"sk RefCnt Rmem Wmem User Inode Src Dst Parent");
	575
	576	if (l->custom_seq_show) {
	577	seq_putc(seq, ' ');
	578	l->custom_seq_show(seq, v);
	579	}
	580
	581	seq_putc(seq, '\n');
	582	} else {
09d5d4aa AE	583	struct sock *sk = sk_entry(v);
09d5d4aa AE	584	struct bt_sock *bt = bt_sk(sk);
256a06c8	585
7028a886 AE	586	seq_printf(seq,
7028a886 AE	587	"%pK %-6d %-6u %-6u %-6u %-6lu %pMR %pMR %-6lu",
256a06c8 MY	588	sk,
	589	atomic_read(&sk->sk_refcnt),
	590	sk_rmem_alloc_get(sk),
	591	sk_wmem_alloc_get(sk),
1bbb3095	592	from_kuid(seq_user_ns(seq), sock_i_uid(sk)),
256a06c8	593	sock_i_ino(sk),
7028a886 AE	594	&bt->src,
7028a886 AE	595	&bt->dst,
256a06c8 MY	596	bt->parent? sock_i_ino(bt->parent): 0LU);
	597
	598	if (l->custom_seq_show) {
	599	seq_putc(seq, ' ');
	600	l->custom_seq_show(seq, v);
	601	}
	602
	603	seq_putc(seq, '\n');
	604	}
	605	return 0;
	606	}
	607
	608	static struct seq_operations bt_seq_ops = {
	609	.start = bt_seq_start,
	610	.next = bt_seq_next,
	611	.stop = bt_seq_stop,
	612	.show = bt_seq_show,
	613	};
	614
	615	static int bt_seq_open(struct inode inode, struct file file)
	616	{
	617	struct bt_sock_list *sk_list;
	618	struct bt_seq_state *s;
	619
d9dda78b	620	sk_list = PDE_DATA(inode);
256a06c8 MY	621	s = __seq_open_private(file, &bt_seq_ops,
256a06c8 MY	622	sizeof(struct bt_seq_state));
31f47073	623	if (!s)
256a06c8 MY	624	return -ENOMEM;
	625
	626	s->l = sk_list;
	627	return 0;
	628	}
	629
14805359 AV	630	static const struct file_operations bt_fops = {
	631	.open = bt_seq_open,
	632	.read = seq_read,
	633	.llseek = seq_lseek,
	634	.release = seq_release_private
	635	};
	636
b0316615	637	int bt_procfs_init(struct net net, const char name,
256a06c8 MY	638	struct bt_sock_list* sk_list,
	639	int (* seq_show)(struct seq_file , void ))
	640	{
	641	struct proc_dir_entry * pde;
	642
	643	sk_list->custom_seq_show = seq_show;
	644
14805359	645	pde = proc_create(name, 0, net->proc_net, &bt_fops);
31f47073	646	if (!pde)
256a06c8 MY	647	return -ENOMEM;
	648
	649	pde->data = sk_list;
	650
	651	return 0;
	652	}
	653
	654	void bt_procfs_cleanup(struct net net, const char name)
	655	{
ece31ffd	656	remove_proc_entry(name, net->proc_net);
256a06c8 MY	657	}
256a06c8 MY	658	#else
b0316615	659	int bt_procfs_init(struct net net, const char name,
256a06c8 MY	660	struct bt_sock_list* sk_list,
	661	int (* seq_show)(struct seq_file , void ))
	662	{
	663	return 0;
	664	}
	665
	666	void bt_procfs_cleanup(struct net net, const char name)
	667	{
	668	}
	669	#endif
	670	EXPORT_SYMBOL(bt_procfs_init);
	671	EXPORT_SYMBOL(bt_procfs_cleanup);
	672
1da177e4 LT	673	static struct net_proto_family bt_sock_family_ops = {
	674	.owner = THIS_MODULE,
	675	.family = PF_BLUETOOTH,
	676	.create = bt_sock_create,
	677	};
	678
1da177e4 LT	679	static int __init bt_init(void)
1da177e4 LT	680	{
27d35284 MH	681	int err;
27d35284 MH	682
1da177e4 LT	683	BT_INFO("Core ver %s", VERSION);
1da177e4 LT	684
27d35284 MH	685	err = bt_sysfs_init();
	686	if (err < 0)
	687	return err;
1da177e4	688
27d35284 MH	689	err = sock_register(&bt_sock_family_ops);
	690	if (err < 0) {
	691	bt_sysfs_cleanup();
	692	return err;
	693	}
1da177e4	694
27d35284	695	BT_INFO("HCI device and connection manager initialized");
1da177e4	696
64274518 GP	697	err = hci_sock_init();
	698	if (err < 0)
	699	goto error;
	700
	701	err = l2cap_init();
0ed54dad	702	if (err < 0)
64274518	703	goto sock_err;
64274518 GP	704
	705	err = sco_init();
	706	if (err < 0) {
	707	l2cap_exit();
	708	goto sock_err;
	709	}
1da177e4 LT	710
1da177e4 LT	711	return 0;
64274518 GP	712
	713	sock_err:
	714	hci_sock_cleanup();
	715
	716	error:
	717	sock_unregister(PF_BLUETOOTH);
	718	bt_sysfs_cleanup();
	719
	720	return err;
1da177e4 LT	721	}
	722
	723	static void __exit bt_exit(void)
	724	{
64274518 GP	725
	726	sco_exit();
	727
	728	l2cap_exit();
	729
1da177e4 LT	730	hci_sock_cleanup();
1da177e4 LT	731
1da177e4	732	sock_unregister(PF_BLUETOOTH);
27d35284 MH	733
27d35284 MH	734	bt_sysfs_cleanup();
1da177e4 LT	735	}
	736
	737	subsys_initcall(bt_init);
	738	module_exit(bt_exit);
	739
63fbd24e	740	MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
1da177e4 LT	741	MODULE_DESCRIPTION("Bluetooth Core ver " VERSION);
	742	MODULE_VERSION(VERSION);
	743	MODULE_LICENSE("GPL");
	744	MODULE_ALIAS_NETPROTO(PF_BLUETOOTH);