hciops.c revision 63ff6738abc6bf21becbbfde583062502e7728a6
194e91856179a268805256055ffd5155d1468b99cAlok Barsode/* 294e91856179a268805256055ffd5155d1468b99cAlok Barsode * 394e91856179a268805256055ffd5155d1468b99cAlok Barsode * BlueZ - Bluetooth protocol stack for Linux 494e91856179a268805256055ffd5155d1468b99cAlok Barsode * 59184e2eeb7b97371c6b83b747c8984e2340d2b47Marcel Holtmann * Copyright (C) 2004-2010 Marcel Holtmann <marcel@holtmann.org> 694e91856179a268805256055ffd5155d1468b99cAlok Barsode * 794e91856179a268805256055ffd5155d1468b99cAlok Barsode * This program is free software; you can redistribute it and/or modify 894e91856179a268805256055ffd5155d1468b99cAlok Barsode * it under the terms of the GNU General Public License as published by 994e91856179a268805256055ffd5155d1468b99cAlok Barsode * the Free Software Foundation; either version 2 of the License, or 1094e91856179a268805256055ffd5155d1468b99cAlok Barsode * (at your option) any later version. 1194e91856179a268805256055ffd5155d1468b99cAlok Barsode * 1294e91856179a268805256055ffd5155d1468b99cAlok Barsode * This program is distributed in the hope that it will be useful, 1394e91856179a268805256055ffd5155d1468b99cAlok Barsode * but WITHOUT ANY WARRANTY; without even the implied warranty of 1494e91856179a268805256055ffd5155d1468b99cAlok Barsode * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1594e91856179a268805256055ffd5155d1468b99cAlok Barsode * GNU General Public License for more details. 1694e91856179a268805256055ffd5155d1468b99cAlok Barsode * 1794e91856179a268805256055ffd5155d1468b99cAlok Barsode * You should have received a copy of the GNU General Public License 1894e91856179a268805256055ffd5155d1468b99cAlok Barsode * along with this program; if not, write to the Free Software 1994e91856179a268805256055ffd5155d1468b99cAlok Barsode * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA 2094e91856179a268805256055ffd5155d1468b99cAlok Barsode * 2194e91856179a268805256055ffd5155d1468b99cAlok Barsode */ 2294e91856179a268805256055ffd5155d1468b99cAlok Barsode 2394e91856179a268805256055ffd5155d1468b99cAlok Barsode#ifdef HAVE_CONFIG_H 2494e91856179a268805256055ffd5155d1468b99cAlok Barsode#include <config.h> 2594e91856179a268805256055ffd5155d1468b99cAlok Barsode#endif 26a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 27a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode#include <stdio.h> 28cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode#include <errno.h> 29a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode#include <unistd.h> 30a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode#include <stdlib.h> 31cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode#include <sys/types.h> 32cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode#include <sys/ioctl.h> 33a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode#include <sys/wait.h> 3494e91856179a268805256055ffd5155d1468b99cAlok Barsode 3594e91856179a268805256055ffd5155d1468b99cAlok Barsode#include <bluetooth/bluetooth.h> 36cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode#include <bluetooth/hci.h> 37cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode#include <bluetooth/hci_lib.h> 3894e91856179a268805256055ffd5155d1468b99cAlok Barsode 39cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode#include <glib.h> 40cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 41cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode#include "hcid.h" 42a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode#include "sdpd.h" 43a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode#include "adapter.h" 4494e91856179a268805256055ffd5155d1468b99cAlok Barsode#include "plugin.h" 45e891f7df6225c758da0d95f7554c6cc67f72f31eGustavo F. Padovan#include "log.h" 465288199788ecb17183d6517da3062cd94692a900Johan Hedberg#include "storage.h" 475288199788ecb17183d6517da3062cd94692a900Johan Hedberg#include "event.h" 485288199788ecb17183d6517da3062cd94692a900Johan Hedberg#include "device.h" 49a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode#include "manager.h" 50a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 5118e8b33f0d60b9e1f4a6521720e14e9db1cda01dJohan Hedbergstatic int child_pipe[2] = { -1, -1 }; 5294e91856179a268805256055ffd5155d1468b99cAlok Barsode 538b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedbergstatic guint child_io_id = 0; 548b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedbergstatic guint ctl_io_id = 0; 558b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg 56be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg/* Commands sent by kernel on starting an adapter */ 57be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedbergenum { 58be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg PENDING_BDADDR, 59be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg PENDING_VERSION, 60be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg PENDING_FEATURES, 61fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg PENDING_NAME, 62be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg}; 63be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 646844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedbergstatic int max_dev = -1; 65ef071f94a765fa0b0e96935abef7508c76cace00Johan Hedbergstatic struct dev_info { 66ef071f94a765fa0b0e96935abef7508c76cace00Johan Hedberg int sk; 67a352058752e541539b09e55124d411a534cc14afJohan Hedberg bdaddr_t bdaddr; 6800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg char name[249]; 6900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint8_t eir[240]; 70be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg uint8_t features[8]; 7100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint8_t ssp_mode; 7200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 7300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg int8_t tx_power; 7400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 7500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint32_t current_cod; 7600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint32_t wanted_cod; 7700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint32_t pending_cod; 7800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg gboolean cache_enable; 795c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg gboolean already_up; 805c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg gboolean registered; 8100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 82be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg struct hci_version ver; 83be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 8400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint16_t did_vendor; 8500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint16_t did_product; 8600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint16_t did_version; 8700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 885a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg gboolean up; 89be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg unsigned long pending; 9055694454017b04a416931a81964bb695f48b3d93Johan Hedberg 91fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg GIOChannel *io; 9255694454017b04a416931a81964bb695f48b3d93Johan Hedberg guint watch_id; 9355694454017b04a416931a81964bb695f48b3d93Johan Hedberg int pin_length; 94ef071f94a765fa0b0e96935abef7508c76cace00Johan Hedberg} *devs = NULL; 95ef071f94a765fa0b0e96935abef7508c76cace00Johan Hedberg 96db5266f0afedc33e2fd6fc3601c16498865f746dJohan Hedbergstatic int ignore_device(struct hci_dev_info *di) 97db5266f0afedc33e2fd6fc3601c16498865f746dJohan Hedberg{ 98db5266f0afedc33e2fd6fc3601c16498865f746dJohan Hedberg return hci_test_bit(HCI_RAW, &di->flags) || di->type >> 4 != HCI_BREDR; 99db5266f0afedc33e2fd6fc3601c16498865f746dJohan Hedberg} 100db5266f0afedc33e2fd6fc3601c16498865f746dJohan Hedberg 1015c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedbergstatic void init_dev_info(int index, int sk, gboolean registered) 102ef071f94a765fa0b0e96935abef7508c76cace00Johan Hedberg{ 103fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 104fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 105fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg memset(dev, 0, sizeof(*dev)); 106fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 107fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->sk = sk; 108fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->pin_length = -1; 109fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->cache_enable = TRUE; 110fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->registered = registered; 111ef071f94a765fa0b0e96935abef7508c76cace00Johan Hedberg} 1126844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg 113abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg/* Async HCI command handling with callback support */ 114abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 115abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedbergstruct hci_cmd_data { 116abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg bt_hci_result_t cb; 117abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg uint16_t handle; 118abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg uint16_t ocf; 119abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg gpointer caller_data; 120abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg}; 121abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 122abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedbergstatic gboolean hci_event_watch(GIOChannel *io, 123abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg GIOCondition cond, gpointer user_data) 124abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg{ 125abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg unsigned char buf[HCI_MAX_EVENT_SIZE], *body; 126abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg struct hci_cmd_data *cmd = user_data; 127abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg evt_cmd_status *evt_status; 128abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg evt_auth_complete *evt_auth; 129abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg evt_encrypt_change *evt_enc; 130abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg hci_event_hdr *hdr; 131abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg set_conn_encrypt_cp cp; 132abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg int dd; 133abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg uint16_t ocf; 134abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg uint8_t status = HCI_OE_POWER_OFF; 135abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 136abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg if (cond & G_IO_NVAL) { 137abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cmd->cb(status, cmd->caller_data); 138abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg return FALSE; 139abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg } 140abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 141abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg if (cond & (G_IO_ERR | G_IO_HUP)) 142abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg goto failed; 143abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 144abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg dd = g_io_channel_unix_get_fd(io); 145abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 146abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg if (read(dd, buf, sizeof(buf)) < 0) 147abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg goto failed; 148abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 149abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg hdr = (hci_event_hdr *) (buf + 1); 150abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg body = buf + (1 + HCI_EVENT_HDR_SIZE); 151abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 152abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg switch (hdr->evt) { 153abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg case EVT_CMD_STATUS: 154abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg evt_status = (evt_cmd_status *) body; 155abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg ocf = cmd_opcode_ocf(evt_status->opcode); 156abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg if (ocf != cmd->ocf) 157abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg return TRUE; 158abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg switch (ocf) { 159abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg case OCF_AUTH_REQUESTED: 160abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg case OCF_SET_CONN_ENCRYPT: 161abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg if (evt_status->status != 0) { 162abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg /* Baseband rejected command */ 163abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg status = evt_status->status; 164abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg goto failed; 165abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg } 166abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg break; 167abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg default: 168abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg return TRUE; 169abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg } 170abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg /* Wait for the next event */ 171abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg return TRUE; 172abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg case EVT_AUTH_COMPLETE: 173abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg evt_auth = (evt_auth_complete *) body; 174abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg if (evt_auth->handle != cmd->handle) { 175abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg /* Skipping */ 176abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg return TRUE; 177abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg } 178abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 179abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg if (evt_auth->status != 0x00) { 180abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg status = evt_auth->status; 181abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg /* Abort encryption */ 182abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg goto failed; 183abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg } 184abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 185abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg memset(&cp, 0, sizeof(cp)); 186abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cp.handle = cmd->handle; 187abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cp.encrypt = 1; 188abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 189abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cmd->ocf = OCF_SET_CONN_ENCRYPT; 190abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 191abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg if (hci_send_cmd(dd, OGF_LINK_CTL, OCF_SET_CONN_ENCRYPT, 192abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg SET_CONN_ENCRYPT_CP_SIZE, &cp) < 0) { 193abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg status = HCI_COMMAND_DISALLOWED; 194abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg goto failed; 195abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg } 196abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg /* Wait for encrypt change event */ 197abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg return TRUE; 198abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg case EVT_ENCRYPT_CHANGE: 199abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg evt_enc = (evt_encrypt_change *) body; 200abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg if (evt_enc->handle != cmd->handle) 201abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg return TRUE; 202abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 203abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg /* Procedure finished: reporting status */ 204abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg status = evt_enc->status; 205abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg break; 206abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg default: 207abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg /* Skipping */ 208abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg return TRUE; 209abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg } 210abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 211abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedbergfailed: 212abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cmd->cb(status, cmd->caller_data); 213abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg g_io_channel_shutdown(io, TRUE, NULL); 214abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 215abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg return FALSE; 216abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg} 217abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 218b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedbergstatic int write_inq_mode(int index, uint8_t mode) 219b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg{ 220fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 221b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg write_inquiry_mode_cp cp; 222b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 223b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg memset(&cp, 0, sizeof(cp)); 224b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg cp.mode = mode; 225b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 226fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, OCF_WRITE_INQUIRY_MODE, 227b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg WRITE_INQUIRY_MODE_CP_SIZE, &cp) < 0) 228b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg return -errno; 229b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 230b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg return 0; 231b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg} 232b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 233b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedbergstatic uint8_t get_inquiry_mode(int index) 234b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg{ 235fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 236fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 237fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->features[6] & LMP_EXT_INQ) 238b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg return 2; 239b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 240fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->features[3] & LMP_RSSI_INQ) 241b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg return 1; 242b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 243fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->ver.manufacturer == 11 && dev->ver.hci_rev == 0x00 && 244fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->ver.lmp_subver == 0x0757) 245b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg return 1; 246b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 247fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->ver.manufacturer == 15) { 248fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->ver.hci_rev == 0x03 && 249fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->ver.lmp_subver == 0x6963) 250b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg return 1; 251fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->ver.hci_rev == 0x09 && 252fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->ver.lmp_subver == 0x6963) 253b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg return 1; 254fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->ver.hci_rev == 0x00 && 255fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->ver.lmp_subver == 0x6965) 256b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg return 1; 257b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg } 258b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 259fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->ver.manufacturer == 31 && dev->ver.hci_rev == 0x2005 && 260fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->ver.lmp_subver == 0x1805) 261b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg return 1; 262b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 263b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg return 0; 264b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg} 265b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 266be49c2621d577da4fafd462265b611289547f183Johan Hedbergstatic int init_ssp_mode(int index) 267be49c2621d577da4fafd462265b611289547f183Johan Hedberg{ 268fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 269be49c2621d577da4fafd462265b611289547f183Johan Hedberg write_simple_pairing_mode_cp cp; 270be49c2621d577da4fafd462265b611289547f183Johan Hedberg 271fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (ioctl(dev->sk, HCIGETAUTHINFO, NULL) < 0 && errno == EINVAL) 272be49c2621d577da4fafd462265b611289547f183Johan Hedberg return 0; 273be49c2621d577da4fafd462265b611289547f183Johan Hedberg 274be49c2621d577da4fafd462265b611289547f183Johan Hedberg memset(&cp, 0, sizeof(cp)); 275be49c2621d577da4fafd462265b611289547f183Johan Hedberg cp.mode = 0x01; 276be49c2621d577da4fafd462265b611289547f183Johan Hedberg 277fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, 278be49c2621d577da4fafd462265b611289547f183Johan Hedberg OCF_WRITE_SIMPLE_PAIRING_MODE, 279be49c2621d577da4fafd462265b611289547f183Johan Hedberg WRITE_SIMPLE_PAIRING_MODE_CP_SIZE, &cp) < 0) 280be49c2621d577da4fafd462265b611289547f183Johan Hedberg return -errno; 281be49c2621d577da4fafd462265b611289547f183Johan Hedberg 282be49c2621d577da4fafd462265b611289547f183Johan Hedberg return 0; 283be49c2621d577da4fafd462265b611289547f183Johan Hedberg} 284be49c2621d577da4fafd462265b611289547f183Johan Hedberg 2855c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedbergstatic int hciops_set_discoverable(int index, gboolean discoverable) 2865c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg{ 287fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2885c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg uint8_t mode; 2895c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 2905c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg if (discoverable) 2915c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg mode = (SCAN_PAGE | SCAN_INQUIRY); 2925c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg else 2935c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg mode = SCAN_PAGE; 2945c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 2955c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg DBG("hci%d discoverable %d", index, discoverable); 2965c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 297fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, OCF_WRITE_SCAN_ENABLE, 2985c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 1, &mode) < 0) 2995c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg return -errno; 3005c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 3015c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg return 0; 3025c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg} 3035c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 30463ff6738abc6bf21becbbfde583062502e7728a6Johan Hedbergstatic int hciops_set_pairable(int index, gboolean pairable) 30563ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg{ 30663ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg DBG("hci%d pairable %d", index, pairable); 30763ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg return -ENOSYS; 30863ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg} 30963ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg 31063ff6738abc6bf21becbbfde583062502e7728a6Johan Hedbergstatic int hciops_power_off(int index) 3115c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg{ 312fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 31363ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg uint8_t mode = SCAN_DISABLED; 3145c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 3155c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg DBG("hci%d", index); 3165c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 31763ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, 31863ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg OCF_WRITE_SCAN_ENABLE, 1, &mode) < 0) 31963ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg return -errno; 3205c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 32163ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg if (ioctl(dev->sk, HCIDEVDOWN, index) < 0 && errno != EALREADY) 32263ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg return -errno; 3235c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 32463ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg return 0; 3255c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg} 3265c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 327b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedbergstatic void start_adapter(int index) 328b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg{ 329fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 330b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg uint8_t events[8] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0x1f, 0x00, 0x00 }; 331b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg uint8_t inqmode; 332ea30b84b2349c01175ed8700e206bca1e019a635Johan Hedberg uint16_t link_policy; 333b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 334fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->ver.lmp_ver > 1) { 335fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->features[5] & LMP_SNIFF_SUBR) 336b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[5] |= 0x20; 337b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 338fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->features[5] & LMP_PAUSE_ENC) 339b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[5] |= 0x80; 340b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 341fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->features[6] & LMP_EXT_INQ) 342b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[5] |= 0x40; 343b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 344fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->features[6] & LMP_NFLUSH_PKTS) 345b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[7] |= 0x01; 346b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 347fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->features[7] & LMP_LSTO) 348b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[6] |= 0x80; 349b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 350fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->features[6] & LMP_SIMPLE_PAIR) { 351b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[6] |= 0x01; /* IO Capability Request */ 352b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[6] |= 0x02; /* IO Capability Response */ 353b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[6] |= 0x04; /* User Confirmation Request */ 354b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[6] |= 0x08; /* User Passkey Request */ 355b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[6] |= 0x10; /* Remote OOB Data Request */ 356b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[6] |= 0x20; /* Simple Pairing Complete */ 357b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[7] |= 0x04; /* User Passkey Notification */ 358b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[7] |= 0x08; /* Keypress Notification */ 359b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[7] |= 0x10; /* Remote Host Supported 360b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg * Features Notification */ 361b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg } 362b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 363fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->features[4] & LMP_LE) 364b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg events[7] |= 0x20; /* LE Meta-Event */ 365b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 366fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_HOST_CTL, OCF_SET_EVENT_MASK, 367b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg sizeof(events), events); 368b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg } 369b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 370fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->features[6] & LMP_SIMPLE_PAIR) 371be49c2621d577da4fafd462265b611289547f183Johan Hedberg init_ssp_mode(index); 372be49c2621d577da4fafd462265b611289547f183Johan Hedberg 373b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg inqmode = get_inquiry_mode(index); 374b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg if (inqmode) 375b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg write_inq_mode(index, inqmode); 376b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 377fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->features[7] & LMP_INQ_TX_PWR) 378fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_HOST_CTL, 379b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg OCF_READ_INQ_RESPONSE_TX_POWER_LEVEL, 0, NULL); 380b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 381b59dabdd2515aa111ebc56d946259e4bbdf20c61Pawel Wieczorkiewicz /* Set default link policy */ 382ea30b84b2349c01175ed8700e206bca1e019a635Johan Hedberg link_policy = main_opts.link_policy; 383ea30b84b2349c01175ed8700e206bca1e019a635Johan Hedberg 384fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!(dev->features[0] & LMP_RSWITCH)) 385ea30b84b2349c01175ed8700e206bca1e019a635Johan Hedberg link_policy &= ~HCI_LP_RSWITCH; 386fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!(dev->features[0] & LMP_HOLD)) 387ea30b84b2349c01175ed8700e206bca1e019a635Johan Hedberg link_policy &= ~HCI_LP_HOLD; 388fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!(dev->features[0] & LMP_SNIFF)) 389ea30b84b2349c01175ed8700e206bca1e019a635Johan Hedberg link_policy &= ~HCI_LP_SNIFF; 390fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!(dev->features[1] & LMP_PARK)) 391ea30b84b2349c01175ed8700e206bca1e019a635Johan Hedberg link_policy &= ~HCI_LP_PARK; 392b59dabdd2515aa111ebc56d946259e4bbdf20c61Pawel Wieczorkiewicz 393ea30b84b2349c01175ed8700e206bca1e019a635Johan Hedberg link_policy = htobs(link_policy); 394fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_POLICY, OCF_WRITE_DEFAULT_LINK_POLICY, 395ea30b84b2349c01175ed8700e206bca1e019a635Johan Hedberg sizeof(link_policy), &link_policy); 396b59dabdd2515aa111ebc56d946259e4bbdf20c61Pawel Wieczorkiewicz 397fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->current_cod = 0; 398fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg memset(dev->eir, 0, sizeof(dev->eir)); 3995c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg} 40000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 4015c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedbergstatic gboolean init_adapter(int index) 4025c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg{ 403fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 4045c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg struct btd_adapter *adapter = NULL; 405fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg gboolean existing_adapter = dev->registered; 4065c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg uint8_t mode, on_mode; 4075c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg gboolean pairable, discoverable; 4085c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 409fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->registered) { 4105c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg adapter = btd_manager_register_adapter(index); 4115c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg if (adapter) 412fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->registered = TRUE; 4135c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg } else { 414fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg adapter = manager_find_adapter(&dev->bdaddr); 4155c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg /* FIXME: manager_find_adapter should return a new ref */ 4165c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg btd_adapter_ref(adapter); 4175c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg } 4185c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 4195c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg if (adapter == NULL) 4205c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg return FALSE; 4215c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 4225c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg btd_adapter_get_state(adapter, &mode, &on_mode, &pairable); 4235c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 4245c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg if (existing_adapter) 4255c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg mode = on_mode; 4265c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 4275c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg if (mode == MODE_OFF) { 42863ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg hciops_power_off(index); 4295c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg goto done; 4305c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg } 4315c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 4325c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg start_adapter(index); 4335c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg btd_adapter_start(adapter); 4345c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 4355c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg discoverable = (mode == MODE_DISCOVERABLE); 4365c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 4375c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg hciops_set_discoverable(index, discoverable); 4385c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg hciops_set_pairable(index, pairable); 4395c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 4405c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedbergdone: 4415c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg btd_adapter_unref(adapter); 4425c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg return TRUE; 443b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg} 444b8486f046aadbe0145519c86a087e880fd1d638fJohan Hedberg 445abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedbergstatic int hciops_encrypt_link(int index, bdaddr_t *dst, bt_hci_result_t cb, 446abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg gpointer user_data) 447abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg{ 448abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg GIOChannel *io; 449abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg struct hci_cmd_data *cmd; 450abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg struct hci_conn_info_req *cr; 451abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg auth_requested_cp cp; 452abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg struct hci_filter nf; 453abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg int dd, err; 454abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg uint32_t link_mode; 455abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg uint16_t handle; 456abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 457684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg dd = hci_open_dev(index); 458684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg if (dd < 0) 459684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg return -errno; 460684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg 461abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cr = g_malloc0(sizeof(*cr) + sizeof(struct hci_conn_info)); 462abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cr->type = ACL_LINK; 463abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg bacpy(&cr->bdaddr, dst); 464abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 465684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg err = ioctl(dd, HCIGETCONNINFO, cr); 466abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg link_mode = cr->conn_info->link_mode; 467abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg handle = cr->conn_info->handle; 468abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg g_free(cr); 469abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 470684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg if (err < 0) { 471684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg err = -errno; 472684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg goto fail; 473684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg } 474abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 475684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg if (link_mode & HCI_LM_ENCRYPT) { 476684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg err = -EALREADY; 477684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg goto fail; 478684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg } 479abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 480abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg memset(&cp, 0, sizeof(cp)); 481abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cp.handle = htobs(handle); 482abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 483684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg if (hci_send_cmd(dd, OGF_LINK_CTL, OCF_AUTH_REQUESTED, 484684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg AUTH_REQUESTED_CP_SIZE, &cp) < 0) { 485684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg err = -errno; 486684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg goto fail; 487684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg } 488abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 489abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cmd = g_new0(struct hci_cmd_data, 1); 490abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cmd->handle = handle; 491abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cmd->ocf = OCF_AUTH_REQUESTED; 492abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cmd->cb = cb; 493abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg cmd->caller_data = user_data; 494abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 495abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg hci_filter_clear(&nf); 496abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg hci_filter_set_ptype(HCI_EVENT_PKT, &nf); 497abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg hci_filter_set_event(EVT_CMD_STATUS, &nf); 498abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg hci_filter_set_event(EVT_AUTH_COMPLETE, &nf); 499abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg hci_filter_set_event(EVT_ENCRYPT_CHANGE, &nf); 500abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 501abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg if (setsockopt(dd, SOL_HCI, HCI_FILTER, &nf, sizeof(nf)) < 0) { 502abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg err = -errno; 503abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg g_free(cmd); 504684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg goto fail; 505abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg } 506abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 507684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg io = g_io_channel_unix_new(dd); 508abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg g_io_channel_set_close_on_unref(io, FALSE); 509abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg g_io_add_watch_full(io, G_PRIORITY_DEFAULT, 510abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg G_IO_HUP | G_IO_ERR | G_IO_NVAL | G_IO_IN, 511abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg hci_event_watch, cmd, g_free); 512abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg g_io_channel_unref(io); 513abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 514abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg return 0; 515684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg 516684b1d3be105b64f3994e621335f69b45e34125fJohan Hedbergfail: 517684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg close(dd); 518684b1d3be105b64f3994e621335f69b45e34125fJohan Hedberg return err; 519abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg} 520abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 52100c2267405ff3416672401cf394f06017a6814c1Johan Hedbergstatic int hciops_set_did(int index, uint16_t vendor, uint16_t product, 52200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint16_t version) 52300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg{ 524fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 525fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 526fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->did_vendor = vendor; 527fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->did_product = product; 528fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->did_version = version; 52900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 53000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return 0; 53100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg} 53200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 533abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg/* End async HCI command handling */ 534abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg 5355288199788ecb17183d6517da3062cd94692a900Johan Hedberg/* Start of HCI event callbacks */ 5365288199788ecb17183d6517da3062cd94692a900Johan Hedberg 53742bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic int get_handle(int index, bdaddr_t *dba, uint16_t *handle) 5385288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 539fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 5405288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct hci_conn_list_req *cl; 5415288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct hci_conn_info *ci; 5425288199788ecb17183d6517da3062cd94692a900Johan Hedberg int i; 5435288199788ecb17183d6517da3062cd94692a900Johan Hedberg 5445288199788ecb17183d6517da3062cd94692a900Johan Hedberg cl = g_malloc0(10 * sizeof(*ci) + sizeof(*cl)); 5455288199788ecb17183d6517da3062cd94692a900Johan Hedberg 54642bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg cl->dev_id = index; 5475288199788ecb17183d6517da3062cd94692a900Johan Hedberg cl->conn_num = 10; 5485288199788ecb17183d6517da3062cd94692a900Johan Hedberg ci = cl->conn_info; 5495288199788ecb17183d6517da3062cd94692a900Johan Hedberg 550fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (ioctl(dev->sk, HCIGETCONNLIST, (void *) cl) < 0) { 5515288199788ecb17183d6517da3062cd94692a900Johan Hedberg g_free(cl); 5525288199788ecb17183d6517da3062cd94692a900Johan Hedberg return -EIO; 5535288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 5545288199788ecb17183d6517da3062cd94692a900Johan Hedberg 5555288199788ecb17183d6517da3062cd94692a900Johan Hedberg for (i = 0; i < cl->conn_num; i++, ci++) { 5565288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (bacmp(&ci->bdaddr, dba) == 0) { 5575288199788ecb17183d6517da3062cd94692a900Johan Hedberg *handle = ci->handle; 5585288199788ecb17183d6517da3062cd94692a900Johan Hedberg g_free(cl); 5595288199788ecb17183d6517da3062cd94692a900Johan Hedberg return 0; 5605288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 5615288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 5625288199788ecb17183d6517da3062cd94692a900Johan Hedberg 5635288199788ecb17183d6517da3062cd94692a900Johan Hedberg g_free(cl); 5645288199788ecb17183d6517da3062cd94692a900Johan Hedberg 5655288199788ecb17183d6517da3062cd94692a900Johan Hedberg return -ENOENT; 5665288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 5675288199788ecb17183d6517da3062cd94692a900Johan Hedberg 56842bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline int get_bdaddr(int index, uint16_t handle, bdaddr_t *dba) 5695288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 570fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 5715288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct hci_conn_list_req *cl; 5725288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct hci_conn_info *ci; 5735288199788ecb17183d6517da3062cd94692a900Johan Hedberg int i; 5745288199788ecb17183d6517da3062cd94692a900Johan Hedberg 5755288199788ecb17183d6517da3062cd94692a900Johan Hedberg cl = g_malloc0(10 * sizeof(*ci) + sizeof(*cl)); 5765288199788ecb17183d6517da3062cd94692a900Johan Hedberg 57742bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg cl->dev_id = index; 5785288199788ecb17183d6517da3062cd94692a900Johan Hedberg cl->conn_num = 10; 5795288199788ecb17183d6517da3062cd94692a900Johan Hedberg ci = cl->conn_info; 5805288199788ecb17183d6517da3062cd94692a900Johan Hedberg 581fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (ioctl(dev->sk, HCIGETCONNLIST, (void *) cl) < 0) { 5825288199788ecb17183d6517da3062cd94692a900Johan Hedberg g_free(cl); 5835288199788ecb17183d6517da3062cd94692a900Johan Hedberg return -EIO; 5845288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 5855288199788ecb17183d6517da3062cd94692a900Johan Hedberg 5865288199788ecb17183d6517da3062cd94692a900Johan Hedberg for (i = 0; i < cl->conn_num; i++, ci++) 5875288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (ci->handle == handle) { 5885288199788ecb17183d6517da3062cd94692a900Johan Hedberg bacpy(dba, &ci->bdaddr); 5895288199788ecb17183d6517da3062cd94692a900Johan Hedberg g_free(cl); 5905288199788ecb17183d6517da3062cd94692a900Johan Hedberg return 0; 5915288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 5925288199788ecb17183d6517da3062cd94692a900Johan Hedberg 5935288199788ecb17183d6517da3062cd94692a900Johan Hedberg g_free(cl); 5945288199788ecb17183d6517da3062cd94692a900Johan Hedberg 5955288199788ecb17183d6517da3062cd94692a900Johan Hedberg return -ENOENT; 5965288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 5975288199788ecb17183d6517da3062cd94692a900Johan Hedberg 5985288199788ecb17183d6517da3062cd94692a900Johan Hedbergstatic inline void update_lastseen(bdaddr_t *sba, bdaddr_t *dba) 5995288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 6005288199788ecb17183d6517da3062cd94692a900Johan Hedberg time_t t; 6015288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct tm *tm; 6025288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6035288199788ecb17183d6517da3062cd94692a900Johan Hedberg t = time(NULL); 6045288199788ecb17183d6517da3062cd94692a900Johan Hedberg tm = gmtime(&t); 6055288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6065288199788ecb17183d6517da3062cd94692a900Johan Hedberg write_lastseen_info(sba, dba, tm); 6075288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 6085288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6095288199788ecb17183d6517da3062cd94692a900Johan Hedbergstatic inline void update_lastused(bdaddr_t *sba, bdaddr_t *dba) 6105288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 6115288199788ecb17183d6517da3062cd94692a900Johan Hedberg time_t t; 6125288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct tm *tm; 6135288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6145288199788ecb17183d6517da3062cd94692a900Johan Hedberg t = time(NULL); 6155288199788ecb17183d6517da3062cd94692a900Johan Hedberg tm = gmtime(&t); 6165288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6175288199788ecb17183d6517da3062cd94692a900Johan Hedberg write_lastused_info(sba, dba, tm); 6185288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 6195288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6205288199788ecb17183d6517da3062cd94692a900Johan Hedberg/* Link Key handling */ 6215288199788ecb17183d6517da3062cd94692a900Johan Hedberg 62242bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic void link_key_request(int index, bdaddr_t *dba) 6235288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 624fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 6255288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct btd_adapter *adapter; 6265288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct btd_device *device; 6275288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct hci_auth_info_req req; 6285288199788ecb17183d6517da3062cd94692a900Johan Hedberg unsigned char key[16]; 6290e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char da[18]; 6305288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint8_t type; 6315288199788ecb17183d6517da3062cd94692a900Johan Hedberg int err; 6325288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6330e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(dba, da); 6340e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d dba %s", index, da); 6355288199788ecb17183d6517da3062cd94692a900Johan Hedberg 636fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg adapter = manager_find_adapter(&dev->bdaddr); 6375288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (adapter) 6385288199788ecb17183d6517da3062cd94692a900Johan Hedberg device = adapter_find_device(adapter, da); 6395288199788ecb17183d6517da3062cd94692a900Johan Hedberg else 6405288199788ecb17183d6517da3062cd94692a900Johan Hedberg device = NULL; 6415288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6425288199788ecb17183d6517da3062cd94692a900Johan Hedberg memset(&req, 0, sizeof(req)); 6435288199788ecb17183d6517da3062cd94692a900Johan Hedberg bacpy(&req.bdaddr, dba); 6445288199788ecb17183d6517da3062cd94692a900Johan Hedberg 645fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = ioctl(dev->sk, HCIGETAUTHINFO, (unsigned long) &req); 6465288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (err < 0) { 6475288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (errno != EINVAL) 6485288199788ecb17183d6517da3062cd94692a900Johan Hedberg DBG("HCIGETAUTHINFO failed %s (%d)", 6495288199788ecb17183d6517da3062cd94692a900Johan Hedberg strerror(errno), errno); 6505288199788ecb17183d6517da3062cd94692a900Johan Hedberg req.type = 0x00; 6515288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 6525288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6535288199788ecb17183d6517da3062cd94692a900Johan Hedberg DBG("kernel auth requirements = 0x%02x", req.type); 6545288199788ecb17183d6517da3062cd94692a900Johan Hedberg 655e5828c7e30453232e930dbead0e359175dc1decfJohan Hedberg if (main_opts.debug_keys && device && 656e5828c7e30453232e930dbead0e359175dc1decfJohan Hedberg device_get_debug_key(device, key)) 6575288199788ecb17183d6517da3062cd94692a900Johan Hedberg type = 0x03; 658fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg else if (read_link_key(&dev->bdaddr, dba, key, &type) < 0 || 65942bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg type == 0x03) { 6605288199788ecb17183d6517da3062cd94692a900Johan Hedberg /* Link key not found */ 661fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_CTL, OCF_LINK_KEY_NEG_REPLY, 66242bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg 6, dba); 6635288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 6645288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 6655288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6665288199788ecb17183d6517da3062cd94692a900Johan Hedberg /* Link key found */ 6675288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6680e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("link key type 0x%02x", type); 6695288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6705288199788ecb17183d6517da3062cd94692a900Johan Hedberg /* Don't use unauthenticated combination keys if MITM is 6715288199788ecb17183d6517da3062cd94692a900Johan Hedberg * required */ 6725288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (type == 0x04 && req.type != 0xff && (req.type & 0x01)) 673fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_CTL, OCF_LINK_KEY_NEG_REPLY, 6745288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6, dba); 6755288199788ecb17183d6517da3062cd94692a900Johan Hedberg else { 6765288199788ecb17183d6517da3062cd94692a900Johan Hedberg link_key_reply_cp lr; 6775288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6785288199788ecb17183d6517da3062cd94692a900Johan Hedberg memcpy(lr.link_key, key, 16); 6795288199788ecb17183d6517da3062cd94692a900Johan Hedberg bacpy(&lr.bdaddr, dba); 6805288199788ecb17183d6517da3062cd94692a900Johan Hedberg 681fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_CTL, OCF_LINK_KEY_REPLY, 6825288199788ecb17183d6517da3062cd94692a900Johan Hedberg LINK_KEY_REPLY_CP_SIZE, &lr); 6835288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 6845288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 6855288199788ecb17183d6517da3062cd94692a900Johan Hedberg 68642bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic void link_key_notify(int index, void *ptr) 6875288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 688fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 6895288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_link_key_notify *evt = ptr; 6905288199788ecb17183d6517da3062cd94692a900Johan Hedberg bdaddr_t *dba = &evt->bdaddr; 6910e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char da[18]; 69242bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg int err; 6935288199788ecb17183d6517da3062cd94692a900Johan Hedberg unsigned char old_key[16]; 6945288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint8_t old_key_type; 6955288199788ecb17183d6517da3062cd94692a900Johan Hedberg 6960e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(dba, da); 6970e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d dba %s type %d", index, da, evt->key_type); 6985288199788ecb17183d6517da3062cd94692a900Johan Hedberg 699fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = read_link_key(&dev->bdaddr, dba, old_key, &old_key_type); 7005288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (err < 0) 7015288199788ecb17183d6517da3062cd94692a900Johan Hedberg old_key_type = 0xff; 7025288199788ecb17183d6517da3062cd94692a900Johan Hedberg 703fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = btd_event_link_key_notify(&dev->bdaddr, dba, evt->link_key, 704fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg evt->key_type, dev->pin_length, 70542bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg old_key_type); 706fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->pin_length = -1; 7075288199788ecb17183d6517da3062cd94692a900Johan Hedberg 7085288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (err < 0) { 7095288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint16_t handle; 7105288199788ecb17183d6517da3062cd94692a900Johan Hedberg 7115288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (err == -ENODEV) 712fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_bonding_process_complete(&dev->bdaddr, dba, 7135288199788ecb17183d6517da3062cd94692a900Johan Hedberg HCI_OE_LOW_RESOURCES); 7145288199788ecb17183d6517da3062cd94692a900Johan Hedberg else 715fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_bonding_process_complete(&dev->bdaddr, dba, 7165288199788ecb17183d6517da3062cd94692a900Johan Hedberg HCI_MEMORY_FULL); 7175288199788ecb17183d6517da3062cd94692a900Johan Hedberg 71842bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg if (get_handle(index, dba, &handle) == 0) { 7195288199788ecb17183d6517da3062cd94692a900Johan Hedberg disconnect_cp cp; 7205288199788ecb17183d6517da3062cd94692a900Johan Hedberg 7215288199788ecb17183d6517da3062cd94692a900Johan Hedberg memset(&cp, 0, sizeof(cp)); 7225288199788ecb17183d6517da3062cd94692a900Johan Hedberg cp.handle = htobs(handle); 7235288199788ecb17183d6517da3062cd94692a900Johan Hedberg cp.reason = HCI_OE_LOW_RESOURCES; 7245288199788ecb17183d6517da3062cd94692a900Johan Hedberg 725fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_CTL, OCF_DISCONNECT, 7265288199788ecb17183d6517da3062cd94692a900Johan Hedberg DISCONNECT_CP_SIZE, &cp); 7275288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 7285288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 7295288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 7305288199788ecb17183d6517da3062cd94692a900Johan Hedberg 73142bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic void return_link_keys(int index, void *ptr) 7325288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 733fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 7345288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_return_link_keys *evt = ptr; 7355288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint8_t num = evt->num_keys; 7365288199788ecb17183d6517da3062cd94692a900Johan Hedberg unsigned char key[16]; 7370e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char da[18]; 7385288199788ecb17183d6517da3062cd94692a900Johan Hedberg bdaddr_t dba; 7395288199788ecb17183d6517da3062cd94692a900Johan Hedberg int i; 7405288199788ecb17183d6517da3062cd94692a900Johan Hedberg 7410e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d num_keys %u", index, num); 7420e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 7435288199788ecb17183d6517da3062cd94692a900Johan Hedberg ptr++; 7445288199788ecb17183d6517da3062cd94692a900Johan Hedberg 7455288199788ecb17183d6517da3062cd94692a900Johan Hedberg for (i = 0; i < num; i++) { 7465288199788ecb17183d6517da3062cd94692a900Johan Hedberg bacpy(&dba, ptr); ba2str(&dba, da); 7475288199788ecb17183d6517da3062cd94692a900Johan Hedberg memcpy(key, ptr + 6, 16); 7485288199788ecb17183d6517da3062cd94692a900Johan Hedberg 7490e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d returned key for %s", index, da); 7505288199788ecb17183d6517da3062cd94692a900Johan Hedberg 751fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_returned_link_key(&dev->bdaddr, &dba); 7525288199788ecb17183d6517da3062cd94692a900Johan Hedberg 7535288199788ecb17183d6517da3062cd94692a900Johan Hedberg ptr += 22; 7545288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 7555288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 7565288199788ecb17183d6517da3062cd94692a900Johan Hedberg 7575288199788ecb17183d6517da3062cd94692a900Johan Hedberg/* Simple Pairing handling */ 7585288199788ecb17183d6517da3062cd94692a900Johan Hedberg 75942bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic void user_confirm_request(int index, void *ptr) 7605288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 761fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 7625288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_user_confirm_request *req = ptr; 7635288199788ecb17183d6517da3062cd94692a900Johan Hedberg 7640e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 7650e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 766fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (btd_event_user_confirm(&dev->bdaddr, &req->bdaddr, 7675288199788ecb17183d6517da3062cd94692a900Johan Hedberg btohl(req->passkey)) < 0) 768fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_CTL, 7695288199788ecb17183d6517da3062cd94692a900Johan Hedberg OCF_USER_CONFIRM_NEG_REPLY, 6, ptr); 7705288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 7715288199788ecb17183d6517da3062cd94692a900Johan Hedberg 77242bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic void user_passkey_request(int index, void *ptr) 7735288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 774fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 7755288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_user_passkey_request *req = ptr; 7765288199788ecb17183d6517da3062cd94692a900Johan Hedberg 7770e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 7780e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 779fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (btd_event_user_passkey(&dev->bdaddr, &req->bdaddr) < 0) 780fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_CTL, 7815288199788ecb17183d6517da3062cd94692a900Johan Hedberg OCF_USER_PASSKEY_NEG_REPLY, 6, ptr); 7825288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 7835288199788ecb17183d6517da3062cd94692a900Johan Hedberg 78442bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic void user_passkey_notify(int index, void *ptr) 7855288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 786fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 7875288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_user_passkey_notify *req = ptr; 7885288199788ecb17183d6517da3062cd94692a900Johan Hedberg 7890e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 7900e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 791fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_user_notify(&dev->bdaddr, &req->bdaddr, 79242bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg btohl(req->passkey)); 7935288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 7945288199788ecb17183d6517da3062cd94692a900Johan Hedberg 79542bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic void remote_oob_data_request(int index, void *ptr) 7965288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 797fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 798fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 7990e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 800fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 801fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_CTL, 80242bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg OCF_REMOTE_OOB_DATA_NEG_REPLY, 6, ptr); 8035288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 8045288199788ecb17183d6517da3062cd94692a900Johan Hedberg 80542bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic void io_capa_request(int index, void *ptr) 8065288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 807fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 80842bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg bdaddr_t *dba = ptr; 8090e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char da[18]; 8105288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint8_t cap, auth; 8115288199788ecb17183d6517da3062cd94692a900Johan Hedberg 8120e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(dba, da); 8130e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d IO capability request for %s", index, da); 8145288199788ecb17183d6517da3062cd94692a900Johan Hedberg 815fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (btd_event_get_io_cap(&dev->bdaddr, dba, &cap, &auth) < 0) { 8165288199788ecb17183d6517da3062cd94692a900Johan Hedberg io_capability_neg_reply_cp cp; 8175288199788ecb17183d6517da3062cd94692a900Johan Hedberg memset(&cp, 0, sizeof(cp)); 8185288199788ecb17183d6517da3062cd94692a900Johan Hedberg bacpy(&cp.bdaddr, dba); 8195288199788ecb17183d6517da3062cd94692a900Johan Hedberg cp.reason = HCI_PAIRING_NOT_ALLOWED; 820fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_CTL, 82142bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg OCF_IO_CAPABILITY_NEG_REPLY, 8225288199788ecb17183d6517da3062cd94692a900Johan Hedberg IO_CAPABILITY_NEG_REPLY_CP_SIZE, &cp); 8235288199788ecb17183d6517da3062cd94692a900Johan Hedberg } else { 8245288199788ecb17183d6517da3062cd94692a900Johan Hedberg io_capability_reply_cp cp; 8255288199788ecb17183d6517da3062cd94692a900Johan Hedberg memset(&cp, 0, sizeof(cp)); 8265288199788ecb17183d6517da3062cd94692a900Johan Hedberg bacpy(&cp.bdaddr, dba); 8275288199788ecb17183d6517da3062cd94692a900Johan Hedberg cp.capability = cap; 8285288199788ecb17183d6517da3062cd94692a900Johan Hedberg cp.oob_data = 0x00; 8295288199788ecb17183d6517da3062cd94692a900Johan Hedberg cp.authentication = auth; 830fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_CTL, OCF_IO_CAPABILITY_REPLY, 8315288199788ecb17183d6517da3062cd94692a900Johan Hedberg IO_CAPABILITY_REPLY_CP_SIZE, &cp); 8325288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 8335288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 8345288199788ecb17183d6517da3062cd94692a900Johan Hedberg 83542bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic void io_capa_response(int index, void *ptr) 8365288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 837fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 8385288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_io_capability_response *evt = ptr; 8390e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char da[18]; 8405288199788ecb17183d6517da3062cd94692a900Johan Hedberg 8410e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(&evt->bdaddr, da); 8420e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d IO capability response from %s", index, da); 8435288199788ecb17183d6517da3062cd94692a900Johan Hedberg 844fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_set_io_cap(&dev->bdaddr, &evt->bdaddr, 8455288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt->capability, evt->authentication); 8465288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 8475288199788ecb17183d6517da3062cd94692a900Johan Hedberg 8485288199788ecb17183d6517da3062cd94692a900Johan Hedberg/* PIN code handling */ 8495288199788ecb17183d6517da3062cd94692a900Johan Hedberg 85042bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic void pin_code_request(int index, bdaddr_t *dba) 8515288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 852fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 8535288199788ecb17183d6517da3062cd94692a900Johan Hedberg pin_code_reply_cp pr; 8545288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct hci_conn_info_req *cr; 8555288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct hci_conn_info *ci; 8560e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char da[18], pin[17]; 8575288199788ecb17183d6517da3062cd94692a900Johan Hedberg int pinlen; 8585288199788ecb17183d6517da3062cd94692a900Johan Hedberg 8595288199788ecb17183d6517da3062cd94692a900Johan Hedberg memset(&pr, 0, sizeof(pr)); 8605288199788ecb17183d6517da3062cd94692a900Johan Hedberg bacpy(&pr.bdaddr, dba); 8615288199788ecb17183d6517da3062cd94692a900Johan Hedberg 8620e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(dba, da); 8630e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d PIN request for %s", index, da); 8645288199788ecb17183d6517da3062cd94692a900Johan Hedberg 8655288199788ecb17183d6517da3062cd94692a900Johan Hedberg cr = g_malloc0(sizeof(*cr) + sizeof(*ci)); 8665288199788ecb17183d6517da3062cd94692a900Johan Hedberg 8675288199788ecb17183d6517da3062cd94692a900Johan Hedberg bacpy(&cr->bdaddr, dba); 8685288199788ecb17183d6517da3062cd94692a900Johan Hedberg cr->type = ACL_LINK; 869fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (ioctl(dev->sk, HCIGETCONNINFO, (unsigned long) cr) < 0) { 8705288199788ecb17183d6517da3062cd94692a900Johan Hedberg error("Can't get conn info: %s (%d)", strerror(errno), errno); 8715288199788ecb17183d6517da3062cd94692a900Johan Hedberg goto reject; 8725288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 8735288199788ecb17183d6517da3062cd94692a900Johan Hedberg ci = cr->conn_info; 8745288199788ecb17183d6517da3062cd94692a900Johan Hedberg 8755288199788ecb17183d6517da3062cd94692a900Johan Hedberg memset(pin, 0, sizeof(pin)); 876fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg pinlen = read_pin_code(&dev->bdaddr, dba, pin); 8775288199788ecb17183d6517da3062cd94692a900Johan Hedberg 8785288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (pinlen > 0) { 879fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->pin_length = pinlen; 8805288199788ecb17183d6517da3062cd94692a900Johan Hedberg memcpy(pr.pin_code, pin, pinlen); 8815288199788ecb17183d6517da3062cd94692a900Johan Hedberg pr.pin_len = pinlen; 882fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_CTL, OCF_PIN_CODE_REPLY, 88342bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg PIN_CODE_REPLY_CP_SIZE, &pr); 8845288199788ecb17183d6517da3062cd94692a900Johan Hedberg } else { 8855288199788ecb17183d6517da3062cd94692a900Johan Hedberg /* Request PIN from passkey agent */ 886fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (btd_event_request_pin(&dev->bdaddr, ci) < 0) 8875288199788ecb17183d6517da3062cd94692a900Johan Hedberg goto reject; 8885288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 8895288199788ecb17183d6517da3062cd94692a900Johan Hedberg 8905288199788ecb17183d6517da3062cd94692a900Johan Hedberg g_free(cr); 8915288199788ecb17183d6517da3062cd94692a900Johan Hedberg 8925288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 8935288199788ecb17183d6517da3062cd94692a900Johan Hedberg 8945288199788ecb17183d6517da3062cd94692a900Johan Hedbergreject: 8955288199788ecb17183d6517da3062cd94692a900Johan Hedberg g_free(cr); 8965288199788ecb17183d6517da3062cd94692a900Johan Hedberg 897fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_CTL, OCF_PIN_CODE_NEG_REPLY, 6, dba); 8985288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 8995288199788ecb17183d6517da3062cd94692a900Johan Hedberg 9005288199788ecb17183d6517da3062cd94692a900Johan Hedbergstatic void start_inquiry(bdaddr_t *local, uint8_t status, gboolean periodic) 9015288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 9025288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct btd_adapter *adapter; 9035288199788ecb17183d6517da3062cd94692a900Johan Hedberg int state; 9045288199788ecb17183d6517da3062cd94692a900Johan Hedberg 9055288199788ecb17183d6517da3062cd94692a900Johan Hedberg /* Don't send the signal if the cmd failed */ 9065288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (status) { 9075288199788ecb17183d6517da3062cd94692a900Johan Hedberg error("Inquiry Failed with status 0x%02x", status); 9085288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 9095288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 9105288199788ecb17183d6517da3062cd94692a900Johan Hedberg 9115288199788ecb17183d6517da3062cd94692a900Johan Hedberg adapter = manager_find_adapter(local); 9125288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (!adapter) { 9135288199788ecb17183d6517da3062cd94692a900Johan Hedberg error("Unable to find matching adapter"); 9145288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 9155288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 9165288199788ecb17183d6517da3062cd94692a900Johan Hedberg 9175288199788ecb17183d6517da3062cd94692a900Johan Hedberg state = adapter_get_state(adapter); 9185288199788ecb17183d6517da3062cd94692a900Johan Hedberg 9195288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (periodic) 9205288199788ecb17183d6517da3062cd94692a900Johan Hedberg state |= STATE_PINQ; 9215288199788ecb17183d6517da3062cd94692a900Johan Hedberg else 9225288199788ecb17183d6517da3062cd94692a900Johan Hedberg state |= STATE_STDINQ; 9235288199788ecb17183d6517da3062cd94692a900Johan Hedberg 9245288199788ecb17183d6517da3062cd94692a900Johan Hedberg adapter_set_state(adapter, state); 9255288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 9265288199788ecb17183d6517da3062cd94692a900Johan Hedberg 927e5828c7e30453232e930dbead0e359175dc1decfJohan Hedbergstatic void inquiry_complete(bdaddr_t *local, uint8_t status, 928e5828c7e30453232e930dbead0e359175dc1decfJohan Hedberg gboolean periodic) 9295288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 9305288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct btd_adapter *adapter; 9315288199788ecb17183d6517da3062cd94692a900Johan Hedberg int state; 9325288199788ecb17183d6517da3062cd94692a900Johan Hedberg 9335288199788ecb17183d6517da3062cd94692a900Johan Hedberg /* Don't send the signal if the cmd failed */ 9345288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (status) { 9355288199788ecb17183d6517da3062cd94692a900Johan Hedberg error("Inquiry Failed with status 0x%02x", status); 9365288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 9375288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 9385288199788ecb17183d6517da3062cd94692a900Johan Hedberg 9395288199788ecb17183d6517da3062cd94692a900Johan Hedberg adapter = manager_find_adapter(local); 9405288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (!adapter) { 9415288199788ecb17183d6517da3062cd94692a900Johan Hedberg error("Unable to find matching adapter"); 9425288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 9435288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 9445288199788ecb17183d6517da3062cd94692a900Johan Hedberg 9455288199788ecb17183d6517da3062cd94692a900Johan Hedberg state = adapter_get_state(adapter); 9465288199788ecb17183d6517da3062cd94692a900Johan Hedberg state &= ~(STATE_STDINQ | STATE_PINQ); 9475288199788ecb17183d6517da3062cd94692a900Johan Hedberg adapter_set_state(adapter, state); 9485288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 9495288199788ecb17183d6517da3062cd94692a900Johan Hedberg 95042bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void remote_features_notify(int index, void *ptr) 9515288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 952fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 9535288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_remote_host_features_notify *evt = ptr; 9545288199788ecb17183d6517da3062cd94692a900Johan Hedberg 9555288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (evt->features[0] & 0x01) 956fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_set_legacy_pairing(&dev->bdaddr, &evt->bdaddr, 95742bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg FALSE); 9585288199788ecb17183d6517da3062cd94692a900Johan Hedberg else 959fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_set_legacy_pairing(&dev->bdaddr, &evt->bdaddr, 96042bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg TRUE); 9615288199788ecb17183d6517da3062cd94692a900Johan Hedberg 962fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg write_features_info(&dev->bdaddr, &evt->bdaddr, NULL, evt->features); 9635288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 9645288199788ecb17183d6517da3062cd94692a900Johan Hedberg 9652db4f654cb730adffe7b55044327f68808cd1c9dJohan Hedbergstatic void write_le_host_complete(int index, uint8_t status) 9665288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 967fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 9682db4f654cb730adffe7b55044327f68808cd1c9dJohan Hedberg uint8_t page_num = 0x01; 9695288199788ecb17183d6517da3062cd94692a900Johan Hedberg 9705288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (status) 9715288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 9725288199788ecb17183d6517da3062cd94692a900Johan Hedberg 973fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_INFO_PARAM, 9742db4f654cb730adffe7b55044327f68808cd1c9dJohan Hedberg OCF_READ_LOCAL_EXT_FEATURES, 1, &page_num) < 0) 9752db4f654cb730adffe7b55044327f68808cd1c9dJohan Hedberg error("Unable to read extended local features: %s (%d)", 9762db4f654cb730adffe7b55044327f68808cd1c9dJohan Hedberg strerror(errno), errno); 9775288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 9785288199788ecb17183d6517da3062cd94692a900Johan Hedberg 979be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedbergstatic void read_local_version_complete(int index, 980be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg const read_local_version_rp *rp) 981be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg{ 982fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 983fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 984be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg if (rp->status) 985be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg return; 986be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 987fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->ver.manufacturer = btohs(bt_get_unaligned(&rp->manufacturer)); 988fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->ver.hci_ver = rp->hci_ver; 989fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->ver.hci_rev = btohs(bt_get_unaligned(&rp->hci_rev)); 990fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->ver.lmp_ver = rp->lmp_ver; 991fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->ver.lmp_subver = btohs(bt_get_unaligned(&rp->lmp_subver)); 992be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 993fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->pending) 994be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg return; 995be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 996fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_clear_bit(PENDING_VERSION, &dev->pending); 997be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 998be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg DBG("Got version for hci%d", index); 999be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 1000fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->pending && dev->up) 10015c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg init_adapter(index); 1002be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg} 1003be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 1004be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedbergstatic void read_local_features_complete(int index, 1005be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg const read_local_features_rp *rp) 1006be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg{ 1007fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 1008fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 1009be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg if (rp->status) 1010be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg return; 1011be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 1012fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg memcpy(dev->features, rp->features, 8); 1013be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 1014fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->pending) 1015be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg return; 1016be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 1017fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_clear_bit(PENDING_FEATURES, &dev->pending); 1018be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 1019be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg DBG("Got features for hci%d", index); 1020be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 1021fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->pending && dev->up) 10225c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg init_adapter(index); 1023be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg} 1024be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 102500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg#define SIZEOF_UUID128 16 102600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 102700c2267405ff3416672401cf394f06017a6814c1Johan Hedbergstatic void eir_generate_uuid128(sdp_list_t *list, 102800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint8_t *ptr, uint16_t *eir_len) 102900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg{ 103000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg int i, k, uuid_count = 0; 103100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint16_t len = *eir_len; 103200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint8_t *uuid128; 103300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg gboolean truncated = FALSE; 103400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 103500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* Store UUIDs in place, skip 2 bytes to write type and length later */ 103600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uuid128 = ptr + 2; 103700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 103800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg for (; list; list = list->next) { 103900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg sdp_record_t *rec = list->data; 104000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint8_t *uuid128_data = rec->svclass.value.uuid128.data; 104100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 104200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (rec->svclass.type != SDP_UUID128) 104300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg continue; 104400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 104500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* Stop if not enough space to put next UUID128 */ 104600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if ((len + 2 + SIZEOF_UUID128) > EIR_DATA_LENGTH) { 104700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg truncated = TRUE; 104800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg break; 104900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 105000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 105100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* Check for duplicates, EIR data is Little Endian */ 105200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg for (i = 0; i < uuid_count; i++) { 105300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg for (k = 0; k < SIZEOF_UUID128; k++) { 105400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (uuid128[i * SIZEOF_UUID128 + k] != 105500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uuid128_data[SIZEOF_UUID128 - 1 - k]) 105600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg break; 105700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 105800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (k == SIZEOF_UUID128) 105900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg break; 106000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 106100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 106200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (i < uuid_count) 106300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg continue; 106400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 106500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* EIR data is Little Endian */ 106600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg for (k = 0; k < SIZEOF_UUID128; k++) 106700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uuid128[uuid_count * SIZEOF_UUID128 + k] = 106800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uuid128_data[SIZEOF_UUID128 - 1 - k]; 106900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 107000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg len += SIZEOF_UUID128; 107100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uuid_count++; 107200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 107300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 107400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (uuid_count > 0 || truncated) { 107500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* EIR Data length */ 107600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg ptr[0] = (uuid_count * SIZEOF_UUID128) + 1; 107700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* EIR Data type */ 107800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg ptr[1] = truncated ? EIR_UUID128_SOME : EIR_UUID128_ALL; 107900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg len += 2; 108000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg *eir_len = len; 108100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 108200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg} 108300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 108400c2267405ff3416672401cf394f06017a6814c1Johan Hedbergstatic void create_ext_inquiry_response(int index, uint8_t *data) 108500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg{ 1086fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 108700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg sdp_list_t *services; 108800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg sdp_list_t *list; 108900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint8_t *ptr = data; 109000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint16_t eir_len = 0; 109100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint16_t uuid16[EIR_DATA_LENGTH / 2]; 109200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg int i, uuid_count = 0; 109300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg gboolean truncated = FALSE; 109400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg struct btd_adapter *adapter; 109500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg size_t name_len; 109600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1097fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg name_len = strlen(dev->name); 109800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 109900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (name_len > 0) { 110000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* EIR Data type */ 110100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (name_len > 48) { 110200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg name_len = 48; 110300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg ptr[1] = EIR_NAME_SHORT; 110400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } else 110500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg ptr[1] = EIR_NAME_COMPLETE; 110600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 110700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* EIR Data length */ 110800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg ptr[0] = name_len + 1; 110900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1110fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg memcpy(ptr + 2, dev->name, name_len); 111100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 111200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg eir_len += (name_len + 2); 111300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg ptr += (name_len + 2); 111400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 111500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1116fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->tx_power != 0) { 111700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg *ptr++ = 2; 111800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg *ptr++ = EIR_TX_POWER; 1119fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg *ptr++ = (uint8_t) dev->tx_power; 112000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg eir_len += 3; 112100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 112200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1123fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->did_vendor != 0x0000) { 112400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint16_t source = 0x0002; 112500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg *ptr++ = 9; 112600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg *ptr++ = EIR_DEVICE_ID; 112700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg *ptr++ = (source & 0x00ff); 112800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg *ptr++ = (source & 0xff00) >> 8; 1129fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg *ptr++ = (dev->did_vendor & 0x00ff); 1130fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg *ptr++ = (dev->did_vendor & 0xff00) >> 8; 1131fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg *ptr++ = (dev->did_product & 0x00ff); 1132fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg *ptr++ = (dev->did_product & 0xff00) >> 8; 1133fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg *ptr++ = (dev->did_version & 0x00ff); 1134fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg *ptr++ = (dev->did_version & 0xff00) >> 8; 113500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg eir_len += 10; 113600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 113700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1138fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg adapter = manager_find_adapter(&dev->bdaddr); 113900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (adapter == NULL) 114000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return; 114100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 114200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg services = adapter_get_services(adapter); 114300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 114400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* Group all UUID16 types */ 114500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg for (list = services; list; list = list->next) { 114600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg sdp_record_t *rec = list->data; 114700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 114800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (rec->svclass.type != SDP_UUID16) 114900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg continue; 115000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 115100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (rec->svclass.value.uuid16 < 0x1100) 115200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg continue; 115300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 115400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (rec->svclass.value.uuid16 == PNP_INFO_SVCLASS_ID) 115500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg continue; 115600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 115700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* Stop if not enough space to put next UUID16 */ 115800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if ((eir_len + 2 + sizeof(uint16_t)) > EIR_DATA_LENGTH) { 115900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg truncated = TRUE; 116000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg break; 116100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 116200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 116300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* Check for duplicates */ 116400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg for (i = 0; i < uuid_count; i++) 116500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (uuid16[i] == rec->svclass.value.uuid16) 116600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg break; 116700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 116800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (i < uuid_count) 116900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg continue; 117000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 117100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uuid16[uuid_count++] = rec->svclass.value.uuid16; 117200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg eir_len += sizeof(uint16_t); 117300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 117400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 117500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (uuid_count > 0) { 117600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* EIR Data length */ 117700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg ptr[0] = (uuid_count * sizeof(uint16_t)) + 1; 117800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* EIR Data type */ 117900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg ptr[1] = truncated ? EIR_UUID16_SOME : EIR_UUID16_ALL; 118000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 118100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg ptr += 2; 118200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg eir_len += 2; 118300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 118400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg for (i = 0; i < uuid_count; i++) { 118500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg *ptr++ = (uuid16[i] & 0x00ff); 118600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg *ptr++ = (uuid16[i] & 0xff00) >> 8; 118700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 118800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 118900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 119000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* Group all UUID128 types */ 119100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (eir_len <= EIR_DATA_LENGTH - 2) 119200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg eir_generate_uuid128(services, ptr, &eir_len); 119300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg} 119400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 119500c2267405ff3416672401cf394f06017a6814c1Johan Hedbergstatic void update_ext_inquiry_response(int index) 119600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg{ 1197fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 119800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg write_ext_inquiry_response_cp cp; 119900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 120000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg DBG("hci%d", index); 120100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1202fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!(dev->features[6] & LMP_EXT_INQ)) 120300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return; 120400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1205fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->ssp_mode == 0) 120600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return; 120700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1208fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->cache_enable) 120900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return; 121000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 121100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg memset(&cp, 0, sizeof(cp)); 121200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 121300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg create_ext_inquiry_response(index, cp.data); 121400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1215fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (memcmp(cp.data, dev->eir, sizeof(cp.data)) == 0) 121600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return; 121700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1218fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg memcpy(dev->eir, cp.data, sizeof(cp.data)); 121900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1220fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, 122100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg OCF_WRITE_EXT_INQUIRY_RESPONSE, 122200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg WRITE_EXT_INQUIRY_RESPONSE_CP_SIZE, &cp) < 0) 122300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg error("Unable to write EIR data: %s (%d)", 122400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg strerror(errno), errno); 122500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg} 122600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 122719084de6a65e4dfad006eb0364eb68e7ced3b46cJohan Hedbergstatic void update_name(int index, const char *name) 122819084de6a65e4dfad006eb0364eb68e7ced3b46cJohan Hedberg{ 1229fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 123019084de6a65e4dfad006eb0364eb68e7ced3b46cJohan Hedberg struct btd_adapter *adapter; 123119084de6a65e4dfad006eb0364eb68e7ced3b46cJohan Hedberg 1232fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg adapter = manager_find_adapter(&dev->bdaddr); 123319084de6a65e4dfad006eb0364eb68e7ced3b46cJohan Hedberg if (adapter) 123419084de6a65e4dfad006eb0364eb68e7ced3b46cJohan Hedberg adapter_update_local_name(adapter, name); 123500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 123600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg update_ext_inquiry_response(index); 123719084de6a65e4dfad006eb0364eb68e7ced3b46cJohan Hedberg} 123819084de6a65e4dfad006eb0364eb68e7ced3b46cJohan Hedberg 1239fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedbergstatic void read_local_name_complete(int index, read_local_name_rp *rp) 1240fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg{ 1241fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 1242fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 12430e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d status %u", index, rp->status); 12440e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 1245fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg if (rp->status) 1246fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg return; 1247fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg 1248fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg memcpy(dev->name, rp->name, 248); 124900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1250fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->pending) { 125119084de6a65e4dfad006eb0364eb68e7ced3b46cJohan Hedberg update_name(index, (char *) rp->name); 1252fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg return; 1253fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg } 1254fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg 1255fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_clear_bit(PENDING_NAME, &dev->pending); 1256fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg 1257fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg DBG("Got name for hci%d", index); 1258fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg 1259fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->up) 12609f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg return; 12619f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg 12629f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg /* Even though it shouldn't happen (assuming the kernel behaves 12639f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg * properly) it seems like we might miss the very first 12649f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg * initialization commands that the kernel sends. So check for 12659f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg * it here (since read_local_name is one of the last init 12669f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg * commands) and resend the first ones if we haven't seen 12679f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg * their results yet */ 12689f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg 1269fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_test_bit(PENDING_FEATURES, &dev->pending)) 1270fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_INFO_PARAM, 12719f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg OCF_READ_LOCAL_FEATURES, 0, NULL); 12729f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg 1273fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_test_bit(PENDING_VERSION, &dev->pending)) 1274fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_INFO_PARAM, 12759f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg OCF_READ_LOCAL_VERSION, 0, NULL); 12769f524fe68a075edd9d0cfdbadea181c76cce4ff5Johan Hedberg 1277fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->pending) 12785c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg init_adapter(index); 1279fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg} 1280fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg 1281e47f4351bcea802ee23a9db237ecd4802894e97eJohan Hedbergstatic void read_tx_power_complete(int index, void *ptr) 1282e47f4351bcea802ee23a9db237ecd4802894e97eJohan Hedberg{ 1283fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 1284fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 1285e47f4351bcea802ee23a9db237ecd4802894e97eJohan Hedberg read_inq_response_tx_power_level_rp *rp = ptr; 1286e47f4351bcea802ee23a9db237ecd4802894e97eJohan Hedberg 12870e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d status %u", index, rp->status); 12880e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 1289e47f4351bcea802ee23a9db237ecd4802894e97eJohan Hedberg if (rp->status) 1290e47f4351bcea802ee23a9db237ecd4802894e97eJohan Hedberg return; 1291e47f4351bcea802ee23a9db237ecd4802894e97eJohan Hedberg 1292fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->tx_power = rp->level; 129300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg update_ext_inquiry_response(index); 1294e47f4351bcea802ee23a9db237ecd4802894e97eJohan Hedberg} 1295e47f4351bcea802ee23a9db237ecd4802894e97eJohan Hedberg 1296af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedbergstatic void read_simple_pairing_mode_complete(int index, void *ptr) 1297af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg{ 1298fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 1299af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg read_simple_pairing_mode_rp *rp = ptr; 1300af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg struct btd_adapter *adapter; 1301af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg 13020e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d status %u", index, rp->status); 13030e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 1304af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg if (rp->status) 1305af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg return; 1306af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg 1307fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->ssp_mode = rp->mode; 130800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg update_ext_inquiry_response(index); 130900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1310fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg adapter = manager_find_adapter(&dev->bdaddr); 1311af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg if (!adapter) { 1312af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg error("No matching adapter found"); 1313af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg return; 1314af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg } 1315af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg 1316af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg adapter_update_ssp_mode(adapter, rp->mode); 1317af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg} 1318af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg 13190e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedbergstatic void read_local_ext_features_complete(int index, 13205288199788ecb17183d6517da3062cd94692a900Johan Hedberg const read_local_ext_features_rp *rp) 13215288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1322fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 13235288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct btd_adapter *adapter; 13245288199788ecb17183d6517da3062cd94692a900Johan Hedberg 13250e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d status %u", index, rp->status); 13260e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 13275288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (rp->status) 13285288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 13295288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1330fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg adapter = manager_find_adapter(&dev->bdaddr); 13315288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (!adapter) { 13325288199788ecb17183d6517da3062cd94692a900Johan Hedberg error("No matching adapter found"); 13335288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 13345288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 13355288199788ecb17183d6517da3062cd94692a900Johan Hedberg 13365288199788ecb17183d6517da3062cd94692a900Johan Hedberg /* Local Extended feature page number is 1 */ 13375288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (rp->page_num != 1) 13385288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 13395288199788ecb17183d6517da3062cd94692a900Johan Hedberg 13405288199788ecb17183d6517da3062cd94692a900Johan Hedberg btd_adapter_update_local_ext_features(adapter, rp->features); 13415288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 13425288199788ecb17183d6517da3062cd94692a900Johan Hedberg 13435a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedbergstatic void read_bd_addr_complete(int index, read_bd_addr_rp *rp) 13445a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg{ 1345fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 1346fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 13470e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d status %u", index, rp->status); 13480e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 13495a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg if (rp->status) 13505a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg return; 13515a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg 1352fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg bacpy(&dev->bdaddr, &rp->bdaddr); 13535a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg 1354fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->pending) 13555a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg return; 13565a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg 1357fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_clear_bit(PENDING_BDADDR, &dev->pending); 13585a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg 135928c405b17a3131494c11599705885ae630c52ee2Johan Hedberg DBG("Got bdaddr for hci%d", index); 13605a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg 1361fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->pending && dev->up) 13625c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg init_adapter(index); 13635a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg} 13645a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg 136542bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void cmd_status(int index, void *ptr) 13665288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1367fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 13685288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_cmd_status *evt = ptr; 13695288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint16_t opcode = btohs(evt->opcode); 13705288199788ecb17183d6517da3062cd94692a900Johan Hedberg 13715288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (opcode == cmd_opcode_pack(OGF_LINK_CTL, OCF_INQUIRY)) 1372fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg start_inquiry(&dev->bdaddr, evt->status, FALSE); 13735288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 13745288199788ecb17183d6517da3062cd94692a900Johan Hedberg 137542bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic void read_scan_complete(int index, uint8_t status, void *ptr) 13765288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1377fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 13785288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct btd_adapter *adapter; 13795288199788ecb17183d6517da3062cd94692a900Johan Hedberg read_scan_enable_rp *rp = ptr; 13805288199788ecb17183d6517da3062cd94692a900Johan Hedberg 13810e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d status %u", index, status); 13820e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 1383fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg adapter = manager_find_adapter(&dev->bdaddr); 13845288199788ecb17183d6517da3062cd94692a900Johan Hedberg 13855288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (!adapter) { 13865288199788ecb17183d6517da3062cd94692a900Johan Hedberg error("Unable to find matching adapter"); 13875288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 13885288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 13895288199788ecb17183d6517da3062cd94692a900Johan Hedberg 13905288199788ecb17183d6517da3062cd94692a900Johan Hedberg adapter_mode_changed(adapter, rp->enable); 13915288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 13925288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1393914a9093c108cf67a1ef08bffc7db2e4c9a5b1b9Johan Hedbergstatic int write_class(int index, uint32_t class) 139400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg{ 1395fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 139600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg write_class_of_dev_cp cp; 139700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 139800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg DBG("hci%d class 0x%06x", index, class); 139900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 140000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg memcpy(cp.dev_class, &class, 3); 140100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1402fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, OCF_WRITE_CLASS_OF_DEV, 140300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg WRITE_CLASS_OF_DEV_CP_SIZE, &cp) < 0) 140400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return -errno; 140500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1406fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->pending_cod = class; 140700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 140800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return 0; 140900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg} 141000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 141100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg/* Limited Discoverable bit mask in CoD */ 141200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg#define LIMITED_BIT 0x002000 141300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 141400c2267405ff3416672401cf394f06017a6814c1Johan Hedbergstatic int hciops_set_limited_discoverable(int index, gboolean limited) 141500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg{ 1416fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 141700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg int num = (limited ? 2 : 1); 141800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint8_t lap[] = { 0x33, 0x8b, 0x9e, 0x00, 0x8b, 0x9e }; 141900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg write_current_iac_lap_cp cp; 142000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 142100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg DBG("hci%d limited %d", index, limited); 142200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 142300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* Check if limited bit needs to be set/reset */ 142400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (limited) 1425fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->wanted_cod |= LIMITED_BIT; 142600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg else 1427fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->wanted_cod &= ~LIMITED_BIT; 142800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 142900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* If we dont need the toggling, save an unnecessary CoD write */ 1430fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->pending_cod || dev->wanted_cod == dev->current_cod) 143100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return 0; 143200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 143300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* 143400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg * 1: giac 143500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg * 2: giac + liac 143600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg */ 143700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg memset(&cp, 0, sizeof(cp)); 143800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg cp.num_current_iac = num; 143900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg memcpy(&cp.lap, lap, num * 3); 144000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1441fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, OCF_WRITE_CURRENT_IAC_LAP, 144200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg (num * 3 + 1), &cp) < 0) 144300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return -errno; 144400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1445fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg return write_class(index, dev->wanted_cod); 144600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg} 144700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 144800c2267405ff3416672401cf394f06017a6814c1Johan Hedbergstatic void write_class_complete(int index, uint8_t status) 144900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg{ 1450fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 145100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg struct btd_adapter *adapter; 145200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 145300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (status) 145400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return; 145500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1456fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->pending_cod == 0) 145700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return; 145800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1459fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->current_cod = dev->pending_cod; 1460fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->pending_cod = 0; 146100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1462fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg adapter = manager_find_adapter(&dev->bdaddr); 146300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (adapter) 1464fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_adapter_class_changed(adapter, dev->current_cod); 146500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 146600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg update_ext_inquiry_response(index); 146700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1468fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->wanted_cod == dev->current_cod) 146900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return; 147000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 1471fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->wanted_cod & LIMITED_BIT && 1472fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg !(dev->current_cod & LIMITED_BIT)) 147300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg hciops_set_limited_discoverable(index, TRUE); 1474fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg else if (!(dev->wanted_cod & LIMITED_BIT) && 1475fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg (dev->current_cod & LIMITED_BIT)) 147600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg hciops_set_limited_discoverable(index, FALSE); 147700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg else 1478fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg write_class(index, dev->wanted_cod); 147900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg} 148000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 148142bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void cmd_complete(int index, void *ptr) 14825288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1483fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 14845288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_cmd_complete *evt = ptr; 14855288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint16_t opcode = btohs(evt->opcode); 14865288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint8_t status = *((uint8_t *) ptr + EVT_CMD_COMPLETE_SIZE); 14875288199788ecb17183d6517da3062cd94692a900Johan Hedberg 14885288199788ecb17183d6517da3062cd94692a900Johan Hedberg switch (opcode) { 1489be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg case cmd_opcode_pack(OGF_INFO_PARAM, OCF_READ_LOCAL_VERSION): 1490be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg ptr += sizeof(evt_cmd_complete); 1491be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg read_local_version_complete(index, ptr); 1492be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg break; 1493be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg case cmd_opcode_pack(OGF_INFO_PARAM, OCF_READ_LOCAL_FEATURES): 1494be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg ptr += sizeof(evt_cmd_complete); 1495be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg read_local_features_complete(index, ptr); 1496be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg break; 14975288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_INFO_PARAM, OCF_READ_LOCAL_EXT_FEATURES): 14985288199788ecb17183d6517da3062cd94692a900Johan Hedberg ptr += sizeof(evt_cmd_complete); 14990e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg read_local_ext_features_complete(index, ptr); 15005288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15015a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg case cmd_opcode_pack(OGF_INFO_PARAM, OCF_READ_BD_ADDR): 15025a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg ptr += sizeof(evt_cmd_complete); 15035a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg read_bd_addr_complete(index, ptr); 15045a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg break; 15055288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_LINK_CTL, OCF_PERIODIC_INQUIRY): 1506fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg start_inquiry(&dev->bdaddr, status, TRUE); 15075288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15085288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_LINK_CTL, OCF_EXIT_PERIODIC_INQUIRY): 1509fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg inquiry_complete(&dev->bdaddr, status, TRUE); 15105288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15115288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_LINK_CTL, OCF_INQUIRY_CANCEL): 1512fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg inquiry_complete(&dev->bdaddr, status, FALSE); 15135288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15145288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_HOST_CTL, OCF_WRITE_LE_HOST_SUPPORTED): 15152db4f654cb730adffe7b55044327f68808cd1c9dJohan Hedberg write_le_host_complete(index, status); 15165288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15175288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_LE_CTL, OCF_LE_SET_SCAN_ENABLE): 1518fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_le_set_scan_enable_complete(&dev->bdaddr, status); 15195288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15205288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_HOST_CTL, OCF_CHANGE_LOCAL_NAME): 1521bd7f8939b50a12418476245f9b5117801f858b02Johan Hedberg if (!status) 1522fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_HOST_CTL, 1523bd7f8939b50a12418476245f9b5117801f858b02Johan Hedberg OCF_READ_LOCAL_NAME, 0, 0); 15245288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15255288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_HOST_CTL, OCF_WRITE_SCAN_ENABLE): 1526fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_setscan_enable_complete(&dev->bdaddr); 15275288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15285288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_HOST_CTL, OCF_READ_SCAN_ENABLE): 15295288199788ecb17183d6517da3062cd94692a900Johan Hedberg ptr += sizeof(evt_cmd_complete); 153042bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg read_scan_complete(index, status, ptr); 15315288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15325288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_HOST_CTL, OCF_WRITE_CLASS_OF_DEV): 153300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg write_class_complete(index, status); 15345288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15355288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_HOST_CTL, OCF_WRITE_SIMPLE_PAIRING_MODE): 15367afa48dcf311926269dcfb8ec1a2a12c94eb2d5bJohan Hedberg if (!status) 1537fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_HOST_CTL, 15387afa48dcf311926269dcfb8ec1a2a12c94eb2d5bJohan Hedberg OCF_READ_SIMPLE_PAIRING_MODE, 0, NULL); 15395288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15405288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_HOST_CTL, OCF_READ_SIMPLE_PAIRING_MODE): 15415288199788ecb17183d6517da3062cd94692a900Johan Hedberg ptr += sizeof(evt_cmd_complete); 1542af56f3b6d5c0261d9faf8c95cf4da5b244a03caeJohan Hedberg read_simple_pairing_mode_complete(index, ptr); 15435288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15445288199788ecb17183d6517da3062cd94692a900Johan Hedberg case cmd_opcode_pack(OGF_HOST_CTL, OCF_READ_LOCAL_NAME): 15455288199788ecb17183d6517da3062cd94692a900Johan Hedberg ptr += sizeof(evt_cmd_complete); 1546fa472e0c7092af97d6f9d5c997003f443991aea9Johan Hedberg read_local_name_complete(index, ptr); 15475288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 1548e5828c7e30453232e930dbead0e359175dc1decfJohan Hedberg case cmd_opcode_pack(OGF_HOST_CTL, 1549e5828c7e30453232e930dbead0e359175dc1decfJohan Hedberg OCF_READ_INQ_RESPONSE_TX_POWER_LEVEL): 15505288199788ecb17183d6517da3062cd94692a900Johan Hedberg ptr += sizeof(evt_cmd_complete); 1551e47f4351bcea802ee23a9db237ecd4802894e97eJohan Hedberg read_tx_power_complete(index, ptr); 15525288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 15535288199788ecb17183d6517da3062cd94692a900Johan Hedberg }; 15545288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 15555288199788ecb17183d6517da3062cd94692a900Johan Hedberg 155642bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void remote_name_information(int index, void *ptr) 15575288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1558fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 15595288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_remote_name_req_complete *evt = ptr; 15605288199788ecb17183d6517da3062cd94692a900Johan Hedberg char name[MAX_NAME_LENGTH + 1]; 15615288199788ecb17183d6517da3062cd94692a900Johan Hedberg 15620e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d status %u", index, evt->status); 15630e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 15645288199788ecb17183d6517da3062cd94692a900Johan Hedberg memset(name, 0, sizeof(name)); 15655288199788ecb17183d6517da3062cd94692a900Johan Hedberg 15665288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (!evt->status) 15675288199788ecb17183d6517da3062cd94692a900Johan Hedberg memcpy(name, evt->name, MAX_NAME_LENGTH); 15685288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1569fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_remote_name(&dev->bdaddr, &evt->bdaddr, evt->status, name); 15705288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 15715288199788ecb17183d6517da3062cd94692a900Johan Hedberg 157242bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void remote_version_information(int index, void *ptr) 15735288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1574fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 15755288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_read_remote_version_complete *evt = ptr; 15765288199788ecb17183d6517da3062cd94692a900Johan Hedberg bdaddr_t dba; 15775288199788ecb17183d6517da3062cd94692a900Johan Hedberg 15780e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d status %u", index, evt->status); 15790e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 15805288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (evt->status) 15815288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 15825288199788ecb17183d6517da3062cd94692a900Johan Hedberg 158342bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg if (get_bdaddr(index, btohs(evt->handle), &dba) < 0) 15845288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 15855288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1586fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg write_version_info(&dev->bdaddr, &dba, btohs(evt->manufacturer), 15875288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt->lmp_ver, btohs(evt->lmp_subver)); 15885288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 15895288199788ecb17183d6517da3062cd94692a900Johan Hedberg 159042bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void inquiry_result(int index, int plen, void *ptr) 15915288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1592fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 15935288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint8_t num = *(uint8_t *) ptr++; 15945288199788ecb17183d6517da3062cd94692a900Johan Hedberg int i; 15955288199788ecb17183d6517da3062cd94692a900Johan Hedberg 15965288199788ecb17183d6517da3062cd94692a900Johan Hedberg for (i = 0; i < num; i++) { 15975288199788ecb17183d6517da3062cd94692a900Johan Hedberg inquiry_info *info = ptr; 159842bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg uint32_t class = info->dev_class[0] | 159942bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg (info->dev_class[1] << 8) | 160042bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg (info->dev_class[2] << 16); 16015288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1602fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_inquiry_result(&dev->bdaddr, &info->bdaddr, class, 160342bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg 0, NULL); 16045288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1605fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg update_lastseen(&dev->bdaddr, &info->bdaddr); 16065288199788ecb17183d6517da3062cd94692a900Johan Hedberg 16075288199788ecb17183d6517da3062cd94692a900Johan Hedberg ptr += INQUIRY_INFO_SIZE; 16085288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 16095288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 16105288199788ecb17183d6517da3062cd94692a900Johan Hedberg 161142bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void inquiry_result_with_rssi(int index, int plen, void *ptr) 16125288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1613fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 16145288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint8_t num = *(uint8_t *) ptr++; 16155288199788ecb17183d6517da3062cd94692a900Johan Hedberg int i; 16165288199788ecb17183d6517da3062cd94692a900Johan Hedberg 16175288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (!num) 16185288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 16195288199788ecb17183d6517da3062cd94692a900Johan Hedberg 16205288199788ecb17183d6517da3062cd94692a900Johan Hedberg if ((plen - 1) / num == INQUIRY_INFO_WITH_RSSI_AND_PSCAN_MODE_SIZE) { 16215288199788ecb17183d6517da3062cd94692a900Johan Hedberg for (i = 0; i < num; i++) { 16225288199788ecb17183d6517da3062cd94692a900Johan Hedberg inquiry_info_with_rssi_and_pscan_mode *info = ptr; 16235288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint32_t class = info->dev_class[0] 162442bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg | (info->dev_class[1] << 8) 162542bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg | (info->dev_class[2] << 16); 16265288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1627fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_inquiry_result(&dev->bdaddr, &info->bdaddr, 16285288199788ecb17183d6517da3062cd94692a900Johan Hedberg class, info->rssi, NULL); 16295288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1630fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg update_lastseen(&dev->bdaddr, &info->bdaddr); 16315288199788ecb17183d6517da3062cd94692a900Johan Hedberg 16325288199788ecb17183d6517da3062cd94692a900Johan Hedberg ptr += INQUIRY_INFO_WITH_RSSI_AND_PSCAN_MODE_SIZE; 16335288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 16345288199788ecb17183d6517da3062cd94692a900Johan Hedberg } else { 16355288199788ecb17183d6517da3062cd94692a900Johan Hedberg for (i = 0; i < num; i++) { 16365288199788ecb17183d6517da3062cd94692a900Johan Hedberg inquiry_info_with_rssi *info = ptr; 16375288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint32_t class = info->dev_class[0] 163842bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg | (info->dev_class[1] << 8) 163942bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg | (info->dev_class[2] << 16); 16405288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1641fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_inquiry_result(&dev->bdaddr, &info->bdaddr, 16425288199788ecb17183d6517da3062cd94692a900Johan Hedberg class, info->rssi, NULL); 16435288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1644fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg update_lastseen(&dev->bdaddr, &info->bdaddr); 16455288199788ecb17183d6517da3062cd94692a900Johan Hedberg 16465288199788ecb17183d6517da3062cd94692a900Johan Hedberg ptr += INQUIRY_INFO_WITH_RSSI_SIZE; 16475288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 16485288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 16495288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 16505288199788ecb17183d6517da3062cd94692a900Johan Hedberg 165142bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void extended_inquiry_result(int index, int plen, void *ptr) 16525288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1653fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 16545288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint8_t num = *(uint8_t *) ptr++; 16555288199788ecb17183d6517da3062cd94692a900Johan Hedberg int i; 16565288199788ecb17183d6517da3062cd94692a900Johan Hedberg 16575288199788ecb17183d6517da3062cd94692a900Johan Hedberg for (i = 0; i < num; i++) { 16585288199788ecb17183d6517da3062cd94692a900Johan Hedberg extended_inquiry_info *info = ptr; 16595288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint32_t class = info->dev_class[0] 166042bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg | (info->dev_class[1] << 8) 166142bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg | (info->dev_class[2] << 16); 16625288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1663fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_inquiry_result(&dev->bdaddr, &info->bdaddr, class, 16645288199788ecb17183d6517da3062cd94692a900Johan Hedberg info->rssi, info->data); 16655288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1666fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg update_lastseen(&dev->bdaddr, &info->bdaddr); 16675288199788ecb17183d6517da3062cd94692a900Johan Hedberg 16685288199788ecb17183d6517da3062cd94692a900Johan Hedberg ptr += EXTENDED_INQUIRY_INFO_SIZE; 16695288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 16705288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 16715288199788ecb17183d6517da3062cd94692a900Johan Hedberg 167242bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void remote_features_information(int index, void *ptr) 16735288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1674fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 16755288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_read_remote_features_complete *evt = ptr; 16765288199788ecb17183d6517da3062cd94692a900Johan Hedberg bdaddr_t dba; 16775288199788ecb17183d6517da3062cd94692a900Johan Hedberg 16780e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d status %u", index, evt->status); 16790e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 16805288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (evt->status) 16815288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 16825288199788ecb17183d6517da3062cd94692a900Johan Hedberg 168342bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg if (get_bdaddr(index, btohs(evt->handle), &dba) < 0) 16845288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 16855288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1686fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg write_features_info(&dev->bdaddr, &dba, evt->features, NULL); 16875288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 16885288199788ecb17183d6517da3062cd94692a900Johan Hedberg 168942bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void conn_complete(int index, void *ptr) 16905288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1691fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 16925288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_conn_complete *evt = ptr; 16935288199788ecb17183d6517da3062cd94692a900Johan Hedberg char filename[PATH_MAX]; 16945288199788ecb17183d6517da3062cd94692a900Johan Hedberg char local_addr[18], peer_addr[18], *str; 16955288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct btd_adapter *adapter; 16965288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1697fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg adapter = manager_find_adapter(&dev->bdaddr); 16985288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (!adapter) { 16995288199788ecb17183d6517da3062cd94692a900Johan Hedberg error("Unable to find matching adapter"); 17005288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 17015288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 17025288199788ecb17183d6517da3062cd94692a900Johan Hedberg 17035288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (evt->link_type != ACL_LINK) 17045288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 17055288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1706fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_conn_complete(&dev->bdaddr, evt->status, 170742bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg btohs(evt->handle), &evt->bdaddr); 17085288199788ecb17183d6517da3062cd94692a900Johan Hedberg 17095288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (evt->status) 17105288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 17115288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1712fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg update_lastused(&dev->bdaddr, &evt->bdaddr); 17135288199788ecb17183d6517da3062cd94692a900Johan Hedberg 17145288199788ecb17183d6517da3062cd94692a900Johan Hedberg /* check if the remote version needs be requested */ 1715fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg ba2str(&dev->bdaddr, local_addr); 17165288199788ecb17183d6517da3062cd94692a900Johan Hedberg ba2str(&evt->bdaddr, peer_addr); 17175288199788ecb17183d6517da3062cd94692a900Johan Hedberg 17185288199788ecb17183d6517da3062cd94692a900Johan Hedberg create_name(filename, sizeof(filename), STORAGEDIR, local_addr, 17195288199788ecb17183d6517da3062cd94692a900Johan Hedberg "manufacturers"); 17205288199788ecb17183d6517da3062cd94692a900Johan Hedberg 17215288199788ecb17183d6517da3062cd94692a900Johan Hedberg str = textfile_get(filename, peer_addr); 17225288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (!str) 17235288199788ecb17183d6517da3062cd94692a900Johan Hedberg btd_adapter_get_remote_version(adapter, btohs(evt->handle), 17245288199788ecb17183d6517da3062cd94692a900Johan Hedberg TRUE); 17255288199788ecb17183d6517da3062cd94692a900Johan Hedberg else 17265288199788ecb17183d6517da3062cd94692a900Johan Hedberg free(str); 17275288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 17285288199788ecb17183d6517da3062cd94692a900Johan Hedberg 17295f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demariostatic inline void le_conn_complete(int index, void *ptr) 17305f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario{ 1731fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 17325f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario evt_le_connection_complete *evt = ptr; 17335f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario char filename[PATH_MAX]; 17345f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario char local_addr[18], peer_addr[18], *str; 17355f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario struct btd_adapter *adapter; 17365f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario 1737fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg adapter = manager_find_adapter(&dev->bdaddr); 17385f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario if (!adapter) { 17395f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario error("Unable to find matching adapter"); 17405f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario return; 17415f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario } 17425f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario 1743fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_conn_complete(&dev->bdaddr, evt->status, 17445f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario btohs(evt->handle), &evt->peer_bdaddr); 17455f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario 17465f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario if (evt->status) 17475f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario return; 17485f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario 1749fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg update_lastused(&dev->bdaddr, &evt->peer_bdaddr); 17505f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario 17515f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario /* check if the remote version needs be requested */ 1752fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg ba2str(&dev->bdaddr, local_addr); 17535f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario ba2str(&evt->peer_bdaddr, peer_addr); 17545f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario 17555f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario create_name(filename, sizeof(filename), STORAGEDIR, local_addr, 17565f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario "manufacturers"); 17575f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario 17585f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario str = textfile_get(filename, peer_addr); 17595f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario if (!str) 17605f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario btd_adapter_get_remote_version(adapter, btohs(evt->handle), 17615f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario TRUE); 17625f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario else 17635f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario free(str); 17645f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario} 17655f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario 176642bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void disconn_complete(int index, void *ptr) 17675288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1768fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 17695288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_disconn_complete *evt = ptr; 17705288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1771fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_disconn_complete(&dev->bdaddr, evt->status, 177242bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg btohs(evt->handle), evt->reason); 17735288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 17745288199788ecb17183d6517da3062cd94692a900Johan Hedberg 177542bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void auth_complete(int index, void *ptr) 17765288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1777fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 17785288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_auth_complete *evt = ptr; 17795288199788ecb17183d6517da3062cd94692a900Johan Hedberg bdaddr_t dba; 17805288199788ecb17183d6517da3062cd94692a900Johan Hedberg 17810e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d status %u", index, evt->status); 17820e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 178342bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg if (get_bdaddr(index, btohs(evt->handle), &dba) < 0) 17845288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 17855288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1786fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_bonding_process_complete(&dev->bdaddr, &dba, evt->status); 17875288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 17885288199788ecb17183d6517da3062cd94692a900Johan Hedberg 178942bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void simple_pairing_complete(int index, void *ptr) 17905288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1791fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 17925288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_simple_pairing_complete *evt = ptr; 17935288199788ecb17183d6517da3062cd94692a900Johan Hedberg 17940e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d status %u", index, evt->status); 17950e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 1796fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_simple_pairing_complete(&dev->bdaddr, &evt->bdaddr, 179742bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg evt->status); 17985288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 17995288199788ecb17183d6517da3062cd94692a900Johan Hedberg 180042bb162ca16e92eac264127a88063cadf7d48af7Johan Hedbergstatic inline void conn_request(int index, void *ptr) 18015288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1802fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 18035288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_conn_request *evt = ptr; 18045288199788ecb17183d6517da3062cd94692a900Johan Hedberg uint32_t class = evt->dev_class[0] | (evt->dev_class[1] << 8) 18055288199788ecb17183d6517da3062cd94692a900Johan Hedberg | (evt->dev_class[2] << 16); 18065288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1807fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_remote_class(&dev->bdaddr, &evt->bdaddr, class); 18085288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 18095288199788ecb17183d6517da3062cd94692a900Johan Hedberg 18105f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demariostatic inline void le_advertising_report(int index, evt_le_meta_event *meta) 18115288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1812fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 18135288199788ecb17183d6517da3062cd94692a900Johan Hedberg le_advertising_info *info; 1814e430998efb9da9c89f1d94e3b6786a14aed834ebBruna Moreira uint8_t num, i; 18155288199788ecb17183d6517da3062cd94692a900Johan Hedberg 18165288199788ecb17183d6517da3062cd94692a900Johan Hedberg num = meta->data[0]; 18175288199788ecb17183d6517da3062cd94692a900Johan Hedberg info = (le_advertising_info *) (meta->data + 1); 18185288199788ecb17183d6517da3062cd94692a900Johan Hedberg 18195288199788ecb17183d6517da3062cd94692a900Johan Hedberg for (i = 0; i < num; i++) { 1820fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg btd_event_advertising_report(&dev->bdaddr, info); 1821e430998efb9da9c89f1d94e3b6786a14aed834ebBruna Moreira info = (le_advertising_info *) (info->data + info->length + 1); 18225288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 18235288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 18245288199788ecb17183d6517da3062cd94692a900Johan Hedberg 18255f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demariostatic inline void le_metaevent(int index, void *ptr) 18265f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario{ 18275f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario evt_le_meta_event *meta = ptr; 18285f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario 18295f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario DBG("hci%d LE Meta Event %u", index, meta->subevent); 18305f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario 18315f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario switch (meta->subevent) { 18325f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario case EVT_LE_ADVERTISING_REPORT: 18335f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario le_advertising_report(index, meta); 18345f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario break; 18355f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario 18365f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario case EVT_LE_CONN_COMPLETE: 18375f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario le_conn_complete(index, meta->data); 18385f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario break; 18395f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario } 18405f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario} 18415f9ebfaa84eacb59a47bcdd6c9479d8b94552414Sheldon Demario 184255694454017b04a416931a81964bb695f48b3d93Johan Hedbergstatic void stop_hci_dev(int index) 18435288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 1844fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 1845fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg GIOChannel *chan = dev->io; 18465288199788ecb17183d6517da3062cd94692a900Johan Hedberg 18475288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (!chan) 18485288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 18495288199788ecb17183d6517da3062cd94692a900Johan Hedberg 185055694454017b04a416931a81964bb695f48b3d93Johan Hedberg info("Stopping hci%d event socket", index); 18515288199788ecb17183d6517da3062cd94692a900Johan Hedberg 1852fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg g_source_remove(dev->watch_id); 1853fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg g_io_channel_unref(dev->io); 1854fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_close_dev(dev->sk); 1855fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg init_dev_info(index, -1, dev->registered); 18565288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 18575288199788ecb17183d6517da3062cd94692a900Johan Hedberg 18585288199788ecb17183d6517da3062cd94692a900Johan Hedbergstatic gboolean io_security_event(GIOChannel *chan, GIOCondition cond, 18595288199788ecb17183d6517da3062cd94692a900Johan Hedberg gpointer data) 18605288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 18615288199788ecb17183d6517da3062cd94692a900Johan Hedberg unsigned char buf[HCI_MAX_EVENT_SIZE], *ptr = buf; 186242bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg int type, index = GPOINTER_TO_INT(data); 1863fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 186442bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg struct hci_dev_info di; 18655288199788ecb17183d6517da3062cd94692a900Johan Hedberg size_t len; 18665288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_event_hdr *eh; 18675288199788ecb17183d6517da3062cd94692a900Johan Hedberg GIOError err; 18685288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt_cmd_status *evt; 18695288199788ecb17183d6517da3062cd94692a900Johan Hedberg 18705288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (cond & (G_IO_NVAL | G_IO_HUP | G_IO_ERR)) { 187155694454017b04a416931a81964bb695f48b3d93Johan Hedberg stop_hci_dev(index); 18725288199788ecb17183d6517da3062cd94692a900Johan Hedberg return FALSE; 18735288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 18745288199788ecb17183d6517da3062cd94692a900Johan Hedberg 18755288199788ecb17183d6517da3062cd94692a900Johan Hedberg if ((err = g_io_channel_read(chan, (gchar *) buf, sizeof(buf), &len))) { 18765288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (err == G_IO_ERROR_AGAIN) 18775288199788ecb17183d6517da3062cd94692a900Johan Hedberg return TRUE; 187855694454017b04a416931a81964bb695f48b3d93Johan Hedberg stop_hci_dev(index); 18795288199788ecb17183d6517da3062cd94692a900Johan Hedberg return FALSE; 18805288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 18815288199788ecb17183d6517da3062cd94692a900Johan Hedberg 18825288199788ecb17183d6517da3062cd94692a900Johan Hedberg type = *ptr++; 18835288199788ecb17183d6517da3062cd94692a900Johan Hedberg 18845288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (type != HCI_EVENT_PKT) 18855288199788ecb17183d6517da3062cd94692a900Johan Hedberg return TRUE; 18865288199788ecb17183d6517da3062cd94692a900Johan Hedberg 18875288199788ecb17183d6517da3062cd94692a900Johan Hedberg eh = (hci_event_hdr *) ptr; 18885288199788ecb17183d6517da3062cd94692a900Johan Hedberg ptr += HCI_EVENT_HDR_SIZE; 18895288199788ecb17183d6517da3062cd94692a900Johan Hedberg 189042bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg memset(&di, 0, sizeof(di)); 189142bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg if (hci_devinfo(index, &di) == 0) { 1892fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg bacpy(&dev->bdaddr, &di.bdaddr); 18935288199788ecb17183d6517da3062cd94692a900Johan Hedberg 189442bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg if (ignore_device(&di)) 189542bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg return TRUE; 189642bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg } 189755694454017b04a416931a81964bb695f48b3d93Johan Hedberg 18985288199788ecb17183d6517da3062cd94692a900Johan Hedberg switch (eh->evt) { 18995288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_CMD_STATUS: 190042bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg cmd_status(index, ptr); 19015288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19025288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19035288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_CMD_COMPLETE: 190442bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg cmd_complete(index, ptr); 19055288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19065288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19075288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_REMOTE_NAME_REQ_COMPLETE: 190842bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg remote_name_information(index, ptr); 19095288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19105288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19115288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_READ_REMOTE_VERSION_COMPLETE: 191242bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg remote_version_information(index, ptr); 19135288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19145288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19155288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_READ_REMOTE_FEATURES_COMPLETE: 191642bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg remote_features_information(index, ptr); 19175288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19185288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19195288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_REMOTE_HOST_FEATURES_NOTIFY: 192042bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg remote_features_notify(index, ptr); 19215288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19225288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19235288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_INQUIRY_COMPLETE: 19245288199788ecb17183d6517da3062cd94692a900Johan Hedberg evt = (evt_cmd_status *) ptr; 1925fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg inquiry_complete(&dev->bdaddr, evt->status, FALSE); 19265288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19275288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19285288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_INQUIRY_RESULT: 192942bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg inquiry_result(index, eh->plen, ptr); 19305288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19315288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19325288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_INQUIRY_RESULT_WITH_RSSI: 193342bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg inquiry_result_with_rssi(index, eh->plen, ptr); 19345288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19355288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19365288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_EXTENDED_INQUIRY_RESULT: 193742bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg extended_inquiry_result(index, eh->plen, ptr); 19385288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19395288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19405288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_CONN_COMPLETE: 194142bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg conn_complete(index, ptr); 19425288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19435288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19445288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_DISCONN_COMPLETE: 194542bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg disconn_complete(index, ptr); 19465288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19475288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19485288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_AUTH_COMPLETE: 194942bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg auth_complete(index, ptr); 19505288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19515288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19525288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_SIMPLE_PAIRING_COMPLETE: 195342bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg simple_pairing_complete(index, ptr); 19545288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19555288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19565288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_CONN_REQUEST: 195742bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg conn_request(index, ptr); 19585288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19595288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_LE_META_EVENT: 196042bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg le_metaevent(index, ptr); 19615288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19625288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_PIN_CODE_REQ: 196342bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg pin_code_request(index, (bdaddr_t *) ptr); 19645288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19655288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19665288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_LINK_KEY_REQ: 196742bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg link_key_request(index, (bdaddr_t *) ptr); 19685288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19695288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19705288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_LINK_KEY_NOTIFY: 197142bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg link_key_notify(index, ptr); 19725288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19735288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19745288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_RETURN_LINK_KEYS: 197542bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg return_link_keys(index, ptr); 19765288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19775288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19785288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_IO_CAPABILITY_REQUEST: 197942bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg io_capa_request(index, ptr); 19805288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19815288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19825288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_IO_CAPABILITY_RESPONSE: 198342bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg io_capa_response(index, ptr); 19845288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19855288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19865288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_USER_CONFIRM_REQUEST: 198742bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg user_confirm_request(index, ptr); 19885288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19895288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19905288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_USER_PASSKEY_REQUEST: 199142bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg user_passkey_request(index, ptr); 19925288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19935288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19945288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_USER_PASSKEY_NOTIFY: 199542bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg user_passkey_notify(index, ptr); 19965288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 19975288199788ecb17183d6517da3062cd94692a900Johan Hedberg 19985288199788ecb17183d6517da3062cd94692a900Johan Hedberg case EVT_REMOTE_OOB_DATA_REQUEST: 199942bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg remote_oob_data_request(index, ptr); 20005288199788ecb17183d6517da3062cd94692a900Johan Hedberg break; 20015288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 20025288199788ecb17183d6517da3062cd94692a900Johan Hedberg 20035288199788ecb17183d6517da3062cd94692a900Johan Hedberg return TRUE; 20045288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 20055288199788ecb17183d6517da3062cd94692a900Johan Hedberg 20065a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedbergstatic void start_hci_dev(int index) 20075288199788ecb17183d6517da3062cd94692a900Johan Hedberg{ 2008fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2009fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg GIOChannel *chan = dev->io; 2010e5828c7e30453232e930dbead0e359175dc1decfJohan Hedberg GIOCondition cond; 20115288199788ecb17183d6517da3062cd94692a900Johan Hedberg struct hci_filter flt; 20125288199788ecb17183d6517da3062cd94692a900Johan Hedberg 20135288199788ecb17183d6517da3062cd94692a900Johan Hedberg if (chan) 20145288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 20155288199788ecb17183d6517da3062cd94692a900Johan Hedberg 20165a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg info("Listening for HCI events on hci%d", index); 20175288199788ecb17183d6517da3062cd94692a900Johan Hedberg 20185288199788ecb17183d6517da3062cd94692a900Johan Hedberg /* Set filter */ 20195288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_clear(&flt); 20205288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_ptype(HCI_EVENT_PKT, &flt); 20215288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_CMD_STATUS, &flt); 20225288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_CMD_COMPLETE, &flt); 20235288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_PIN_CODE_REQ, &flt); 20245288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_LINK_KEY_REQ, &flt); 20255288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_LINK_KEY_NOTIFY, &flt); 20265288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_RETURN_LINK_KEYS, &flt); 20275288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_IO_CAPABILITY_REQUEST, &flt); 20285288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_IO_CAPABILITY_RESPONSE, &flt); 20295288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_USER_CONFIRM_REQUEST, &flt); 20305288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_USER_PASSKEY_REQUEST, &flt); 20315288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_REMOTE_OOB_DATA_REQUEST, &flt); 20325288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_USER_PASSKEY_NOTIFY, &flt); 20335288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_KEYPRESS_NOTIFY, &flt); 20345288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_SIMPLE_PAIRING_COMPLETE, &flt); 20355288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_AUTH_COMPLETE, &flt); 20365288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_REMOTE_NAME_REQ_COMPLETE, &flt); 20375288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_READ_REMOTE_VERSION_COMPLETE, &flt); 20385288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_READ_REMOTE_FEATURES_COMPLETE, &flt); 20395288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_REMOTE_HOST_FEATURES_NOTIFY, &flt); 20405288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_INQUIRY_COMPLETE, &flt); 20415288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_INQUIRY_RESULT, &flt); 20425288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_INQUIRY_RESULT_WITH_RSSI, &flt); 20435288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_EXTENDED_INQUIRY_RESULT, &flt); 20445288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_CONN_REQUEST, &flt); 20455288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_CONN_COMPLETE, &flt); 20465288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_DISCONN_COMPLETE, &flt); 20475288199788ecb17183d6517da3062cd94692a900Johan Hedberg hci_filter_set_event(EVT_LE_META_EVENT, &flt); 2048fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (setsockopt(dev->sk, SOL_HCI, HCI_FILTER, &flt, sizeof(flt)) < 0) { 20495288199788ecb17183d6517da3062cd94692a900Johan Hedberg error("Can't set filter on hci%d: %s (%d)", 20505a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg index, strerror(errno), errno); 20515288199788ecb17183d6517da3062cd94692a900Johan Hedberg return; 20525288199788ecb17183d6517da3062cd94692a900Johan Hedberg } 20535288199788ecb17183d6517da3062cd94692a900Johan Hedberg 2054fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg chan = g_io_channel_unix_new(dev->sk); 2055e5828c7e30453232e930dbead0e359175dc1decfJohan Hedberg cond = G_IO_IN | G_IO_NVAL | G_IO_HUP | G_IO_ERR; 2056fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->watch_id = g_io_add_watch_full(chan, G_PRIORITY_LOW, cond, 2057e5828c7e30453232e930dbead0e359175dc1decfJohan Hedberg io_security_event, 2058e5828c7e30453232e930dbead0e359175dc1decfJohan Hedberg GINT_TO_POINTER(index), NULL); 2059fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->io = chan; 2060fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->pin_length = -1; 20615288199788ecb17183d6517da3062cd94692a900Johan Hedberg 20625288199788ecb17183d6517da3062cd94692a900Johan Hedberg} 20635288199788ecb17183d6517da3062cd94692a900Johan Hedberg 20645288199788ecb17183d6517da3062cd94692a900Johan Hedberg/* End of HCI event callbacks */ 20655288199788ecb17183d6517da3062cd94692a900Johan Hedberg 2066a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsodestatic gboolean child_exit(GIOChannel *io, GIOCondition cond, void *user_data) 2067a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode{ 2068a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode int status, fd = g_io_channel_unix_get_fd(io); 2069a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode pid_t child_pid; 2070a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2071a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode if (read(fd, &child_pid, sizeof(child_pid)) != sizeof(child_pid)) { 2072a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode error("child_exit: unable to read child pid from pipe"); 2073a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode return TRUE; 2074a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode } 2075a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2076a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode if (waitpid(child_pid, &status, 0) != child_pid) 2077a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode error("waitpid(%d) failed", child_pid); 2078a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode else 20798e58667ef0a4cda88ac64137728da28d8fdf3f0fGustavo F. Padovan DBG("child %d exited", child_pid); 2080a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2081a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode return TRUE; 2082a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode} 2083a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2084a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsodestatic void at_child_exit(void) 2085a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode{ 2086a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode pid_t pid = getpid(); 2087a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2088a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode if (write(child_pipe[1], &pid, sizeof(pid)) != sizeof(pid)) 2089a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode error("unable to write to child pipe"); 2090a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode} 2091a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2092fccdf4a50765ef5a2dbde00d95f65e94ce0a543bJohan Hedbergstatic void device_devup_setup(int index) 2093a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode{ 2094fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2095a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode struct hci_dev_info di; 20965a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg read_stored_link_key_cp cp; 2097a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 20980e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 20990e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2100ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsode if (hci_devinfo(index, &di) < 0) 2101a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode return; 2102a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 210365bf1321203b55b11167ac8b869da28a86ce49d2David Scherba if (ignore_device(&di)) 2104a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode return; 2105a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2106fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg bacpy(&dev->bdaddr, &di.bdaddr); 2107fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg memcpy(dev->features, di.features, 8); 2108a352058752e541539b09e55124d411a534cc14afJohan Hedberg 2109a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode /* Set page timeout */ 2110a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode if ((main_opts.flags & (1 << HCID_SET_PAGETO))) { 2111a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode write_page_timeout_cp cp; 2112a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2113a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode cp.timeout = htobs(main_opts.pageto); 2114fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_HOST_CTL, OCF_WRITE_PAGE_TIMEOUT, 2115a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode WRITE_PAGE_TIMEOUT_CP_SIZE, &cp); 2116a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode } 2117a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 21185a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg bacpy(&cp.bdaddr, BDADDR_ANY); 21195a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg cp.read_all = 1; 2120fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_HOST_CTL, OCF_READ_STORED_LINK_KEY, 21215a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg READ_STORED_LINK_KEY_CP_SIZE, (void *) &cp); 2122fccdf4a50765ef5a2dbde00d95f65e94ce0a543bJohan Hedberg 2123fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->pending) 21245c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg init_adapter(index); 2125a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode} 2126a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2127be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedbergstatic void init_pending(int index) 2128be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg{ 2129fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2130fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 2131fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_set_bit(PENDING_BDADDR, &dev->pending); 2132fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_set_bit(PENDING_VERSION, &dev->pending); 2133fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_set_bit(PENDING_FEATURES, &dev->pending); 2134fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_set_bit(PENDING_NAME, &dev->pending); 2135be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg} 2136be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 2137ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsodestatic void init_device(int index) 2138a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode{ 2139a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode struct hci_dev_req dr; 2140c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg int dd; 21416844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg pid_t pid; 21426844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg 21430e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 21440e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 21456844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg dd = hci_open_dev(index); 21466844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg if (dd < 0) { 21476844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg error("Unable to open hci%d: %s (%d)", index, 21486844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg strerror(errno), errno); 21496844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return; 21506844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg } 21516844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg 21526844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg if (index > max_dev) { 21536844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg max_dev = index; 2154ef071f94a765fa0b0e96935abef7508c76cace00Johan Hedberg devs = g_realloc(devs, sizeof(devs[0]) * (max_dev + 1)); 21556844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg } 21566844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg 21575c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg init_dev_info(index, dd, FALSE); 2158be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg init_pending(index); 21595a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg start_hci_dev(index); 2160a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2161a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode /* Do initialization in the separate process */ 2162a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode pid = fork(); 2163a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode switch (pid) { 2164a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode case 0: 2165a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode atexit(at_child_exit); 2166a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode break; 2167a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode case -1: 2168a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode error("Fork failed. Can't init device hci%d: %s (%d)", 2169c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg index, strerror(errno), errno); 2170a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode default: 21718e58667ef0a4cda88ac64137728da28d8fdf3f0fGustavo F. Padovan DBG("child %d forked", pid); 2172a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode return; 2173a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode } 2174a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2175a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode memset(&dr, 0, sizeof(dr)); 2176ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsode dr.dev_id = index; 2177a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2178a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode /* Set link mode */ 2179a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode dr.dev_opt = main_opts.link_mode; 2180c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg if (ioctl(dd, HCISETLINKMODE, (unsigned long) &dr) < 0) 2181a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode error("Can't set link mode on hci%d: %s (%d)", 2182ad737e6427a5bfb09bc26c4af071a7aa7045f0acJohan Hedberg index, strerror(errno), errno); 2183a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2184a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode /* Start HCI device */ 2185ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsode if (ioctl(dd, HCIDEVUP, index) < 0 && errno != EALREADY) { 2186a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode error("Can't init device hci%d: %s (%d)", 2187ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsode index, strerror(errno), errno); 2188a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode goto fail; 2189a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode } 2190a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2191a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode hci_close_dev(dd); 2192a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode exit(0); 2193a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2194a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsodefail: 2195a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode hci_close_dev(dd); 2196a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode exit(1); 2197a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode} 2198a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2199ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsodestatic void device_devreg_setup(int index) 2200a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode{ 2201a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode struct hci_dev_info di; 2202a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 22030e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 22040e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2205ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsode init_device(index); 2206a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2207a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode memset(&di, 0, sizeof(di)); 2208a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2209ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsode if (hci_devinfo(index, &di) < 0) 2210a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode return; 2211a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 22125c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg if (ignore_device(&di)) 22135c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg return; 2214a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2215fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg devs[index].already_up = hci_test_bit(HCI_UP, &di.flags); 2216a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode} 2217a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2218ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsodestatic void device_event(int event, int index) 2219a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode{ 2220a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode switch (event) { 2221a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode case HCI_DEV_REG: 2222ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsode info("HCI dev %d registered", index); 2223ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsode device_devreg_setup(index); 2224fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (devs[index].already_up) 22255c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg device_event(HCI_DEV_UP, index); 2226a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode break; 2227a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2228a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode case HCI_DEV_UNREG: 2229ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsode info("HCI dev %d unregistered", index); 223055694454017b04a416931a81964bb695f48b3d93Johan Hedberg stop_hci_dev(index); 2231fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (devs[index].registered) 22325c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg btd_manager_unregister_adapter(index); 2233a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode break; 2234a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2235a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode case HCI_DEV_UP: 2236ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsode info("HCI dev %d up", index); 2237fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg devs[index].up = TRUE; 2238ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsode device_devup_setup(index); 2239a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode break; 2240a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2241a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode case HCI_DEV_DOWN: 2242ffff055ee50ab909b61e2b904bfa71dde42ee5c7Alok Barsode info("HCI dev %d down", index); 2243fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg devs[index].up = FALSE; 2244fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg devs[index].pending_cod = 0; 2245fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg devs[index].cache_enable = TRUE; 2246fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!devs[index].pending) { 22475a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg manager_stop_adapter(index); 2248be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg init_pending(index); 22495a58cd8ac9a93cfde63371872cd89ff8b190c52cJohan Hedberg } 2250a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode break; 2251a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode } 2252a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode} 2253cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 22545c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedbergstatic int hciops_stop_inquiry(int index) 22555c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg{ 2256fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 22575c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg struct hci_dev_info di; 22585c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg int err; 22595c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 22605c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg DBG("hci%d", index); 22615c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 22625c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg if (hci_devinfo(index, &di) < 0) 22635c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg return -errno; 22645c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 22655c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg if (hci_test_bit(HCI_INQUIRY, &di.flags)) 2266fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = hci_send_cmd(dev->sk, OGF_LINK_CTL, 22675c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg OCF_INQUIRY_CANCEL, 0, 0); 22685c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg else 2269fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = hci_send_cmd(dev->sk, OGF_LINK_CTL, 22705c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg OCF_EXIT_PERIODIC_INQUIRY, 0, 0); 22715c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg if (err < 0) 22725c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg err = -errno; 22735c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 22745c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg return err; 22755c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg} 22765c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 2277f92841301d17330745d286ed35249a3a51c1e4e4Johan Hedbergstatic gboolean init_known_adapters(gpointer user_data) 227894e91856179a268805256055ffd5155d1468b99cAlok Barsode{ 2279cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode struct hci_dev_list_req *dl; 2280cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode struct hci_dev_req *dr; 2281f92841301d17330745d286ed35249a3a51c1e4e4Johan Hedberg int i, err, ctl = GPOINTER_TO_INT(user_data); 2282ad737e6427a5bfb09bc26c4af071a7aa7045f0acJohan Hedberg size_t req_size; 2283cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 22840e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG(""); 22850e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2286ad737e6427a5bfb09bc26c4af071a7aa7045f0acJohan Hedberg req_size = HCI_MAX_DEV * sizeof(struct hci_dev_req) + sizeof(uint16_t); 2287ad737e6427a5bfb09bc26c4af071a7aa7045f0acJohan Hedberg 2288ad737e6427a5bfb09bc26c4af071a7aa7045f0acJohan Hedberg dl = g_try_malloc0(req_size); 2289cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode if (!dl) { 2290ad737e6427a5bfb09bc26c4af071a7aa7045f0acJohan Hedberg error("Can't allocate devlist buffer"); 2291f92841301d17330745d286ed35249a3a51c1e4e4Johan Hedberg return FALSE; 2292cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode } 2293cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2294cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode dl->dev_num = HCI_MAX_DEV; 2295cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode dr = dl->dev_req; 2296cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2297ad737e6427a5bfb09bc26c4af071a7aa7045f0acJohan Hedberg if (ioctl(ctl, HCIGETDEVLIST, dl) < 0) { 2298c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg err = -errno; 2299ad737e6427a5bfb09bc26c4af071a7aa7045f0acJohan Hedberg error("Can't get device list: %s (%d)", strerror(-err), -err); 230083003660808c30390f21c569a5ba7dbdd8344a41Claudio Takahasi g_free(dl); 2301f92841301d17330745d286ed35249a3a51c1e4e4Johan Hedberg return FALSE; 2302cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode } 2303cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2304cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode for (i = 0; i < dl->dev_num; i++, dr++) { 2305fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev; 2306fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 2307cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode device_event(HCI_DEV_REG, dr->dev_id); 2308cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2309fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev = &devs[dr->dev_id]; 2310fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 2311fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->already_up = hci_test_bit(HCI_UP, &dr->dev_opt); 23125c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 2313fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->already_up) 2314be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg continue; 2315be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg 23165c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg hciops_stop_inquiry(dr->dev_id); 23175c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 2318fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->pending = 0; 2319fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_set_bit(PENDING_VERSION, &dev->pending); 2320fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_INFO_PARAM, 2321be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg OCF_READ_LOCAL_VERSION, 0, NULL); 2322be3d4f5e4c621718de0dc0fb4f947635682f1a95Johan Hedberg device_event(HCI_DEV_UP, dr->dev_id); 2323cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode } 2324cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2325cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode g_free(dl); 2326f92841301d17330745d286ed35249a3a51c1e4e4Johan Hedberg 2327f92841301d17330745d286ed35249a3a51c1e4e4Johan Hedberg return FALSE; 232894e91856179a268805256055ffd5155d1468b99cAlok Barsode} 232994e91856179a268805256055ffd5155d1468b99cAlok Barsode 2330cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsodestatic gboolean io_stack_event(GIOChannel *chan, GIOCondition cond, 2331cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode gpointer data) 2332cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode{ 2333cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode unsigned char buf[HCI_MAX_FRAME_SIZE], *ptr; 2334cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode evt_stack_internal *si; 2335cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode evt_si_device *sd; 2336cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode hci_event_hdr *eh; 2337cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode int type; 2338cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode size_t len; 2339cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode GIOError err; 2340cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2341cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode ptr = buf; 2342cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2343cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode err = g_io_channel_read(chan, (gchar *) buf, sizeof(buf), &len); 2344cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode if (err) { 2345cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode if (err == G_IO_ERROR_AGAIN) 2346cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode return TRUE; 2347cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2348cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode error("Read from control socket failed: %s (%d)", 2349ad737e6427a5bfb09bc26c4af071a7aa7045f0acJohan Hedberg strerror(errno), errno); 2350cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode return FALSE; 2351cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode } 2352cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2353cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode type = *ptr++; 2354cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2355cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode if (type != HCI_EVENT_PKT) 2356cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode return TRUE; 2357cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2358cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode eh = (hci_event_hdr *) ptr; 2359cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode if (eh->evt != EVT_STACK_INTERNAL) 2360cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode return TRUE; 2361cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2362cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode ptr += HCI_EVENT_HDR_SIZE; 2363cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2364cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode si = (evt_stack_internal *) ptr; 2365cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode switch (si->type) { 2366cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode case EVT_SI_DEVICE: 2367cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode sd = (void *) &si->data; 2368cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode device_event(sd->event, sd->dev_id); 2369cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode break; 2370cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode } 2371cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2372cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode return TRUE; 2373cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode} 2374cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 237534c4239984722c169e3e821ec5ca7c88528827bdAlok Barsodestatic int hciops_setup(void) 2376cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode{ 2377cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode struct sockaddr_hci addr; 2378cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode struct hci_filter flt; 2379a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode GIOChannel *ctl_io, *child_io; 238018e8b33f0d60b9e1f4a6521720e14e9db1cda01dJohan Hedberg int sock, err; 238118e8b33f0d60b9e1f4a6521720e14e9db1cda01dJohan Hedberg 23820e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG(""); 23830e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 238418e8b33f0d60b9e1f4a6521720e14e9db1cda01dJohan Hedberg if (child_pipe[0] != -1) 238518e8b33f0d60b9e1f4a6521720e14e9db1cda01dJohan Hedberg return -EALREADY; 2386cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2387a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode if (pipe(child_pipe) < 0) { 2388c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg err = -errno; 2389c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg error("pipe(): %s (%d)", strerror(-err), -err); 2390c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg return err; 2391a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode } 2392a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2393a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode child_io = g_io_channel_unix_new(child_pipe[0]); 2394a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode g_io_channel_set_close_on_unref(child_io, TRUE); 23958b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg child_io_id = g_io_add_watch(child_io, 23968b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg G_IO_IN | G_IO_ERR | G_IO_HUP | G_IO_NVAL, 23978b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg child_exit, NULL); 2398a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode g_io_channel_unref(child_io); 2399a557e08d8c3e39439e922b1267d13c8cf34e37eaAlok Barsode 2400cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode /* Create and bind HCI socket */ 2401cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode sock = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI); 2402cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode if (sock < 0) { 2403c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg err = -errno; 2404c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg error("Can't open HCI socket: %s (%d)", strerror(-err), 2405c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg -err); 2406c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg return err; 2407cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode } 2408cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2409cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode /* Set filter */ 2410cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode hci_filter_clear(&flt); 2411cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode hci_filter_set_ptype(HCI_EVENT_PKT, &flt); 2412cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode hci_filter_set_event(EVT_STACK_INTERNAL, &flt); 24136844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg if (setsockopt(sock, SOL_HCI, HCI_FILTER, &flt, sizeof(flt)) < 0) { 2414c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg err = -errno; 2415c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg error("Can't set filter: %s (%d)", strerror(-err), -err); 2416c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg return err; 2417cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode } 2418cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2419cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode memset(&addr, 0, sizeof(addr)); 2420cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode addr.hci_family = AF_BLUETOOTH; 2421cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode addr.hci_dev = HCI_DEV_NONE; 24226844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg if (bind(sock, (struct sockaddr *) &addr, sizeof(addr)) < 0) { 2423c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg err = -errno; 24246844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg error("Can't bind HCI socket: %s (%d)", strerror(-err), -err); 2425c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg return err; 2426cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode } 2427cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2428cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode ctl_io = g_io_channel_unix_new(sock); 2429cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode g_io_channel_set_close_on_unref(ctl_io, TRUE); 2430cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 24318b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg ctl_io_id = g_io_add_watch(ctl_io, G_IO_IN, io_stack_event, NULL); 2432cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2433cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode g_io_channel_unref(ctl_io); 2434cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 2435f92841301d17330745d286ed35249a3a51c1e4e4Johan Hedberg g_idle_add(init_known_adapters, GINT_TO_POINTER(sock)); 2436f92841301d17330745d286ed35249a3a51c1e4e4Johan Hedberg 2437f92841301d17330745d286ed35249a3a51c1e4e4Johan Hedberg return 0; 2438cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode} 2439cce9e28ea1ea1cbf5f9e9027c949632ce67cd27fAlok Barsode 244034c4239984722c169e3e821ec5ca7c88528827bdAlok Barsodestatic void hciops_cleanup(void) 244134c4239984722c169e3e821ec5ca7c88528827bdAlok Barsode{ 24426844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg int i; 24436844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg 24440e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG(""); 24450e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 24466844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg for (i = 0; i <= max_dev; i++) { 2447fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[i]; 2448fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 2449fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->sk >= 0) 2450fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_close_dev(dev->sk); 24516844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg } 24526844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg 24536844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg g_free(devs); 24546844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg devs = NULL; 24556844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg max_dev = -1; 24566844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg 24578b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg if (child_io_id) { 24588b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg g_source_remove(child_io_id); 24598b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg child_io_id = 0; 24608b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg } 24618b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg 24628b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg if (ctl_io_id) { 24638b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg g_source_remove(ctl_io_id); 24648b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg ctl_io_id = 0; 24658b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg } 24668b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg 24678b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg if (child_pipe[0] >= 0) { 24688b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg close(child_pipe[0]); 24698b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg child_pipe[0] = -1; 24708b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg } 24718b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg 24728b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg if (child_pipe[1] >= 0) { 24738b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg close(child_pipe[1]); 24748b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg child_pipe[1] = -1; 24758b9bab24d5e35777c6838a48d487355ad790a5f4Johan Hedberg } 247634c4239984722c169e3e821ec5ca7c88528827bdAlok Barsode} 247734c4239984722c169e3e821ec5ca7c88528827bdAlok Barsode 247863ff6738abc6bf21becbbfde583062502e7728a6Johan Hedbergstatic int hciops_power_on(int index, gboolean discoverable) 2479076540a14a41acf8eba0bdb65e2dd5d4d42c7946Alok Barsode{ 2480fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 24816844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg int err; 2482076540a14a41acf8eba0bdb65e2dd5d4d42c7946Alok Barsode 24830e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 24840e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2485fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (ioctl(dev->sk, HCIDEVUP, index) == 0) 24866844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 2487076540a14a41acf8eba0bdb65e2dd5d4d42c7946Alok Barsode 24886844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg if (errno == EALREADY) 24896844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 2490076540a14a41acf8eba0bdb65e2dd5d4d42c7946Alok Barsode 24916844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg err = -errno; 24926844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg error("Can't init device hci%d: %s (%d)", 24936844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg index, strerror(-err), -err); 2494076540a14a41acf8eba0bdb65e2dd5d4d42c7946Alok Barsode 2495c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg return err; 2496076540a14a41acf8eba0bdb65e2dd5d4d42c7946Alok Barsode} 2497076540a14a41acf8eba0bdb65e2dd5d4d42c7946Alok Barsode 24985c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedbergstatic int hciops_set_connectable(int index, gboolean connectable) 24998b000e17009d5b6772ab3b4367881dfcef763e7eAlok Barsode{ 2500fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 25015c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg uint8_t mode; 25028b000e17009d5b6772ab3b4367881dfcef763e7eAlok Barsode 25035c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg if (connectable) 25045c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg mode = SCAN_PAGE; 25055c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg else 25065c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg mode = 0x00; 25075c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 25085c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg DBG("hci%d connectable %d", index, connectable); 25090e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2510fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, 25116844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg OCF_WRITE_SCAN_ENABLE, 1, &mode) < 0) 25126844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 25138b000e17009d5b6772ab3b4367881dfcef763e7eAlok Barsode 25146844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 25158b000e17009d5b6772ab3b4367881dfcef763e7eAlok Barsode} 25168b000e17009d5b6772ab3b4367881dfcef763e7eAlok Barsode 251700c2267405ff3416672401cf394f06017a6814c1Johan Hedbergstatic int hciops_set_dev_class(int index, uint8_t major, uint8_t minor) 2518d2a6bf00afbaeef82f9210639150e1f93cb44589Alok Barsode{ 2519fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 252000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg int err; 2521d2a6bf00afbaeef82f9210639150e1f93cb44589Alok Barsode 25225c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg DBG("hci%d major %u minor %u", index, major, minor); 25235c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 252400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* Update only the major and minor class bits keeping remaining bits 252500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg * intact*/ 2526fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->wanted_cod &= 0xffe000; 2527fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->wanted_cod |= ((major & 0x1f) << 8) | minor; 2528d2a6bf00afbaeef82f9210639150e1f93cb44589Alok Barsode 2529fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->wanted_cod == dev->current_cod || 2530fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->cache_enable || dev->pending_cod) 253100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return 0; 25320e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2533fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg DBG("Changing Major/Minor class to 0x%06x", dev->wanted_cod); 2534eeba5fdb9c807191893b9e82cb4952e23df3ca56Alok Barsode 2535fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = write_class(index, dev->wanted_cod); 253600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (err < 0) 253700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg error("Adapter class update failed: %s (%d)", 253800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg strerror(-err), -err); 2539d2a6bf00afbaeef82f9210639150e1f93cb44589Alok Barsode 254000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return err; 2541eeba5fdb9c807191893b9e82cb4952e23df3ca56Alok Barsode} 2542eeba5fdb9c807191893b9e82cb4952e23df3ca56Alok Barsode 25433af792e57b7ccb82d3139748a2b3c6b44d2e7ce2Claudio Takahasistatic int hciops_start_inquiry(int index, uint8_t length, gboolean periodic) 2544a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode{ 2545fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2546a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode uint8_t lap[3] = { 0x33, 0x8b, 0x9e }; 25476844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg int err; 2548a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode 25490e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d length %u periodic %d", index, length, periodic); 25500e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2551a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode if (periodic) { 2552a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode periodic_inquiry_cp cp; 2553a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode 2554a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode memset(&cp, 0, sizeof(cp)); 2555a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode memcpy(&cp.lap, lap, 3); 2556a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode cp.max_period = htobs(24); 2557a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode cp.min_period = htobs(16); 2558388cdea43870fe5c5163cfbe96d3218111ba39b5Claudio Takahasi cp.length = length; 2559a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode cp.num_rsp = 0x00; 2560a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode 2561fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = hci_send_cmd(dev->sk, OGF_LINK_CTL, 25626844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg OCF_PERIODIC_INQUIRY, 25636844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg PERIODIC_INQUIRY_CP_SIZE, &cp); 2564a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode } else { 2565a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode inquiry_cp inq_cp; 2566a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode 2567a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode memset(&inq_cp, 0, sizeof(inq_cp)); 2568a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode memcpy(&inq_cp.lap, lap, 3); 2569388cdea43870fe5c5163cfbe96d3218111ba39b5Claudio Takahasi inq_cp.length = length; 2570a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode inq_cp.num_rsp = 0x00; 2571a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode 2572fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = hci_send_cmd(dev->sk, OGF_LINK_CTL, 25736844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg OCF_INQUIRY, INQUIRY_CP_SIZE, &inq_cp); 2574a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode } 2575a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode 2576a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode if (err < 0) 2577a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode err = -errno; 2578a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode 2579a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode return err; 2580a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode} 2581a67cf482f872ae7c87de9478a471cd1e478d688fAlok Barsode 25823ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasistatic int le_set_scan_enable(int index, uint8_t enable) 258370cd37db7cdadd72b0cd4c7e3e1b329b79e0d868Claudio Takahasi{ 2584fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 25853ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi le_set_scan_enable_cp cp; 25863ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi 25870e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d enable %u", index, enable); 25880e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 25893ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi memset(&cp, 0, sizeof(cp)); 25903ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi cp.enable = enable; 25913ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi cp.filter_dup = 0; 259270cd37db7cdadd72b0cd4c7e3e1b329b79e0d868Claudio Takahasi 2593fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_LE_CTL, OCF_LE_SET_SCAN_ENABLE, 25943ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi LE_SET_SCAN_ENABLE_CP_SIZE, &cp) < 0) 25956844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 259670cd37db7cdadd72b0cd4c7e3e1b329b79e0d868Claudio Takahasi 25976844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 259870cd37db7cdadd72b0cd4c7e3e1b329b79e0d868Claudio Takahasi} 259970cd37db7cdadd72b0cd4c7e3e1b329b79e0d868Claudio Takahasi 26003ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasistatic int hciops_start_scanning(int index) 260170cd37db7cdadd72b0cd4c7e3e1b329b79e0d868Claudio Takahasi{ 2602fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 26033ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi le_set_scan_parameters_cp cp; 26043ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi 26050e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 26060e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 26073ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi memset(&cp, 0, sizeof(cp)); 26083ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi cp.type = 0x01; /* Active scanning */ 26093ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi cp.interval = htobs(0x0010); 26103ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi cp.window = htobs(0x0010); 26113ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi cp.own_bdaddr_type = 0; /* Public address */ 26123ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi cp.filter = 0; /* Accept all adv packets */ 26133ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi 2614fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_LE_CTL, OCF_LE_SET_SCAN_PARAMETERS, 26153ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi LE_SET_SCAN_PARAMETERS_CP_SIZE, &cp) < 0) 261670cd37db7cdadd72b0cd4c7e3e1b329b79e0d868Claudio Takahasi return -errno; 261770cd37db7cdadd72b0cd4c7e3e1b329b79e0d868Claudio Takahasi 26183ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi return le_set_scan_enable(index, 1); 26193ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi} 26203ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi 26213ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasistatic int hciops_stop_scanning(int index) 26223ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi{ 26230e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 26240e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 26253ef2b1cae64036f074908a927803a45a86e65f04Claudio Takahasi return le_set_scan_enable(index, 0); 262670cd37db7cdadd72b0cd4c7e3e1b329b79e0d868Claudio Takahasi} 262770cd37db7cdadd72b0cd4c7e3e1b329b79e0d868Claudio Takahasi 2628ef876daebf32cbe65fb4d9ec6fb1ffead60086eaAlok Barsodestatic int hciops_resolve_name(int index, bdaddr_t *bdaddr) 2629ef876daebf32cbe65fb4d9ec6fb1ffead60086eaAlok Barsode{ 2630fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2631ef876daebf32cbe65fb4d9ec6fb1ffead60086eaAlok Barsode remote_name_req_cp cp; 26320e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char addr[18]; 26330e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 26340e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(bdaddr, addr); 26350e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d dba %s", index, addr); 2636ef876daebf32cbe65fb4d9ec6fb1ffead60086eaAlok Barsode 2637ef876daebf32cbe65fb4d9ec6fb1ffead60086eaAlok Barsode memset(&cp, 0, sizeof(cp)); 2638ef876daebf32cbe65fb4d9ec6fb1ffead60086eaAlok Barsode bacpy(&cp.bdaddr, bdaddr); 2639ef876daebf32cbe65fb4d9ec6fb1ffead60086eaAlok Barsode cp.pscan_rep_mode = 0x02; 2640ef876daebf32cbe65fb4d9ec6fb1ffead60086eaAlok Barsode 2641fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_LINK_CTL, OCF_REMOTE_NAME_REQ, 26426844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg REMOTE_NAME_REQ_CP_SIZE, &cp) < 0) 26436844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 2644ef876daebf32cbe65fb4d9ec6fb1ffead60086eaAlok Barsode 26456844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 2646ef876daebf32cbe65fb4d9ec6fb1ffead60086eaAlok Barsode} 2647ef876daebf32cbe65fb4d9ec6fb1ffead60086eaAlok Barsode 2648164ccf9a6641fe646d8476f6b860d5ff4905632bAlok Barsodestatic int hciops_set_name(int index, const char *name) 2649164ccf9a6641fe646d8476f6b860d5ff4905632bAlok Barsode{ 2650fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2651164ccf9a6641fe646d8476f6b860d5ff4905632bAlok Barsode change_local_name_cp cp; 2652164ccf9a6641fe646d8476f6b860d5ff4905632bAlok Barsode 26530e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d, name %s", index, name); 26540e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2655164ccf9a6641fe646d8476f6b860d5ff4905632bAlok Barsode memset(&cp, 0, sizeof(cp)); 2656164ccf9a6641fe646d8476f6b860d5ff4905632bAlok Barsode strncpy((char *) cp.name, name, sizeof(cp.name)); 2657164ccf9a6641fe646d8476f6b860d5ff4905632bAlok Barsode 2658fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, OCF_CHANGE_LOCAL_NAME, 26596844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg CHANGE_LOCAL_NAME_CP_SIZE, &cp) < 0) 26606844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 2661164ccf9a6641fe646d8476f6b860d5ff4905632bAlok Barsode 2662fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg memcpy(dev->name, cp.name, 248); 266300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg update_ext_inquiry_response(index); 266400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 26656844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 2666164ccf9a6641fe646d8476f6b860d5ff4905632bAlok Barsode} 2667164ccf9a6641fe646d8476f6b860d5ff4905632bAlok Barsode 2668b96f44db8e91325968a0149595b2522d4a22481aAlok Barsodestatic int hciops_cancel_resolve_name(int index, bdaddr_t *bdaddr) 2669b96f44db8e91325968a0149595b2522d4a22481aAlok Barsode{ 2670fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2671b96f44db8e91325968a0149595b2522d4a22481aAlok Barsode remote_name_req_cancel_cp cp; 26720e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char addr[18]; 26730e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 26740e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(bdaddr, addr); 26750e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d dba %s", index, addr); 2676b96f44db8e91325968a0149595b2522d4a22481aAlok Barsode 2677b96f44db8e91325968a0149595b2522d4a22481aAlok Barsode memset(&cp, 0, sizeof(cp)); 2678b96f44db8e91325968a0149595b2522d4a22481aAlok Barsode bacpy(&cp.bdaddr, bdaddr); 2679b96f44db8e91325968a0149595b2522d4a22481aAlok Barsode 2680fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_LINK_CTL, OCF_REMOTE_NAME_REQ_CANCEL, 26816844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg REMOTE_NAME_REQ_CANCEL_CP_SIZE, &cp) < 0) 26826844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 2683b96f44db8e91325968a0149595b2522d4a22481aAlok Barsode 26846844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 2685b96f44db8e91325968a0149595b2522d4a22481aAlok Barsode} 2686b96f44db8e91325968a0149595b2522d4a22481aAlok Barsode 268761f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliystatic int hciops_fast_connectable(int index, gboolean enable) 268861f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy{ 2689fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 269061f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy write_page_activity_cp cp; 269161f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy uint8_t type; 269261f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy 26930e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d enable %d", index, enable); 26940e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 269561f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy if (enable) { 269661f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy type = PAGE_SCAN_TYPE_INTERLACED; 269761f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy cp.interval = 0x0024; /* 22.5 msec page scan interval */ 269861f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy } else { 269961f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy type = PAGE_SCAN_TYPE_STANDARD; /* default */ 270061f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy cp.interval = 0x0800; /* default 1.28 sec page scan */ 270161f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy } 270261f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy 270361f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy cp.window = 0x0012; /* default 11.25 msec page scan window */ 270461f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy 2705fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, OCF_WRITE_PAGE_ACTIVITY, 270661f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy WRITE_PAGE_ACTIVITY_CP_SIZE, &cp) < 0) 27076844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 2708fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg else if (hci_send_cmd(dev->sk, OGF_HOST_CTL, 27096844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg OCF_WRITE_PAGE_SCAN_TYPE, 1, &type) < 0) 27106844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 271161f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy 27126844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 271361f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy} 271461f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy 27155bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuterstatic int hciops_read_clock(int index, int handle, int which, int timeout, 2716ad737e6427a5bfb09bc26c4af071a7aa7045f0acJohan Hedberg uint32_t *clock, uint16_t *accuracy) 27175bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter{ 2718fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2719fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 27200e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d handle %d which %d timeout %d", index, handle, which, 27210e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg timeout); 27220e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2723fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_read_clock(dev->sk, handle, which, clock, accuracy, 27246844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg timeout) < 0) 27256844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 27265bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter 27276844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 27285bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter} 27295bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter 27305bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuterstatic int hciops_conn_handle(int index, const bdaddr_t *bdaddr, int *handle) 27315bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter{ 2732fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 27335bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter struct hci_conn_info_req *cr; 27340e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char addr[18]; 2735fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg int err; 27360e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 27370e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(bdaddr, addr); 27380e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d dba %s", index, addr); 27395bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter 27405bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter cr = g_malloc0(sizeof(*cr) + sizeof(struct hci_conn_info)); 27415bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter bacpy(&cr->bdaddr, bdaddr); 27425bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter cr->type = ACL_LINK; 27435bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter 2744fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (ioctl(dev->sk, HCIGETCONNINFO, (unsigned long) cr) < 0) { 2745c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg err = -errno; 2746c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg goto fail; 2747c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg } 27485bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter 27496844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg err = 0; 2750c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedberg *handle = htobs(cr->conn_info->handle); 27515bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter 2752c67ba167cc642c34b4b85abbe3a9866cb00c0e57Johan Hedbergfail: 27535bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter g_free(cr); 27545bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter return err; 27555bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter} 27565bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter 2757b5c556ef59a9a8318b239453c3d4a8aad951689fJohan Hedbergstatic int hciops_read_bdaddr(int index, bdaddr_t *bdaddr) 2758b5c556ef59a9a8318b239453c3d4a8aad951689fJohan Hedberg{ 2759fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2760fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 27610e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 2762fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 2763fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg bacpy(bdaddr, &dev->bdaddr); 2764fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 27656844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 2766b5c556ef59a9a8318b239453c3d4a8aad951689fJohan Hedberg} 2767b5c556ef59a9a8318b239453c3d4a8aad951689fJohan Hedberg 2768885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedbergstatic int hciops_block_device(int index, bdaddr_t *bdaddr) 2769885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg{ 2770fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 27710e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char addr[18]; 27720e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 27730e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(bdaddr, addr); 27740e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d dba %s", index, addr); 27750e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2776fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (ioctl(dev->sk, HCIBLOCKADDR, bdaddr) < 0) 2777885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg return -errno; 2778885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg 27796844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 2780885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg} 2781885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg 2782885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedbergstatic int hciops_unblock_device(int index, bdaddr_t *bdaddr) 2783885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg{ 2784fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 27850e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char addr[18]; 27860e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 27870e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(bdaddr, addr); 27880e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d dba %s", index, addr); 27890e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2790fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (ioctl(dev->sk, HCIUNBLOCKADDR, bdaddr) < 0) 2791885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg return -errno; 2792885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg 27936844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 2794885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg} 2795885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg 2796f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedbergstatic int hciops_get_conn_list(int index, GSList **conns) 2797f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg{ 2798fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2799f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg struct hci_conn_list_req *cl; 2800f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg struct hci_conn_info *ci; 28016844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg int err, i; 2802f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg 28030e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 28040e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2805f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg cl = g_malloc0(10 * sizeof(*ci) + sizeof(*cl)); 2806f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg 2807f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg cl->dev_id = index; 2808f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg cl->conn_num = 10; 2809f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg ci = cl->conn_info; 2810f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg 2811fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (ioctl(dev->sk, HCIGETCONNLIST, cl) < 0) { 2812f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg err = -errno; 2813f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg goto fail; 2814f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg } 2815f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg 2816f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg err = 0; 2817f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg *conns = NULL; 2818f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg 2819f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg for (i = 0; i < cl->conn_num; i++, ci++) 2820f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg *conns = g_slist_append(*conns, g_memdup(ci, sizeof(*ci))); 2821f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg 2822f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedbergfail: 2823f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg g_free(cl); 2824f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg return err; 2825f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg} 2826f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg 2827e38fdde63c8f385b99bf17c9e5794e7f08575f7eJohan Hedbergstatic int hciops_read_local_version(int index, struct hci_version *ver) 2828e38fdde63c8f385b99bf17c9e5794e7f08575f7eJohan Hedberg{ 2829fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2830fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 28310e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 2832fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 2833fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg memcpy(ver, &dev->ver, sizeof(*ver)); 2834fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 28356844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 2836e38fdde63c8f385b99bf17c9e5794e7f08575f7eJohan Hedberg} 2837e38fdde63c8f385b99bf17c9e5794e7f08575f7eJohan Hedberg 283848e6007a98222853a0e1bcbbd6ac17a37098bb49Johan Hedbergstatic int hciops_read_local_features(int index, uint8_t *features) 283948e6007a98222853a0e1bcbbd6ac17a37098bb49Johan Hedberg{ 2840fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2841fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 28420e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 2843fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 2844fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg memcpy(features, dev->features, 8); 2845fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 28466844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 284748e6007a98222853a0e1bcbbd6ac17a37098bb49Johan Hedberg} 284848e6007a98222853a0e1bcbbd6ac17a37098bb49Johan Hedberg 284906dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedbergstatic int hciops_disconnect(int index, uint16_t handle) 285006dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedberg{ 2851fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 285206dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedberg disconnect_cp cp; 285306dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedberg 28540e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d handle %u", index, handle); 28550e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 285606dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedberg memset(&cp, 0, sizeof(cp)); 285706dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedberg cp.handle = htobs(handle); 285806dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedberg cp.reason = HCI_OE_USER_ENDED_CONNECTION; 285906dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedberg 2860fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_LINK_CTL, OCF_DISCONNECT, 286106dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedberg DISCONNECT_CP_SIZE, &cp) < 0) 28626844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 286306dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedberg 28646844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 286506dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedberg} 286606dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedberg 28671bf7ec6b5c5a786775813650a6ef00f47b4d11ecJohan Hedbergstatic int hciops_remove_bonding(int index, bdaddr_t *bdaddr) 28681bf7ec6b5c5a786775813650a6ef00f47b4d11ecJohan Hedberg{ 2869fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 287073c8e7ac377f0f6ea0df6396b96cb9e8a11eb070Johan Hedberg delete_stored_link_key_cp cp; 28710e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char addr[18]; 28720e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 28730e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(bdaddr, addr); 28740e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d dba %s", index, addr); 28751bf7ec6b5c5a786775813650a6ef00f47b4d11ecJohan Hedberg 287673c8e7ac377f0f6ea0df6396b96cb9e8a11eb070Johan Hedberg memset(&cp, 0, sizeof(cp)); 287773c8e7ac377f0f6ea0df6396b96cb9e8a11eb070Johan Hedberg bacpy(&cp.bdaddr, bdaddr); 287873c8e7ac377f0f6ea0df6396b96cb9e8a11eb070Johan Hedberg 28791bf7ec6b5c5a786775813650a6ef00f47b4d11ecJohan Hedberg /* Delete the link key from the Bluetooth chip */ 2880fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, OCF_DELETE_STORED_LINK_KEY, 288173c8e7ac377f0f6ea0df6396b96cb9e8a11eb070Johan Hedberg DELETE_STORED_LINK_KEY_CP_SIZE, &cp) < 0) 28826844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 28831bf7ec6b5c5a786775813650a6ef00f47b4d11ecJohan Hedberg 28846844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 28851bf7ec6b5c5a786775813650a6ef00f47b4d11ecJohan Hedberg} 28861bf7ec6b5c5a786775813650a6ef00f47b4d11ecJohan Hedberg 2887c3ebed5a7d7e6146e7dfb97f6597222f1f9f0e71Johan Hedbergstatic int hciops_request_authentication(int index, uint16_t handle) 2888424ffb26405690b9d9653a9418a9c4d332a85176Johan Hedberg{ 2889fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2890424ffb26405690b9d9653a9418a9c4d332a85176Johan Hedberg auth_requested_cp cp; 2891424ffb26405690b9d9653a9418a9c4d332a85176Johan Hedberg 28920e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d handle %u", index, handle); 2893424ffb26405690b9d9653a9418a9c4d332a85176Johan Hedberg 2894424ffb26405690b9d9653a9418a9c4d332a85176Johan Hedberg memset(&cp, 0, sizeof(cp)); 2895424ffb26405690b9d9653a9418a9c4d332a85176Johan Hedberg cp.handle = htobs(handle); 2896424ffb26405690b9d9653a9418a9c4d332a85176Johan Hedberg 2897fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_LINK_CTL, OCF_AUTH_REQUESTED, 2898c3ebed5a7d7e6146e7dfb97f6597222f1f9f0e71Johan Hedberg AUTH_REQUESTED_CP_SIZE, &cp) < 0) 28996844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 2900424ffb26405690b9d9653a9418a9c4d332a85176Johan Hedberg 29016844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 2902424ffb26405690b9d9653a9418a9c4d332a85176Johan Hedberg} 2903424ffb26405690b9d9653a9418a9c4d332a85176Johan Hedberg 2904e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedbergstatic int hciops_pincode_reply(int index, bdaddr_t *bdaddr, const char *pin) 2905e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg{ 2906fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 29070e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char addr[18]; 29086844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg int err; 2909e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg 29100e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(bdaddr, addr); 29110e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d dba %s", index, addr); 29120e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2913e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg if (pin) { 2914e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg pin_code_reply_cp pr; 2915e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg size_t len = strlen(pin); 2916e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg 2917fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->pin_length = len; 291842bb162ca16e92eac264127a88063cadf7d48af7Johan Hedberg 2919e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg memset(&pr, 0, sizeof(pr)); 2920e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg bacpy(&pr.bdaddr, bdaddr); 2921e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg memcpy(pr.pin_code, pin, len); 2922e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg pr.pin_len = len; 2923fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = hci_send_cmd(dev->sk, OGF_LINK_CTL, 29246844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg OCF_PIN_CODE_REPLY, 2925e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg PIN_CODE_REPLY_CP_SIZE, &pr); 2926e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg } else 2927fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = hci_send_cmd(dev->sk, OGF_LINK_CTL, 2928e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg OCF_PIN_CODE_NEG_REPLY, 6, bdaddr); 2929e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg 29306844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg if (err < 0) 29316844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg err = -errno; 2932e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg 2933e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg return err; 2934e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg} 2935e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg 2936df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedbergstatic int hciops_confirm_reply(int index, bdaddr_t *bdaddr, gboolean success) 2937df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg{ 2938fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 2939df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg user_confirm_reply_cp cp; 29400e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char addr[18]; 29410e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg int err; 29420e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 29430e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(bdaddr, addr); 29440e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d dba %s success %d", index, addr, success); 2945df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg 2946df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg memset(&cp, 0, sizeof(cp)); 2947df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg bacpy(&cp.bdaddr, bdaddr); 2948df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg 2949df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg if (success) 2950fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = hci_send_cmd(dev->sk, OGF_LINK_CTL, 29516844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg OCF_USER_CONFIRM_REPLY, 2952df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg USER_CONFIRM_REPLY_CP_SIZE, &cp); 2953df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg else 2954fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = hci_send_cmd(dev->sk, OGF_LINK_CTL, 2955df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg OCF_USER_CONFIRM_NEG_REPLY, 2956df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg USER_CONFIRM_REPLY_CP_SIZE, &cp); 2957df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg 29586844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg if (err < 0) 29596844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg err = -errno; 2960df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg 2961df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg return err; 2962df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg} 2963df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg 2964889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedbergstatic int hciops_passkey_reply(int index, bdaddr_t *bdaddr, uint32_t passkey) 2965889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg{ 2966fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 29670e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char addr[18]; 29686844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg int err; 2969889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg 29700e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(bdaddr, addr); 29710e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d dba %s", index, addr); 29720e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 2973889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg if (passkey != INVALID_PASSKEY) { 2974889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg user_passkey_reply_cp cp; 2975889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg 2976889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg memset(&cp, 0, sizeof(cp)); 2977889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg bacpy(&cp.bdaddr, bdaddr); 2978889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg cp.passkey = passkey; 2979889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg 2980fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = hci_send_cmd(dev->sk, OGF_LINK_CTL, 29816844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg OCF_USER_PASSKEY_REPLY, 2982889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg USER_PASSKEY_REPLY_CP_SIZE, &cp); 2983889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg } else 2984fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = hci_send_cmd(dev->sk, OGF_LINK_CTL, 2985889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg OCF_USER_PASSKEY_NEG_REPLY, 6, bdaddr); 2986889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg 29876844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg if (err < 0) 29886844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg err = -errno; 2989889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg 2990889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg return err; 2991889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg} 2992889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg 29934b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedbergstatic int hciops_get_auth_info(int index, bdaddr_t *bdaddr, uint8_t *auth) 29944b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg{ 2995fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 29964b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg struct hci_auth_info_req req; 29970e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg char addr[18]; 29980e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 29990e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg ba2str(bdaddr, addr); 30000e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d dba %s", index, addr); 30014b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg 30024b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg memset(&req, 0, sizeof(req)); 30034b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg bacpy(&req.bdaddr, bdaddr); 30044b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg 3005fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (ioctl(dev->sk, HCIGETAUTHINFO, (unsigned long) &req) < 0) 30066844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 30074b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg 30084b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg if (auth) 30094b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg *auth = req.type; 30104b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg 30116844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 30124b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg} 30134b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg 3014f8b7d84e2cceed2f113d1688c87326ea2505cd16Johan Hedbergstatic int hciops_read_scan_enable(int index) 3015f8b7d84e2cceed2f113d1688c87326ea2505cd16Johan Hedberg{ 3016fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 3017fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 30180e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d", index); 30190e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 3020fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, OCF_READ_SCAN_ENABLE, 30216844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg 0, NULL) < 0) 3022f8b7d84e2cceed2f113d1688c87326ea2505cd16Johan Hedberg return -errno; 3023f8b7d84e2cceed2f113d1688c87326ea2505cd16Johan Hedberg 30246844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 3025f8b7d84e2cceed2f113d1688c87326ea2505cd16Johan Hedberg} 3026f8b7d84e2cceed2f113d1688c87326ea2505cd16Johan Hedberg 30275c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedbergstatic int hciops_enable_le(int index) 30287ff8fd32ebaec606c8ee9d063a277eeba7352f5fClaudio Takahasi{ 3029fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 30307ff8fd32ebaec606c8ee9d063a277eeba7352f5fClaudio Takahasi write_le_host_supported_cp cp; 30317ff8fd32ebaec606c8ee9d063a277eeba7352f5fClaudio Takahasi 30325c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg DBG("hci%d", index); 30335c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 3034fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!(dev->features[4] & LMP_LE)) 30355c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg return -ENOTSUP; 30360e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 30375c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg cp.le = 0x01; 3038fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg cp.simul = (dev->features[6] & LMP_LE_BREDR) ? 0x01 : 0x00; 30397ff8fd32ebaec606c8ee9d063a277eeba7352f5fClaudio Takahasi 3040fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (hci_send_cmd(dev->sk, OGF_HOST_CTL, 30416844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg OCF_WRITE_LE_HOST_SUPPORTED, 30426844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg WRITE_LE_HOST_SUPPORTED_CP_SIZE, &cp) < 0) 30436844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return -errno; 30447ff8fd32ebaec606c8ee9d063a277eeba7352f5fClaudio Takahasi 30456844ac4ce59e05b8857f18fa620adf42479d6aa5Johan Hedberg return 0; 30467ff8fd32ebaec606c8ee9d063a277eeba7352f5fClaudio Takahasi} 30477ff8fd32ebaec606c8ee9d063a277eeba7352f5fClaudio Takahasi 3048646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedbergstruct remote_version_req { 3049646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg int index; 3050646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg uint16_t handle; 3051646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg}; 3052646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg 3053646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedbergstatic gboolean get_remote_version(gpointer user_data) 3054646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg{ 3055646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg struct remote_version_req *req = user_data; 3056fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[req->index]; 3057646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg read_remote_version_cp cp; 3058646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg 30590e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d handle %u", req->index, req->handle); 30600e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 3061646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg memset(&cp, 0, sizeof(cp)); 3062646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg cp.handle = htobs(req->handle); 3063646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg 3064fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg hci_send_cmd(dev->sk, OGF_LINK_CTL, OCF_READ_REMOTE_VERSION, 3065646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg READ_REMOTE_VERSION_CP_SIZE, &cp); 3066646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg 3067646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg return FALSE; 3068646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg} 3069646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg 3070646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedbergstatic int hciops_get_remote_version(int index, uint16_t handle, 3071646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg gboolean delayed) 3072646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg{ 3073646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg struct remote_version_req *req; 3074646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg 30750e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG("hci%d handle %u delayed %d", index, handle, delayed); 30760e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg 3077646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg req = g_new0(struct remote_version_req, 1); 3078646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg req->handle = handle; 3079646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg req->index = index; 3080646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg 3081646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg if (!delayed) { 3082646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg get_remote_version(req); 3083646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg g_free(req); 3084646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg return 0; 3085646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg } 3086646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg 3087646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg g_timeout_add_seconds_full(G_PRIORITY_DEFAULT, 1, get_remote_version, 3088646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg req, g_free); 3089646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg 3090646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg return 0; 3091646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg} 3092646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg 309300c2267405ff3416672401cf394f06017a6814c1Johan Hedbergstatic int set_service_classes(int index, uint8_t value) 309400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg{ 3095fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 309600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg int err; 309700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 30985c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg DBG("hci%d value %u", index, value); 30995c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 310000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* Update only the service class, keep the limited bit, 310100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg * major/minor class bits intact */ 3102fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->wanted_cod &= 0x00ffff; 3103fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->wanted_cod |= (value << 16); 310400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 310500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* If the cache is enabled or an existing CoD write is in progress 310600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg * just bail out */ 3107fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->cache_enable || dev->pending_cod) 310800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return 0; 310900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 311000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* If we already have the CoD we want, update EIR and return */ 3111fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->current_cod == dev->wanted_cod) { 311200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg update_ext_inquiry_response(index); 311300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return 0; 311400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 311500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 3116fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg DBG("Changing service classes to 0x%06x", dev->wanted_cod); 311700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 3118fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg err = write_class(index, dev->wanted_cod); 311900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (err < 0) 312000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg error("Adapter class update failed: %s (%d)", 312100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg strerror(-err), -err); 312200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 312300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return err; 312400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg} 312500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 312600c2267405ff3416672401cf394f06017a6814c1Johan Hedbergstatic int hciops_services_updated(int index) 312700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg{ 3128fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 312900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg struct btd_adapter *adapter; 313000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg sdp_list_t *list; 313100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg uint8_t val = 0; 313200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 313300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg DBG("hci%d", index); 313400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 3135fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg adapter = manager_find_adapter(&dev->bdaddr); 313600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (adapter == NULL) 313700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return -ENODEV; 313800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 313900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg for (list = adapter_get_services(adapter); list; list = list->next) { 31405c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg sdp_record_t *rec = list->data; 314100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 314200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg if (rec->svclass.type != SDP_UUID16) 314300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg continue; 314400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 314500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg switch (rec->svclass.value.uuid16) { 314600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case DIALUP_NET_SVCLASS_ID: 314700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case CIP_SVCLASS_ID: 314800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg val |= 0x42; /* Telephony & Networking */ 314900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg break; 315000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case IRMC_SYNC_SVCLASS_ID: 315100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case OBEX_OBJPUSH_SVCLASS_ID: 315200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case OBEX_FILETRANS_SVCLASS_ID: 315300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case IRMC_SYNC_CMD_SVCLASS_ID: 315400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case PBAP_PSE_SVCLASS_ID: 315500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg val |= 0x10; /* Object Transfer */ 315600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg break; 315700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case HEADSET_SVCLASS_ID: 315800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case HANDSFREE_SVCLASS_ID: 315900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg val |= 0x20; /* Audio */ 316000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg break; 316100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case CORDLESS_TELEPHONY_SVCLASS_ID: 316200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case INTERCOM_SVCLASS_ID: 316300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case FAX_SVCLASS_ID: 316400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case SAP_SVCLASS_ID: 316500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* 316600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg * Setting the telephony bit for the handsfree audio gateway 316700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg * role is not required by the HFP specification, but the 316800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg * Nokia 616 carkit is just plain broken! It will refuse 316900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg * pairing without this bit set. 317000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg */ 317100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case HANDSFREE_AGW_SVCLASS_ID: 317200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg val |= 0x40; /* Telephony */ 317300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg break; 317400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case AUDIO_SOURCE_SVCLASS_ID: 317500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case VIDEO_SOURCE_SVCLASS_ID: 317600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg val |= 0x08; /* Capturing */ 317700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg break; 317800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case AUDIO_SINK_SVCLASS_ID: 317900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case VIDEO_SINK_SVCLASS_ID: 318000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg val |= 0x04; /* Rendering */ 318100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg break; 318200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case PANU_SVCLASS_ID: 318300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case NAP_SVCLASS_ID: 318400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg case GN_SVCLASS_ID: 318500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg val |= 0x02; /* Networking */ 318600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg break; 318700c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 318800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 318900c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 319000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return set_service_classes(index, val); 319100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg} 319200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 319300c2267405ff3416672401cf394f06017a6814c1Johan Hedbergstatic int hciops_disable_cod_cache(int index) 319400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg{ 3195fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 319600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 3197fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg DBG("hci%d cache_enable %d", index, dev->cache_enable); 3198fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 3199fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->cache_enable) 320000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return 0; 320100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 320200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg DBG("hci%d current_cod 0x%06x wanted_cod 0x%06x", index, 3203fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->current_cod, dev->wanted_cod); 320400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 320500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg /* Disable and flush svc cache. All successive service class 320600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg * updates * will be written to the device */ 3207fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg dev->cache_enable = FALSE; 320800c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 3209fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (dev->current_cod == dev->wanted_cod) { 321000c2267405ff3416672401cf394f06017a6814c1Johan Hedberg update_ext_inquiry_response(index); 321100c2267405ff3416672401cf394f06017a6814c1Johan Hedberg return 0; 321200c2267405ff3416672401cf394f06017a6814c1Johan Hedberg } 321300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 3214fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg return write_class(index, dev->wanted_cod); 321500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg} 321600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg 32175c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedbergstatic int hciops_restore_powered(int index) 32185c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg{ 3219fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg struct dev_info *dev = &devs[index]; 3220fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg 3221fdb266b6797638b89b9ba9fe0d89670bf71d47c5Johan Hedberg if (!dev->already_up && dev->up) 322263ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg return hciops_power_off(index); 32235c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 32245c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg return 0; 32255c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg} 32265c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg 322734c4239984722c169e3e821ec5ca7c88528827bdAlok Barsodestatic struct btd_adapter_ops hci_ops = { 322834c4239984722c169e3e821ec5ca7c88528827bdAlok Barsode .setup = hciops_setup, 322934c4239984722c169e3e821ec5ca7c88528827bdAlok Barsode .cleanup = hciops_cleanup, 323063ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg .power_on = hciops_power_on, 323163ff6738abc6bf21becbbfde583062502e7728a6Johan Hedberg .power_off = hciops_power_off, 32325c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg .set_connectable = hciops_set_connectable, 32335c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg .set_discoverable = hciops_set_discoverable, 32345c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg .set_pairable = hciops_set_pairable, 3235eeba5fdb9c807191893b9e82cb4952e23df3ca56Alok Barsode .set_limited_discoverable = hciops_set_limited_discoverable, 32363af792e57b7ccb82d3139748a2b3c6b44d2e7ce2Claudio Takahasi .start_inquiry = hciops_start_inquiry, 32373af792e57b7ccb82d3139748a2b3c6b44d2e7ce2Claudio Takahasi .stop_inquiry = hciops_stop_inquiry, 323870cd37db7cdadd72b0cd4c7e3e1b329b79e0d868Claudio Takahasi .start_scanning = hciops_start_scanning, 323970cd37db7cdadd72b0cd4c7e3e1b329b79e0d868Claudio Takahasi .stop_scanning = hciops_stop_scanning, 3240ef876daebf32cbe65fb4d9ec6fb1ffead60086eaAlok Barsode .resolve_name = hciops_resolve_name, 3241b96f44db8e91325968a0149595b2522d4a22481aAlok Barsode .cancel_resolve_name = hciops_cancel_resolve_name, 3242164ccf9a6641fe646d8476f6b860d5ff4905632bAlok Barsode .set_name = hciops_set_name, 324300c2267405ff3416672401cf394f06017a6814c1Johan Hedberg .set_dev_class = hciops_set_dev_class, 324461f0df8f18c417df50a296e10893c82b5eb83879Dmitriy Paliy .set_fast_connectable = hciops_fast_connectable, 32455bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter .read_clock = hciops_read_clock, 32465bca34b67c59a01d72adcf6601ce2c8553464142Elvis Pfützenreuter .get_conn_handle = hciops_conn_handle, 3247b5c556ef59a9a8318b239453c3d4a8aad951689fJohan Hedberg .read_bdaddr = hciops_read_bdaddr, 3248885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg .block_device = hciops_block_device, 3249885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg .unblock_device = hciops_unblock_device, 3250f7b4b3fcd1190d231b864730c821b98fb945e439Johan Hedberg .get_conn_list = hciops_get_conn_list, 3251e38fdde63c8f385b99bf17c9e5794e7f08575f7eJohan Hedberg .read_local_version = hciops_read_local_version, 325248e6007a98222853a0e1bcbbd6ac17a37098bb49Johan Hedberg .read_local_features = hciops_read_local_features, 325306dcf6ada5042f6f8a52ae64cfca8327399c09b1Johan Hedberg .disconnect = hciops_disconnect, 32541bf7ec6b5c5a786775813650a6ef00f47b4d11ecJohan Hedberg .remove_bonding = hciops_remove_bonding, 3255424ffb26405690b9d9653a9418a9c4d332a85176Johan Hedberg .request_authentication = hciops_request_authentication, 3256e7daece858070d71cecf6ade4f0e3c93272c53acJohan Hedberg .pincode_reply = hciops_pincode_reply, 3257df6c074158bc0f2caf76178dc00d50c7bf1b444aJohan Hedberg .confirm_reply = hciops_confirm_reply, 3258889c7513b312854e7f5c274696ad92a233c1ce78Johan Hedberg .passkey_reply = hciops_passkey_reply, 32594b625a87bd009aa6a61443d802d63a5f81c58cc8Johan Hedberg .get_auth_info = hciops_get_auth_info, 3260f8b7d84e2cceed2f113d1688c87326ea2505cd16Johan Hedberg .read_scan_enable = hciops_read_scan_enable, 32615c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg .enable_le = hciops_enable_le, 3262646f0c7e6b557c5413825ce7b04bee52bf0129e8Johan Hedberg .get_remote_version = hciops_get_remote_version, 3263abe7cd44124a6955c1a3fd5c828ec2934f38a528Johan Hedberg .encrypt_link = hciops_encrypt_link, 326400c2267405ff3416672401cf394f06017a6814c1Johan Hedberg .set_did = hciops_set_did, 326500c2267405ff3416672401cf394f06017a6814c1Johan Hedberg .services_updated = hciops_services_updated, 326600c2267405ff3416672401cf394f06017a6814c1Johan Hedberg .disable_cod_cache = hciops_disable_cod_cache, 32675c1c35eb38790bd068bfd37e0355aafb194f7812Johan Hedberg .restore_powered = hciops_restore_powered, 326834c4239984722c169e3e821ec5ca7c88528827bdAlok Barsode}; 326934c4239984722c169e3e821ec5ca7c88528827bdAlok Barsode 327034c4239984722c169e3e821ec5ca7c88528827bdAlok Barsodestatic int hciops_init(void) 327134c4239984722c169e3e821ec5ca7c88528827bdAlok Barsode{ 32720e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG(""); 3273d30044157466e7f34e7f2d5d7ce70215ea013338Johan Hedberg return btd_register_adapter_ops(&hci_ops, FALSE); 327434c4239984722c169e3e821ec5ca7c88528827bdAlok Barsode} 3275d57934d1d09c34d1b136c572cad1dff6306c8c48Johan Hedberg 327694e91856179a268805256055ffd5155d1468b99cAlok Barsodestatic void hciops_exit(void) 327794e91856179a268805256055ffd5155d1468b99cAlok Barsode{ 32780e9aac1c77cac6e125ea0dbf68769e12e0928964Johan Hedberg DBG(""); 3279929393b82db06368ff5fa4074bc209d1d4d03a48Marcel Holtmann btd_adapter_cleanup_ops(&hci_ops); 328094e91856179a268805256055ffd5155d1468b99cAlok Barsode} 328194e91856179a268805256055ffd5155d1468b99cAlok Barsode 328294e91856179a268805256055ffd5155d1468b99cAlok BarsodeBLUETOOTH_PLUGIN_DEFINE(hciops, VERSION, 32831ab388feb37980f1afc940c7cf530b9baadeabb1Marcel Holtmann BLUETOOTH_PLUGIN_PRIORITY_LOW, hciops_init, hciops_exit) 3284