[mirror_ubuntu-bionic-kernel.git] / net / bluetooth / hci_conn.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 HCI connection handling. */

#include <linux/module.h>

#include <linux/types.h>
#include <linux/errno.h>
#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/poll.h>
#include <linux/fcntl.h>
#include <linux/init.h>
#include <linux/skbuff.h>
#include <linux/interrupt.h>
#include <linux/notifier.h>
#include <net/sock.h>

#include <asm/system.h>
#include <asm/uaccess.h>
#include <asm/unaligned.h>

#include <net/bluetooth/bluetooth.h>
#include <net/bluetooth/hci_core.h>

void hci_acl_connect(struct hci_conn *conn)
{
	struct hci_dev *hdev = conn->hdev;
	struct inquiry_entry *ie;
	struct hci_cp_create_conn cp;

	BT_DBG("%p", conn);

	conn->state = BT_CONNECT;
	conn->out = 1;

	conn->link_mode = HCI_LM_MASTER;

	conn->attempt++;

	conn->link_policy = hdev->link_policy;

	memset(&cp, 0, sizeof(cp));
	bacpy(&cp.bdaddr, &conn->dst);
	cp.pscan_rep_mode = 0x02;

	if ((ie = hci_inquiry_cache_lookup(hdev, &conn->dst))) {
		if (inquiry_entry_age(ie) <= INQUIRY_ENTRY_AGE_MAX) {
			cp.pscan_rep_mode = ie->data.pscan_rep_mode;
			cp.pscan_mode     = ie->data.pscan_mode;
			cp.clock_offset   = ie->data.clock_offset |
							cpu_to_le16(0x8000);
		}

		memcpy(conn->dev_class, ie->data.dev_class, 3);
		conn->ssp_mode = ie->data.ssp_mode;
	}

	cp.pkt_type = cpu_to_le16(conn->pkt_type);
	if (lmp_rswitch_capable(hdev) && !(hdev->link_mode & HCI_LM_MASTER))
		cp.role_switch = 0x01;
	else
		cp.role_switch = 0x00;

	hci_send_cmd(hdev, HCI_OP_CREATE_CONN, sizeof(cp), &cp);
}

static void hci_acl_connect_cancel(struct hci_conn *conn)
{
	struct hci_cp_create_conn_cancel cp;

	BT_DBG("%p", conn);

	if (conn->hdev->hci_ver < 2)
		return;

	bacpy(&cp.bdaddr, &conn->dst);
	hci_send_cmd(conn->hdev, HCI_OP_CREATE_CONN_CANCEL, sizeof(cp), &cp);
}

void hci_acl_disconn(struct hci_conn *conn, __u8 reason)
{
	struct hci_cp_disconnect cp;

	BT_DBG("%p", conn);

	conn->state = BT_DISCONN;

	cp.handle = cpu_to_le16(conn->handle);
	cp.reason = reason;
	hci_send_cmd(conn->hdev, HCI_OP_DISCONNECT, sizeof(cp), &cp);
}

void hci_add_sco(struct hci_conn *conn, __u16 handle)
{
	struct hci_dev *hdev = conn->hdev;
	struct hci_cp_add_sco cp;

	BT_DBG("%p", conn);

	conn->state = BT_CONNECT;
	conn->out = 1;

	cp.handle   = cpu_to_le16(handle);
	cp.pkt_type = cpu_to_le16(conn->pkt_type);

	hci_send_cmd(hdev, HCI_OP_ADD_SCO, sizeof(cp), &cp);
}

void hci_setup_sync(struct hci_conn *conn, __u16 handle)
{
	struct hci_dev *hdev = conn->hdev;
	struct hci_cp_setup_sync_conn cp;

	BT_DBG("%p", conn);

	conn->state = BT_CONNECT;
	conn->out = 1;

	cp.handle   = cpu_to_le16(handle);
	cp.pkt_type = cpu_to_le16(conn->pkt_type);

	cp.tx_bandwidth   = cpu_to_le32(0x00001f40);
	cp.rx_bandwidth   = cpu_to_le32(0x00001f40);
	cp.max_latency    = cpu_to_le16(0xffff);
	cp.voice_setting  = cpu_to_le16(hdev->voice_setting);
	cp.retrans_effort = 0xff;

	hci_send_cmd(hdev, HCI_OP_SETUP_SYNC_CONN, sizeof(cp), &cp);
}

static void hci_conn_timeout(unsigned long arg)
{
	struct hci_conn *conn = (void *) arg;
	struct hci_dev *hdev = conn->hdev;

	BT_DBG("conn %p state %d", conn, conn->state);

	if (atomic_read(&conn->refcnt))
		return;

	hci_dev_lock(hdev);

	switch (conn->state) {
	case BT_CONNECT:
	case BT_CONNECT2:
		if (conn->type == ACL_LINK)
			hci_acl_connect_cancel(conn);
		else
			hci_acl_disconn(conn, 0x13);
		break;
	case BT_CONFIG:
	case BT_CONNECTED:
		hci_acl_disconn(conn, 0x13);
		break;
	default:
		conn->state = BT_CLOSED;
		break;
	}

	hci_dev_unlock(hdev);
}

static void hci_conn_idle(unsigned long arg)
{
	struct hci_conn *conn = (void *) arg;

	BT_DBG("conn %p mode %d", conn, conn->mode);

	hci_conn_enter_sniff_mode(conn);
}

struct hci_conn *hci_conn_add(struct hci_dev *hdev, int type, bdaddr_t *dst)
{
	struct hci_conn *conn;

	BT_DBG("%s dst %s", hdev->name, batostr(dst));

	conn = kzalloc(sizeof(struct hci_conn), GFP_ATOMIC);
	if (!conn)
		return NULL;

	bacpy(&conn->dst, dst);
	conn->hdev  = hdev;
	conn->type  = type;
	conn->mode  = HCI_CM_ACTIVE;
	conn->state = BT_OPEN;

	conn->power_save = 1;

	switch (type) {
	case ACL_LINK:
		conn->pkt_type = hdev->pkt_type & ACL_PTYPE_MASK;
		break;
	case SCO_LINK:
		if (lmp_esco_capable(hdev))
			conn->pkt_type = hdev->esco_type & SCO_ESCO_MASK;
		else
			conn->pkt_type = hdev->pkt_type & SCO_PTYPE_MASK;
		break;
	case ESCO_LINK:
		conn->pkt_type = hdev->esco_type;
		break;
	}

	skb_queue_head_init(&conn->data_q);

	setup_timer(&conn->disc_timer, hci_conn_timeout, (unsigned long)conn);
	setup_timer(&conn->idle_timer, hci_conn_idle, (unsigned long)conn);

	atomic_set(&conn->refcnt, 0);

	hci_dev_hold(hdev);

	tasklet_disable(&hdev->tx_task);

	hci_conn_hash_add(hdev, conn);
	if (hdev->notify)
		hdev->notify(hdev, HCI_NOTIFY_CONN_ADD);

	tasklet_enable(&hdev->tx_task);

	return conn;
}

int hci_conn_del(struct hci_conn *conn)
{
	struct hci_dev *hdev = conn->hdev;

	BT_DBG("%s conn %p handle %d", hdev->name, conn, conn->handle);

	del_timer(&conn->idle_timer);

	del_timer(&conn->disc_timer);

	if (conn->type == ACL_LINK) {
		struct hci_conn *sco = conn->link;
		if (sco)
			sco->link = NULL;

		/* Unacked frames */
		hdev->acl_cnt += conn->sent;
	} else {
		struct hci_conn *acl = conn->link;
		if (acl) {
			acl->link = NULL;
			hci_conn_put(acl);
		}
	}

	tasklet_disable(&hdev->tx_task);

	hci_conn_hash_del(hdev, conn);
	if (hdev->notify)
		hdev->notify(hdev, HCI_NOTIFY_CONN_DEL);

	tasklet_enable(&hdev->tx_task);

	skb_queue_purge(&conn->data_q);

	return 0;
}

struct hci_dev *hci_get_route(bdaddr_t *dst, bdaddr_t *src)
{
	int use_src = bacmp(src, BDADDR_ANY);
	struct hci_dev *hdev = NULL;
	struct list_head *p;

	BT_DBG("%s -> %s", batostr(src), batostr(dst));

	read_lock_bh(&hci_dev_list_lock);

	list_for_each(p, &hci_dev_list) {
		struct hci_dev *d = list_entry(p, struct hci_dev, list);

		if (!test_bit(HCI_UP, &d->flags) || test_bit(HCI_RAW, &d->flags))
			continue;

		/* Simple routing:
		 *   No source address - find interface with bdaddr != dst
		 *   Source address    - find interface with bdaddr == src
		 */

		if (use_src) {
			if (!bacmp(&d->bdaddr, src)) {
				hdev = d; break;
			}
		} else {
			if (bacmp(&d->bdaddr, dst)) {
				hdev = d; break;
			}
		}
	}

	if (hdev)
		hdev = hci_dev_hold(hdev);

	read_unlock_bh(&hci_dev_list_lock);
	return hdev;
}
EXPORT_SYMBOL(hci_get_route);

/* Create SCO or ACL connection.
 * Device _must_ be locked */
struct hci_conn *hci_connect(struct hci_dev *hdev, int type, bdaddr_t *dst, __u8 sec_level, __u8 auth_type)
{
	struct hci_conn *acl;
	struct hci_conn *sco;

	BT_DBG("%s dst %s", hdev->name, batostr(dst));

	if (!(acl = hci_conn_hash_lookup_ba(hdev, ACL_LINK, dst))) {
		if (!(acl = hci_conn_add(hdev, ACL_LINK, dst)))
			return NULL;
	}

	hci_conn_hold(acl);

	if (acl->state == BT_OPEN || acl->state == BT_CLOSED) {
		acl->sec_level = sec_level;
		acl->auth_type = auth_type;
		hci_acl_connect(acl);
	}

	if (type == ACL_LINK)
		return acl;

	if (!(sco = hci_conn_hash_lookup_ba(hdev, type, dst))) {
		if (!(sco = hci_conn_add(hdev, type, dst))) {
			hci_conn_put(acl);
			return NULL;
		}
	}

	acl->link = sco;
	sco->link = acl;

	hci_conn_hold(sco);

	if (acl->state == BT_CONNECTED &&
			(sco->state == BT_OPEN || sco->state == BT_CLOSED)) {
		if (lmp_esco_capable(hdev))
			hci_setup_sync(sco, acl->handle);
		else
			hci_add_sco(sco, acl->handle);
	}

	return sco;
}
EXPORT_SYMBOL(hci_connect);

/* Check link security requirement */
int hci_conn_check_link_mode(struct hci_conn *conn)
{
	BT_DBG("conn %p", conn);

	if (conn->ssp_mode > 0 && conn->hdev->ssp_mode > 0 &&
					!(conn->link_mode & HCI_LM_ENCRYPT))
		return 0;

	return 1;
}
EXPORT_SYMBOL(hci_conn_check_link_mode);

/* Authenticate remote device */
static int hci_conn_auth(struct hci_conn *conn, __u8 sec_level)
{
	BT_DBG("conn %p", conn);

	if (sec_level > conn->sec_level)
		conn->link_mode &= ~HCI_LM_AUTH;

	conn->sec_level = sec_level;

	if (sec_level == BT_SECURITY_HIGH)
		conn->auth_type |= 0x01;

	if (conn->link_mode & HCI_LM_AUTH)
		return 1;

	if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
		struct hci_cp_auth_requested cp;
		cp.handle = cpu_to_le16(conn->handle);
		hci_send_cmd(conn->hdev, HCI_OP_AUTH_REQUESTED,
							sizeof(cp), &cp);
	}

	return 0;
}

/* Enable security */
int hci_conn_security(struct hci_conn *conn, __u8 sec_level)
{
	BT_DBG("conn %p", conn);

	if (sec_level == BT_SECURITY_SDP)
		return 1;

	if (sec_level == BT_SECURITY_LOW) {
		if (conn->ssp_mode > 0 && conn->hdev->ssp_mode > 0)
			return hci_conn_auth(conn, sec_level);
		else
			return 1;
	}

	if (conn->link_mode & HCI_LM_ENCRYPT)
		return hci_conn_auth(conn, sec_level);

	if (test_and_set_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend))
		return 0;

	if (hci_conn_auth(conn, sec_level)) {
		struct hci_cp_set_conn_encrypt cp;
		cp.handle  = cpu_to_le16(conn->handle);
		cp.encrypt = 1;
		hci_send_cmd(conn->hdev, HCI_OP_SET_CONN_ENCRYPT,
							sizeof(cp), &cp);
	}

	return 0;
}
EXPORT_SYMBOL(hci_conn_security);

/* Change link key */
int hci_conn_change_link_key(struct hci_conn *conn)
{
	BT_DBG("conn %p", conn);

	if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
		struct hci_cp_change_conn_link_key cp;
		cp.handle = cpu_to_le16(conn->handle);
		hci_send_cmd(conn->hdev, HCI_OP_CHANGE_CONN_LINK_KEY,
							sizeof(cp), &cp);
	}

	return 0;
}
EXPORT_SYMBOL(hci_conn_change_link_key);

/* Switch role */
int hci_conn_switch_role(struct hci_conn *conn, __u8 role)
{
	BT_DBG("conn %p", conn);

	if (!role && conn->link_mode & HCI_LM_MASTER)
		return 1;

	if (!test_and_set_bit(HCI_CONN_RSWITCH_PEND, &conn->pend)) {
		struct hci_cp_switch_role cp;
		bacpy(&cp.bdaddr, &conn->dst);
		cp.role = role;
		hci_send_cmd(conn->hdev, HCI_OP_SWITCH_ROLE, sizeof(cp), &cp);
	}

	return 0;
}
EXPORT_SYMBOL(hci_conn_switch_role);

/* Enter active mode */
void hci_conn_enter_active_mode(struct hci_conn *conn)
{
	struct hci_dev *hdev = conn->hdev;

	BT_DBG("conn %p mode %d", conn, conn->mode);

	if (test_bit(HCI_RAW, &hdev->flags))
		return;

	if (conn->mode != HCI_CM_SNIFF || !conn->power_save)
		goto timer;

	if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
		struct hci_cp_exit_sniff_mode cp;
		cp.handle = cpu_to_le16(conn->handle);
		hci_send_cmd(hdev, HCI_OP_EXIT_SNIFF_MODE, sizeof(cp), &cp);
	}

timer:
	if (hdev->idle_timeout > 0)
		mod_timer(&conn->idle_timer,
			jiffies + msecs_to_jiffies(hdev->idle_timeout));
}

/* Enter sniff mode */
void hci_conn_enter_sniff_mode(struct hci_conn *conn)
{
	struct hci_dev *hdev = conn->hdev;

	BT_DBG("conn %p mode %d", conn, conn->mode);

	if (test_bit(HCI_RAW, &hdev->flags))
		return;

	if (!lmp_sniff_capable(hdev) || !lmp_sniff_capable(conn))
		return;

	if (conn->mode != HCI_CM_ACTIVE || !(conn->link_policy & HCI_LP_SNIFF))
		return;

	if (lmp_sniffsubr_capable(hdev) && lmp_sniffsubr_capable(conn)) {
		struct hci_cp_sniff_subrate cp;
		cp.handle             = cpu_to_le16(conn->handle);
		cp.max_latency        = cpu_to_le16(0);
		cp.min_remote_timeout = cpu_to_le16(0);
		cp.min_local_timeout  = cpu_to_le16(0);
		hci_send_cmd(hdev, HCI_OP_SNIFF_SUBRATE, sizeof(cp), &cp);
	}

	if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
		struct hci_cp_sniff_mode cp;
		cp.handle       = cpu_to_le16(conn->handle);
		cp.max_interval = cpu_to_le16(hdev->sniff_max_interval);
		cp.min_interval = cpu_to_le16(hdev->sniff_min_interval);
		cp.attempt      = cpu_to_le16(4);
		cp.timeout      = cpu_to_le16(1);
		hci_send_cmd(hdev, HCI_OP_SNIFF_MODE, sizeof(cp), &cp);
	}
}

/* Drop all connection on the device */
void hci_conn_hash_flush(struct hci_dev *hdev)
{
	struct hci_conn_hash *h = &hdev->conn_hash;
	struct list_head *p;

	BT_DBG("hdev %s", hdev->name);

	p = h->list.next;
	while (p != &h->list) {
		struct hci_conn *c;

		c = list_entry(p, struct hci_conn, list);
		p = p->next;

		c->state = BT_CLOSED;

		hci_conn_del_sysfs(c);

		hci_proto_disconn_ind(c, 0x16);
		hci_conn_del(c);
	}
}

/* Check pending connect attempts */
void hci_conn_check_pending(struct hci_dev *hdev)
{
	struct hci_conn *conn;

	BT_DBG("hdev %s", hdev->name);

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_state(hdev, ACL_LINK, BT_CONNECT2);
	if (conn)
		hci_acl_connect(conn);

	hci_dev_unlock(hdev);
}

int hci_get_conn_list(void __user *arg)
{
	struct hci_conn_list_req req, *cl;
	struct hci_conn_info *ci;
	struct hci_dev *hdev;
	struct list_head *p;
	int n = 0, size, err;

	if (copy_from_user(&req, arg, sizeof(req)))
		return -EFAULT;

	if (!req.conn_num || req.conn_num > (PAGE_SIZE * 2) / sizeof(*ci))
		return -EINVAL;

	size = sizeof(req) + req.conn_num * sizeof(*ci);

	if (!(cl = kmalloc(size, GFP_KERNEL)))
		return -ENOMEM;

	if (!(hdev = hci_dev_get(req.dev_id))) {
		kfree(cl);
		return -ENODEV;
	}

	ci = cl->conn_info;

	hci_dev_lock_bh(hdev);
	list_for_each(p, &hdev->conn_hash.list) {
		register struct hci_conn *c;
		c = list_entry(p, struct hci_conn, list);

		bacpy(&(ci + n)->bdaddr, &c->dst);
		(ci + n)->handle = c->handle;
		(ci + n)->type  = c->type;
		(ci + n)->out   = c->out;
		(ci + n)->state = c->state;
		(ci + n)->link_mode = c->link_mode;
		if (++n >= req.conn_num)
			break;
	}
	hci_dev_unlock_bh(hdev);

	cl->dev_id = hdev->id;
	cl->conn_num = n;
	size = sizeof(req) + n * sizeof(*ci);

	hci_dev_put(hdev);

	err = copy_to_user(arg, cl, size);
	kfree(cl);

	return err ? -EFAULT : 0;
}

int hci_get_conn_info(struct hci_dev *hdev, void __user *arg)
{
	struct hci_conn_info_req req;
	struct hci_conn_info ci;
	struct hci_conn *conn;
	char __user *ptr = arg + sizeof(req);

	if (copy_from_user(&req, arg, sizeof(req)))
		return -EFAULT;

	hci_dev_lock_bh(hdev);
	conn = hci_conn_hash_lookup_ba(hdev, req.type, &req.bdaddr);
	if (conn) {
		bacpy(&ci.bdaddr, &conn->dst);
		ci.handle = conn->handle;
		ci.type  = conn->type;
		ci.out   = conn->out;
		ci.state = conn->state;
		ci.link_mode = conn->link_mode;
	}
	hci_dev_unlock_bh(hdev);

	if (!conn)
		return -ENOENT;

	return copy_to_user(ptr, &ci, sizeof(ci)) ? -EFAULT : 0;
}

int hci_get_auth_info(struct hci_dev *hdev, void __user *arg)
{
	struct hci_auth_info_req req;
	struct hci_conn *conn;

	if (copy_from_user(&req, arg, sizeof(req)))
		return -EFAULT;

	hci_dev_lock_bh(hdev);
	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &req.bdaddr);
	if (conn)
		req.type = conn->auth_type;
	hci_dev_unlock_bh(hdev);

	if (!conn)
		return -ENOENT;

	return copy_to_user(arg, &req, sizeof(req)) ? -EFAULT : 0;
}
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 HCI connection handling. */
	26
1da177e4 LT	27	#include <linux/module.h>
	28
	29	#include <linux/types.h>
	30	#include <linux/errno.h>
	31	#include <linux/kernel.h>
1da177e4 LT	32	#include <linux/slab.h>
	33	#include <linux/poll.h>
	34	#include <linux/fcntl.h>
	35	#include <linux/init.h>
	36	#include <linux/skbuff.h>
	37	#include <linux/interrupt.h>
	38	#include <linux/notifier.h>
	39	#include <net/sock.h>
	40
	41	#include <asm/system.h>
	42	#include <asm/uaccess.h>
	43	#include <asm/unaligned.h>
	44
	45	#include <net/bluetooth/bluetooth.h>
	46	#include <net/bluetooth/hci_core.h>
	47
4c67bc74	48	void hci_acl_connect(struct hci_conn *conn)
1da177e4 LT	49	{
	50	struct hci_dev *hdev = conn->hdev;
	51	struct inquiry_entry *ie;
	52	struct hci_cp_create_conn cp;
	53
	54	BT_DBG("%p", conn);
	55
	56	conn->state = BT_CONNECT;
a8746417 MH	57	conn->out = 1;
a8746417 MH	58
1da177e4 LT	59	conn->link_mode = HCI_LM_MASTER;
1da177e4 LT	60
4c67bc74 MH	61	conn->attempt++;
4c67bc74 MH	62
e4e8e37c MH	63	conn->link_policy = hdev->link_policy;
e4e8e37c MH	64
1da177e4 LT	65	memset(&cp, 0, sizeof(cp));
	66	bacpy(&cp.bdaddr, &conn->dst);
	67	cp.pscan_rep_mode = 0x02;
	68
41a96212 MH	69	if ((ie = hci_inquiry_cache_lookup(hdev, &conn->dst))) {
	70	if (inquiry_entry_age(ie) <= INQUIRY_ENTRY_AGE_MAX) {
	71	cp.pscan_rep_mode = ie->data.pscan_rep_mode;
	72	cp.pscan_mode = ie->data.pscan_mode;
	73	cp.clock_offset = ie->data.clock_offset \|
	74	cpu_to_le16(0x8000);
	75	}
	76
1da177e4	77	memcpy(conn->dev_class, ie->data.dev_class, 3);
41a96212	78	conn->ssp_mode = ie->data.ssp_mode;
1da177e4 LT	79	}
1da177e4 LT	80
a8746417	81	cp.pkt_type = cpu_to_le16(conn->pkt_type);
1da177e4	82	if (lmp_rswitch_capable(hdev) && !(hdev->link_mode & HCI_LM_MASTER))
b6a0dc82	83	cp.role_switch = 0x01;
1da177e4	84	else
b6a0dc82	85	cp.role_switch = 0x00;
4c67bc74	86
a9de9248	87	hci_send_cmd(hdev, HCI_OP_CREATE_CONN, sizeof(cp), &cp);
1da177e4 LT	88	}
1da177e4 LT	89
6ac59344 MH	90	static void hci_acl_connect_cancel(struct hci_conn *conn)
	91	{
	92	struct hci_cp_create_conn_cancel cp;
	93
	94	BT_DBG("%p", conn);
	95
	96	if (conn->hdev->hci_ver < 2)
	97	return;
	98
	99	bacpy(&cp.bdaddr, &conn->dst);
a9de9248	100	hci_send_cmd(conn->hdev, HCI_OP_CREATE_CONN_CANCEL, sizeof(cp), &cp);
6ac59344 MH	101	}
6ac59344 MH	102
1da177e4 LT	103	void hci_acl_disconn(struct hci_conn *conn, __u8 reason)
	104	{
	105	struct hci_cp_disconnect cp;
	106
	107	BT_DBG("%p", conn);
	108
	109	conn->state = BT_DISCONN;
	110
aca3192c	111	cp.handle = cpu_to_le16(conn->handle);
1da177e4	112	cp.reason = reason;
a9de9248	113	hci_send_cmd(conn->hdev, HCI_OP_DISCONNECT, sizeof(cp), &cp);
1da177e4 LT	114	}
	115
	116	void hci_add_sco(struct hci_conn *conn, __u16 handle)
	117	{
	118	struct hci_dev *hdev = conn->hdev;
	119	struct hci_cp_add_sco cp;
	120
	121	BT_DBG("%p", conn);
	122
	123	conn->state = BT_CONNECT;
	124	conn->out = 1;
	125
aca3192c	126	cp.handle = cpu_to_le16(handle);
a8746417	127	cp.pkt_type = cpu_to_le16(conn->pkt_type);
1da177e4	128
a9de9248	129	hci_send_cmd(hdev, HCI_OP_ADD_SCO, sizeof(cp), &cp);
1da177e4 LT	130	}
1da177e4 LT	131
b6a0dc82 MH	132	void hci_setup_sync(struct hci_conn *conn, __u16 handle)
	133	{
	134	struct hci_dev *hdev = conn->hdev;
	135	struct hci_cp_setup_sync_conn cp;
	136
	137	BT_DBG("%p", conn);
	138
	139	conn->state = BT_CONNECT;
	140	conn->out = 1;
	141
	142	cp.handle = cpu_to_le16(handle);
a8746417	143	cp.pkt_type = cpu_to_le16(conn->pkt_type);
b6a0dc82 MH	144
	145	cp.tx_bandwidth = cpu_to_le32(0x00001f40);
	146	cp.rx_bandwidth = cpu_to_le32(0x00001f40);
	147	cp.max_latency = cpu_to_le16(0xffff);
	148	cp.voice_setting = cpu_to_le16(hdev->voice_setting);
	149	cp.retrans_effort = 0xff;
	150
	151	hci_send_cmd(hdev, HCI_OP_SETUP_SYNC_CONN, sizeof(cp), &cp);
	152	}
	153
1da177e4 LT	154	static void hci_conn_timeout(unsigned long arg)
1da177e4 LT	155	{
04837f64 MH	156	struct hci_conn conn = (void ) arg;
04837f64 MH	157	struct hci_dev *hdev = conn->hdev;
1da177e4 LT	158
	159	BT_DBG("conn %p state %d", conn, conn->state);
	160
	161	if (atomic_read(&conn->refcnt))
	162	return;
	163
	164	hci_dev_lock(hdev);
6ac59344 MH	165
	166	switch (conn->state) {
	167	case BT_CONNECT:
769be974	168	case BT_CONNECT2:
b6a0dc82 MH	169	if (conn->type == ACL_LINK)
	170	hci_acl_connect_cancel(conn);
	171	else
	172	hci_acl_disconn(conn, 0x13);
6ac59344	173	break;
769be974	174	case BT_CONFIG:
8e87d142	175	case BT_CONNECTED:
1da177e4	176	hci_acl_disconn(conn, 0x13);
6ac59344 MH	177	break;
6ac59344 MH	178	default:
1da177e4	179	conn->state = BT_CLOSED;
6ac59344 MH	180	break;
	181	}
	182
1da177e4	183	hci_dev_unlock(hdev);
1da177e4 LT	184	}
1da177e4 LT	185
04837f64	186	static void hci_conn_idle(unsigned long arg)
1da177e4	187	{
04837f64 MH	188	struct hci_conn conn = (void ) arg;
	189
	190	BT_DBG("conn %p mode %d", conn, conn->mode);
	191
	192	hci_conn_enter_sniff_mode(conn);
1da177e4 LT	193	}
	194
	195	struct hci_conn hci_conn_add(struct hci_dev hdev, int type, bdaddr_t *dst)
	196	{
	197	struct hci_conn *conn;
	198
	199	BT_DBG("%s dst %s", hdev->name, batostr(dst));
	200
04837f64 MH	201	conn = kzalloc(sizeof(struct hci_conn), GFP_ATOMIC);
04837f64 MH	202	if (!conn)
1da177e4	203	return NULL;
1da177e4 LT	204
1da177e4 LT	205	bacpy(&conn->dst, dst);
a8746417 MH	206	conn->hdev = hdev;
	207	conn->type = type;
	208	conn->mode = HCI_CM_ACTIVE;
	209	conn->state = BT_OPEN;
1da177e4	210
04837f64 MH	211	conn->power_save = 1;
04837f64 MH	212
a8746417 MH	213	switch (type) {
	214	case ACL_LINK:
	215	conn->pkt_type = hdev->pkt_type & ACL_PTYPE_MASK;
	216	break;
	217	case SCO_LINK:
	218	if (lmp_esco_capable(hdev))
	219	conn->pkt_type = hdev->esco_type & SCO_ESCO_MASK;
	220	else
	221	conn->pkt_type = hdev->pkt_type & SCO_PTYPE_MASK;
	222	break;
	223	case ESCO_LINK:
	224	conn->pkt_type = hdev->esco_type;
	225	break;
	226	}
	227
1da177e4	228	skb_queue_head_init(&conn->data_q);
04837f64	229
b24b8a24 PE	230	setup_timer(&conn->disc_timer, hci_conn_timeout, (unsigned long)conn);
b24b8a24 PE	231	setup_timer(&conn->idle_timer, hci_conn_idle, (unsigned long)conn);
1da177e4 LT	232
	233	atomic_set(&conn->refcnt, 0);
	234
	235	hci_dev_hold(hdev);
	236
	237	tasklet_disable(&hdev->tx_task);
	238
	239	hci_conn_hash_add(hdev, conn);
	240	if (hdev->notify)
	241	hdev->notify(hdev, HCI_NOTIFY_CONN_ADD);
	242
	243	tasklet_enable(&hdev->tx_task);
	244
	245	return conn;
	246	}
	247
	248	int hci_conn_del(struct hci_conn *conn)
	249	{
	250	struct hci_dev *hdev = conn->hdev;
	251
	252	BT_DBG("%s conn %p handle %d", hdev->name, conn, conn->handle);
	253
04837f64 MH	254	del_timer(&conn->idle_timer);
	255
	256	del_timer(&conn->disc_timer);
1da177e4	257
5b7f9909	258	if (conn->type == ACL_LINK) {
1da177e4 LT	259	struct hci_conn *sco = conn->link;
	260	if (sco)
	261	sco->link = NULL;
	262
	263	/* Unacked frames */
	264	hdev->acl_cnt += conn->sent;
5b7f9909 MH	265	} else {
	266	struct hci_conn *acl = conn->link;
	267	if (acl) {
	268	acl->link = NULL;
	269	hci_conn_put(acl);
	270	}
1da177e4 LT	271	}
	272
	273	tasklet_disable(&hdev->tx_task);
7d0db0a3	274
1da177e4 LT	275	hci_conn_hash_del(hdev, conn);
	276	if (hdev->notify)
	277	hdev->notify(hdev, HCI_NOTIFY_CONN_DEL);
7d0db0a3	278
1da177e4	279	tasklet_enable(&hdev->tx_task);
7d0db0a3	280
1da177e4	281	skb_queue_purge(&conn->data_q);
1da177e4	282
1da177e4 LT	283	return 0;
	284	}
	285
	286	struct hci_dev hci_get_route(bdaddr_t dst, bdaddr_t *src)
	287	{
	288	int use_src = bacmp(src, BDADDR_ANY);
	289	struct hci_dev *hdev = NULL;
	290	struct list_head *p;
	291
	292	BT_DBG("%s -> %s", batostr(src), batostr(dst));
	293
	294	read_lock_bh(&hci_dev_list_lock);
	295
	296	list_for_each(p, &hci_dev_list) {
	297	struct hci_dev *d = list_entry(p, struct hci_dev, list);
	298
	299	if (!test_bit(HCI_UP, &d->flags) \|\| test_bit(HCI_RAW, &d->flags))
	300	continue;
	301
8e87d142	302	/* Simple routing:
1da177e4 LT	303	* No source address - find interface with bdaddr != dst
	304	* Source address - find interface with bdaddr == src
	305	*/
	306
	307	if (use_src) {
	308	if (!bacmp(&d->bdaddr, src)) {
	309	hdev = d; break;
	310	}
	311	} else {
	312	if (bacmp(&d->bdaddr, dst)) {
	313	hdev = d; break;
	314	}
	315	}
	316	}
	317
	318	if (hdev)
	319	hdev = hci_dev_hold(hdev);
	320
	321	read_unlock_bh(&hci_dev_list_lock);
	322	return hdev;
	323	}
	324	EXPORT_SYMBOL(hci_get_route);
	325
	326	/* Create SCO or ACL connection.
	327	* Device _must_ be locked */
8c1b2355	328	struct hci_conn hci_connect(struct hci_dev hdev, int type, bdaddr_t *dst, __u8 sec_level, __u8 auth_type)
1da177e4 LT	329	{
1da177e4 LT	330	struct hci_conn *acl;
5b7f9909	331	struct hci_conn *sco;
1da177e4 LT	332
	333	BT_DBG("%s dst %s", hdev->name, batostr(dst));
	334
	335	if (!(acl = hci_conn_hash_lookup_ba(hdev, ACL_LINK, dst))) {
	336	if (!(acl = hci_conn_add(hdev, ACL_LINK, dst)))
	337	return NULL;
	338	}
	339
	340	hci_conn_hold(acl);
	341
09ab6f4c	342	if (acl->state == BT_OPEN \|\| acl->state == BT_CLOSED) {
8c1b2355	343	acl->sec_level = sec_level;
09ab6f4c	344	acl->auth_type = auth_type;
1da177e4	345	hci_acl_connect(acl);
09ab6f4c	346	}
1da177e4	347
5b7f9909 MH	348	if (type == ACL_LINK)
5b7f9909 MH	349	return acl;
1da177e4	350
5b7f9909 MH	351	if (!(sco = hci_conn_hash_lookup_ba(hdev, type, dst))) {
	352	if (!(sco = hci_conn_add(hdev, type, dst))) {
	353	hci_conn_put(acl);
	354	return NULL;
1da177e4	355	}
5b7f9909	356	}
1da177e4	357
5b7f9909 MH	358	acl->link = sco;
5b7f9909 MH	359	sco->link = acl;
1da177e4	360
5b7f9909	361	hci_conn_hold(sco);
1da177e4	362
5b7f9909	363	if (acl->state == BT_CONNECTED &&
b6a0dc82 MH	364	(sco->state == BT_OPEN \|\| sco->state == BT_CLOSED)) {
	365	if (lmp_esco_capable(hdev))
	366	hci_setup_sync(sco, acl->handle);
	367	else
	368	hci_add_sco(sco, acl->handle);
	369	}
5b7f9909 MH	370
5b7f9909 MH	371	return sco;
1da177e4 LT	372	}
	373	EXPORT_SYMBOL(hci_connect);
	374
e7c29cb1 MH	375	/* Check link security requirement */
	376	int hci_conn_check_link_mode(struct hci_conn *conn)
	377	{
	378	BT_DBG("conn %p", conn);
	379
	380	if (conn->ssp_mode > 0 && conn->hdev->ssp_mode > 0 &&
	381	!(conn->link_mode & HCI_LM_ENCRYPT))
	382	return 0;
	383
	384	return 1;
	385	}
	386	EXPORT_SYMBOL(hci_conn_check_link_mode);
	387
1da177e4	388	/* Authenticate remote device */
8c1b2355	389	static int hci_conn_auth(struct hci_conn *conn, __u8 sec_level)
1da177e4 LT	390	{
	391	BT_DBG("conn %p", conn);
	392
8c1b2355 MH	393	if (sec_level > conn->sec_level)
	394	conn->link_mode &= ~HCI_LM_AUTH;
	395
	396	conn->sec_level = sec_level;
	397
	398	if (sec_level == BT_SECURITY_HIGH)
	399	conn->auth_type \|= 0x01;
40be492f	400
1da177e4 LT	401	if (conn->link_mode & HCI_LM_AUTH)
	402	return 1;
	403
	404	if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
	405	struct hci_cp_auth_requested cp;
aca3192c	406	cp.handle = cpu_to_le16(conn->handle);
40be492f MH	407	hci_send_cmd(conn->hdev, HCI_OP_AUTH_REQUESTED,
40be492f MH	408	sizeof(cp), &cp);
1da177e4	409	}
8c1b2355	410
1da177e4 LT	411	return 0;
1da177e4 LT	412	}
1da177e4	413
8c1b2355 MH	414	/* Enable security */
8c1b2355 MH	415	int hci_conn_security(struct hci_conn *conn, __u8 sec_level)
1da177e4 LT	416	{
	417	BT_DBG("conn %p", conn);
	418
8c1b2355 MH	419	if (sec_level == BT_SECURITY_SDP)
	420	return 1;
	421
	422	if (sec_level == BT_SECURITY_LOW) {
	423	if (conn->ssp_mode > 0 && conn->hdev->ssp_mode > 0)
	424	return hci_conn_auth(conn, sec_level);
	425	else
	426	return 1;
	427	}
	428
1da177e4	429	if (conn->link_mode & HCI_LM_ENCRYPT)
8c1b2355	430	return hci_conn_auth(conn, sec_level);
1da177e4 LT	431
	432	if (test_and_set_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend))
	433	return 0;
	434
8c1b2355	435	if (hci_conn_auth(conn, sec_level)) {
1da177e4	436	struct hci_cp_set_conn_encrypt cp;
aca3192c	437	cp.handle = cpu_to_le16(conn->handle);
8e87d142	438	cp.encrypt = 1;
40be492f MH	439	hci_send_cmd(conn->hdev, HCI_OP_SET_CONN_ENCRYPT,
40be492f MH	440	sizeof(cp), &cp);
1da177e4	441	}
8c1b2355	442
1da177e4 LT	443	return 0;
1da177e4 LT	444	}
8c1b2355	445	EXPORT_SYMBOL(hci_conn_security);
1da177e4 LT	446
	447	/* Change link key */
	448	int hci_conn_change_link_key(struct hci_conn *conn)
	449	{
	450	BT_DBG("conn %p", conn);
	451
	452	if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
	453	struct hci_cp_change_conn_link_key cp;
aca3192c	454	cp.handle = cpu_to_le16(conn->handle);
40be492f MH	455	hci_send_cmd(conn->hdev, HCI_OP_CHANGE_CONN_LINK_KEY,
40be492f MH	456	sizeof(cp), &cp);
1da177e4	457	}
8c1b2355	458
1da177e4 LT	459	return 0;
	460	}
	461	EXPORT_SYMBOL(hci_conn_change_link_key);
	462
	463	/* Switch role */
8c1b2355	464	int hci_conn_switch_role(struct hci_conn *conn, __u8 role)
1da177e4 LT	465	{
	466	BT_DBG("conn %p", conn);
	467
	468	if (!role && conn->link_mode & HCI_LM_MASTER)
	469	return 1;
	470
	471	if (!test_and_set_bit(HCI_CONN_RSWITCH_PEND, &conn->pend)) {
	472	struct hci_cp_switch_role cp;
	473	bacpy(&cp.bdaddr, &conn->dst);
	474	cp.role = role;
a9de9248	475	hci_send_cmd(conn->hdev, HCI_OP_SWITCH_ROLE, sizeof(cp), &cp);
1da177e4	476	}
8c1b2355	477
1da177e4 LT	478	return 0;
	479	}
	480	EXPORT_SYMBOL(hci_conn_switch_role);
	481
04837f64 MH	482	/* Enter active mode */
	483	void hci_conn_enter_active_mode(struct hci_conn *conn)
	484	{
	485	struct hci_dev *hdev = conn->hdev;
	486
	487	BT_DBG("conn %p mode %d", conn, conn->mode);
	488
	489	if (test_bit(HCI_RAW, &hdev->flags))
	490	return;
	491
	492	if (conn->mode != HCI_CM_SNIFF \|\| !conn->power_save)
	493	goto timer;
	494
	495	if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
	496	struct hci_cp_exit_sniff_mode cp;
aca3192c	497	cp.handle = cpu_to_le16(conn->handle);
a9de9248	498	hci_send_cmd(hdev, HCI_OP_EXIT_SNIFF_MODE, sizeof(cp), &cp);
04837f64 MH	499	}
	500
	501	timer:
	502	if (hdev->idle_timeout > 0)
	503	mod_timer(&conn->idle_timer,
	504	jiffies + msecs_to_jiffies(hdev->idle_timeout));
	505	}
	506
	507	/* Enter sniff mode */
	508	void hci_conn_enter_sniff_mode(struct hci_conn *conn)
	509	{
	510	struct hci_dev *hdev = conn->hdev;
	511
	512	BT_DBG("conn %p mode %d", conn, conn->mode);
	513
	514	if (test_bit(HCI_RAW, &hdev->flags))
	515	return;
	516
	517	if (!lmp_sniff_capable(hdev) \|\| !lmp_sniff_capable(conn))
	518	return;
	519
	520	if (conn->mode != HCI_CM_ACTIVE \|\| !(conn->link_policy & HCI_LP_SNIFF))
	521	return;
	522
	523	if (lmp_sniffsubr_capable(hdev) && lmp_sniffsubr_capable(conn)) {
	524	struct hci_cp_sniff_subrate cp;
aca3192c YH	525	cp.handle = cpu_to_le16(conn->handle);
	526	cp.max_latency = cpu_to_le16(0);
	527	cp.min_remote_timeout = cpu_to_le16(0);
	528	cp.min_local_timeout = cpu_to_le16(0);
a9de9248	529	hci_send_cmd(hdev, HCI_OP_SNIFF_SUBRATE, sizeof(cp), &cp);
04837f64 MH	530	}
	531
	532	if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
	533	struct hci_cp_sniff_mode cp;
aca3192c YH	534	cp.handle = cpu_to_le16(conn->handle);
	535	cp.max_interval = cpu_to_le16(hdev->sniff_max_interval);
	536	cp.min_interval = cpu_to_le16(hdev->sniff_min_interval);
	537	cp.attempt = cpu_to_le16(4);
	538	cp.timeout = cpu_to_le16(1);
a9de9248	539	hci_send_cmd(hdev, HCI_OP_SNIFF_MODE, sizeof(cp), &cp);
04837f64 MH	540	}
	541	}
	542
1da177e4 LT	543	/* Drop all connection on the device */
	544	void hci_conn_hash_flush(struct hci_dev *hdev)
	545	{
	546	struct hci_conn_hash *h = &hdev->conn_hash;
	547	struct list_head *p;
	548
	549	BT_DBG("hdev %s", hdev->name);
	550
	551	p = h->list.next;
	552	while (p != &h->list) {
	553	struct hci_conn *c;
	554
	555	c = list_entry(p, struct hci_conn, list);
	556	p = p->next;
	557
	558	c->state = BT_CLOSED;
	559
7d0db0a3 MH	560	hci_conn_del_sysfs(c);
7d0db0a3 MH	561
1da177e4 LT	562	hci_proto_disconn_ind(c, 0x16);
	563	hci_conn_del(c);
	564	}
	565	}
	566
a9de9248 MH	567	/* Check pending connect attempts */
	568	void hci_conn_check_pending(struct hci_dev *hdev)
	569	{
	570	struct hci_conn *conn;
	571
	572	BT_DBG("hdev %s", hdev->name);
	573
	574	hci_dev_lock(hdev);
	575
	576	conn = hci_conn_hash_lookup_state(hdev, ACL_LINK, BT_CONNECT2);
	577	if (conn)
	578	hci_acl_connect(conn);
	579
	580	hci_dev_unlock(hdev);
	581	}
	582
1da177e4 LT	583	int hci_get_conn_list(void __user *arg)
	584	{
	585	struct hci_conn_list_req req, *cl;
	586	struct hci_conn_info *ci;
	587	struct hci_dev *hdev;
	588	struct list_head *p;
	589	int n = 0, size, err;
	590
	591	if (copy_from_user(&req, arg, sizeof(req)))
	592	return -EFAULT;
	593
	594	if (!req.conn_num \|\| req.conn_num > (PAGE_SIZE * 2) / sizeof(*ci))
	595	return -EINVAL;
	596
	597	size = sizeof(req) + req.conn_num * sizeof(*ci);
	598
12fe2c58	599	if (!(cl = kmalloc(size, GFP_KERNEL)))
1da177e4 LT	600	return -ENOMEM;
	601
	602	if (!(hdev = hci_dev_get(req.dev_id))) {
	603	kfree(cl);
	604	return -ENODEV;
	605	}
	606
	607	ci = cl->conn_info;
	608
	609	hci_dev_lock_bh(hdev);
	610	list_for_each(p, &hdev->conn_hash.list) {
	611	register struct hci_conn *c;
	612	c = list_entry(p, struct hci_conn, list);
	613
	614	bacpy(&(ci + n)->bdaddr, &c->dst);
	615	(ci + n)->handle = c->handle;
	616	(ci + n)->type = c->type;
	617	(ci + n)->out = c->out;
	618	(ci + n)->state = c->state;
	619	(ci + n)->link_mode = c->link_mode;
	620	if (++n >= req.conn_num)
	621	break;
	622	}
	623	hci_dev_unlock_bh(hdev);
	624
	625	cl->dev_id = hdev->id;
	626	cl->conn_num = n;
	627	size = sizeof(req) + n * sizeof(*ci);
	628
	629	hci_dev_put(hdev);
	630
	631	err = copy_to_user(arg, cl, size);
	632	kfree(cl);
	633
	634	return err ? -EFAULT : 0;
	635	}
	636
	637	int hci_get_conn_info(struct hci_dev hdev, void __user arg)
	638	{
	639	struct hci_conn_info_req req;
	640	struct hci_conn_info ci;
	641	struct hci_conn *conn;
	642	char __user *ptr = arg + sizeof(req);
	643
	644	if (copy_from_user(&req, arg, sizeof(req)))
	645	return -EFAULT;
	646
	647	hci_dev_lock_bh(hdev);
	648	conn = hci_conn_hash_lookup_ba(hdev, req.type, &req.bdaddr);
	649	if (conn) {
	650	bacpy(&ci.bdaddr, &conn->dst);
	651	ci.handle = conn->handle;
	652	ci.type = conn->type;
	653	ci.out = conn->out;
	654	ci.state = conn->state;
	655	ci.link_mode = conn->link_mode;
	656	}
	657	hci_dev_unlock_bh(hdev);
	658
	659	if (!conn)
	660	return -ENOENT;
	661
	662	return copy_to_user(ptr, &ci, sizeof(ci)) ? -EFAULT : 0;
	663	}
40be492f MH	664
	665	int hci_get_auth_info(struct hci_dev hdev, void __user arg)
	666	{
	667	struct hci_auth_info_req req;
	668	struct hci_conn *conn;
	669
	670	if (copy_from_user(&req, arg, sizeof(req)))
	671	return -EFAULT;
	672
	673	hci_dev_lock_bh(hdev);
	674	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &req.bdaddr);
	675	if (conn)
	676	req.type = conn->auth_type;
	677	hci_dev_unlock_bh(hdev);
	678
	679	if (!conn)
	680	return -ENOENT;
	681
	682	return copy_to_user(arg, &req, sizeof(req)) ? -EFAULT : 0;
	683	}