hci_event.c revision 1.1.2.3
1 1.1.2.3 yamt /* $NetBSD: hci_event.c,v 1.1.2.3 2006/12/30 20:50:32 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.3 yamt __KERNEL_RCSID(0, "$NetBSD: hci_event.c,v 1.1.2.3 2006/12/30 20:50:32 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.2 yamt static void hci_cmd_read_bdaddr(struct hci_unit *, struct mbuf *); 55 1.1.2.2 yamt static void hci_cmd_read_buffer_size(struct hci_unit *, struct mbuf *); 56 1.1.2.2 yamt static void hci_cmd_read_local_features(struct hci_unit *, struct mbuf *); 57 1.1.2.2 yamt static void hci_cmd_reset(struct hci_unit *, struct mbuf *); 58 1.1.2.2 yamt 59 1.1.2.2 yamt #ifdef BLUETOOTH_DEBUG 60 1.1.2.2 yamt int bluetooth_debug = BLUETOOTH_DEBUG; 61 1.1.2.2 yamt 62 1.1.2.2 yamt static const char *hci_eventnames[] = { 63 1.1.2.2 yamt /* 0x00 */ "NULL", 64 1.1.2.2 yamt /* 0x01 */ "INQUIRY COMPLETE", 65 1.1.2.2 yamt /* 0x02 */ "INQUIRY RESULT", 66 1.1.2.2 yamt /* 0x03 */ "CONN COMPLETE", 67 1.1.2.2 yamt /* 0x04 */ "CONN REQ", 68 1.1.2.2 yamt /* 0x05 */ "DISCONN COMPLETE", 69 1.1.2.2 yamt /* 0x06 */ "AUTH COMPLETE", 70 1.1.2.2 yamt /* 0x07 */ "REMOTE NAME REQ COMPLETE", 71 1.1.2.2 yamt /* 0x08 */ "ENCRYPTION CHANGE", 72 1.1.2.2 yamt /* 0x09 */ "CHANGE CONN LINK KEY COMPLETE", 73 1.1.2.2 yamt /* 0x0a */ "MASTER LINK KEY COMPLETE", 74 1.1.2.2 yamt /* 0x0b */ "READ REMOTE FEATURES COMPLETE", 75 1.1.2.2 yamt /* 0x0c */ "READ REMOTE VERSION INFO COMPLETE", 76 1.1.2.2 yamt /* 0x0d */ "QoS SETUP COMPLETE", 77 1.1.2.2 yamt /* 0x0e */ "COMMAND COMPLETE", 78 1.1.2.2 yamt /* 0x0f */ "COMMAND STATUS", 79 1.1.2.2 yamt /* 0x10 */ "HARDWARE ERROR", 80 1.1.2.2 yamt /* 0x11 */ "FLUSH OCCUR", 81 1.1.2.2 yamt /* 0x12 */ "ROLE CHANGE", 82 1.1.2.2 yamt /* 0x13 */ "NUM COMPLETED PACKETS", 83 1.1.2.2 yamt /* 0x14 */ "MODE CHANGE", 84 1.1.2.2 yamt /* 0x15 */ "RETURN LINK KEYS", 85 1.1.2.2 yamt /* 0x16 */ "PIN CODE REQ", 86 1.1.2.2 yamt /* 0x17 */ "LINK KEY REQ", 87 1.1.2.2 yamt /* 0x18 */ "LINK KEY NOTIFICATION", 88 1.1.2.2 yamt /* 0x19 */ "LOOPBACK COMMAND", 89 1.1.2.2 yamt /* 0x1a */ "DATA BUFFER OVERFLOW", 90 1.1.2.2 yamt /* 0x1b */ "MAX SLOT CHANGE", 91 1.1.2.2 yamt /* 0x1c */ "READ CLOCK OFFSET COMPLETE", 92 1.1.2.2 yamt /* 0x1d */ "CONN PKT TYPE CHANGED", 93 1.1.2.2 yamt /* 0x1e */ "QOS VIOLATION", 94 1.1.2.2 yamt /* 0x1f */ "PAGE SCAN MODE CHANGE", 95 1.1.2.2 yamt /* 0x20 */ "PAGE SCAN REP MODE CHANGE", 96 1.1.2.2 yamt /* 0x21 */ "FLOW SPECIFICATION COMPLETE", 97 1.1.2.2 yamt /* 0x22 */ "RSSI RESULT", 98 1.1.2.2 yamt /* 0x23 */ "READ REMOTE EXT FEATURES" 99 1.1.2.2 yamt }; 100 1.1.2.2 yamt 101 1.1.2.2 yamt static const char * 102 1.1.2.2 yamt hci_eventstr(unsigned int event) 103 1.1.2.2 yamt { 104 1.1.2.2 yamt 105 1.1.2.2 yamt if (event < (sizeof(hci_eventnames) / sizeof(*hci_eventnames))) 106 1.1.2.2 yamt return hci_eventnames[event]; 107 1.1.2.2 yamt 108 1.1.2.2 yamt switch (event) { 109 1.1.2.2 yamt case HCI_EVENT_SCO_CON_COMPL: /* 0x2c */ 110 1.1.2.2 yamt return "SCO CON COMPLETE"; 111 1.1.2.2 yamt 112 1.1.2.2 yamt case HCI_EVENT_SCO_CON_CHANGED: /* 0x2d */ 113 1.1.2.2 yamt return "SCO CON CHANGED"; 114 1.1.2.2 yamt 115 1.1.2.2 yamt case HCI_EVENT_BT_LOGO: /* 0xfe */ 116 1.1.2.2 yamt return "BT_LOGO"; 117 1.1.2.2 yamt 118 1.1.2.2 yamt case HCI_EVENT_VENDOR: /* 0xff */ 119 1.1.2.2 yamt return "VENDOR"; 120 1.1.2.2 yamt } 121 1.1.2.2 yamt 122 1.1.2.2 yamt return "UNRECOGNISED"; 123 1.1.2.2 yamt } 124 1.1.2.2 yamt #endif /* BLUETOOTH_DEBUG */ 125 1.1.2.2 yamt 126 1.1.2.2 yamt /* 127 1.1.2.2 yamt * process HCI Events 128 1.1.2.2 yamt * 129 1.1.2.2 yamt * We will free the mbuf at the end, no need for any sub 130 1.1.2.2 yamt * functions to handle that. We kind of assume that the 131 1.1.2.2 yamt * device sends us valid events. 132 1.1.2.2 yamt */ 133 1.1.2.2 yamt void 134 1.1.2.2 yamt hci_event(struct mbuf *m, struct hci_unit *unit) 135 1.1.2.2 yamt { 136 1.1.2.2 yamt hci_event_hdr_t hdr; 137 1.1.2.2 yamt 138 1.1.2.2 yamt KASSERT(m->m_flags & M_PKTHDR); 139 1.1.2.2 yamt 140 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(hdr)); 141 1.1.2.2 yamt m_copydata(m, 0, sizeof(hdr), &hdr); 142 1.1.2.2 yamt m_adj(m, sizeof(hdr)); 143 1.1.2.2 yamt 144 1.1.2.2 yamt KASSERT(hdr.type == HCI_EVENT_PKT); 145 1.1.2.2 yamt 146 1.1.2.2 yamt DPRINTFN(1, "(%s) event %s\n", unit->hci_devname, hci_eventstr(hdr.event)); 147 1.1.2.2 yamt 148 1.1.2.2 yamt switch(hdr.event) { 149 1.1.2.2 yamt case HCI_EVENT_COMMAND_STATUS: 150 1.1.2.2 yamt hci_event_command_status(unit, m); 151 1.1.2.2 yamt break; 152 1.1.2.2 yamt 153 1.1.2.2 yamt case HCI_EVENT_COMMAND_COMPL: 154 1.1.2.2 yamt hci_event_command_compl(unit, m); 155 1.1.2.2 yamt break; 156 1.1.2.2 yamt 157 1.1.2.2 yamt case HCI_EVENT_NUM_COMPL_PKTS: 158 1.1.2.2 yamt hci_event_num_compl_pkts(unit, m); 159 1.1.2.2 yamt break; 160 1.1.2.2 yamt 161 1.1.2.2 yamt case HCI_EVENT_INQUIRY_RESULT: 162 1.1.2.2 yamt hci_event_inquiry_result(unit, m); 163 1.1.2.2 yamt break; 164 1.1.2.2 yamt 165 1.1.2.2 yamt case HCI_EVENT_CON_COMPL: 166 1.1.2.2 yamt hci_event_con_compl(unit, m); 167 1.1.2.2 yamt break; 168 1.1.2.2 yamt 169 1.1.2.2 yamt case HCI_EVENT_DISCON_COMPL: 170 1.1.2.2 yamt hci_event_discon_compl(unit, m); 171 1.1.2.2 yamt break; 172 1.1.2.2 yamt 173 1.1.2.2 yamt case HCI_EVENT_CON_REQ: 174 1.1.2.2 yamt hci_event_con_req(unit, m); 175 1.1.2.2 yamt break; 176 1.1.2.2 yamt 177 1.1.2.2 yamt case HCI_EVENT_SCO_CON_COMPL: 178 1.1.2.2 yamt case HCI_EVENT_INQUIRY_COMPL: 179 1.1.2.2 yamt case HCI_EVENT_AUTH_COMPL: 180 1.1.2.2 yamt case HCI_EVENT_REMOTE_NAME_REQ_COMPL: 181 1.1.2.2 yamt case HCI_EVENT_ENCRYPTION_CHANGE: 182 1.1.2.2 yamt case HCI_EVENT_CHANGE_CON_LINK_KEY_COMPL: 183 1.1.2.2 yamt case HCI_EVENT_MASTER_LINK_KEY_COMPL: 184 1.1.2.2 yamt case HCI_EVENT_READ_REMOTE_FEATURES_COMPL: 185 1.1.2.2 yamt case HCI_EVENT_READ_REMOTE_VER_INFO_COMPL: 186 1.1.2.2 yamt case HCI_EVENT_QOS_SETUP_COMPL: 187 1.1.2.2 yamt case HCI_EVENT_HARDWARE_ERROR: 188 1.1.2.2 yamt case HCI_EVENT_FLUSH_OCCUR: 189 1.1.2.2 yamt case HCI_EVENT_ROLE_CHANGE: 190 1.1.2.2 yamt case HCI_EVENT_MODE_CHANGE: 191 1.1.2.2 yamt case HCI_EVENT_RETURN_LINK_KEYS: 192 1.1.2.2 yamt case HCI_EVENT_PIN_CODE_REQ: 193 1.1.2.2 yamt case HCI_EVENT_LINK_KEY_REQ: 194 1.1.2.2 yamt case HCI_EVENT_LINK_KEY_NOTIFICATION: 195 1.1.2.2 yamt case HCI_EVENT_LOOPBACK_COMMAND: 196 1.1.2.2 yamt case HCI_EVENT_DATA_BUFFER_OVERFLOW: 197 1.1.2.2 yamt case HCI_EVENT_MAX_SLOT_CHANGE: 198 1.1.2.2 yamt case HCI_EVENT_READ_CLOCK_OFFSET_COMPL: 199 1.1.2.2 yamt case HCI_EVENT_CON_PKT_TYPE_CHANGED: 200 1.1.2.2 yamt case HCI_EVENT_QOS_VIOLATION: 201 1.1.2.2 yamt case HCI_EVENT_PAGE_SCAN_MODE_CHANGE: 202 1.1.2.2 yamt case HCI_EVENT_PAGE_SCAN_REP_MODE_CHANGE: 203 1.1.2.2 yamt case HCI_EVENT_FLOW_SPECIFICATION_COMPL: 204 1.1.2.2 yamt case HCI_EVENT_RSSI_RESULT: 205 1.1.2.2 yamt case HCI_EVENT_READ_REMOTE_EXTENDED_FEATURES: 206 1.1.2.2 yamt case HCI_EVENT_SCO_CON_CHANGED: 207 1.1.2.2 yamt case HCI_EVENT_BT_LOGO: 208 1.1.2.2 yamt case HCI_EVENT_VENDOR: 209 1.1.2.2 yamt break; 210 1.1.2.2 yamt 211 1.1.2.2 yamt default: 212 1.1.2.2 yamt UNKNOWN(hdr.event); 213 1.1.2.2 yamt break; 214 1.1.2.2 yamt } 215 1.1.2.2 yamt 216 1.1.2.2 yamt m_freem(m); 217 1.1.2.2 yamt } 218 1.1.2.2 yamt 219 1.1.2.2 yamt /* 220 1.1.2.2 yamt * Command Status 221 1.1.2.2 yamt * 222 1.1.2.2 yamt * Update our record of num_cmd_pkts then post-process any pending commands 223 1.1.2.2 yamt * and optionally restart cmd output on the unit. 224 1.1.2.2 yamt */ 225 1.1.2.2 yamt static void 226 1.1.2.2 yamt hci_event_command_status(struct hci_unit *unit, struct mbuf *m) 227 1.1.2.2 yamt { 228 1.1.2.2 yamt hci_command_status_ep ep; 229 1.1.2.2 yamt 230 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 231 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 232 1.1.2.2 yamt m_adj(m, sizeof(ep)); 233 1.1.2.2 yamt 234 1.1.2.2 yamt DPRINTFN(1, "(%s) opcode (%03x|%04x) num_cmd_pkts = %d\n", 235 1.1.2.2 yamt unit->hci_devname, 236 1.1.2.2 yamt HCI_OGF(le16toh(ep.opcode)), HCI_OCF(le16toh(ep.opcode)), 237 1.1.2.2 yamt ep.num_cmd_pkts); 238 1.1.2.2 yamt 239 1.1.2.2 yamt unit->hci_num_cmd_pkts = ep.num_cmd_pkts; 240 1.1.2.2 yamt 241 1.1.2.2 yamt /* 242 1.1.2.2 yamt * post processing of pending commands 243 1.1.2.2 yamt */ 244 1.1.2.2 yamt switch(le16toh(ep.opcode)) { 245 1.1.2.2 yamt default: 246 1.1.2.2 yamt break; 247 1.1.2.2 yamt } 248 1.1.2.2 yamt 249 1.1.2.2 yamt while (unit->hci_num_cmd_pkts > 0 && MBUFQ_FIRST(&unit->hci_cmdwait)) { 250 1.1.2.2 yamt MBUFQ_DEQUEUE(&unit->hci_cmdwait, m); 251 1.1.2.2 yamt hci_output_cmd(unit, m); 252 1.1.2.2 yamt } 253 1.1.2.2 yamt } 254 1.1.2.2 yamt 255 1.1.2.2 yamt /* 256 1.1.2.2 yamt * Command Complete 257 1.1.2.2 yamt * 258 1.1.2.2 yamt * Update our record of num_cmd_pkts then handle the completed command, 259 1.1.2.2 yamt * and optionally restart cmd output on the unit. 260 1.1.2.2 yamt */ 261 1.1.2.2 yamt static void 262 1.1.2.2 yamt hci_event_command_compl(struct hci_unit *unit, struct mbuf *m) 263 1.1.2.2 yamt { 264 1.1.2.2 yamt hci_command_compl_ep ep; 265 1.1.2.2 yamt 266 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 267 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 268 1.1.2.2 yamt m_adj(m, sizeof(ep)); 269 1.1.2.2 yamt 270 1.1.2.2 yamt DPRINTFN(1, "(%s) opcode (%03x|%04x) num_cmd_pkts = %d\n", 271 1.1.2.2 yamt unit->hci_devname, 272 1.1.2.2 yamt HCI_OGF(le16toh(ep.opcode)), HCI_OCF(le16toh(ep.opcode)), 273 1.1.2.2 yamt ep.num_cmd_pkts); 274 1.1.2.2 yamt 275 1.1.2.2 yamt unit->hci_num_cmd_pkts = ep.num_cmd_pkts; 276 1.1.2.2 yamt 277 1.1.2.2 yamt /* 278 1.1.2.2 yamt * post processing of completed commands 279 1.1.2.2 yamt */ 280 1.1.2.2 yamt switch(le16toh(ep.opcode)) { 281 1.1.2.2 yamt case HCI_CMD_READ_BDADDR: 282 1.1.2.2 yamt hci_cmd_read_bdaddr(unit, m); 283 1.1.2.2 yamt break; 284 1.1.2.2 yamt 285 1.1.2.2 yamt case HCI_CMD_READ_BUFFER_SIZE: 286 1.1.2.2 yamt hci_cmd_read_buffer_size(unit, m); 287 1.1.2.2 yamt break; 288 1.1.2.2 yamt 289 1.1.2.2 yamt case HCI_CMD_READ_LOCAL_FEATURES: 290 1.1.2.2 yamt hci_cmd_read_local_features(unit, m); 291 1.1.2.2 yamt break; 292 1.1.2.2 yamt 293 1.1.2.2 yamt case HCI_CMD_RESET: 294 1.1.2.2 yamt hci_cmd_reset(unit, m); 295 1.1.2.2 yamt break; 296 1.1.2.2 yamt 297 1.1.2.2 yamt default: 298 1.1.2.2 yamt break; 299 1.1.2.2 yamt } 300 1.1.2.2 yamt 301 1.1.2.2 yamt while (unit->hci_num_cmd_pkts > 0 && MBUFQ_FIRST(&unit->hci_cmdwait)) { 302 1.1.2.2 yamt MBUFQ_DEQUEUE(&unit->hci_cmdwait, m); 303 1.1.2.2 yamt hci_output_cmd(unit, m); 304 1.1.2.2 yamt } 305 1.1.2.2 yamt } 306 1.1.2.2 yamt 307 1.1.2.2 yamt /* 308 1.1.2.2 yamt * Number of Completed Packets 309 1.1.2.2 yamt * 310 1.1.2.2 yamt * This is sent periodically by the Controller telling us how many 311 1.1.2.2 yamt * buffers are now freed up and which handle was using them. From 312 1.1.2.2 yamt * this we determine which type of buffer it was and add the qty 313 1.1.2.2 yamt * back into the relevant packet counter, then restart output on 314 1.1.2.2 yamt * links that have halted. 315 1.1.2.2 yamt */ 316 1.1.2.2 yamt static void 317 1.1.2.2 yamt hci_event_num_compl_pkts(struct hci_unit *unit, struct mbuf *m) 318 1.1.2.2 yamt { 319 1.1.2.2 yamt hci_num_compl_pkts_ep ep; 320 1.1.2.2 yamt struct hci_link *link, *next; 321 1.1.2.2 yamt uint16_t handle, num; 322 1.1.2.2 yamt int num_acl = 0, num_sco = 0; 323 1.1.2.2 yamt 324 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 325 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 326 1.1.2.2 yamt m_adj(m, sizeof(ep)); 327 1.1.2.2 yamt 328 1.1.2.2 yamt while (ep.num_con_handles--) { 329 1.1.2.2 yamt m_copydata(m, 0, sizeof(handle), (caddr_t)&handle); 330 1.1.2.2 yamt m_adj(m, sizeof(handle)); 331 1.1.2.2 yamt handle = le16toh(handle); 332 1.1.2.2 yamt 333 1.1.2.2 yamt m_copydata(m, 0, sizeof(num), (caddr_t)&num); 334 1.1.2.2 yamt m_adj(m, sizeof(num)); 335 1.1.2.2 yamt num = le16toh(num); 336 1.1.2.2 yamt 337 1.1.2.2 yamt link = hci_link_lookup_handle(unit, handle); 338 1.1.2.2 yamt if (link) { 339 1.1.2.2 yamt if (link->hl_type == HCI_LINK_ACL) { 340 1.1.2.2 yamt num_acl += num; 341 1.1.2.2 yamt hci_acl_complete(link, num); 342 1.1.2.2 yamt } else { 343 1.1.2.2 yamt num_sco += num; 344 1.1.2.2 yamt hci_sco_complete(link, num); 345 1.1.2.2 yamt } 346 1.1.2.2 yamt } else { 347 1.1.2.2 yamt // XXX need to issue Read_Buffer_Size or Reset? 348 1.1.2.2 yamt printf("%s: unknown handle %d! " 349 1.1.2.2 yamt "(losing track of %d packet buffer%s)\n", 350 1.1.2.2 yamt unit->hci_devname, handle, 351 1.1.2.2 yamt num, (num == 1 ? "" : "s")); 352 1.1.2.2 yamt } 353 1.1.2.2 yamt } 354 1.1.2.2 yamt 355 1.1.2.2 yamt /* 356 1.1.2.2 yamt * Move up any queued packets. When a link has sent data, it will move 357 1.1.2.2 yamt * to the back of the queue - technically then if a link had something 358 1.1.2.2 yamt * to send and there were still buffers available it could get started 359 1.1.2.2 yamt * twice but it seemed more important to to handle higher loads fairly 360 1.1.2.2 yamt * than worry about wasting cycles when we are not busy. 361 1.1.2.2 yamt */ 362 1.1.2.2 yamt 363 1.1.2.2 yamt unit->hci_num_acl_pkts += num_acl; 364 1.1.2.2 yamt unit->hci_num_sco_pkts += num_sco; 365 1.1.2.2 yamt 366 1.1.2.2 yamt link = TAILQ_FIRST(&unit->hci_links); 367 1.1.2.2 yamt while (link && (unit->hci_num_acl_pkts > 0 || unit->hci_num_sco_pkts > 0)) { 368 1.1.2.2 yamt next = TAILQ_NEXT(link, hl_next); 369 1.1.2.2 yamt 370 1.1.2.2 yamt if (link->hl_type == HCI_LINK_ACL) { 371 1.1.2.2 yamt if (unit->hci_num_acl_pkts > 0 && link->hl_txqlen > 0) 372 1.1.2.2 yamt hci_acl_start(link); 373 1.1.2.2 yamt } else { 374 1.1.2.2 yamt if (unit->hci_num_sco_pkts > 0 && link->hl_txqlen > 0) 375 1.1.2.2 yamt hci_sco_start(link); 376 1.1.2.2 yamt } 377 1.1.2.2 yamt 378 1.1.2.2 yamt link = next; 379 1.1.2.2 yamt } 380 1.1.2.2 yamt } 381 1.1.2.2 yamt 382 1.1.2.2 yamt /* 383 1.1.2.2 yamt * Inquiry Result 384 1.1.2.2 yamt * 385 1.1.2.2 yamt * keep a note of devices seen, so we know which unit to use 386 1.1.2.2 yamt * on outgoing connections 387 1.1.2.2 yamt */ 388 1.1.2.2 yamt static void 389 1.1.2.2 yamt hci_event_inquiry_result(struct hci_unit *unit, struct mbuf *m) 390 1.1.2.2 yamt { 391 1.1.2.2 yamt hci_inquiry_result_ep ep; 392 1.1.2.2 yamt struct hci_memo *memo; 393 1.1.2.2 yamt bdaddr_t bdaddr; 394 1.1.2.2 yamt 395 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 396 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 397 1.1.2.2 yamt m_adj(m, sizeof(ep)); 398 1.1.2.2 yamt 399 1.1.2.2 yamt DPRINTFN(1, "%d response%s\n", ep.num_responses, 400 1.1.2.2 yamt (ep.num_responses == 1 ? "" : "s")); 401 1.1.2.2 yamt 402 1.1.2.2 yamt while(ep.num_responses--) { 403 1.1.2.2 yamt m_copydata(m, 0, sizeof(bdaddr_t), (caddr_t)&bdaddr); 404 1.1.2.2 yamt 405 1.1.2.2 yamt DPRINTFN(1, "bdaddr %02x:%02x:%02x:%02x:%02x:%02x\n", 406 1.1.2.2 yamt bdaddr.b[5], bdaddr.b[4], bdaddr.b[3], 407 1.1.2.2 yamt bdaddr.b[2], bdaddr.b[1], bdaddr.b[0]); 408 1.1.2.2 yamt 409 1.1.2.2 yamt memo = hci_memo_find(unit, &bdaddr); 410 1.1.2.2 yamt if (memo == NULL) { 411 1.1.2.2 yamt memo = malloc(sizeof(struct hci_memo), 412 1.1.2.2 yamt M_BLUETOOTH, M_NOWAIT | M_ZERO); 413 1.1.2.2 yamt if (memo == NULL) { 414 1.1.2.2 yamt DPRINTFN(0, "out of memo memory!\n"); 415 1.1.2.2 yamt break; 416 1.1.2.2 yamt } 417 1.1.2.2 yamt 418 1.1.2.2 yamt LIST_INSERT_HEAD(&unit->hci_memos, memo, next); 419 1.1.2.2 yamt } 420 1.1.2.2 yamt 421 1.1.2.2 yamt microtime(&memo->time); 422 1.1.2.2 yamt m_copydata(m, 0, sizeof(hci_inquiry_response), 423 1.1.2.2 yamt (caddr_t)&memo->response); 424 1.1.2.2 yamt m_adj(m, sizeof(hci_inquiry_response)); 425 1.1.2.3 yamt 426 1.1.2.3 yamt memo->response.clock_offset = 427 1.1.2.3 yamt le16toh(memo->response.clock_offset); 428 1.1.2.2 yamt } 429 1.1.2.2 yamt } 430 1.1.2.2 yamt 431 1.1.2.2 yamt /* 432 1.1.2.2 yamt * Connection Complete 433 1.1.2.2 yamt * 434 1.1.2.2 yamt * Sent to us when a connection is made. If there is no link 435 1.1.2.2 yamt * structure already allocated for this, we must have changed 436 1.1.2.2 yamt * our mind, so just disconnect. 437 1.1.2.2 yamt */ 438 1.1.2.2 yamt static void 439 1.1.2.2 yamt hci_event_con_compl(struct hci_unit *unit, struct mbuf *m) 440 1.1.2.2 yamt { 441 1.1.2.2 yamt hci_con_compl_ep ep; 442 1.1.2.2 yamt hci_write_link_policy_settings_cp cp; 443 1.1.2.2 yamt struct hci_link *link; 444 1.1.2.2 yamt int err; 445 1.1.2.2 yamt 446 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 447 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 448 1.1.2.2 yamt m_adj(m, sizeof(ep)); 449 1.1.2.2 yamt 450 1.1.2.2 yamt DPRINTFN(1, "(%s) %s connection complete for " 451 1.1.2.2 yamt "%02x:%02x:%02x:%02x:%02x:%02x status %#x\n", 452 1.1.2.2 yamt unit->hci_devname, 453 1.1.2.2 yamt (ep.link_type == HCI_LINK_ACL ? "ACL" : "SCO"), 454 1.1.2.2 yamt ep.bdaddr.b[5], ep.bdaddr.b[4], ep.bdaddr.b[3], 455 1.1.2.2 yamt ep.bdaddr.b[2], ep.bdaddr.b[1], ep.bdaddr.b[0], 456 1.1.2.2 yamt ep.status); 457 1.1.2.2 yamt 458 1.1.2.2 yamt link = hci_link_lookup_bdaddr(unit, &ep.bdaddr, ep.link_type); 459 1.1.2.2 yamt 460 1.1.2.2 yamt if (ep.status) { 461 1.1.2.2 yamt if (link != NULL) { 462 1.1.2.2 yamt switch (ep.status) { 463 1.1.2.2 yamt case 0x04: /* "Page Timeout" */ 464 1.1.2.2 yamt err = EHOSTDOWN; 465 1.1.2.2 yamt break; 466 1.1.2.2 yamt 467 1.1.2.2 yamt case 0x08: /* "Connection Timed Out" */ 468 1.1.2.2 yamt err = ETIMEDOUT; 469 1.1.2.2 yamt break; 470 1.1.2.2 yamt 471 1.1.2.2 yamt case 0x16: /* "Connection Terminated by Local Host" */ 472 1.1.2.2 yamt err = 0; 473 1.1.2.2 yamt break; 474 1.1.2.2 yamt 475 1.1.2.2 yamt default: 476 1.1.2.2 yamt err = ECONNREFUSED; 477 1.1.2.2 yamt break; 478 1.1.2.2 yamt } 479 1.1.2.2 yamt 480 1.1.2.2 yamt hci_link_free(link, err); 481 1.1.2.2 yamt } 482 1.1.2.2 yamt 483 1.1.2.2 yamt return; 484 1.1.2.2 yamt } 485 1.1.2.2 yamt 486 1.1.2.2 yamt if (link == NULL) { 487 1.1.2.2 yamt hci_discon_cp dp; 488 1.1.2.2 yamt 489 1.1.2.2 yamt dp.con_handle = ep.con_handle; 490 1.1.2.2 yamt dp.reason = 0x13; /* "Remote User Terminated Connection" */ 491 1.1.2.2 yamt 492 1.1.2.2 yamt hci_send_cmd(unit, HCI_CMD_DISCONNECT, &dp, sizeof(dp)); 493 1.1.2.2 yamt return; 494 1.1.2.2 yamt } 495 1.1.2.2 yamt 496 1.1.2.2 yamt link->hl_state = HCI_LINK_OPEN; 497 1.1.2.2 yamt link->hl_handle = HCI_CON_HANDLE(le16toh(ep.con_handle)); 498 1.1.2.2 yamt 499 1.1.2.2 yamt if (ep.link_type == HCI_LINK_ACL) { 500 1.1.2.2 yamt cp.con_handle = ep.con_handle; 501 1.1.2.2 yamt cp.settings = htole16(unit->hci_link_policy); 502 1.1.2.2 yamt err = hci_send_cmd(unit, HCI_CMD_WRITE_LINK_POLICY_SETTINGS, 503 1.1.2.2 yamt &cp, sizeof(cp)); 504 1.1.2.2 yamt if (err) 505 1.1.2.2 yamt printf("%s: Warning, could not write link policy\n", 506 1.1.2.2 yamt unit->hci_devname); 507 1.1.2.2 yamt 508 1.1.2.2 yamt hci_acl_start(link); 509 1.1.2.2 yamt } else { 510 1.1.2.2 yamt (*link->hl_sco->sp_proto->connected)(link->hl_sco->sp_upper); 511 1.1.2.2 yamt } 512 1.1.2.2 yamt } 513 1.1.2.2 yamt 514 1.1.2.2 yamt /* 515 1.1.2.2 yamt * Disconnection Complete 516 1.1.2.2 yamt * 517 1.1.2.2 yamt * This is sent in response to a disconnection request, but also if 518 1.1.2.2 yamt * the remote device goes out of range. 519 1.1.2.2 yamt */ 520 1.1.2.2 yamt static void 521 1.1.2.2 yamt hci_event_discon_compl(struct hci_unit *unit, struct mbuf *m) 522 1.1.2.2 yamt { 523 1.1.2.2 yamt hci_discon_compl_ep ep; 524 1.1.2.2 yamt struct hci_link *link; 525 1.1.2.2 yamt 526 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 527 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 528 1.1.2.2 yamt m_adj(m, sizeof(ep)); 529 1.1.2.2 yamt 530 1.1.2.2 yamt ep.con_handle = le16toh(ep.con_handle); 531 1.1.2.2 yamt 532 1.1.2.2 yamt DPRINTFN(1, "handle #%d, status=0x%x\n", ep.con_handle, ep.status); 533 1.1.2.2 yamt 534 1.1.2.2 yamt link = hci_link_lookup_handle(unit, HCI_CON_HANDLE(ep.con_handle)); 535 1.1.2.2 yamt if (link) 536 1.1.2.2 yamt hci_link_free(link, ENOLINK); 537 1.1.2.2 yamt } 538 1.1.2.2 yamt 539 1.1.2.2 yamt /* 540 1.1.2.2 yamt * Connect Request 541 1.1.2.2 yamt * 542 1.1.2.2 yamt * We check upstream for appropriate listeners and accept connections 543 1.1.2.2 yamt * that are wanted. 544 1.1.2.2 yamt */ 545 1.1.2.2 yamt static void 546 1.1.2.2 yamt hci_event_con_req(struct hci_unit *unit, struct mbuf *m) 547 1.1.2.2 yamt { 548 1.1.2.2 yamt hci_con_req_ep ep; 549 1.1.2.2 yamt hci_accept_con_cp ap; 550 1.1.2.2 yamt hci_reject_con_cp rp; 551 1.1.2.2 yamt struct hci_link *link; 552 1.1.2.2 yamt 553 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(ep)); 554 1.1.2.2 yamt m_copydata(m, 0, sizeof(ep), &ep); 555 1.1.2.2 yamt m_adj(m, sizeof(ep)); 556 1.1.2.2 yamt 557 1.1.2.2 yamt DPRINTFN(1, "bdaddr %2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x " 558 1.1.2.2 yamt "class %2.2x%2.2x%2.2x type %s\n", 559 1.1.2.2 yamt ep.bdaddr.b[5], ep.bdaddr.b[4], ep.bdaddr.b[3], 560 1.1.2.2 yamt ep.bdaddr.b[2], ep.bdaddr.b[1], ep.bdaddr.b[0], 561 1.1.2.2 yamt ep.uclass[0], ep.uclass[1], ep.uclass[2], 562 1.1.2.2 yamt ep.link_type == HCI_LINK_ACL ? "ACL" : "SCO"); 563 1.1.2.2 yamt 564 1.1.2.2 yamt if (ep.link_type == HCI_LINK_ACL) 565 1.1.2.2 yamt link = hci_acl_newconn(unit, &ep.bdaddr); 566 1.1.2.2 yamt else 567 1.1.2.2 yamt link = hci_sco_newconn(unit, &ep.bdaddr); 568 1.1.2.2 yamt 569 1.1.2.2 yamt if (link == NULL) { 570 1.1.2.2 yamt memset(&rp, 0, sizeof(rp)); 571 1.1.2.2 yamt bdaddr_copy(&rp.bdaddr, &ep.bdaddr); 572 1.1.2.2 yamt rp.reason = 0x0f; /* Unacceptable BD_ADDR */ 573 1.1.2.2 yamt 574 1.1.2.2 yamt hci_send_cmd(unit, HCI_CMD_REJECT_CON, &rp, sizeof(rp)); 575 1.1.2.2 yamt } else { 576 1.1.2.2 yamt memset(&ap, 0, sizeof(ap)); 577 1.1.2.2 yamt bdaddr_copy(&ap.bdaddr, &ep.bdaddr); 578 1.1.2.2 yamt if (unit->hci_link_policy & HCI_LINK_POLICY_ENABLE_ROLE_SWITCH) 579 1.1.2.2 yamt ap.role = HCI_ROLE_MASTER; 580 1.1.2.2 yamt else 581 1.1.2.2 yamt ap.role = HCI_ROLE_SLAVE; 582 1.1.2.2 yamt 583 1.1.2.2 yamt hci_send_cmd(unit, HCI_CMD_ACCEPT_CON, &ap, sizeof(ap)); 584 1.1.2.2 yamt } 585 1.1.2.2 yamt } 586 1.1.2.2 yamt 587 1.1.2.2 yamt /* 588 1.1.2.2 yamt * process results of read_bdaddr command_complete event 589 1.1.2.2 yamt */ 590 1.1.2.2 yamt static void 591 1.1.2.2 yamt hci_cmd_read_bdaddr(struct hci_unit *unit, struct mbuf *m) 592 1.1.2.2 yamt { 593 1.1.2.2 yamt hci_read_bdaddr_rp rp; 594 1.1.2.2 yamt int s; 595 1.1.2.2 yamt 596 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(rp)); 597 1.1.2.2 yamt m_copydata(m, 0, sizeof(rp), &rp); 598 1.1.2.2 yamt m_adj(m, sizeof(rp)); 599 1.1.2.2 yamt 600 1.1.2.2 yamt if (rp.status > 0) 601 1.1.2.2 yamt return; 602 1.1.2.2 yamt 603 1.1.2.2 yamt if ((unit->hci_flags & BTF_INIT_BDADDR) == 0) 604 1.1.2.2 yamt return; 605 1.1.2.2 yamt 606 1.1.2.2 yamt bdaddr_copy(&unit->hci_bdaddr, &rp.bdaddr); 607 1.1.2.2 yamt 608 1.1.2.2 yamt s = splraiseipl(unit->hci_ipl); 609 1.1.2.2 yamt unit->hci_flags &= ~BTF_INIT_BDADDR; 610 1.1.2.2 yamt splx(s); 611 1.1.2.2 yamt 612 1.1.2.2 yamt wakeup(unit); 613 1.1.2.2 yamt } 614 1.1.2.2 yamt 615 1.1.2.2 yamt /* 616 1.1.2.2 yamt * process results of read_buffer_size command_complete event 617 1.1.2.2 yamt */ 618 1.1.2.2 yamt static void 619 1.1.2.2 yamt hci_cmd_read_buffer_size(struct hci_unit *unit, struct mbuf *m) 620 1.1.2.2 yamt { 621 1.1.2.2 yamt hci_read_buffer_size_rp rp; 622 1.1.2.2 yamt int s; 623 1.1.2.2 yamt 624 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(rp)); 625 1.1.2.2 yamt m_copydata(m, 0, sizeof(rp), &rp); 626 1.1.2.2 yamt m_adj(m, sizeof(rp)); 627 1.1.2.2 yamt 628 1.1.2.2 yamt if (rp.status > 0) 629 1.1.2.2 yamt return; 630 1.1.2.2 yamt 631 1.1.2.2 yamt if ((unit->hci_flags & BTF_INIT_BUFFER_SIZE) == 0) 632 1.1.2.2 yamt return; 633 1.1.2.2 yamt 634 1.1.2.2 yamt unit->hci_max_acl_size = le16toh(rp.max_acl_size); 635 1.1.2.2 yamt unit->hci_num_acl_pkts = le16toh(rp.num_acl_pkts); 636 1.1.2.2 yamt unit->hci_max_sco_size = rp.max_sco_size; 637 1.1.2.2 yamt unit->hci_num_sco_pkts = le16toh(rp.num_sco_pkts); 638 1.1.2.2 yamt 639 1.1.2.2 yamt s = splraiseipl(unit->hci_ipl); 640 1.1.2.2 yamt unit->hci_flags &= ~BTF_INIT_BUFFER_SIZE; 641 1.1.2.2 yamt splx(s); 642 1.1.2.2 yamt 643 1.1.2.2 yamt wakeup(unit); 644 1.1.2.2 yamt } 645 1.1.2.2 yamt 646 1.1.2.2 yamt /* 647 1.1.2.2 yamt * process results of read_local_features command_complete event 648 1.1.2.2 yamt */ 649 1.1.2.2 yamt static void 650 1.1.2.2 yamt hci_cmd_read_local_features(struct hci_unit *unit, struct mbuf *m) 651 1.1.2.2 yamt { 652 1.1.2.2 yamt hci_read_local_features_rp rp; 653 1.1.2.2 yamt int s; 654 1.1.2.2 yamt 655 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(rp)); 656 1.1.2.2 yamt m_copydata(m, 0, sizeof(rp), &rp); 657 1.1.2.2 yamt m_adj(m, sizeof(rp)); 658 1.1.2.2 yamt 659 1.1.2.2 yamt if (rp.status > 0) 660 1.1.2.2 yamt return; 661 1.1.2.2 yamt 662 1.1.2.2 yamt if ((unit->hci_flags & BTF_INIT_FEATURES) == 0) 663 1.1.2.2 yamt return; 664 1.1.2.2 yamt 665 1.1.2.2 yamt unit->hci_lmp_mask = 0; 666 1.1.2.2 yamt 667 1.1.2.2 yamt if (rp.features[0] & HCI_LMP_ROLE_SWITCH) 668 1.1.2.2 yamt unit->hci_lmp_mask |= HCI_LINK_POLICY_ENABLE_ROLE_SWITCH; 669 1.1.2.2 yamt 670 1.1.2.2 yamt if (rp.features[0] & HCI_LMP_HOLD_MODE) 671 1.1.2.2 yamt unit->hci_lmp_mask |= HCI_LINK_POLICY_ENABLE_HOLD_MODE; 672 1.1.2.2 yamt 673 1.1.2.2 yamt if (rp.features[0] & HCI_LMP_SNIFF_MODE) 674 1.1.2.2 yamt unit->hci_lmp_mask |= HCI_LINK_POLICY_ENABLE_SNIFF_MODE; 675 1.1.2.2 yamt 676 1.1.2.2 yamt if (rp.features[1] & HCI_LMP_PARK_MODE) 677 1.1.2.2 yamt unit->hci_lmp_mask |= HCI_LINK_POLICY_ENABLE_PARK_MODE; 678 1.1.2.2 yamt 679 1.1.2.2 yamt /* ACL packet mask */ 680 1.1.2.2 yamt unit->hci_acl_mask = HCI_PKT_DM1 | HCI_PKT_DH1; 681 1.1.2.2 yamt 682 1.1.2.2 yamt if (rp.features[0] & HCI_LMP_3SLOT) 683 1.1.2.2 yamt unit->hci_acl_mask |= HCI_PKT_DM3 | HCI_PKT_DH3; 684 1.1.2.2 yamt 685 1.1.2.2 yamt if (rp.features[0] & HCI_LMP_5SLOT) 686 1.1.2.2 yamt unit->hci_acl_mask |= HCI_PKT_DM5 | HCI_PKT_DH5; 687 1.1.2.2 yamt 688 1.1.2.2 yamt if ((rp.features[3] & HCI_LMP_EDR_ACL_2MBPS) == 0) 689 1.1.2.2 yamt unit->hci_acl_mask |= HCI_PKT_2MBPS_DH1 690 1.1.2.2 yamt | HCI_PKT_2MBPS_DH3 691 1.1.2.2 yamt | HCI_PKT_2MBPS_DH5; 692 1.1.2.2 yamt 693 1.1.2.2 yamt if ((rp.features[3] & HCI_LMP_EDR_ACL_3MBPS) == 0) 694 1.1.2.2 yamt unit->hci_acl_mask |= HCI_PKT_3MBPS_DH1 695 1.1.2.2 yamt | HCI_PKT_3MBPS_DH3 696 1.1.2.2 yamt | HCI_PKT_3MBPS_DH5; 697 1.1.2.2 yamt 698 1.1.2.2 yamt if ((rp.features[4] & HCI_LMP_3SLOT_EDR_ACL) == 0) 699 1.1.2.2 yamt unit->hci_acl_mask |= HCI_PKT_2MBPS_DH3 700 1.1.2.2 yamt | HCI_PKT_3MBPS_DH3; 701 1.1.2.2 yamt 702 1.1.2.2 yamt if ((rp.features[5] & HCI_LMP_5SLOT_EDR_ACL) == 0) 703 1.1.2.2 yamt unit->hci_acl_mask |= HCI_PKT_2MBPS_DH5 704 1.1.2.2 yamt | HCI_PKT_3MBPS_DH5; 705 1.1.2.2 yamt 706 1.1.2.2 yamt unit->hci_packet_type = unit->hci_acl_mask; 707 1.1.2.2 yamt 708 1.1.2.2 yamt /* SCO packet mask */ 709 1.1.2.2 yamt unit->hci_sco_mask = 0; 710 1.1.2.2 yamt if (rp.features[1] & HCI_LMP_SCO_LINK) 711 1.1.2.2 yamt unit->hci_sco_mask |= HCI_PKT_HV1; 712 1.1.2.2 yamt 713 1.1.2.2 yamt if (rp.features[1] & HCI_LMP_HV2_PKT) 714 1.1.2.2 yamt unit->hci_sco_mask |= HCI_PKT_HV2; 715 1.1.2.2 yamt 716 1.1.2.2 yamt if (rp.features[1] & HCI_LMP_HV3_PKT) 717 1.1.2.2 yamt unit->hci_sco_mask |= HCI_PKT_HV3; 718 1.1.2.2 yamt 719 1.1.2.2 yamt if (rp.features[3] & HCI_LMP_EV3_PKT) 720 1.1.2.2 yamt unit->hci_sco_mask |= HCI_PKT_EV3; 721 1.1.2.2 yamt 722 1.1.2.2 yamt if (rp.features[4] & HCI_LMP_EV4_PKT) 723 1.1.2.2 yamt unit->hci_sco_mask |= HCI_PKT_EV4; 724 1.1.2.2 yamt 725 1.1.2.2 yamt if (rp.features[4] & HCI_LMP_EV5_PKT) 726 1.1.2.2 yamt unit->hci_sco_mask |= HCI_PKT_EV5; 727 1.1.2.2 yamt 728 1.1.2.2 yamt // XXX what do 2MBPS/3MBPS/3SLOT eSCO mean? 729 1.1.2.2 yamt 730 1.1.2.2 yamt s = splraiseipl(unit->hci_ipl); 731 1.1.2.2 yamt unit->hci_flags &= ~BTF_INIT_FEATURES; 732 1.1.2.2 yamt splx(s); 733 1.1.2.2 yamt 734 1.1.2.2 yamt wakeup(unit); 735 1.1.2.2 yamt 736 1.1.2.2 yamt DPRINTFN(1, "%s: lmp_mask %4.4x, acl_mask %4.4x, sco_mask %4.4x\n", 737 1.1.2.2 yamt unit->hci_devname, unit->hci_lmp_mask, 738 1.1.2.2 yamt unit->hci_acl_mask, unit->hci_sco_mask); 739 1.1.2.2 yamt } 740 1.1.2.2 yamt 741 1.1.2.2 yamt /* 742 1.1.2.2 yamt * process results of reset command_complete event 743 1.1.2.2 yamt * 744 1.1.2.2 yamt * This has killed all the connections, so close down anything we have left, 745 1.1.2.2 yamt * and reinitialise the unit. 746 1.1.2.2 yamt */ 747 1.1.2.2 yamt static void 748 1.1.2.2 yamt hci_cmd_reset(struct hci_unit *unit, struct mbuf *m) 749 1.1.2.2 yamt { 750 1.1.2.2 yamt hci_reset_rp rp; 751 1.1.2.2 yamt struct hci_link *link, *next; 752 1.1.2.2 yamt int acl; 753 1.1.2.2 yamt 754 1.1.2.2 yamt KASSERT(m->m_pkthdr.len >= sizeof(rp)); 755 1.1.2.2 yamt m_copydata(m, 0, sizeof(rp), &rp); 756 1.1.2.2 yamt m_adj(m, sizeof(rp)); 757 1.1.2.2 yamt 758 1.1.2.2 yamt if (rp.status != 0) 759 1.1.2.2 yamt return; 760 1.1.2.2 yamt 761 1.1.2.2 yamt /* 762 1.1.2.2 yamt * release SCO links first, since they may be holding 763 1.1.2.2 yamt * an ACL link reference. 764 1.1.2.2 yamt */ 765 1.1.2.2 yamt for (acl = 0 ; acl < 2 ; acl++) { 766 1.1.2.2 yamt next = TAILQ_FIRST(&unit->hci_links); 767 1.1.2.2 yamt while ((link = next) != NULL) { 768 1.1.2.2 yamt next = TAILQ_NEXT(link, hl_next); 769 1.1.2.2 yamt if (acl || link->hl_type != HCI_LINK_ACL) 770 1.1.2.2 yamt hci_link_free(link, ECONNABORTED); 771 1.1.2.2 yamt } 772 1.1.2.2 yamt } 773 1.1.2.2 yamt 774 1.1.2.2 yamt unit->hci_num_acl_pkts = 0; 775 1.1.2.2 yamt unit->hci_num_sco_pkts = 0; 776 1.1.2.2 yamt 777 1.1.2.2 yamt if (hci_send_cmd(unit, HCI_CMD_READ_BDADDR, NULL, 0)) 778 1.1.2.2 yamt return; 779 1.1.2.2 yamt 780 1.1.2.2 yamt if (hci_send_cmd(unit, HCI_CMD_READ_BUFFER_SIZE, NULL, 0)) 781 1.1.2.2 yamt return; 782 1.1.2.2 yamt 783 1.1.2.2 yamt if (hci_send_cmd(unit, HCI_CMD_READ_LOCAL_FEATURES, NULL, 0)) 784 1.1.2.2 yamt return; 785 1.1.2.2 yamt } 786
Indexes created Mon Oct 13 15:10:03 GMT 2025