hci_event.c revision 1.1.2.4
1 1.1.2.4 yamt /* $NetBSD: hci_event.c,v 1.1.2.4 2007/09/03 14:42:33 yamt Exp $ */ 2 1.1.2.2 yamt 3 1.1.2.2 yamt /*- 4 1.1.2.2 yamt * Copyright (c) 2005 Iain Hibbert. 5 1.1.2.2 yamt * Copyright (c) 2006 Itronix Inc. 6 1.1.2.2 yamt * All rights reserved. 7 1.1.2.2 yamt * 8 1.1.2.2 yamt * Redistribution and use in source and binary forms, with or without 9 1.1.2.2 yamt * modification, are permitted provided that the following conditions 10 1.1.2.2 yamt * are met: 11 1.1.2.2 yamt * 1. Redistributions of source code must retain the above copyright 12 1.1.2.2 yamt * notice, this list of conditions and the following disclaimer. 13 1.1.2.2 yamt * 2. Redistributions in binary form must reproduce the above copyright 14 1.1.2.2 yamt * notice, this list of conditions and the following disclaimer in the 15 1.1.2.2 yamt * documentation and/or other materials provided with the distribution. 16 1.1.2.2 yamt * 3. The name of Itronix Inc. may not be used to endorse 17 1.1.2.2 yamt * or promote products derived from this software without specific 18 1.1.2.2 yamt * prior written permission. 19 1.1.2.2 yamt * 20 1.1.2.2 yamt * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND 21 1.1.2.2 yamt * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 22 1.1.2.2 yamt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 23 1.1.2.2 yamt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY 24 1.1.2.2 yamt * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 25 1.1.2.2 yamt * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 26 1.1.2.2 yamt * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 27 1.1.2.2 yamt * ON ANY THEORY OF LIABILITY, WHETHER IN 28 1.1.2.2 yamt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 29 1.1.2.2 yamt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 30 1.1.2.2 yamt * POSSIBILITY OF SUCH DAMAGE. 31 1.1.2.2 yamt */ 32 1.1.2.2 yamt 33 1.1.2.2 yamt #include <sys/cdefs.h> 34 1.1.2.4 yamt __KERNEL_RCSID(0, "$NetBSD: hci_event.c,v 1.1.2.4 2007/09/03 14:42:33 yamt Exp $"); 35 1.1.2.2 yamt 36 1.1.2.2 yamt #include <sys/param.h> 37 1.1.2.2 yamt #include <sys/kernel.h> 38 1.1.2.2 yamt #include <sys/malloc.h> 39 1.1.2.2 yamt #include <sys/mbuf.h> 40 1.1.2.2 yamt #include <sys/proc.h> 41 1.1.2.2 yamt #include <sys/systm.h> 42 1.1.2.2 yamt 43 1.1.2.2 yamt #include <netbt/bluetooth.h> 44 1.1.2.2 yamt #include <netbt/hci.h> 45 1.1.2.2 yamt #include <netbt/sco.h> 46 1.1.2.2 yamt 47 1.1.2.2 yamt static void hci_event_inquiry_result(struct hci_unit *, struct mbuf *); 48 1.1.2.2 yamt static void hci_event_command_status(struct hci_unit *, struct mbuf *); 49 1.1.2.2 yamt static void hci_event_command_compl(struct hci_unit *, struct mbuf *); 50 1.1.2.2 yamt static void hci_event_con_compl(struct hci_unit *, struct mbuf *); 51 1.1.2.2 yamt static void hci_event_discon_compl(struct hci_unit *, struct mbuf *); 52 1.1.2.2 yamt static void hci_event_con_req(struct hci_unit *, struct mbuf *); 53 1.1.2.2 yamt static void hci_event_num_compl_pkts(struct hci_unit *, struct mbuf *); 54 1.1.2.4 yamt static void hci_event_auth_compl(struct hci_unit *, struct mbuf *); 55 1.1.2.4 yamt static void hci_event_encryption_change(struct hci_unit *, struct mbuf *); 56 1.1.2.4 yamt static void hci_event_change_con_link_key_compl(struct hci_unit *, struct mbuf *); 57 1.1.2.2 yamt static void hci_cmd_read_bdaddr(struct hci_unit *, struct mbuf *); 58 1.1.2.2 yamt static void hci_cmd_read_buffer_size(struct hci_unit *, struct mbuf *); 59 1.1.2.2 yamt static void hci_cmd_read_local_features(struct hci_unit *, struct mbuf *); 60 1.1.2.2 yamt static void hci_cmd_reset(struct hci_unit *, struct mbuf *); 61 1.1.2.2 yamt 62 1.1.2.2 yamt #ifdef BLUETOOTH_DEBUG 63 1.1.2.4 yamt int bluetooth_debug; 64 1.1.2.2 yamt 65 1.1.2.2 yamt static const char *hci_eventnames[] = { 66 1.1.2.2 yamt /* 0x00 */ "NULL", 67 1.1.2.2 yamt /* 0x01 */ "INQUIRY COMPLETE", 68 1.1.2.2 yamt /* 0x02 */ "INQUIRY RESULT", 69 1.1.2.2 yamt /* 0x03 */ "CONN COMPLETE", 70 1.1.2.2 yamt /* 0x04 */ "CONN REQ", 71 1.1.2.2 yamt /* 0x05 */ "DISCONN COMPLETE", 72 1.1.2.2 yamt /* 0x06 */ "AUTH COMPLETE", 73 1.1.2.2 yamt /* 0x07 */ "REMOTE NAME REQ COMPLETE", 74 1.1.2.2 yamt /* 0x08 */ "ENCRYPTION CHANGE", 75 1.1.2.2 yamt /* 0x09 */ "CHANGE CONN LINK KEY COMPLETE", 76 1.1.2.2 yamt /* 0x0a */ "MASTER LINK KEY COMPLETE", 77 1.1.2.2 yamt /* 0x0b */ "READ REMOTE FEATURES COMPLETE", 78 1.1.2.2 yamt /* 0x0c */ "READ REMOTE VERSION INFO COMPLETE", 79 1.1.2.2 yamt /* 0x0d */ "QoS SETUP COMPLETE", 80 1.1.2.2 yamt /* 0x0e */ "COMMAND COMPLETE", 81 1.1.2.2 yamt /* 0x0f */ "COMMAND STATUS", 82 1.1.2.2 yamt /* 0x10 */ "HARDWARE ERROR", 83 1.1.2.2 yamt /* 0x11 */ "FLUSH OCCUR", 84 1.1.2.2 yamt /* 0x12 */ "ROLE CHANGE", 85 1.1.2.2 yamt /* 0x13 */ "NUM COMPLETED PACKETS", 86 1.1.2.2 yamt /* 0x14 */ "MODE CHANGE", 87 1.1.2.2 yamt /* 0x15 */ "RETURN LINK KEYS", 88 1.1.2.2 yamt /* 0x16 */ "PIN CODE REQ", 89 1.1.2.2 yamt /* 0x17 */ "LINK KEY REQ", 90 1.1.2.2 yamt /* 0x18 */ "LINK KEY NOTIFICATION", 91 1.1.2.2 yamt /* 0x19 */ "LOOPBACK COMMAND", 92 1.1.2.2 yamt /* 0x1a */ "DATA BUFFER OVERFLOW", 93 1.1.2.2 yamt /* 0x1b */ "MAX SLOT CHANGE", 94 1.1.2.2 yamt /* 0x1c */ "READ CLOCK OFFSET COMPLETE", 95 1.1.2.2 yamt /* 0x1d */ "CONN PKT TYPE CHANGED", 96 1.1.2.2 yamt /* 0x1e */ "QOS VIOLATION", 97 1.1.2.2 yamt /* 0x1f */ "PAGE SCAN MODE CHANGE", 98 1.1.2.2 yamt /* 0x20 */ "PAGE SCAN REP MODE CHANGE", 99 1.1.2.2 yamt /* 0x21 */ "FLOW SPECIFICATION COMPLETE", 100 1.1.2.2 yamt /* 0x22 */ "RSSI RESULT", 101 1.1.2.2 yamt /* 0x23 */ "READ REMOTE EXT FEATURES" 102 1.1.2.2 yamt }; 103 1.1.2.2 yamt 104 1.1.2.2 yamt static const char * 105 1.1.2.2 yamt hci_eventstr(unsigned int event) 106 1.1.2.2 yamt { 107 1.1.2.2 yamt 108 1.1.2.2 yamt if (event < (sizeof(hci_eventnames) / sizeof(*hci_eventnames))) 109 1.1.2.2 yamt return hci_eventnames[event]; 110 1.1.2.2 yamt 111 1.1.2.2 yamt switch (event) { 112 1.1.2.2 yamt case HCI_EVENT_SCO_CON_COMPL: /* 0x2c */ 113 1.1.2.2 yamt return "SCO CON COMPLETE"; 114 1.1.2.2 yamt 115 1.1.2.2 yamt case HCI_EVENT_SCO_CON_CHANGED: /* 0x2d */ 116 1.1.2.2 yamt return "SCO CON CHANGED"; 117 1.1.2.2 yamt 118 1.1.2.2 yamt case HCI_EVENT_BT_LOGO: /* 0xfe */ 119 1.1.2.2 yamt return "BT_LOGO"; 120 1.1.2.2 yamt 121 1.1.2.2 yamt case HCI_EVENT_VENDOR: /* 0xff */ 122 1.1.2.2 yamt return "VENDOR"; 123 1.1.2.2 yamt } 124 1.1.2.2 yamt 125 1.1.2.2 yamt return "UNRECOGNISED"; 126 1.1.2.2 yamt } 127 1.1.2.2 yamt #endif /* BLUETOOTH_DEBUG */ 128 1.1.2.2 yamt 129 1.1.2.2 yamt /* 130 1.1.2.2 yamt * process HCI Events 131 1.1.2.2 yamt * 132 1.1.2.2 yamt * We will free the mbuf at the end, no need for any sub 133 1.1.2.2 yamt * functions to handle that. We kind of assume that the 134 1.1.2.2 yamt * device sends us valid events. 135 1.1.2.2 yamt */ 136 1.1.2.2 yamt void 137 1.1.2.2 yamt hci_event(struct mbuf *m, struct hci_unit *unit) 138 1.1.2.2 yamt { 139 1.1.2.2 yamt hci_event_hdr_t hdr; 140 1.1.2.2 yamt 141 1.1.2.2 yamt KASSERT(m->m_flags & M_PKTHDR); 142 1.1.2.2 yamt 143 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(hdr)); 144 1.1.2.2 yamt m_copydata(m, 0, sizeof(hdr), &hdr); 145 1.1.2.2 yamt m_adj(m, sizeof(hdr)); 146 1.1.2.2 yamt 147 1.1.2.2 yamt KASSERT(hdr.type == HCI_EVENT_PKT); 148 1.1.2.2 yamt 149 1.1.2.2 yamt DPRINTFN(1, "(%s) event %s\n", unit->hci_devname, hci_eventstr(hdr.event)); 150 1.1.2.2 yamt 151 1.1.2.2 yamt switch(hdr.event) { 152 1.1.2.2 yamt case HCI_EVENT_COMMAND_STATUS: 153 1.1.2.2 yamt hci_event_command_status(unit, m); 154 1.1.2.2 yamt break; 155 1.1.2.2 yamt 156 1.1.2.2 yamt case HCI_EVENT_COMMAND_COMPL: 157 1.1.2.2 yamt hci_event_command_compl(unit, m); 158 1.1.2.2 yamt break; 159 1.1.2.2 yamt 160 1.1.2.2 yamt case HCI_EVENT_NUM_COMPL_PKTS: 161 1.1.2.2 yamt hci_event_num_compl_pkts(unit, m); 162 1.1.2.2 yamt break; 163 1.1.2.2 yamt 164 1.1.2.2 yamt case HCI_EVENT_INQUIRY_RESULT: 165 1.1.2.2 yamt hci_event_inquiry_result(unit, m); 166 1.1.2.2 yamt break; 167 1.1.2.2 yamt 168 1.1.2.2 yamt case HCI_EVENT_CON_COMPL: 169 1.1.2.2 yamt hci_event_con_compl(unit, m); 170 1.1.2.2 yamt break; 171 1.1.2.2 yamt 172 1.1.2.2 yamt case HCI_EVENT_DISCON_COMPL: 173 1.1.2.2 yamt hci_event_discon_compl(unit, m); 174 1.1.2.2 yamt break; 175 1.1.2.2 yamt 176 1.1.2.2 yamt case HCI_EVENT_CON_REQ: 177 1.1.2.2 yamt hci_event_con_req(unit, m); 178 1.1.2.2 yamt break; 179 1.1.2.2 yamt 180 1.1.2.2 yamt case HCI_EVENT_AUTH_COMPL: 181 1.1.2.4 yamt hci_event_auth_compl(unit, m); 182 1.1.2.4 yamt break; 183 1.1.2.4 yamt 184 1.1.2.2 yamt case HCI_EVENT_ENCRYPTION_CHANGE: 185 1.1.2.4 yamt hci_event_encryption_change(unit, m); 186 1.1.2.4 yamt break; 187 1.1.2.4 yamt 188 1.1.2.2 yamt case HCI_EVENT_CHANGE_CON_LINK_KEY_COMPL: 189 1.1.2.4 yamt hci_event_change_con_link_key_compl(unit, m); 190 1.1.2.4 yamt break; 191 1.1.2.4 yamt 192 1.1.2.4 yamt case HCI_EVENT_SCO_CON_COMPL: 193 1.1.2.4 yamt case HCI_EVENT_INQUIRY_COMPL: 194 1.1.2.4 yamt case HCI_EVENT_REMOTE_NAME_REQ_COMPL: 195 1.1.2.2 yamt case HCI_EVENT_MASTER_LINK_KEY_COMPL: 196 1.1.2.2 yamt case HCI_EVENT_READ_REMOTE_FEATURES_COMPL: 197 1.1.2.2 yamt case HCI_EVENT_READ_REMOTE_VER_INFO_COMPL: 198 1.1.2.2 yamt case HCI_EVENT_QOS_SETUP_COMPL: 199 1.1.2.2 yamt case HCI_EVENT_HARDWARE_ERROR: 200 1.1.2.2 yamt case HCI_EVENT_FLUSH_OCCUR: 201 1.1.2.2 yamt case HCI_EVENT_ROLE_CHANGE: 202 1.1.2.2 yamt case HCI_EVENT_MODE_CHANGE: 203 1.1.2.2 yamt case HCI_EVENT_RETURN_LINK_KEYS: 204 1.1.2.2 yamt case HCI_EVENT_PIN_CODE_REQ: 205 1.1.2.2 yamt case HCI_EVENT_LINK_KEY_REQ: 206 1.1.2.2 yamt case HCI_EVENT_LINK_KEY_NOTIFICATION: 207 1.1.2.2 yamt case HCI_EVENT_LOOPBACK_COMMAND: 208 1.1.2.2 yamt case HCI_EVENT_DATA_BUFFER_OVERFLOW: 209 1.1.2.2 yamt case HCI_EVENT_MAX_SLOT_CHANGE: 210 1.1.2.2 yamt case HCI_EVENT_READ_CLOCK_OFFSET_COMPL: 211 1.1.2.2 yamt case HCI_EVENT_CON_PKT_TYPE_CHANGED: 212 1.1.2.2 yamt case HCI_EVENT_QOS_VIOLATION: 213 1.1.2.2 yamt case HCI_EVENT_PAGE_SCAN_MODE_CHANGE: 214 1.1.2.2 yamt case HCI_EVENT_PAGE_SCAN_REP_MODE_CHANGE: 215 1.1.2.2 yamt case HCI_EVENT_FLOW_SPECIFICATION_COMPL: 216 1.1.2.2 yamt case HCI_EVENT_RSSI_RESULT: 217 1.1.2.2 yamt case HCI_EVENT_READ_REMOTE_EXTENDED_FEATURES: 218 1.1.2.2 yamt case HCI_EVENT_SCO_CON_CHANGED: 219 1.1.2.2 yamt case HCI_EVENT_BT_LOGO: 220 1.1.2.2 yamt case HCI_EVENT_VENDOR: 221 1.1.2.2 yamt break; 222 1.1.2.2 yamt 223 1.1.2.2 yamt default: 224 1.1.2.2 yamt UNKNOWN(hdr.event); 225 1.1.2.2 yamt break; 226 1.1.2.2 yamt } 227 1.1.2.2 yamt 228 1.1.2.2 yamt m_freem(m); 229 1.1.2.2 yamt } 230 1.1.2.2 yamt 231 1.1.2.2 yamt /* 232 1.1.2.2 yamt * Command Status 233 1.1.2.2 yamt * 234 1.1.2.2 yamt * Update our record of num_cmd_pkts then post-process any pending commands 235 1.1.2.2 yamt * and optionally restart cmd output on the unit. 236 1.1.2.2 yamt */ 237 1.1.2.2 yamt static void 238 1.1.2.2 yamt hci_event_command_status(struct hci_unit *unit, struct mbuf *m) 239 1.1.2.2 yamt { 240 1.1.2.2 yamt hci_command_status_ep ep; 241 1.1.2.2 yamt 242 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 243 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 244 1.1.2.2 yamt m_adj(m, sizeof(ep)); 245 1.1.2.2 yamt 246 1.1.2.4 yamt DPRINTFN(1, "(%s) opcode (%03x|%04x) status = 0x%x num_cmd_pkts = %d\n", 247 1.1.2.2 yamt unit->hci_devname, 248 1.1.2.2 yamt HCI_OGF(le16toh(ep.opcode)), HCI_OCF(le16toh(ep.opcode)), 249 1.1.2.4 yamt ep.status, 250 1.1.2.2 yamt ep.num_cmd_pkts); 251 1.1.2.2 yamt 252 1.1.2.2 yamt unit->hci_num_cmd_pkts = ep.num_cmd_pkts; 253 1.1.2.2 yamt 254 1.1.2.2 yamt /* 255 1.1.2.2 yamt * post processing of pending commands 256 1.1.2.2 yamt */ 257 1.1.2.2 yamt switch(le16toh(ep.opcode)) { 258 1.1.2.2 yamt default: 259 1.1.2.2 yamt break; 260 1.1.2.2 yamt } 261 1.1.2.2 yamt 262 1.1.2.2 yamt while (unit->hci_num_cmd_pkts > 0 && MBUFQ_FIRST(&unit->hci_cmdwait)) { 263 1.1.2.2 yamt MBUFQ_DEQUEUE(&unit->hci_cmdwait, m); 264 1.1.2.2 yamt hci_output_cmd(unit, m); 265 1.1.2.2 yamt } 266 1.1.2.2 yamt } 267 1.1.2.2 yamt 268 1.1.2.2 yamt /* 269 1.1.2.2 yamt * Command Complete 270 1.1.2.2 yamt * 271 1.1.2.2 yamt * Update our record of num_cmd_pkts then handle the completed command, 272 1.1.2.2 yamt * and optionally restart cmd output on the unit. 273 1.1.2.2 yamt */ 274 1.1.2.2 yamt static void 275 1.1.2.2 yamt hci_event_command_compl(struct hci_unit *unit, struct mbuf *m) 276 1.1.2.2 yamt { 277 1.1.2.2 yamt hci_command_compl_ep ep; 278 1.1.2.2 yamt 279 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 280 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 281 1.1.2.2 yamt m_adj(m, sizeof(ep)); 282 1.1.2.2 yamt 283 1.1.2.2 yamt DPRINTFN(1, "(%s) opcode (%03x|%04x) num_cmd_pkts = %d\n", 284 1.1.2.2 yamt unit->hci_devname, 285 1.1.2.2 yamt HCI_OGF(le16toh(ep.opcode)), HCI_OCF(le16toh(ep.opcode)), 286 1.1.2.2 yamt ep.num_cmd_pkts); 287 1.1.2.2 yamt 288 1.1.2.2 yamt unit->hci_num_cmd_pkts = ep.num_cmd_pkts; 289 1.1.2.2 yamt 290 1.1.2.2 yamt /* 291 1.1.2.2 yamt * post processing of completed commands 292 1.1.2.2 yamt */ 293 1.1.2.2 yamt switch(le16toh(ep.opcode)) { 294 1.1.2.2 yamt case HCI_CMD_READ_BDADDR: 295 1.1.2.2 yamt hci_cmd_read_bdaddr(unit, m); 296 1.1.2.2 yamt break; 297 1.1.2.2 yamt 298 1.1.2.2 yamt case HCI_CMD_READ_BUFFER_SIZE: 299 1.1.2.2 yamt hci_cmd_read_buffer_size(unit, m); 300 1.1.2.2 yamt break; 301 1.1.2.2 yamt 302 1.1.2.2 yamt case HCI_CMD_READ_LOCAL_FEATURES: 303 1.1.2.2 yamt hci_cmd_read_local_features(unit, m); 304 1.1.2.2 yamt break; 305 1.1.2.2 yamt 306 1.1.2.2 yamt case HCI_CMD_RESET: 307 1.1.2.2 yamt hci_cmd_reset(unit, m); 308 1.1.2.2 yamt break; 309 1.1.2.2 yamt 310 1.1.2.2 yamt default: 311 1.1.2.2 yamt break; 312 1.1.2.2 yamt } 313 1.1.2.2 yamt 314 1.1.2.2 yamt while (unit->hci_num_cmd_pkts > 0 && MBUFQ_FIRST(&unit->hci_cmdwait)) { 315 1.1.2.2 yamt MBUFQ_DEQUEUE(&unit->hci_cmdwait, m); 316 1.1.2.2 yamt hci_output_cmd(unit, m); 317 1.1.2.2 yamt } 318 1.1.2.2 yamt } 319 1.1.2.2 yamt 320 1.1.2.2 yamt /* 321 1.1.2.2 yamt * Number of Completed Packets 322 1.1.2.2 yamt * 323 1.1.2.2 yamt * This is sent periodically by the Controller telling us how many 324 1.1.2.2 yamt * buffers are now freed up and which handle was using them. From 325 1.1.2.2 yamt * this we determine which type of buffer it was and add the qty 326 1.1.2.2 yamt * back into the relevant packet counter, then restart output on 327 1.1.2.2 yamt * links that have halted. 328 1.1.2.2 yamt */ 329 1.1.2.2 yamt static void 330 1.1.2.2 yamt hci_event_num_compl_pkts(struct hci_unit *unit, struct mbuf *m) 331 1.1.2.2 yamt { 332 1.1.2.2 yamt hci_num_compl_pkts_ep ep; 333 1.1.2.2 yamt struct hci_link *link, *next; 334 1.1.2.2 yamt uint16_t handle, num; 335 1.1.2.2 yamt int num_acl = 0, num_sco = 0; 336 1.1.2.2 yamt 337 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 338 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 339 1.1.2.2 yamt m_adj(m, sizeof(ep)); 340 1.1.2.2 yamt 341 1.1.2.2 yamt while (ep.num_con_handles--) { 342 1.1.2.4 yamt m_copydata(m, 0, sizeof(handle), &handle); 343 1.1.2.2 yamt m_adj(m, sizeof(handle)); 344 1.1.2.2 yamt handle = le16toh(handle); 345 1.1.2.2 yamt 346 1.1.2.4 yamt m_copydata(m, 0, sizeof(num), &num); 347 1.1.2.2 yamt m_adj(m, sizeof(num)); 348 1.1.2.2 yamt num = le16toh(num); 349 1.1.2.2 yamt 350 1.1.2.2 yamt link = hci_link_lookup_handle(unit, handle); 351 1.1.2.2 yamt if (link) { 352 1.1.2.2 yamt if (link->hl_type == HCI_LINK_ACL) { 353 1.1.2.2 yamt num_acl += num; 354 1.1.2.2 yamt hci_acl_complete(link, num); 355 1.1.2.2 yamt } else { 356 1.1.2.2 yamt num_sco += num; 357 1.1.2.2 yamt hci_sco_complete(link, num); 358 1.1.2.2 yamt } 359 1.1.2.2 yamt } else { 360 1.1.2.4 yamt /* XXX need to issue Read_Buffer_Size or Reset? */ 361 1.1.2.2 yamt printf("%s: unknown handle %d! " 362 1.1.2.2 yamt "(losing track of %d packet buffer%s)\n", 363 1.1.2.2 yamt unit->hci_devname, handle, 364 1.1.2.2 yamt num, (num == 1 ? "" : "s")); 365 1.1.2.2 yamt } 366 1.1.2.2 yamt } 367 1.1.2.2 yamt 368 1.1.2.2 yamt /* 369 1.1.2.2 yamt * Move up any queued packets. When a link has sent data, it will move 370 1.1.2.2 yamt * to the back of the queue - technically then if a link had something 371 1.1.2.2 yamt * to send and there were still buffers available it could get started 372 1.1.2.2 yamt * twice but it seemed more important to to handle higher loads fairly 373 1.1.2.2 yamt * than worry about wasting cycles when we are not busy. 374 1.1.2.2 yamt */ 375 1.1.2.2 yamt 376 1.1.2.2 yamt unit->hci_num_acl_pkts += num_acl; 377 1.1.2.2 yamt unit->hci_num_sco_pkts += num_sco; 378 1.1.2.2 yamt 379 1.1.2.2 yamt link = TAILQ_FIRST(&unit->hci_links); 380 1.1.2.2 yamt while (link && (unit->hci_num_acl_pkts > 0 || unit->hci_num_sco_pkts > 0)) { 381 1.1.2.2 yamt next = TAILQ_NEXT(link, hl_next); 382 1.1.2.2 yamt 383 1.1.2.2 yamt if (link->hl_type == HCI_LINK_ACL) { 384 1.1.2.2 yamt if (unit->hci_num_acl_pkts > 0 && link->hl_txqlen > 0) 385 1.1.2.2 yamt hci_acl_start(link); 386 1.1.2.2 yamt } else { 387 1.1.2.2 yamt if (unit->hci_num_sco_pkts > 0 && link->hl_txqlen > 0) 388 1.1.2.2 yamt hci_sco_start(link); 389 1.1.2.2 yamt } 390 1.1.2.2 yamt 391 1.1.2.2 yamt link = next; 392 1.1.2.2 yamt } 393 1.1.2.2 yamt } 394 1.1.2.2 yamt 395 1.1.2.2 yamt /* 396 1.1.2.2 yamt * Inquiry Result 397 1.1.2.2 yamt * 398 1.1.2.2 yamt * keep a note of devices seen, so we know which unit to use 399 1.1.2.2 yamt * on outgoing connections 400 1.1.2.2 yamt */ 401 1.1.2.2 yamt static void 402 1.1.2.2 yamt hci_event_inquiry_result(struct hci_unit *unit, struct mbuf *m) 403 1.1.2.2 yamt { 404 1.1.2.2 yamt hci_inquiry_result_ep ep; 405 1.1.2.2 yamt struct hci_memo *memo; 406 1.1.2.2 yamt bdaddr_t bdaddr; 407 1.1.2.2 yamt 408 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 409 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 410 1.1.2.2 yamt m_adj(m, sizeof(ep)); 411 1.1.2.2 yamt 412 1.1.2.2 yamt DPRINTFN(1, "%d response%s\n", ep.num_responses, 413 1.1.2.2 yamt (ep.num_responses == 1 ? "" : "s")); 414 1.1.2.2 yamt 415 1.1.2.2 yamt while(ep.num_responses--) { 416 1.1.2.4 yamt m_copydata(m, 0, sizeof(bdaddr_t), &bdaddr); 417 1.1.2.2 yamt 418 1.1.2.2 yamt DPRINTFN(1, "bdaddr %02x:%02x:%02x:%02x:%02x:%02x\n", 419 1.1.2.2 yamt bdaddr.b[5], bdaddr.b[4], bdaddr.b[3], 420 1.1.2.2 yamt bdaddr.b[2], bdaddr.b[1], bdaddr.b[0]); 421 1.1.2.2 yamt 422 1.1.2.2 yamt memo = hci_memo_find(unit, &bdaddr); 423 1.1.2.2 yamt if (memo == NULL) { 424 1.1.2.2 yamt memo = malloc(sizeof(struct hci_memo), 425 1.1.2.2 yamt M_BLUETOOTH, M_NOWAIT | M_ZERO); 426 1.1.2.2 yamt if (memo == NULL) { 427 1.1.2.2 yamt DPRINTFN(0, "out of memo memory!\n"); 428 1.1.2.2 yamt break; 429 1.1.2.2 yamt } 430 1.1.2.2 yamt 431 1.1.2.2 yamt LIST_INSERT_HEAD(&unit->hci_memos, memo, next); 432 1.1.2.2 yamt } 433 1.1.2.2 yamt 434 1.1.2.2 yamt microtime(&memo->time); 435 1.1.2.4 yamt m_copydata(m, 0, sizeof(hci_inquiry_response), &memo->response); 436 1.1.2.2 yamt m_adj(m, sizeof(hci_inquiry_response)); 437 1.1.2.3 yamt 438 1.1.2.3 yamt memo->response.clock_offset = 439 1.1.2.3 yamt le16toh(memo->response.clock_offset); 440 1.1.2.2 yamt } 441 1.1.2.2 yamt } 442 1.1.2.2 yamt 443 1.1.2.2 yamt /* 444 1.1.2.2 yamt * Connection Complete 445 1.1.2.2 yamt * 446 1.1.2.2 yamt * Sent to us when a connection is made. If there is no link 447 1.1.2.2 yamt * structure already allocated for this, we must have changed 448 1.1.2.2 yamt * our mind, so just disconnect. 449 1.1.2.2 yamt */ 450 1.1.2.2 yamt static void 451 1.1.2.2 yamt hci_event_con_compl(struct hci_unit *unit, struct mbuf *m) 452 1.1.2.2 yamt { 453 1.1.2.2 yamt hci_con_compl_ep ep; 454 1.1.2.2 yamt hci_write_link_policy_settings_cp cp; 455 1.1.2.2 yamt struct hci_link *link; 456 1.1.2.2 yamt int err; 457 1.1.2.2 yamt 458 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 459 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 460 1.1.2.2 yamt m_adj(m, sizeof(ep)); 461 1.1.2.2 yamt 462 1.1.2.2 yamt DPRINTFN(1, "(%s) %s connection complete for " 463 1.1.2.2 yamt "%02x:%02x:%02x:%02x:%02x:%02x status %#x\n", 464 1.1.2.2 yamt unit->hci_devname, 465 1.1.2.2 yamt (ep.link_type == HCI_LINK_ACL ? "ACL" : "SCO"), 466 1.1.2.2 yamt ep.bdaddr.b[5], ep.bdaddr.b[4], ep.bdaddr.b[3], 467 1.1.2.2 yamt ep.bdaddr.b[2], ep.bdaddr.b[1], ep.bdaddr.b[0], 468 1.1.2.2 yamt ep.status); 469 1.1.2.2 yamt 470 1.1.2.2 yamt link = hci_link_lookup_bdaddr(unit, &ep.bdaddr, ep.link_type); 471 1.1.2.2 yamt 472 1.1.2.2 yamt if (ep.status) { 473 1.1.2.2 yamt if (link != NULL) { 474 1.1.2.2 yamt switch (ep.status) { 475 1.1.2.2 yamt case 0x04: /* "Page Timeout" */ 476 1.1.2.2 yamt err = EHOSTDOWN; 477 1.1.2.2 yamt break; 478 1.1.2.2 yamt 479 1.1.2.2 yamt case 0x08: /* "Connection Timed Out" */ 480 1.1.2.2 yamt err = ETIMEDOUT; 481 1.1.2.2 yamt break; 482 1.1.2.2 yamt 483 1.1.2.2 yamt case 0x16: /* "Connection Terminated by Local Host" */ 484 1.1.2.2 yamt err = 0; 485 1.1.2.2 yamt break; 486 1.1.2.2 yamt 487 1.1.2.2 yamt default: 488 1.1.2.2 yamt err = ECONNREFUSED; 489 1.1.2.2 yamt break; 490 1.1.2.2 yamt } 491 1.1.2.2 yamt 492 1.1.2.2 yamt hci_link_free(link, err); 493 1.1.2.2 yamt } 494 1.1.2.2 yamt 495 1.1.2.2 yamt return; 496 1.1.2.2 yamt } 497 1.1.2.2 yamt 498 1.1.2.2 yamt if (link == NULL) { 499 1.1.2.2 yamt hci_discon_cp dp; 500 1.1.2.2 yamt 501 1.1.2.2 yamt dp.con_handle = ep.con_handle; 502 1.1.2.2 yamt dp.reason = 0x13; /* "Remote User Terminated Connection" */ 503 1.1.2.2 yamt 504 1.1.2.2 yamt hci_send_cmd(unit, HCI_CMD_DISCONNECT, &dp, sizeof(dp)); 505 1.1.2.2 yamt return; 506 1.1.2.2 yamt } 507 1.1.2.2 yamt 508 1.1.2.4 yamt /* XXX could check auth_enable here */ 509 1.1.2.4 yamt 510 1.1.2.4 yamt if (ep.encryption_mode) 511 1.1.2.4 yamt link->hl_flags |= (HCI_LINK_AUTH | HCI_LINK_ENCRYPT); 512 1.1.2.4 yamt 513 1.1.2.2 yamt link->hl_state = HCI_LINK_OPEN; 514 1.1.2.2 yamt link->hl_handle = HCI_CON_HANDLE(le16toh(ep.con_handle)); 515 1.1.2.2 yamt 516 1.1.2.2 yamt if (ep.link_type == HCI_LINK_ACL) { 517 1.1.2.2 yamt cp.con_handle = ep.con_handle; 518 1.1.2.2 yamt cp.settings = htole16(unit->hci_link_policy); 519 1.1.2.2 yamt err = hci_send_cmd(unit, HCI_CMD_WRITE_LINK_POLICY_SETTINGS, 520 1.1.2.2 yamt &cp, sizeof(cp)); 521 1.1.2.2 yamt if (err) 522 1.1.2.2 yamt printf("%s: Warning, could not write link policy\n", 523 1.1.2.2 yamt unit->hci_devname); 524 1.1.2.2 yamt 525 1.1.2.4 yamt err = hci_acl_setmode(link); 526 1.1.2.4 yamt if (err == EINPROGRESS) 527 1.1.2.4 yamt return; 528 1.1.2.4 yamt 529 1.1.2.4 yamt hci_acl_linkmode(link); 530 1.1.2.2 yamt } else { 531 1.1.2.2 yamt (*link->hl_sco->sp_proto->connected)(link->hl_sco->sp_upper); 532 1.1.2.2 yamt } 533 1.1.2.2 yamt } 534 1.1.2.2 yamt 535 1.1.2.2 yamt /* 536 1.1.2.2 yamt * Disconnection Complete 537 1.1.2.2 yamt * 538 1.1.2.2 yamt * This is sent in response to a disconnection request, but also if 539 1.1.2.2 yamt * the remote device goes out of range. 540 1.1.2.2 yamt */ 541 1.1.2.2 yamt static void 542 1.1.2.2 yamt hci_event_discon_compl(struct hci_unit *unit, struct mbuf *m) 543 1.1.2.2 yamt { 544 1.1.2.2 yamt hci_discon_compl_ep ep; 545 1.1.2.2 yamt struct hci_link *link; 546 1.1.2.2 yamt 547 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 548 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 549 1.1.2.2 yamt m_adj(m, sizeof(ep)); 550 1.1.2.2 yamt 551 1.1.2.2 yamt ep.con_handle = le16toh(ep.con_handle); 552 1.1.2.2 yamt 553 1.1.2.2 yamt DPRINTFN(1, "handle #%d, status=0x%x\n", ep.con_handle, ep.status); 554 1.1.2.2 yamt 555 1.1.2.2 yamt link = hci_link_lookup_handle(unit, HCI_CON_HANDLE(ep.con_handle)); 556 1.1.2.2 yamt if (link) 557 1.1.2.2 yamt hci_link_free(link, ENOLINK); 558 1.1.2.2 yamt } 559 1.1.2.2 yamt 560 1.1.2.2 yamt /* 561 1.1.2.2 yamt * Connect Request 562 1.1.2.2 yamt * 563 1.1.2.2 yamt * We check upstream for appropriate listeners and accept connections 564 1.1.2.2 yamt * that are wanted. 565 1.1.2.2 yamt */ 566 1.1.2.2 yamt static void 567 1.1.2.2 yamt hci_event_con_req(struct hci_unit *unit, struct mbuf *m) 568 1.1.2.2 yamt { 569 1.1.2.2 yamt hci_con_req_ep ep; 570 1.1.2.2 yamt hci_accept_con_cp ap; 571 1.1.2.2 yamt hci_reject_con_cp rp; 572 1.1.2.2 yamt struct hci_link *link; 573 1.1.2.2 yamt 574 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 575 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 576 1.1.2.2 yamt m_adj(m, sizeof(ep)); 577 1.1.2.2 yamt 578 1.1.2.2 yamt DPRINTFN(1, "bdaddr %2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x " 579 1.1.2.2 yamt "class %2.2x%2.2x%2.2x type %s\n", 580 1.1.2.2 yamt ep.bdaddr.b[5], ep.bdaddr.b[4], ep.bdaddr.b[3], 581 1.1.2.2 yamt ep.bdaddr.b[2], ep.bdaddr.b[1], ep.bdaddr.b[0], 582 1.1.2.2 yamt ep.uclass[0], ep.uclass[1], ep.uclass[2], 583 1.1.2.2 yamt ep.link_type == HCI_LINK_ACL ? "ACL" : "SCO"); 584 1.1.2.2 yamt 585 1.1.2.2 yamt if (ep.link_type == HCI_LINK_ACL) 586 1.1.2.2 yamt link = hci_acl_newconn(unit, &ep.bdaddr); 587 1.1.2.2 yamt else 588 1.1.2.2 yamt link = hci_sco_newconn(unit, &ep.bdaddr); 589 1.1.2.2 yamt 590 1.1.2.2 yamt if (link == NULL) { 591 1.1.2.2 yamt memset(&rp, 0, sizeof(rp)); 592 1.1.2.2 yamt bdaddr_copy(&rp.bdaddr, &ep.bdaddr); 593 1.1.2.2 yamt rp.reason = 0x0f; /* Unacceptable BD_ADDR */ 594 1.1.2.2 yamt 595 1.1.2.2 yamt hci_send_cmd(unit, HCI_CMD_REJECT_CON, &rp, sizeof(rp)); 596 1.1.2.2 yamt } else { 597 1.1.2.2 yamt memset(&ap, 0, sizeof(ap)); 598 1.1.2.2 yamt bdaddr_copy(&ap.bdaddr, &ep.bdaddr); 599 1.1.2.2 yamt if (unit->hci_link_policy & HCI_LINK_POLICY_ENABLE_ROLE_SWITCH) 600 1.1.2.2 yamt ap.role = HCI_ROLE_MASTER; 601 1.1.2.2 yamt else 602 1.1.2.2 yamt ap.role = HCI_ROLE_SLAVE; 603 1.1.2.2 yamt 604 1.1.2.2 yamt hci_send_cmd(unit, HCI_CMD_ACCEPT_CON, &ap, sizeof(ap)); 605 1.1.2.2 yamt } 606 1.1.2.2 yamt } 607 1.1.2.2 yamt 608 1.1.2.2 yamt /* 609 1.1.2.4 yamt * Auth Complete 610 1.1.2.4 yamt * 611 1.1.2.4 yamt * Authentication has been completed on an ACL link. We can notify the 612 1.1.2.4 yamt * upper layer protocols unless further mode changes are pending. 613 1.1.2.4 yamt */ 614 1.1.2.4 yamt static void 615 1.1.2.4 yamt hci_event_auth_compl(struct hci_unit *unit, struct mbuf *m) 616 1.1.2.4 yamt { 617 1.1.2.4 yamt hci_auth_compl_ep ep; 618 1.1.2.4 yamt struct hci_link *link; 619 1.1.2.4 yamt int err; 620 1.1.2.4 yamt 621 1.1.2.4 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 622 1.1.2.4 yamt m_copydata(m, 0, sizeof(ep), &ep); 623 1.1.2.4 yamt m_adj(m, sizeof(ep)); 624 1.1.2.4 yamt 625 1.1.2.4 yamt ep.con_handle = HCI_CON_HANDLE(le16toh(ep.con_handle)); 626 1.1.2.4 yamt 627 1.1.2.4 yamt DPRINTFN(1, "handle #%d, status=0x%x\n", ep.con_handle, ep.status); 628 1.1.2.4 yamt 629 1.1.2.4 yamt link = hci_link_lookup_handle(unit, ep.con_handle); 630 1.1.2.4 yamt if (link == NULL || link->hl_type != HCI_LINK_ACL) 631 1.1.2.4 yamt return; 632 1.1.2.4 yamt 633 1.1.2.4 yamt if (ep.status == 0) { 634 1.1.2.4 yamt link->hl_flags |= HCI_LINK_AUTH; 635 1.1.2.4 yamt 636 1.1.2.4 yamt if (link->hl_state == HCI_LINK_WAIT_AUTH) 637 1.1.2.4 yamt link->hl_state = HCI_LINK_OPEN; 638 1.1.2.4 yamt 639 1.1.2.4 yamt err = hci_acl_setmode(link); 640 1.1.2.4 yamt if (err == EINPROGRESS) 641 1.1.2.4 yamt return; 642 1.1.2.4 yamt } 643 1.1.2.4 yamt 644 1.1.2.4 yamt hci_acl_linkmode(link); 645 1.1.2.4 yamt } 646 1.1.2.4 yamt 647 1.1.2.4 yamt /* 648 1.1.2.4 yamt * Encryption Change 649 1.1.2.4 yamt * 650 1.1.2.4 yamt * The encryption status has changed. Basically, we note the change 651 1.1.2.4 yamt * then notify the upper layer protocol unless further mode changes 652 1.1.2.4 yamt * are pending. 653 1.1.2.4 yamt * Note that if encryption gets disabled when it has been requested, 654 1.1.2.4 yamt * we will attempt to enable it again.. (its a feature not a bug :) 655 1.1.2.4 yamt */ 656 1.1.2.4 yamt static void 657 1.1.2.4 yamt hci_event_encryption_change(struct hci_unit *unit, struct mbuf *m) 658 1.1.2.4 yamt { 659 1.1.2.4 yamt hci_encryption_change_ep ep; 660 1.1.2.4 yamt struct hci_link *link; 661 1.1.2.4 yamt int err; 662 1.1.2.4 yamt 663 1.1.2.4 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 664 1.1.2.4 yamt m_copydata(m, 0, sizeof(ep), &ep); 665 1.1.2.4 yamt m_adj(m, sizeof(ep)); 666 1.1.2.4 yamt 667 1.1.2.4 yamt ep.con_handle = HCI_CON_HANDLE(le16toh(ep.con_handle)); 668 1.1.2.4 yamt 669 1.1.2.4 yamt DPRINTFN(1, "handle #%d, status=0x%x, encryption_enable=0x%x\n", 670 1.1.2.4 yamt ep.con_handle, ep.status, ep.encryption_enable); 671 1.1.2.4 yamt 672 1.1.2.4 yamt link = hci_link_lookup_handle(unit, ep.con_handle); 673 1.1.2.4 yamt if (link == NULL || link->hl_type != HCI_LINK_ACL) 674 1.1.2.4 yamt return; 675 1.1.2.4 yamt 676 1.1.2.4 yamt if (ep.status == 0) { 677 1.1.2.4 yamt if (ep.encryption_enable == 0) 678 1.1.2.4 yamt link->hl_flags &= ~HCI_LINK_ENCRYPT; 679 1.1.2.4 yamt else 680 1.1.2.4 yamt link->hl_flags |= (HCI_LINK_AUTH | HCI_LINK_ENCRYPT); 681 1.1.2.4 yamt 682 1.1.2.4 yamt if (link->hl_state == HCI_LINK_WAIT_ENCRYPT) 683 1.1.2.4 yamt link->hl_state = HCI_LINK_OPEN; 684 1.1.2.4 yamt 685 1.1.2.4 yamt err = hci_acl_setmode(link); 686 1.1.2.4 yamt if (err == EINPROGRESS) 687 1.1.2.4 yamt return; 688 1.1.2.4 yamt } 689 1.1.2.4 yamt 690 1.1.2.4 yamt hci_acl_linkmode(link); 691 1.1.2.4 yamt } 692 1.1.2.4 yamt 693 1.1.2.4 yamt /* 694 1.1.2.4 yamt * Change Connection Link Key Complete 695 1.1.2.4 yamt * 696 1.1.2.4 yamt * Link keys are handled in userland but if we are waiting to secure 697 1.1.2.4 yamt * this link, we should notify the upper protocols. A SECURE request 698 1.1.2.4 yamt * only needs a single key change, so we can cancel the request. 699 1.1.2.4 yamt */ 700 1.1.2.4 yamt static void 701 1.1.2.4 yamt hci_event_change_con_link_key_compl(struct hci_unit *unit, struct mbuf *m) 702 1.1.2.4 yamt { 703 1.1.2.4 yamt hci_change_con_link_key_compl_ep ep; 704 1.1.2.4 yamt struct hci_link *link; 705 1.1.2.4 yamt int err; 706 1.1.2.4 yamt 707 1.1.2.4 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 708 1.1.2.4 yamt m_copydata(m, 0, sizeof(ep), &ep); 709 1.1.2.4 yamt m_adj(m, sizeof(ep)); 710 1.1.2.4 yamt 711 1.1.2.4 yamt ep.con_handle = HCI_CON_HANDLE(le16toh(ep.con_handle)); 712 1.1.2.4 yamt 713 1.1.2.4 yamt DPRINTFN(1, "handle #%d, status=0x%x\n", ep.con_handle, ep.status); 714 1.1.2.4 yamt 715 1.1.2.4 yamt link = hci_link_lookup_handle(unit, ep.con_handle); 716 1.1.2.4 yamt if (link == NULL || link->hl_type != HCI_LINK_ACL) 717 1.1.2.4 yamt return; 718 1.1.2.4 yamt 719 1.1.2.4 yamt link->hl_flags &= ~HCI_LINK_SECURE_REQ; 720 1.1.2.4 yamt 721 1.1.2.4 yamt if (ep.status == 0) { 722 1.1.2.4 yamt link->hl_flags |= (HCI_LINK_AUTH | HCI_LINK_SECURE); 723 1.1.2.4 yamt 724 1.1.2.4 yamt if (link->hl_state == HCI_LINK_WAIT_SECURE) 725 1.1.2.4 yamt link->hl_state = HCI_LINK_OPEN; 726 1.1.2.4 yamt 727 1.1.2.4 yamt err = hci_acl_setmode(link); 728 1.1.2.4 yamt if (err == EINPROGRESS) 729 1.1.2.4 yamt return; 730 1.1.2.4 yamt } 731 1.1.2.4 yamt 732 1.1.2.4 yamt hci_acl_linkmode(link); 733 1.1.2.4 yamt } 734 1.1.2.4 yamt 735 1.1.2.4 yamt /* 736 1.1.2.2 yamt * process results of read_bdaddr command_complete event 737 1.1.2.2 yamt */ 738 1.1.2.2 yamt static void 739 1.1.2.2 yamt hci_cmd_read_bdaddr(struct hci_unit *unit, struct mbuf *m) 740 1.1.2.2 yamt { 741 1.1.2.2 yamt hci_read_bdaddr_rp rp; 742 1.1.2.2 yamt int s; 743 1.1.2.2 yamt 744 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(rp)); 745 1.1.2.2 yamt m_copydata(m, 0, sizeof(rp), &rp); 746 1.1.2.2 yamt m_adj(m, sizeof(rp)); 747 1.1.2.2 yamt 748 1.1.2.2 yamt if (rp.status > 0) 749 1.1.2.2 yamt return; 750 1.1.2.2 yamt 751 1.1.2.2 yamt if ((unit->hci_flags & BTF_INIT_BDADDR) == 0) 752 1.1.2.2 yamt return; 753 1.1.2.2 yamt 754 1.1.2.2 yamt bdaddr_copy(&unit->hci_bdaddr, &rp.bdaddr); 755 1.1.2.2 yamt 756 1.1.2.2 yamt s = splraiseipl(unit->hci_ipl); 757 1.1.2.2 yamt unit->hci_flags &= ~BTF_INIT_BDADDR; 758 1.1.2.2 yamt splx(s); 759 1.1.2.2 yamt 760 1.1.2.2 yamt wakeup(unit); 761 1.1.2.2 yamt } 762 1.1.2.2 yamt 763 1.1.2.2 yamt /* 764 1.1.2.2 yamt * process results of read_buffer_size command_complete event 765 1.1.2.2 yamt */ 766 1.1.2.2 yamt static void 767 1.1.2.2 yamt hci_cmd_read_buffer_size(struct hci_unit *unit, struct mbuf *m) 768 1.1.2.2 yamt { 769 1.1.2.2 yamt hci_read_buffer_size_rp rp; 770 1.1.2.2 yamt int s; 771 1.1.2.2 yamt 772 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(rp)); 773 1.1.2.2 yamt m_copydata(m, 0, sizeof(rp), &rp); 774 1.1.2.2 yamt m_adj(m, sizeof(rp)); 775 1.1.2.2 yamt 776 1.1.2.2 yamt if (rp.status > 0) 777 1.1.2.2 yamt return; 778 1.1.2.2 yamt 779 1.1.2.2 yamt if ((unit->hci_flags & BTF_INIT_BUFFER_SIZE) == 0) 780 1.1.2.2 yamt return; 781 1.1.2.2 yamt 782 1.1.2.2 yamt unit->hci_max_acl_size = le16toh(rp.max_acl_size); 783 1.1.2.2 yamt unit->hci_num_acl_pkts = le16toh(rp.num_acl_pkts); 784 1.1.2.2 yamt unit->hci_max_sco_size = rp.max_sco_size; 785 1.1.2.2 yamt unit->hci_num_sco_pkts = le16toh(rp.num_sco_pkts); 786 1.1.2.2 yamt 787 1.1.2.2 yamt s = splraiseipl(unit->hci_ipl); 788 1.1.2.2 yamt unit->hci_flags &= ~BTF_INIT_BUFFER_SIZE; 789 1.1.2.2 yamt splx(s); 790 1.1.2.2 yamt 791 1.1.2.2 yamt wakeup(unit); 792 1.1.2.2 yamt } 793 1.1.2.2 yamt 794 1.1.2.2 yamt /* 795 1.1.2.2 yamt * process results of read_local_features command_complete event 796 1.1.2.2 yamt */ 797 1.1.2.2 yamt static void 798 1.1.2.2 yamt hci_cmd_read_local_features(struct hci_unit *unit, struct mbuf *m) 799 1.1.2.2 yamt { 800 1.1.2.2 yamt hci_read_local_features_rp rp; 801 1.1.2.2 yamt int s; 802 1.1.2.2 yamt 803 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(rp)); 804 1.1.2.2 yamt m_copydata(m, 0, sizeof(rp), &rp); 805 1.1.2.2 yamt m_adj(m, sizeof(rp)); 806 1.1.2.2 yamt 807 1.1.2.2 yamt if (rp.status > 0) 808 1.1.2.2 yamt return; 809 1.1.2.2 yamt 810 1.1.2.2 yamt if ((unit->hci_flags & BTF_INIT_FEATURES) == 0) 811 1.1.2.2 yamt return; 812 1.1.2.2 yamt 813 1.1.2.2 yamt unit->hci_lmp_mask = 0; 814 1.1.2.2 yamt 815 1.1.2.2 yamt if (rp.features[0] & HCI_LMP_ROLE_SWITCH) 816 1.1.2.2 yamt unit->hci_lmp_mask |= HCI_LINK_POLICY_ENABLE_ROLE_SWITCH; 817 1.1.2.2 yamt 818 1.1.2.2 yamt if (rp.features[0] & HCI_LMP_HOLD_MODE) 819 1.1.2.2 yamt unit->hci_lmp_mask |= HCI_LINK_POLICY_ENABLE_HOLD_MODE; 820 1.1.2.2 yamt 821 1.1.2.2 yamt if (rp.features[0] & HCI_LMP_SNIFF_MODE) 822 1.1.2.2 yamt unit->hci_lmp_mask |= HCI_LINK_POLICY_ENABLE_SNIFF_MODE; 823 1.1.2.2 yamt 824 1.1.2.2 yamt if (rp.features[1] & HCI_LMP_PARK_MODE) 825 1.1.2.2 yamt unit->hci_lmp_mask |= HCI_LINK_POLICY_ENABLE_PARK_MODE; 826 1.1.2.2 yamt 827 1.1.2.2 yamt /* ACL packet mask */ 828 1.1.2.2 yamt unit->hci_acl_mask = HCI_PKT_DM1 | HCI_PKT_DH1; 829 1.1.2.2 yamt 830 1.1.2.2 yamt if (rp.features[0] & HCI_LMP_3SLOT) 831 1.1.2.2 yamt unit->hci_acl_mask |= HCI_PKT_DM3 | HCI_PKT_DH3; 832 1.1.2.2 yamt 833 1.1.2.2 yamt if (rp.features[0] & HCI_LMP_5SLOT) 834 1.1.2.2 yamt unit->hci_acl_mask |= HCI_PKT_DM5 | HCI_PKT_DH5; 835 1.1.2.2 yamt 836 1.1.2.2 yamt if ((rp.features[3] & HCI_LMP_EDR_ACL_2MBPS) == 0) 837 1.1.2.2 yamt unit->hci_acl_mask |= HCI_PKT_2MBPS_DH1 838 1.1.2.2 yamt | HCI_PKT_2MBPS_DH3 839 1.1.2.2 yamt | HCI_PKT_2MBPS_DH5; 840 1.1.2.2 yamt 841 1.1.2.2 yamt if ((rp.features[3] & HCI_LMP_EDR_ACL_3MBPS) == 0) 842 1.1.2.2 yamt unit->hci_acl_mask |= HCI_PKT_3MBPS_DH1 843 1.1.2.2 yamt | HCI_PKT_3MBPS_DH3 844 1.1.2.2 yamt | HCI_PKT_3MBPS_DH5; 845 1.1.2.2 yamt 846 1.1.2.2 yamt if ((rp.features[4] & HCI_LMP_3SLOT_EDR_ACL) == 0) 847 1.1.2.2 yamt unit->hci_acl_mask |= HCI_PKT_2MBPS_DH3 848 1.1.2.2 yamt | HCI_PKT_3MBPS_DH3; 849 1.1.2.2 yamt 850 1.1.2.2 yamt if ((rp.features[5] & HCI_LMP_5SLOT_EDR_ACL) == 0) 851 1.1.2.2 yamt unit->hci_acl_mask |= HCI_PKT_2MBPS_DH5 852 1.1.2.2 yamt | HCI_PKT_3MBPS_DH5; 853 1.1.2.2 yamt 854 1.1.2.2 yamt unit->hci_packet_type = unit->hci_acl_mask; 855 1.1.2.2 yamt 856 1.1.2.2 yamt /* SCO packet mask */ 857 1.1.2.2 yamt unit->hci_sco_mask = 0; 858 1.1.2.2 yamt if (rp.features[1] & HCI_LMP_SCO_LINK) 859 1.1.2.2 yamt unit->hci_sco_mask |= HCI_PKT_HV1; 860 1.1.2.2 yamt 861 1.1.2.2 yamt if (rp.features[1] & HCI_LMP_HV2_PKT) 862 1.1.2.2 yamt unit->hci_sco_mask |= HCI_PKT_HV2; 863 1.1.2.2 yamt 864 1.1.2.2 yamt if (rp.features[1] & HCI_LMP_HV3_PKT) 865 1.1.2.2 yamt unit->hci_sco_mask |= HCI_PKT_HV3; 866 1.1.2.2 yamt 867 1.1.2.2 yamt if (rp.features[3] & HCI_LMP_EV3_PKT) 868 1.1.2.2 yamt unit->hci_sco_mask |= HCI_PKT_EV3; 869 1.1.2.2 yamt 870 1.1.2.2 yamt if (rp.features[4] & HCI_LMP_EV4_PKT) 871 1.1.2.2 yamt unit->hci_sco_mask |= HCI_PKT_EV4; 872 1.1.2.2 yamt 873 1.1.2.2 yamt if (rp.features[4] & HCI_LMP_EV5_PKT) 874 1.1.2.2 yamt unit->hci_sco_mask |= HCI_PKT_EV5; 875 1.1.2.2 yamt 876 1.1.2.4 yamt /* XXX what do 2MBPS/3MBPS/3SLOT eSCO mean? */ 877 1.1.2.2 yamt 878 1.1.2.2 yamt s = splraiseipl(unit->hci_ipl); 879 1.1.2.2 yamt unit->hci_flags &= ~BTF_INIT_FEATURES; 880 1.1.2.2 yamt splx(s); 881 1.1.2.2 yamt 882 1.1.2.2 yamt wakeup(unit); 883 1.1.2.2 yamt 884 1.1.2.2 yamt DPRINTFN(1, "%s: lmp_mask %4.4x, acl_mask %4.4x, sco_mask %4.4x\n", 885 1.1.2.2 yamt unit->hci_devname, unit->hci_lmp_mask, 886 1.1.2.2 yamt unit->hci_acl_mask, unit->hci_sco_mask); 887 1.1.2.2 yamt } 888 1.1.2.2 yamt 889 1.1.2.2 yamt /* 890 1.1.2.2 yamt * process results of reset command_complete event 891 1.1.2.2 yamt * 892 1.1.2.2 yamt * This has killed all the connections, so close down anything we have left, 893 1.1.2.2 yamt * and reinitialise the unit. 894 1.1.2.2 yamt */ 895 1.1.2.2 yamt static void 896 1.1.2.2 yamt hci_cmd_reset(struct hci_unit *unit, struct mbuf *m) 897 1.1.2.2 yamt { 898 1.1.2.2 yamt hci_reset_rp rp; 899 1.1.2.2 yamt struct hci_link *link, *next; 900 1.1.2.2 yamt int acl; 901 1.1.2.2 yamt 902 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(rp)); 903 1.1.2.2 yamt m_copydata(m, 0, sizeof(rp), &rp); 904 1.1.2.2 yamt m_adj(m, sizeof(rp)); 905 1.1.2.2 yamt 906 1.1.2.2 yamt if (rp.status != 0) 907 1.1.2.2 yamt return; 908 1.1.2.2 yamt 909 1.1.2.2 yamt /* 910 1.1.2.2 yamt * release SCO links first, since they may be holding 911 1.1.2.2 yamt * an ACL link reference. 912 1.1.2.2 yamt */ 913 1.1.2.2 yamt for (acl = 0 ; acl < 2 ; acl++) { 914 1.1.2.2 yamt next = TAILQ_FIRST(&unit->hci_links); 915 1.1.2.2 yamt while ((link = next) != NULL) { 916 1.1.2.2 yamt next = TAILQ_NEXT(link, hl_next); 917 1.1.2.2 yamt if (acl || link->hl_type != HCI_LINK_ACL) 918 1.1.2.2 yamt hci_link_free(link, ECONNABORTED); 919 1.1.2.2 yamt } 920 1.1.2.2 yamt } 921 1.1.2.2 yamt 922 1.1.2.2 yamt unit->hci_num_acl_pkts = 0; 923 1.1.2.2 yamt unit->hci_num_sco_pkts = 0; 924 1.1.2.2 yamt 925 1.1.2.2 yamt if (hci_send_cmd(unit, HCI_CMD_READ_BDADDR, NULL, 0)) 926 1.1.2.2 yamt return; 927 1.1.2.2 yamt 928 1.1.2.2 yamt if (hci_send_cmd(unit, HCI_CMD_READ_BUFFER_SIZE, NULL, 0)) 929 1.1.2.2 yamt return; 930 1.1.2.2 yamt 931 1.1.2.2 yamt if (hci_send_cmd(unit, HCI_CMD_READ_LOCAL_FEATURES, NULL, 0)) 932 1.1.2.2 yamt return; 933 1.1.2.2 yamt } 934
Indexes created Wed Oct 22 13:09:56 GMT 2025