diff options
Diffstat (limited to 'src/hci.c')
| -rw-r--r-- | src/hci.c | 2489 | 
1 files changed, 0 insertions, 2489 deletions
diff --git a/src/hci.c b/src/hci.c deleted file mode 100644 index a72b0355..00000000 --- a/src/hci.c +++ /dev/null @@ -1,2489 +0,0 @@ -/* - * - *  BlueZ - Bluetooth protocol stack for Linux - * - *  Copyright (C) 2000-2001  Qualcomm Incorporated - *  Copyright (C) 2002-2003  Maxim Krasnyansky <maxk@qualcomm.com> - *  Copyright (C) 2002-2008  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 as published by - *  the Free Software Foundation; either version 2 of the License, or - *  (at your option) any later version. - * - *  This program is distributed in the hope that it will be useful, - *  but WITHOUT ANY WARRANTY; without even the implied warranty of - *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the - *  GNU General Public License for more details. - * - *  You should have received a copy of the GNU General Public License - *  along with this program; if not, write to the Free Software - *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA - * - */ - -#ifdef HAVE_CONFIG_H -#include <config.h> -#endif - -#include <stdio.h> -#include <errno.h> -#include <fcntl.h> -#include <unistd.h> -#include <stdlib.h> -#include <string.h> - -#include <sys/param.h> -#include <sys/uio.h> -#include <sys/poll.h> -#include <sys/types.h> -#include <sys/ioctl.h> -#include <sys/socket.h> - -#include <bluetooth/bluetooth.h> -#include <bluetooth/hci.h> -#include <bluetooth/hci_lib.h> - -#ifndef MIN -#define MIN(x, y) ((x) < (y) ? (x) : (y)) -#endif - -typedef struct { -	char *str; -	unsigned int val; -} hci_map; - -static char *hci_bit2str(hci_map *m, unsigned int val)  -{ -	char *str = malloc(120); -	char *ptr = str; - -	if (!str) -		return NULL; - -	*ptr = 0; -	while (m->str) { -		if ((unsigned int) m->val & val) -			ptr += sprintf(ptr, "%s ", m->str); -		m++; -	} -	return str; -} - -static int hci_str2bit(hci_map *map, char *str, unsigned int *val) -{ -	char *t, *ptr; -	hci_map *m; -	int set; - -	if (!str || !(str = ptr = strdup(str))) -		return 0; - -	*val = set = 0; - -	while ((t = strsep(&ptr, ","))) { -		for (m = map; m->str; m++) { -			if (!strcasecmp(m->str, t)) { -				*val |= (unsigned int) m->val; -				set = 1; -			} -		} -	} -	free(str); - -	return set; -} - -static char *hci_uint2str(hci_map *m, unsigned int val)  -{ -	char *str = malloc(50); -	char *ptr = str; - -	if (!str) -		return NULL; - -	*ptr = 0; -	while (m->str) { -		if ((unsigned int) m->val == val) { -			ptr += sprintf(ptr, "%s", m->str); -			break; -		} -		m++; -	} -	return str; -} - -static int hci_str2uint(hci_map *map, char *str, unsigned int *val) -{ -	char *t, *ptr; -	hci_map *m; -	int set = 0; - -	if (!str) -		return 0; - -	str = ptr = strdup(str); - -	while ((t = strsep(&ptr, ","))) { -		for (m = map; m->str; m++) { -			if (!strcasecmp(m->str,t)) { -				*val = (unsigned int) m->val; set = 1; -				break; -			} -		} -	} -	free(str); - -	return set; -} - -char *hci_dtypetostr(int type) -{ -	switch (type) { -	case HCI_VIRTUAL: -		return "VIRTUAL"; -	case HCI_USB: -		return "USB"; -	case HCI_PCCARD: -		return "PCCARD"; -	case HCI_UART: -		return "UART"; -	case HCI_RS232: -		return "RS232"; -	case HCI_PCI: -		return "PCI"; -	case HCI_SDIO: -		return "SDIO"; -	default: -		return "UNKNOWN"; -	} -} - -/* HCI dev flags mapping */ -static hci_map dev_flags_map[] = { -	{ "UP",      HCI_UP      }, -	{ "INIT",    HCI_INIT    }, -	{ "RUNNING", HCI_RUNNING }, -	{ "RAW",     HCI_RAW     }, -	{ "PSCAN",   HCI_PSCAN   }, -	{ "ISCAN",   HCI_ISCAN   }, -	{ "INQUIRY", HCI_INQUIRY }, -	{ "AUTH",    HCI_AUTH    }, -	{ "ENCRYPT", HCI_ENCRYPT }, -	{ "SECMGR",  HCI_SECMGR  }, -	{ NULL } -}; - -char *hci_dflagstostr(uint32_t flags) -{ -	char *str = bt_malloc(50); -	char *ptr = str; -	hci_map *m = dev_flags_map; - -	if (!str) -		return NULL; - -	*ptr = 0; - -	if (!hci_test_bit(HCI_UP, &flags)) -		ptr += sprintf(ptr, "DOWN "); - -	while (m->str) { -		if (hci_test_bit(m->val, &flags)) -			ptr += sprintf(ptr, "%s ", m->str); -		m++; -	} 	 -	return str; -} - -/* HCI packet type mapping */ -static hci_map pkt_type_map[] = { -	{ "DM1",   HCI_DM1  }, -	{ "DM3",   HCI_DM3  }, -	{ "DM5",   HCI_DM5  }, -	{ "DH1",   HCI_DH1  }, -	{ "DH3",   HCI_DH3  }, -	{ "DH5",   HCI_DH5  }, -	{ "HV1",   HCI_HV1  }, -	{ "HV2",   HCI_HV2  }, -	{ "HV3",   HCI_HV3  }, -	{ "2-DH1", HCI_2DH1 }, -	{ "2-DH3", HCI_2DH3 }, -	{ "2-DH5", HCI_2DH5 }, -	{ "3-DH1", HCI_3DH1 }, -	{ "3-DH3", HCI_3DH3 }, -	{ "3-DH5", HCI_3DH5 }, -	{ NULL } -}; - -static hci_map sco_ptype_map[] = { -	{ "HV1",   0x0001   }, -	{ "HV2",   0x0002   }, -	{ "HV3",   0x0004   }, -	{ "EV3",   HCI_EV3  }, -	{ "EV4",   HCI_EV4  }, -	{ "EV5",   HCI_EV5  }, -	{ "2-EV3", HCI_2EV3 }, -	{ "2-EV5", HCI_2EV5 }, -	{ "3-EV3", HCI_3EV3 }, -	{ "3-EV5", HCI_3EV5 }, -	{ NULL } -}; - -char *hci_ptypetostr(unsigned int ptype) -{ -	return hci_bit2str(pkt_type_map, ptype); -} - -int hci_strtoptype(char *str, unsigned int *val) -{ -	return hci_str2bit(pkt_type_map, str, val); -} - -char *hci_scoptypetostr(unsigned int ptype) -{ -	return hci_bit2str(sco_ptype_map, ptype); -} - -int hci_strtoscoptype(char *str, unsigned int *val) -{ -	return hci_str2bit(sco_ptype_map, str, val); -} - -/* Link policy mapping */ -static hci_map link_policy_map[] = { -	{ "NONE",	0		}, -	{ "RSWITCH",	HCI_LP_RSWITCH	}, -	{ "HOLD",	HCI_LP_HOLD	}, -	{ "SNIFF",	HCI_LP_SNIFF	}, -	{ "PARK",	HCI_LP_PARK	}, -	{ NULL } -}; - -char *hci_lptostr(unsigned int lp) -{ -	return hci_bit2str(link_policy_map, lp); -} - -int hci_strtolp(char *str, unsigned int *val) -{ -	return hci_str2bit(link_policy_map, str, val); -} - -/* Link mode mapping */ -static hci_map link_mode_map[] = { -	{ "NONE",	0		}, -	{ "ACCEPT",	HCI_LM_ACCEPT	}, -	{ "MASTER",	HCI_LM_MASTER	}, -	{ "AUTH",	HCI_LM_AUTH	}, -	{ "ENCRYPT",	HCI_LM_ENCRYPT	}, -	{ "TRUSTED",	HCI_LM_TRUSTED	}, -	{ "RELIABLE",	HCI_LM_RELIABLE	}, -	{ "SECURE",	HCI_LM_SECURE	}, -	{ NULL } -}; - -char *hci_lmtostr(unsigned int lm) -{ -	char *s, *str = bt_malloc(50); -	if (!str) -		return NULL; - -	*str = 0; -	if (!(lm & HCI_LM_MASTER)) -		strcpy(str, "SLAVE "); - -	s = hci_bit2str(link_mode_map, lm); -	if (!s) { -		bt_free(str); -		return NULL; -	} - -	strcat(str, s); -	free(s); -	return str; -} - -int hci_strtolm(char *str, unsigned int *val) -{ -	return hci_str2bit(link_mode_map, str, val); -} - -/* Command mapping */ -static hci_map commands_map[] = { -	{ "Inquiry",					0   }, -	{ "Inquiry Cancel",				1   }, -	{ "Periodic Inquiry Mode",			2   }, -	{ "Exit Periodic Inquiry Mode",			3   }, -	{ "Create Connection",				4   }, -	{ "Disconnect",					5   }, -	{ "Add SCO Connection",				6   }, -	{ "Cancel Create Connection",			7   }, - -	{ "Accept Connection Request",			8   }, -	{ "Reject Connection Request",			9   }, -	{ "Link Key Request Reply",			10  }, -	{ "Link Key Request Negative Reply",		11  }, -	{ "PIN Code Request Reply",			12  }, -	{ "PIN Code Request Negative Reply",		13  }, -	{ "Change Connection Packet Type",		14  }, -	{ "Authentication Requested",			15  }, - -	{ "Set Connection Encryption",			16  }, -	{ "Change Connection Link Key",			17  }, -	{ "Master Link Key",				18  }, -	{ "Remote Name Request",			19  }, -	{ "Cancel Remote Name Request",			20  }, -	{ "Read Remote Supported Features",		21  }, -	{ "Read Remote Extended Features",		22  }, -	{ "Read Remote Version Information",		23  }, - -	{ "Read Clock Offset",				24  }, -	{ "Read LMP Handle",				25  }, -	{ "Reserved",					26  }, -	{ "Reserved",					27  }, -	{ "Reserved",					28  }, -	{ "Reserved",					29  }, -	{ "Reserved",					30  }, -	{ "Reserved",					31  }, - -	{ "Reserved",					32  }, -	{ "Hold Mode",					33  }, -	{ "Sniff Mode",					34  }, -	{ "Exit Sniff Mode",				35  }, -	{ "Park State",					36  }, -	{ "Exit Park State",				37  }, -	{ "QoS Setup",					38  }, -	{ "Role Discovery",				39  }, - -	{ "Switch Role",				40  }, -	{ "Read Link Policy Settings",			41  }, -	{ "Write Link Policy Settings",			42  }, -	{ "Read Default Link Policy Settings",		43  }, -	{ "Write Default Link Policy Settings",		44  }, -	{ "Flow Specification",				45  }, -	{ "Set Event Mask",				46  }, -	{ "Reset",					47  }, - -	{ "Set Event Filter",				48  }, -	{ "Flush",					49  }, -	{ "Read PIN Type",				50  }, -	{ "Write PIN Type",				51  }, -	{ "Create New Unit Key",			52  }, -	{ "Read Stored Link Key",			53  }, -	{ "Write Stored Link Key",			54  }, -	{ "Delete Stored Link Key",			55  }, - -	{ "Write Local Name",				56  }, -	{ "Read Local Name",				57  }, -	{ "Read Connection Accept Timeout",		58  }, -	{ "Write Connection Accept Timeout",		59  }, -	{ "Read Page Timeout",				60  }, -	{ "Write Page Timeout",				61  }, -	{ "Read Scan Enable",				62  }, -	{ "Write Scan Enable",				63  }, - -	{ "Read Page Scan Activity",			64  }, -	{ "Write Page Scan Activity",			65  }, -	{ "Read Inquiry Scan Activity",			66  }, -	{ "Write Inquiry Scan Activity",		67  }, -	{ "Read Authentication Enable",			68  }, -	{ "Write Authentication Enable",		69  }, -	{ "Read Encryption Mode",			70  }, -	{ "Write Encryption Mode",			71  }, - -	{ "Read Class Of Device",			72  }, -	{ "Write Class Of Device",			73  }, -	{ "Read Voice Setting",				74  }, -	{ "Write Voice Setting",			75  }, -	{ "Read Automatic Flush Timeout",		76  }, -	{ "Write Automatic Flush Timeout",		77  }, -	{ "Read Num Broadcast Retransmissions",		78  }, -	{ "Write Num Broadcast Retransmissions",	79  }, - -	{ "Read Hold Mode Activity",			80  }, -	{ "Write Hold Mode Activity",			81  }, -	{ "Read Transmit Power Level",			82  }, -	{ "Read Synchronous Flow Control Enable",	83  }, -	{ "Write Synchronous Flow Control Enable",	84  }, -	{ "Set Host Controller To Host Flow Control",	85  }, -	{ "Host Buffer Size",				86  }, -	{ "Host Number Of Completed Packets",		87  }, - -	{ "Read Link Supervision Timeout",		88  }, -	{ "Write Link Supervision Timeout",		89  }, -	{ "Read Number of Supported IAC",		90  }, -	{ "Read Current IAC LAP",			91  }, -	{ "Write Current IAC LAP",			92  }, -	{ "Read Page Scan Period Mode",			93  }, -	{ "Write Page Scan Period Mode",		94  }, -	{ "Read Page Scan Mode",			95  }, - -	{ "Write Page Scan Mode",			96  }, -	{ "Set AFH Channel Classification",		97  }, -	{ "Reserved",					98  }, -	{ "Reserved",					99  }, -	{ "Read Inquiry Scan Type",			100 }, -	{ "Write Inquiry Scan Type",			101 }, -	{ "Read Inquiry Mode",				102 }, -	{ "Write Inquiry Mode",				103 }, - -	{ "Read Page Scan Type",			104 }, -	{ "Write Page Scan Type",			105 }, -	{ "Read AFH Channel Assessment Mode",		106 }, -	{ "Write AFH Channel Assessment Mode",		107 }, -	{ "Reserved",					108 }, -	{ "Reserved",					109 }, -	{ "Reserved",					110 }, -	{ "Reserved",					111 }, - -	{ "Reserved",					112 }, -	{ "Reserved",					113 }, -	{ "Reserved",					114 }, -	{ "Read Local Version Information",		115 }, -	{ "Read Local Supported Commands",		116 }, -	{ "Read Local Supported Features",		117 }, -	{ "Read Local Extended Features",		118 }, -	{ "Read Buffer Size",				119 }, - -	{ "Read Country Code",				120 }, -	{ "Read BD ADDR",				121 }, -	{ "Read Failed Contact Counter",		122 }, -	{ "Reset Failed Contact Counter",		123 }, -	{ "Get Link Quality",				124 }, -	{ "Read RSSI",					125 }, -	{ "Read AFH Channel Map",			126 }, -	{ "Read BD Clock",				127 }, - -	{ "Read Loopback Mode",				128 }, -	{ "Write Loopback Mode",			129 }, -	{ "Enable Device Under Test Mode",		130 }, -	{ "Setup Synchronous Connection",		131 }, -	{ "Accept Synchronous Connection",		132 }, -	{ "Reject Synchronous Connection",		133 }, -	{ "Reserved",					134 }, -	{ "Reserved",					135 }, - -	{ "Read Extended Inquiry Response",		136 }, -	{ "Write Extended Inquiry Response",		137 }, -	{ "Refresh Encryption Key",			138 }, -	{ "Reserved",					139 }, -	{ "Sniff Subrating",				140 }, -	{ "Read Simple Pairing Mode",			141 }, -	{ "Write Simple Pairing Mode",			142 }, -	{ "Read Local OOB Data",			143 }, - -	{ "Read Inquiry Transmit Power Level",		144 }, -	{ "Write Inquiry Transmit Power Level",		145 }, -	{ "Read Default Erroneous Data Reporting",	146 }, -	{ "Write Default Erroneous Data Reporting",	147 }, -	{ "Reserved",					148 }, -	{ "Reserved",					149 }, -	{ "Reserved",					150 }, -	{ "IO Capability Request Reply",		151 }, - -	{ "User Confirmation Request Reply",		152 }, -	{ "User Confirmation Request Negative Reply",	153 }, -	{ "User Passkey Request Reply",			154 }, -	{ "User Passkey Request Negative Reply",	155 }, -	{ "Remote OOB Data Request Reply",		156 }, -	{ "Write Simple Pairing Debug Mode",		157 }, -	{ "Enhanced Flush",				158 }, -	{ "Remote OOB Data Request Negative Reply",	159 }, - -	{ "Reserved",					160 }, -	{ "Reserved",					161 }, -	{ "Send Keypress Notification",			162 }, -	{ "IO Capabilities Response Negative Reply",	163 }, -	{ "Reserved",					164 }, -	{ "Reserved",					165 }, -	{ "Reserved",					166 }, -	{ "Reserved",					167 }, - -	{ NULL } -}; - -char *hci_cmdtostr(unsigned int cmd) -{ -	return hci_uint2str(commands_map, cmd); -} - -char *hci_commandstostr(uint8_t *commands, char *pref, int width) -{ -	hci_map *m; -	char *off, *ptr, *str; -	int size = 10; - -	m = commands_map; - -	while (m->str) { -		if (commands[m->val / 8] & (1 << (m->val % 8))) -			size += strlen(m->str) + (pref ? strlen(pref) : 0) + 3; -		m++; -	} - -	str = bt_malloc(size); -	if (!str) -		return NULL; - -	ptr = str; *ptr = '\0'; - -	if (pref) -		ptr += sprintf(ptr, "%s", pref); - -	off = ptr; - -	m = commands_map; - -	while (m->str) { -		if (commands[m->val / 8] & (1 << (m->val % 8))) { -			if (strlen(off) + strlen(m->str) > width - 3) { -				ptr += sprintf(ptr, "\n%s", pref ? pref : ""); -				off = ptr; -			} -			ptr += sprintf(ptr, "'%s' ", m->str); -		} -		m++; -	} - -	return str; -} - -/* Version mapping */ -static hci_map ver_map[] = { -	{ "1.0b",	0x00 }, -	{ "1.1",	0x01 }, -	{ "1.2",	0x02 }, -	{ "2.0",	0x03 }, -	{ "2.1",	0x04 }, -	{ NULL } -}; - -char *hci_vertostr(unsigned int ver) -{ -	return hci_uint2str(ver_map, ver); -} - -int hci_strtover(char *str, unsigned int *ver) -{ -	return hci_str2uint(ver_map, str, ver); -} - -char *lmp_vertostr(unsigned int ver) -{ -	return hci_uint2str(ver_map, ver); -} - -int lmp_strtover(char *str, unsigned int *ver) -{ -	return hci_str2uint(ver_map, str, ver); -} - -/* LMP features mapping */ -static hci_map lmp_features_map[8][9] = { -	{	/* Byte 0 */ -		{ "<3-slot packets>",	LMP_3SLOT	},	/* Bit 0 */ -		{ "<5-slot packets>",	LMP_5SLOT	},	/* Bit 1 */ -		{ "<encryption>",	LMP_ENCRYPT	},	/* Bit 2 */ -		{ "<slot offset>",	LMP_SOFFSET	},	/* Bit 3 */ -		{ "<timing accuracy>",	LMP_TACCURACY	},	/* Bit 4 */ -		{ "<role switch>",	LMP_RSWITCH	},	/* Bit 5 */ -		{ "<hold mode>",	LMP_HOLD	},	/* Bit 6 */ -		{ "<sniff mode>",	LMP_SNIFF	},	/* Bit 7 */ -		{ NULL } -	}, -	{	/* Byte 1 */ -		{ "<park state>",	LMP_PARK	},	/* Bit 0 */ -		{ "<RSSI>",		LMP_RSSI	},	/* Bit 1 */ -		{ "<channel quality>",	LMP_QUALITY	},	/* Bit 2 */ -		{ "<SCO link>",		LMP_SCO		},	/* Bit 3 */ -		{ "<HV2 packets>",	LMP_HV2		},	/* Bit 4 */ -		{ "<HV3 packets>",	LMP_HV3		},	/* Bit 5 */ -		{ "<u-law log>",	LMP_ULAW	},	/* Bit 6 */ -		{ "<A-law log>",	LMP_ALAW	},	/* Bit 7 */ -		{ NULL } -	}, -	{	/* Byte 2 */ -		{ "<CVSD>",		LMP_CVSD	},	/* Bit 0 */ -		{ "<paging scheme>",	LMP_PSCHEME	},	/* Bit 1 */ -		{ "<power control>",	LMP_PCONTROL	},	/* Bit 2 */ -		{ "<transparent SCO>",	LMP_TRSP_SCO	},	/* Bit 3 */ -		{ "<broadcast encrypt>",LMP_BCAST_ENC	},	/* Bit 7 */ -		{ NULL } -	}, -	{	/* Byte 3 */ -		{ "<no. 24>",		0x01		},	/* Bit 0 */ -		{ "<EDR ACL 2 Mbps>",	LMP_EDR_ACL_2M	},	/* Bit 1 */ -		{ "<EDR ACL 3 Mbps>",	LMP_EDR_ACL_3M	},	/* Bit 2 */ -		{ "<enhanced iscan>",	LMP_ENH_ISCAN	},	/* Bit 3 */ -		{ "<interlaced iscan>",	LMP_ILACE_ISCAN	},	/* Bit 4 */ -		{ "<interlaced pscan>",	LMP_ILACE_PSCAN	},	/* Bit 5 */ -		{ "<inquiry with RSSI>",LMP_RSSI_INQ	},	/* Bit 6 */ -		{ "<extended SCO>",	LMP_ESCO	},	/* Bit 7 */ -		{ NULL } -	}, -	{	/* Byte 4 */ -		{ "<EV4 packets>",	LMP_EV4		},	/* Bit 0 */ -		{ "<EV5 packets>",	LMP_EV5		},	/* Bit 1 */ -		{ "<no. 34>",		0x04		},	/* Bit 2 */ -		{ "<AFH cap. slave>",	LMP_AFH_CAP_SLV	},	/* Bit 3 */ -		{ "<AFH class. slave>",	LMP_AFH_CLS_SLV	},	/* Bit 4 */ -		{ "<no. 37>",		0x20		},	/* Bit 5 */ -		{ "<no. 38>",		0x40		},	/* Bit 6 */ -		{ "<3-slot EDR ACL>",	LMP_EDR_3SLOT	},	/* Bit 7 */ -		{ NULL } -	}, -	{	/* Byte 5 */ -		{ "<5-slot EDR ACL>",	LMP_EDR_5SLOT	},	/* Bit 0 */ -		{ "<sniff subrating>",	LMP_SNIFF_SUBR	},	/* Bit 1 */ -		{ "<pause encryption>",	LMP_PAUSE_ENC	},	/* Bit 2 */ -		{ "<AFH cap. master>",	LMP_AFH_CAP_MST	},	/* Bit 3 */ -		{ "<AFH class. master>",LMP_AFH_CLS_MST	},	/* Bit 4 */ -		{ "<EDR eSCO 2 Mbps>",	LMP_EDR_ESCO_2M	},	/* Bit 5 */ -		{ "<EDR eSCO 3 Mbps>",	LMP_EDR_ESCO_3M	},	/* Bit 6 */ -		{ "<3-slot EDR eSCO>",	LMP_EDR_3S_ESCO	},	/* Bit 7 */ -		{ NULL } -	}, -	{	/* Byte 6 */ -		{ "<extended inquiry>",	LMP_EXT_INQ	},	/* Bit 0 */ -		{ "<no. 49>",		0x02		},	/* Bit 1 */ -		{ "<no. 50>",		0x04		},	/* Bit 2 */ -		{ "<simple pairing>",	LMP_SIMPLE_PAIR	},	/* Bit 3 */ -		{ "<encapsulated PDU>",	LMP_ENCAPS_PDU	},	/* Bit 4 */ -		{ "<err. data report>",	LMP_ERR_DAT_REP	},	/* Bit 5 */ -		{ "<non-flush flag>",	LMP_NFLUSH_PKTS	},	/* Bit 6 */ -		{ "<no. 55>",		0x80		},	/* Bit 7 */ -		{ NULL } -	}, -	{	/* Byte 7 */ -		{ "<LSTO>",		LMP_LSTO	},	/* Bit 1 */ -		{ "<inquiry TX power>",	LMP_INQ_TX_PWR	},	/* Bit 1 */ -		{ "<no. 58>",		0x04		},	/* Bit 2 */ -		{ "<no. 59>",		0x08		},	/* Bit 3 */ -		{ "<no. 60>",		0x10		},	/* Bit 4 */ -		{ "<no. 61>",		0x20		},	/* Bit 5 */ -		{ "<no. 62>",		0x40		},	/* Bit 6 */ -		{ "<extended features>",LMP_EXT_FEAT	},	/* Bit 7 */ -		{ NULL } -	}, -}; - -char *lmp_featurestostr(uint8_t *features, char *pref, int width) -{ -	char *off, *ptr, *str; -	int i, size = 10; - -	for (i = 0; i < 8; i++) { -		hci_map *m = lmp_features_map[i]; - -		while (m->str) { -			if (m->val & features[i]) -				size += strlen(m->str) + (pref ? strlen(pref) : 0) + 1; -			m++; -		} -	} - -	str = bt_malloc(size); -	if (!str) -		return NULL; - -	ptr = str; *ptr = '\0'; - -	if (pref) -		ptr += sprintf(ptr, "%s", pref); - -	off = ptr; - -	for (i = 0; i < 8; i++) { -		hci_map *m = lmp_features_map[i]; - -		while (m->str) { -			if (m->val & features[i]) { -				if (strlen(off) + strlen(m->str) > width - 1) { -					ptr += sprintf(ptr, "\n%s", pref ? pref : ""); -					off = ptr; -				} -				ptr += sprintf(ptr, "%s ", m->str); -			} -			m++; -		} -	} - -	return str; -} - -/* HCI functions that do not require open device */ - -int hci_for_each_dev(int flag, int (*func)(int dd, int dev_id, long arg), long arg) -{ -	struct hci_dev_list_req *dl; -	struct hci_dev_req *dr; -	int dev_id = -1; -	int i, sk, err = 0; - -	sk = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI); -	if (sk < 0) -		return -1; - -	dl = malloc(HCI_MAX_DEV * sizeof(*dr) + sizeof(*dl)); -	if (!dl) { -		err = errno; -		goto done; -	} - -	memset(dl, 0, HCI_MAX_DEV * sizeof(*dr) + sizeof(*dl)); - -	dl->dev_num = HCI_MAX_DEV; -	dr = dl->dev_req; - -	if (ioctl(sk, HCIGETDEVLIST, (void *) dl) < 0) { -		err = errno; -		goto free; -	} - -	for (i = 0; i < dl->dev_num; i++, dr++) { -		if (hci_test_bit(flag, &dr->dev_opt)) -			if (!func || func(sk, dr->dev_id, arg)) { -				dev_id = dr->dev_id; -				break; -			} -	} - -	if (dev_id < 0) -		err = ENODEV; - -free: -	free(dl); - -done: -	close(sk); -	errno = err; - -	return dev_id; -} - -static int __other_bdaddr(int dd, int dev_id, long arg) -{ -	struct hci_dev_info di = { dev_id: dev_id }; - -	if (ioctl(dd, HCIGETDEVINFO, (void *) &di)) -		return 0; - -	if (hci_test_bit(HCI_RAW, &di.flags)) -		return 0; - -	return bacmp((bdaddr_t *) arg, &di.bdaddr); -} - -static int __same_bdaddr(int dd, int dev_id, long arg) -{ -	struct hci_dev_info di = { dev_id: dev_id }; - -	if (ioctl(dd, HCIGETDEVINFO, (void *) &di)) -		return 0; - -	return !bacmp((bdaddr_t *) arg, &di.bdaddr); -} - -int hci_get_route(bdaddr_t *bdaddr) -{ -	return hci_for_each_dev(HCI_UP, __other_bdaddr, -				(long) (bdaddr ? bdaddr : BDADDR_ANY)); -} - -int hci_devid(const char *str) -{ -	bdaddr_t ba; -	int id = -1; - -	if (!strncmp(str, "hci", 3) && strlen(str) >= 4) { -		id = atoi(str + 3); -		if (hci_devba(id, &ba) < 0) -			return -1; -	} else { -		errno = ENODEV; -		str2ba(str, &ba); -		id = hci_for_each_dev(HCI_UP, __same_bdaddr, (long) &ba); -	} - -	return id; -} - -int hci_devinfo(int dev_id, struct hci_dev_info *di) -{ -	int dd, err, ret; - -	dd = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI); -	if (dd < 0) -		return dd; - -	memset(di, 0, sizeof(struct hci_dev_info)); - -	di->dev_id = dev_id; -	ret = ioctl(dd, HCIGETDEVINFO, (void *) di); - -	err = errno; -	close(dd); -	errno = err; - -	return ret; -} - -int hci_devba(int dev_id, bdaddr_t *bdaddr) -{ -	struct hci_dev_info di; - -	memset(&di, 0, sizeof(di)); - -	if (hci_devinfo(dev_id, &di)) -		return -1; - -	if (!hci_test_bit(HCI_UP, &di.flags)) { -		errno = ENETDOWN; -		return -1; -	} - -	bacpy(bdaddr, &di.bdaddr); - -	return 0; -} - -int hci_inquiry(int dev_id, int len, int nrsp, const uint8_t *lap, inquiry_info **ii, long flags) -{ -	struct hci_inquiry_req *ir; -	uint8_t num_rsp = nrsp; -	void *buf; -	int dd, size, err, ret = -1; - -	if (nrsp <= 0) { -		num_rsp = 0; -		nrsp = 255; -	} - -	if (dev_id < 0) { -		dev_id = hci_get_route(NULL); -		if (dev_id < 0) { -			errno = ENODEV; -			return -1; -		} -	}	 - -	dd = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI); -	if (dd < 0) -		return dd; - -	buf = malloc(sizeof(*ir) + (sizeof(inquiry_info) * (nrsp))); -	if (!buf) -		goto done; - -	ir = buf; -	ir->dev_id  = dev_id; -	ir->num_rsp = num_rsp; -	ir->length  = len; -	ir->flags   = flags; - -	if (lap) { -		memcpy(ir->lap, lap, 3); -	} else { -		ir->lap[0] = 0x33; -		ir->lap[1] = 0x8b; -		ir->lap[2] = 0x9e; -	} - -	ret = ioctl(dd, HCIINQUIRY, (unsigned long) buf); -	if (ret < 0) -		goto free; - -	size = sizeof(inquiry_info) * ir->num_rsp; - -	if (!*ii) -		*ii = malloc(size); - -	if (*ii) { -		memcpy((void *) *ii, buf + sizeof(*ir), size); -		ret = ir->num_rsp; -	} else -		ret = -1; - -free: -	free(buf); - -done: -	err = errno; -	close(dd); -	errno = err; - -	return ret; -} - -/* Open HCI device.  - * Returns device descriptor (dd). */ -int hci_open_dev(int dev_id) -{ -	struct sockaddr_hci a; -	int dd, err; - -	/* Create HCI socket */ -	dd = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI); -	if (dd < 0) -		return dd; - -	/* Bind socket to the HCI device */ -	memset(&a, 0, sizeof(a)); -	a.hci_family = AF_BLUETOOTH; -	a.hci_dev = dev_id; -	if (bind(dd, (struct sockaddr *) &a, sizeof(a)) < 0) -		goto failed; - -	return dd; - -failed: -	err = errno; -	close(dd); -	errno = err; - -	return -1; -} - -int hci_close_dev(int dd) -{ -	return close(dd); -} - -/* HCI functions that require open device - * dd - Device descriptor returned by hci_open_dev. */ - -int hci_send_cmd(int dd, uint16_t ogf, uint16_t ocf, uint8_t plen, void *param) -{ -	uint8_t type = HCI_COMMAND_PKT; -	hci_command_hdr hc; -	struct iovec iv[3]; -	int ivn; - -	hc.opcode = htobs(cmd_opcode_pack(ogf, ocf)); -	hc.plen= plen; - -	iv[0].iov_base = &type; -	iv[0].iov_len  = 1; -	iv[1].iov_base = &hc; -	iv[1].iov_len  = HCI_COMMAND_HDR_SIZE; -	ivn = 2; - -	if (plen) { -		iv[2].iov_base = param; -		iv[2].iov_len  = plen; -		ivn = 3; -	} - -	while (writev(dd, iv, ivn) < 0) { -		if (errno == EAGAIN || errno == EINTR) -			continue; -		return -1; -	} -	return 0; -} - -int hci_send_req(int dd, struct hci_request *r, int to) -{ -	unsigned char buf[HCI_MAX_EVENT_SIZE], *ptr; -	uint16_t opcode = htobs(cmd_opcode_pack(r->ogf, r->ocf)); -	struct hci_filter nf, of; -	socklen_t len; -	hci_event_hdr *hdr; -	int err, try; - -	len = sizeof(of); -	if (getsockopt(dd, SOL_HCI, HCI_FILTER, &of, &len) < 0) -		return -1; - -	hci_filter_clear(&nf); -	hci_filter_set_ptype(HCI_EVENT_PKT,  &nf); -	hci_filter_set_event(EVT_CMD_STATUS, &nf); -	hci_filter_set_event(EVT_CMD_COMPLETE, &nf); -	hci_filter_set_event(r->event, &nf); -	hci_filter_set_opcode(opcode, &nf); -	if (setsockopt(dd, SOL_HCI, HCI_FILTER, &nf, sizeof(nf)) < 0) -		return -1; - -	if (hci_send_cmd(dd, r->ogf, r->ocf, r->clen, r->cparam) < 0) -		goto failed; - -	try = 10; -	while (try--) { -		evt_cmd_complete *cc; -		evt_cmd_status *cs; -		evt_remote_name_req_complete *rn; -		remote_name_req_cp *cp; - -		if (to) { -			struct pollfd p; -			int n; - -			p.fd = dd; p.events = POLLIN; -			while ((n = poll(&p, 1, to)) < 0) { -				if (errno == EAGAIN || errno == EINTR) -					continue; -				goto failed; -			} - -			if (!n) { -				errno = ETIMEDOUT; -				goto failed; -			} - -			to -= 10; -			if (to < 0) to = 0; - -		} - -		while ((len = read(dd, buf, sizeof(buf))) < 0) { -			if (errno == EAGAIN || errno == EINTR) -				continue; -			goto failed; -		} - -		hdr = (void *) (buf + 1); -		ptr = buf + (1 + HCI_EVENT_HDR_SIZE); -		len -= (1 + HCI_EVENT_HDR_SIZE); - -		switch (hdr->evt) { -		case EVT_CMD_STATUS: -			cs = (void *) ptr; - -			if (cs->opcode != opcode) -				continue; - -			if (r->event != EVT_CMD_STATUS) { -				if (cs->status) { -					errno = EIO; -					goto failed; -				} -				break; -			} - -			r->rlen = MIN(len, r->rlen); -			memcpy(r->rparam, ptr, r->rlen); -			goto done; - -		case EVT_CMD_COMPLETE: -			cc = (void *) ptr; - -			if (cc->opcode != opcode) -				continue; - -			ptr += EVT_CMD_COMPLETE_SIZE; -			len -= EVT_CMD_COMPLETE_SIZE; - -			r->rlen = MIN(len, r->rlen); -			memcpy(r->rparam, ptr, r->rlen); -			goto done; - -		case EVT_REMOTE_NAME_REQ_COMPLETE: -			if (hdr->evt != r->event) -				break; - -			rn = (void *) ptr; -			cp = r->cparam; - -			if (bacmp(&rn->bdaddr, &cp->bdaddr)) -				continue; - -			r->rlen = MIN(len, r->rlen); -			memcpy(r->rparam, ptr, r->rlen); -			goto done; - -		default: -			if (hdr->evt != r->event) -				break; - -			r->rlen = MIN(len, r->rlen); -			memcpy(r->rparam, ptr, r->rlen); -			goto done; -		} -	} -	errno = ETIMEDOUT; - -failed: -	err = errno; -	setsockopt(dd, SOL_HCI, HCI_FILTER, &of, sizeof(of)); -	errno = err; -	return -1; - -done: -	setsockopt(dd, SOL_HCI, HCI_FILTER, &of, sizeof(of)); -	return 0; -} - -int hci_create_connection(int dd, const bdaddr_t *bdaddr, uint16_t ptype, uint16_t clkoffset, uint8_t rswitch, uint16_t *handle, int to) -{ -	evt_conn_complete rp; -	create_conn_cp cp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	bacpy(&cp.bdaddr, bdaddr); -	cp.pkt_type       = ptype; -	cp.pscan_rep_mode = 0x02; -	cp.clock_offset   = clkoffset; -	cp.role_switch    = rswitch; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_LINK_CTL; -	rq.ocf    = OCF_CREATE_CONN; -	rq.event  = EVT_CONN_COMPLETE; -	rq.cparam = &cp; -	rq.clen   = CREATE_CONN_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = EVT_CONN_COMPLETE_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*handle = rp.handle; -	return 0; -} - -int hci_disconnect(int dd, uint16_t handle, uint8_t reason, int to) -{ -	evt_disconn_complete rp; -	disconnect_cp cp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.handle = handle; -	cp.reason = reason; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_LINK_CTL; -	rq.ocf    = OCF_DISCONNECT; -	rq.event  = EVT_DISCONN_COMPLETE; -	rq.cparam = &cp; -	rq.clen   = DISCONNECT_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = EVT_DISCONN_COMPLETE_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} -	return 0; -} - -int hci_read_local_name(int dd, int len, char *name, int to) -{ -	read_local_name_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_LOCAL_NAME; -	rq.rparam = &rp; -	rq.rlen   = READ_LOCAL_NAME_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	rp.name[247] = '\0'; -	strncpy(name, (char *) rp.name, len); -	return 0; -} - -int hci_write_local_name(int dd, const char *name, int to) -{ -	change_local_name_cp cp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	strncpy((char *) cp.name, name, sizeof(cp.name)); - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_CHANGE_LOCAL_NAME; -	rq.cparam = &cp; -	rq.clen   = CHANGE_LOCAL_NAME_CP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	return 0; -} - -int hci_read_remote_name_with_clock_offset(int dd, const bdaddr_t *bdaddr, uint8_t pscan_rep_mode, uint16_t clkoffset, int len, char *name, int to) -{ -	evt_remote_name_req_complete rn; -	remote_name_req_cp cp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	bacpy(&cp.bdaddr, bdaddr); -	cp.pscan_rep_mode = pscan_rep_mode; -	cp.clock_offset   = clkoffset; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_LINK_CTL; -	rq.ocf    = OCF_REMOTE_NAME_REQ; -	rq.cparam = &cp; -	rq.clen   = REMOTE_NAME_REQ_CP_SIZE; -	rq.event  = EVT_REMOTE_NAME_REQ_COMPLETE; -	rq.rparam = &rn; -	rq.rlen   = EVT_REMOTE_NAME_REQ_COMPLETE_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rn.status) { -		errno = EIO; -		return -1; -	} - -	rn.name[247] = '\0'; -	strncpy(name, (char *) rn.name, len); -	return 0; -} - -int hci_read_remote_name(int dd, const bdaddr_t *bdaddr, int len, char *name, int to) -{ -	return hci_read_remote_name_with_clock_offset(dd, bdaddr, 0x02, 0x0000, len, name, to); -} - -int hci_read_remote_name_cancel(int dd, const bdaddr_t *bdaddr, int to) -{ -	remote_name_req_cancel_cp cp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	bacpy(&cp.bdaddr, bdaddr); - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_LINK_CTL; -	rq.ocf    = OCF_REMOTE_NAME_REQ_CANCEL; -	rq.cparam = &cp; -	rq.clen   = REMOTE_NAME_REQ_CANCEL_CP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	return 0; -} - -int hci_read_remote_version(int dd, uint16_t handle, struct hci_version *ver, int to) -{ -	evt_read_remote_version_complete rp; -	read_remote_version_cp cp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.handle = handle; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_LINK_CTL; -	rq.ocf    = OCF_READ_REMOTE_VERSION; -	rq.event  = EVT_READ_REMOTE_VERSION_COMPLETE; -	rq.cparam = &cp; -	rq.clen   = READ_REMOTE_VERSION_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = EVT_READ_REMOTE_VERSION_COMPLETE_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	ver->manufacturer = btohs(rp.manufacturer); -	ver->lmp_ver      = rp.lmp_ver; -	ver->lmp_subver   = btohs(rp.lmp_subver); -	return 0; -} - -int hci_read_remote_features(int dd, uint16_t handle, uint8_t *features, int to) -{ -	evt_read_remote_features_complete rp; -	read_remote_features_cp cp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.handle = handle; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_LINK_CTL; -	rq.ocf    = OCF_READ_REMOTE_FEATURES; -	rq.event  = EVT_READ_REMOTE_FEATURES_COMPLETE; -	rq.cparam = &cp; -	rq.clen   = READ_REMOTE_FEATURES_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = EVT_READ_REMOTE_FEATURES_COMPLETE_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	memcpy(features, rp.features, 8); -	return 0; -} - -int hci_read_remote_ext_features(int dd, uint16_t handle, uint8_t page, uint8_t *max_page, uint8_t *features, int to) -{ -	evt_read_remote_ext_features_complete rp; -	read_remote_ext_features_cp cp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.handle   = handle; -	cp.page_num = page; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_LINK_CTL; -	rq.ocf    = OCF_READ_REMOTE_EXT_FEATURES; -	rq.event  = EVT_READ_REMOTE_EXT_FEATURES_COMPLETE; -	rq.cparam = &cp; -	rq.clen   = READ_REMOTE_EXT_FEATURES_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = EVT_READ_REMOTE_EXT_FEATURES_COMPLETE_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*max_page = rp.max_page_num; -	memcpy(features, rp.features, 8); -	return 0; -} - -int hci_read_clock_offset(int dd, uint16_t handle, uint16_t *clkoffset, int to) -{ -	evt_read_clock_offset_complete rp; -	read_clock_offset_cp cp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.handle = handle; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_LINK_CTL; -	rq.ocf    = OCF_READ_CLOCK_OFFSET; -	rq.event  = EVT_READ_CLOCK_OFFSET_COMPLETE; -	rq.cparam = &cp; -	rq.clen   = READ_CLOCK_OFFSET_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = EVT_READ_CLOCK_OFFSET_COMPLETE_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*clkoffset = rp.clock_offset; -	return 0; -} - -int hci_read_local_version(int dd, struct hci_version *ver, int to) -{ -	read_local_version_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_INFO_PARAM; -	rq.ocf    = OCF_READ_LOCAL_VERSION; -	rq.rparam = &rp; -	rq.rlen   = READ_LOCAL_VERSION_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	ver->manufacturer = btohs(rp.manufacturer); -	ver->hci_ver      = rp.hci_ver; -	ver->hci_rev      = btohs(rp.hci_rev); -	ver->lmp_ver      = rp.lmp_ver; -	ver->lmp_subver   = btohs(rp.lmp_subver); -	return 0; -} - -int hci_read_local_commands(int dd, uint8_t *commands, int to) -{ -	read_local_commands_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_INFO_PARAM; -	rq.ocf    = OCF_READ_LOCAL_COMMANDS; -	rq.rparam = &rp; -	rq.rlen   = READ_LOCAL_COMMANDS_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	memcpy(commands, rp.commands, 64); -	return 0; -} - -int hci_read_local_features(int dd, uint8_t *features, int to) -{ -	read_local_features_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_INFO_PARAM; -	rq.ocf    = OCF_READ_LOCAL_FEATURES; -	rq.rparam = &rp; -	rq.rlen   = READ_LOCAL_FEATURES_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	memcpy(features, rp.features, 8); -	return 0; -} - -int hci_read_local_ext_features(int dd, uint8_t page, uint8_t *max_page, uint8_t *features, int to) -{ -	read_local_ext_features_cp cp; -	read_local_ext_features_rp rp; -	struct hci_request rq; - -	cp.page_num = page; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_INFO_PARAM; -	rq.ocf    = OCF_READ_LOCAL_EXT_FEATURES; -	rq.cparam = &cp; -	rq.clen   = READ_LOCAL_EXT_FEATURES_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = READ_LOCAL_EXT_FEATURES_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*max_page = rp.max_page_num; -	memcpy(features, rp.features, 8); -	return 0; -} - -int hci_read_bd_addr(int dd, bdaddr_t *bdaddr, int to) -{ -	read_bd_addr_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_INFO_PARAM; -	rq.ocf    = OCF_READ_BD_ADDR; -	rq.rparam = &rp; -	rq.rlen   = READ_BD_ADDR_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	bacpy(bdaddr, &rp.bdaddr); -	return 0; -} - -int hci_read_class_of_dev(int dd, uint8_t *cls, int to) -{ -	read_class_of_dev_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_CLASS_OF_DEV; -	rq.rparam = &rp; -	rq.rlen   = READ_CLASS_OF_DEV_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	memcpy(cls, rp.dev_class, 3); -	return 0; -} - -int hci_write_class_of_dev(int dd, uint32_t cls, int to) -{ -	write_class_of_dev_cp cp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	cp.dev_class[0] = cls & 0xff; -	cp.dev_class[1] = (cls >> 8) & 0xff; -	cp.dev_class[2] = (cls >> 16) & 0xff; -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_WRITE_CLASS_OF_DEV; -	rq.cparam = &cp; -	rq.clen   = WRITE_CLASS_OF_DEV_CP_SIZE; -	return hci_send_req(dd, &rq, to); -} - -int hci_read_voice_setting(int dd, uint16_t *vs, int to) -{ -	read_voice_setting_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_VOICE_SETTING; -	rq.rparam = &rp; -	rq.rlen   = READ_VOICE_SETTING_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*vs = rp.voice_setting; -	return 0; -} - -int hci_write_voice_setting(int dd, uint16_t vs, int to) -{ -	write_voice_setting_cp cp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	cp.voice_setting = vs; -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_WRITE_VOICE_SETTING; -	rq.cparam = &cp; -	rq.clen   = WRITE_VOICE_SETTING_CP_SIZE; - -	return hci_send_req(dd, &rq, to); -} - -int hci_read_current_iac_lap(int dd, uint8_t *num_iac, uint8_t *lap, int to) -{ -	read_current_iac_lap_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_CURRENT_IAC_LAP; -	rq.rparam = &rp; -	rq.rlen   = READ_CURRENT_IAC_LAP_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*num_iac = rp.num_current_iac; -	memcpy(lap, rp.lap, rp.num_current_iac * 3); -	return 0; -} - -int hci_write_current_iac_lap(int dd, uint8_t num_iac, uint8_t *lap, int to) -{ -	write_current_iac_lap_cp cp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.num_current_iac = num_iac; -	memcpy(&cp.lap, lap, num_iac * 3); - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_WRITE_CURRENT_IAC_LAP; -	rq.cparam = &cp; -	rq.clen   = num_iac * 3 + 1; - -	return hci_send_req(dd, &rq, to); -} - -int hci_read_stored_link_key(int dd, bdaddr_t *bdaddr, uint8_t all, int to) -{ -	read_stored_link_key_cp cp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	bacpy(&cp.bdaddr, bdaddr); -	cp.read_all = all; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_STORED_LINK_KEY; -	rq.cparam = &cp; -	rq.clen   = READ_STORED_LINK_KEY_CP_SIZE; - -	return hci_send_req(dd, &rq, to); -} - -int hci_write_stored_link_key(int dd, bdaddr_t *bdaddr, uint8_t *key, int to) -{ -	unsigned char cp[WRITE_STORED_LINK_KEY_CP_SIZE + 6 + 16]; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp[0] = 1; -	bacpy((bdaddr_t *) (cp + 1), bdaddr); -	memcpy(cp + 7, key, 16); - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_WRITE_STORED_LINK_KEY; -	rq.cparam = &cp; -	rq.clen   = WRITE_STORED_LINK_KEY_CP_SIZE + 6 + 16; - -	return hci_send_req(dd, &rq, to); -} - -int hci_delete_stored_link_key(int dd, bdaddr_t *bdaddr, uint8_t all, int to) -{ -	delete_stored_link_key_cp cp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	bacpy(&cp.bdaddr, bdaddr); -	cp.delete_all = all; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_DELETE_STORED_LINK_KEY; -	rq.cparam = &cp; -	rq.clen   = DELETE_STORED_LINK_KEY_CP_SIZE; - -	return hci_send_req(dd, &rq, to); -} - -int hci_authenticate_link(int dd, uint16_t handle, int to) -{ -	auth_requested_cp cp; -	evt_auth_complete rp; -	struct hci_request rq; - -	cp.handle = handle; - -	rq.ogf    = OGF_LINK_CTL; -	rq.ocf    = OCF_AUTH_REQUESTED; -	rq.event  = EVT_AUTH_COMPLETE; -	rq.cparam = &cp; -	rq.clen   = AUTH_REQUESTED_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = EVT_AUTH_COMPLETE_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_encrypt_link(int dd, uint16_t handle, uint8_t encrypt, int to) -{ -	set_conn_encrypt_cp cp; -	evt_encrypt_change rp; -	struct hci_request rq; - -	cp.handle  = handle; -	cp.encrypt = encrypt; - -	rq.ogf     = OGF_LINK_CTL; -	rq.ocf     = OCF_SET_CONN_ENCRYPT; -	rq.event   = EVT_ENCRYPT_CHANGE; -	rq.cparam  = &cp; -	rq.clen    = SET_CONN_ENCRYPT_CP_SIZE; -	rq.rparam  = &rp; -	rq.rlen    = EVT_ENCRYPT_CHANGE_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_change_link_key(int dd, uint16_t handle, int to) -{ -	change_conn_link_key_cp cp; -	evt_change_conn_link_key_complete rp; -	struct hci_request rq; - -	cp.handle = handle; - -	rq.ogf    = OGF_LINK_CTL; -	rq.ocf    = OCF_CHANGE_CONN_LINK_KEY; -	rq.event  = EVT_CHANGE_CONN_LINK_KEY_COMPLETE; -	rq.cparam = &cp; -	rq.clen   = CHANGE_CONN_LINK_KEY_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = EVT_CHANGE_CONN_LINK_KEY_COMPLETE_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_switch_role(int dd, bdaddr_t *bdaddr, uint8_t role, int to) -{ -	switch_role_cp cp; -	evt_role_change rp; -	struct hci_request rq; - -	bacpy(&cp.bdaddr, bdaddr); -	cp.role   = role; -	rq.ogf    = OGF_LINK_POLICY; -	rq.ocf    = OCF_SWITCH_ROLE; -	rq.cparam = &cp; -	rq.clen   = SWITCH_ROLE_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = EVT_ROLE_CHANGE_SIZE; -	rq.event  = EVT_ROLE_CHANGE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_park_mode(int dd, uint16_t handle, uint16_t max_interval, uint16_t min_interval, int to) -{ -	park_mode_cp cp; -	evt_mode_change rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof (cp)); -	cp.handle       = handle; -	cp.max_interval = max_interval; -	cp.min_interval = min_interval; - -	memset(&rq, 0, sizeof (rq)); -	rq.ogf    = OGF_LINK_POLICY; -	rq.ocf    = OCF_PARK_MODE; -	rq.event  = EVT_MODE_CHANGE; -	rq.cparam = &cp; -	rq.clen   = PARK_MODE_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = EVT_MODE_CHANGE_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_exit_park_mode(int dd, uint16_t handle, int to) -{ -	exit_park_mode_cp cp; -	evt_mode_change rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof (cp)); -	cp.handle = handle; - -	memset (&rq, 0, sizeof (rq)); -	rq.ogf    = OGF_LINK_POLICY; -	rq.ocf    = OCF_EXIT_PARK_MODE; -	rq.event  = EVT_MODE_CHANGE; -	rq.cparam = &cp; -	rq.clen   = EXIT_PARK_MODE_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = EVT_MODE_CHANGE_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_read_inquiry_scan_type(int dd, uint8_t *type, int to) -{ -	read_inquiry_scan_type_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_INQUIRY_SCAN_TYPE; -	rq.rparam = &rp; -	rq.rlen   = READ_INQUIRY_SCAN_TYPE_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*type = rp.type; -	return 0; -} - -int hci_write_inquiry_scan_type(int dd, uint8_t type, int to) -{ -	write_inquiry_scan_type_cp cp; -	write_inquiry_scan_type_rp rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.type = type; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_WRITE_INQUIRY_SCAN_TYPE; -	rq.cparam = &cp; -	rq.clen   = WRITE_INQUIRY_SCAN_TYPE_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = WRITE_INQUIRY_SCAN_TYPE_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_read_inquiry_mode(int dd, uint8_t *mode, int to) -{ -	read_inquiry_mode_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_INQUIRY_MODE; -	rq.rparam = &rp; -	rq.rlen   = READ_INQUIRY_MODE_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*mode = rp.mode; -	return 0; -} - -int hci_write_inquiry_mode(int dd, uint8_t mode, int to) -{ -	write_inquiry_mode_cp cp; -	write_inquiry_mode_rp rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.mode = mode; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_WRITE_INQUIRY_MODE; -	rq.cparam = &cp; -	rq.clen   = WRITE_INQUIRY_MODE_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = WRITE_INQUIRY_MODE_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_read_afh_mode(int dd, uint8_t *mode, int to) -{ -	read_afh_mode_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_AFH_MODE; -	rq.rparam = &rp; -	rq.rlen   = READ_AFH_MODE_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*mode = rp.mode; -	return 0; -} - -int hci_write_afh_mode(int dd, uint8_t mode, int to) -{ -	write_afh_mode_cp cp; -	write_afh_mode_rp rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.mode = mode; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_WRITE_AFH_MODE; -	rq.cparam = &cp; -	rq.clen   = WRITE_AFH_MODE_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = WRITE_AFH_MODE_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_read_ext_inquiry_response(int dd, uint8_t *fec, uint8_t *data, int to) -{ -	read_ext_inquiry_response_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_EXT_INQUIRY_RESPONSE; -	rq.rparam = &rp; -	rq.rlen   = READ_EXT_INQUIRY_RESPONSE_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*fec = rp.fec; -	memcpy(data, rp.data, 240); - -	return 0; -} - -int hci_write_ext_inquiry_response(int dd, uint8_t fec, uint8_t *data, int to) -{ -	write_ext_inquiry_response_cp cp; -	write_ext_inquiry_response_rp rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.fec = fec; -	memcpy(cp.data, data, 240); - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_WRITE_EXT_INQUIRY_RESPONSE; -	rq.cparam = &cp; -	rq.clen   = WRITE_EXT_INQUIRY_RESPONSE_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = WRITE_EXT_INQUIRY_RESPONSE_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_read_simple_pairing_mode(int dd, uint8_t *mode, int to) -{ -	read_simple_pairing_mode_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_SIMPLE_PAIRING_MODE; -	rq.rparam = &rp; -	rq.rlen   = READ_SIMPLE_PAIRING_MODE_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*mode = rp.mode; -	return 0; -} - -int hci_write_simple_pairing_mode(int dd, uint8_t mode, int to) -{ -	write_simple_pairing_mode_cp cp; -	write_simple_pairing_mode_rp rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.mode = mode; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_WRITE_SIMPLE_PAIRING_MODE; -	rq.cparam = &cp; -	rq.clen   = WRITE_SIMPLE_PAIRING_MODE_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = WRITE_SIMPLE_PAIRING_MODE_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_read_local_oob_data(int dd, uint8_t *hash, uint8_t *randomizer, int to) -{ -	read_local_oob_data_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_LOCAL_OOB_DATA; -	rq.rparam = &rp; -	rq.rlen   = READ_LOCAL_OOB_DATA_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	memcpy(hash, rp.hash, 16); -	memcpy(randomizer, rp.randomizer, 16); -	return 0; -} - -int hci_read_inquiry_transmit_power_level(int dd, int8_t *level, int to) -{ -	read_inquiry_transmit_power_level_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_INQUIRY_TRANSMIT_POWER_LEVEL; -	rq.rparam = &rp; -	rq.rlen   = READ_INQUIRY_TRANSMIT_POWER_LEVEL_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*level = rp.level; -	return 0; -} - -int hci_write_inquiry_transmit_power_level(int dd, int8_t level, int to) -{ -	write_inquiry_transmit_power_level_cp cp; -	write_inquiry_transmit_power_level_rp rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.level = level; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_WRITE_INQUIRY_TRANSMIT_POWER_LEVEL; -	rq.cparam = &cp; -	rq.clen   = WRITE_INQUIRY_TRANSMIT_POWER_LEVEL_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = WRITE_INQUIRY_TRANSMIT_POWER_LEVEL_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_read_transmit_power_level(int dd, uint16_t handle, uint8_t type, int8_t *level, int to) -{ -	read_transmit_power_level_cp cp; -	read_transmit_power_level_rp rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.handle = handle; -	cp.type   = type; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_TRANSMIT_POWER_LEVEL; -	rq.cparam = &cp; -	rq.clen   = READ_TRANSMIT_POWER_LEVEL_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = READ_TRANSMIT_POWER_LEVEL_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*level = rp.level; -	return 0; -} - -int hci_read_link_policy(int dd, uint16_t handle, uint16_t *policy, int to) -{ -	read_link_policy_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_LINK_POLICY; -	rq.ocf    = OCF_READ_LINK_POLICY; -	rq.cparam = &handle; -	rq.clen   = 2; -	rq.rparam = &rp; -	rq.rlen   = READ_LINK_POLICY_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*policy = rp.policy; -	return 0; -} - -int hci_write_link_policy(int dd, uint16_t handle, uint16_t policy, int to) -{ -	write_link_policy_cp cp; -	write_link_policy_rp rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.handle = handle; -	cp.policy = policy; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_LINK_POLICY; -	rq.ocf    = OCF_WRITE_LINK_POLICY; -	rq.cparam = &cp; -	rq.clen   = WRITE_LINK_POLICY_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = WRITE_LINK_POLICY_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_read_link_supervision_timeout(int dd, uint16_t handle, uint16_t *timeout, int to) -{ -	read_link_supervision_timeout_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_READ_LINK_SUPERVISION_TIMEOUT; -	rq.cparam = &handle; -	rq.clen   = 2; -	rq.rparam = &rp; -	rq.rlen   = READ_LINK_SUPERVISION_TIMEOUT_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*timeout = rp.timeout; -	return 0; -} - -int hci_write_link_supervision_timeout(int dd, uint16_t handle, uint16_t timeout, int to) -{ -	write_link_supervision_timeout_cp cp; -	write_link_supervision_timeout_rp rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.handle  = handle; -	cp.timeout = timeout; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_WRITE_LINK_SUPERVISION_TIMEOUT; -	rq.cparam = &cp; -	rq.clen   = WRITE_LINK_SUPERVISION_TIMEOUT_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = WRITE_LINK_SUPERVISION_TIMEOUT_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_set_afh_classification(int dd, uint8_t *map, int to) -{ -	set_afh_classification_cp cp; -	set_afh_classification_rp rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	memcpy(cp.map, map, 10); - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_HOST_CTL; -	rq.ocf    = OCF_SET_AFH_CLASSIFICATION; -	rq.cparam = &cp; -	rq.clen   = SET_AFH_CLASSIFICATION_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = SET_AFH_CLASSIFICATION_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	return 0; -} - -int hci_read_link_quality(int dd, uint16_t handle, uint8_t *link_quality, int to) -{ -	read_link_quality_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_STATUS_PARAM; -	rq.ocf    = OCF_READ_LINK_QUALITY; -	rq.cparam = &handle; -	rq.clen   = 2; -	rq.rparam = &rp; -	rq.rlen   = READ_LINK_QUALITY_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*link_quality = rp.link_quality; -	return 0; -} - -int hci_read_rssi(int dd, uint16_t handle, int8_t *rssi, int to) -{ -	read_rssi_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_STATUS_PARAM; -	rq.ocf    = OCF_READ_RSSI; -	rq.cparam = &handle; -	rq.clen   = 2; -	rq.rparam = &rp; -	rq.rlen   = READ_RSSI_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*rssi = rp.rssi; -	return 0; -} - -int hci_read_afh_map(int dd, uint16_t handle, uint8_t *mode, uint8_t *map, int to) -{ -	read_afh_map_rp rp; -	struct hci_request rq; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_STATUS_PARAM; -	rq.ocf    = OCF_READ_AFH_MAP; -	rq.cparam = &handle; -	rq.clen   = 2; -	rq.rparam = &rp; -	rq.rlen   = READ_AFH_MAP_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*mode = rp.mode; -	memcpy(map, rp.map, 10); -	return 0; -} - -int hci_read_clock(int dd, uint16_t handle, uint8_t which, uint32_t *clock, uint16_t *accuracy, int to) -{ -	read_clock_cp cp; -	read_clock_rp rp; -	struct hci_request rq; - -	memset(&cp, 0, sizeof(cp)); -	cp.handle      = handle; -	cp.which_clock = which; - -	memset(&rq, 0, sizeof(rq)); -	rq.ogf    = OGF_STATUS_PARAM; -	rq.ocf    = OCF_READ_CLOCK; -	rq.cparam = &cp; -	rq.clen   = READ_CLOCK_CP_SIZE; -	rq.rparam = &rp; -	rq.rlen   = READ_CLOCK_RP_SIZE; - -	if (hci_send_req(dd, &rq, to) < 0) -		return -1; - -	if (rp.status) { -		errno = EIO; -		return -1; -	} - -	*clock    = rp.clock; -	*accuracy = rp.accuracy; -	return 0; -} - -int hci_local_name(int dd, int len, char *name, int to) -{ -	return hci_read_local_name(dd, len, name, to); -} - -int hci_remote_name(int dd, const bdaddr_t *bdaddr, int len, char *name, int to) -{ -	return hci_read_remote_name(dd, bdaddr, len, name, to); -}  | 
