11f504dbdSmatthias.ringwald /* 26b64433eSmatthias.ringwald * Copyright (C) 2009-2012 by Matthias Ringwald 31713bceaSmatthias.ringwald * 41713bceaSmatthias.ringwald * Redistribution and use in source and binary forms, with or without 51713bceaSmatthias.ringwald * modification, are permitted provided that the following conditions 61713bceaSmatthias.ringwald * are met: 71713bceaSmatthias.ringwald * 81713bceaSmatthias.ringwald * 1. Redistributions of source code must retain the above copyright 91713bceaSmatthias.ringwald * notice, this list of conditions and the following disclaimer. 101713bceaSmatthias.ringwald * 2. Redistributions in binary form must reproduce the above copyright 111713bceaSmatthias.ringwald * notice, this list of conditions and the following disclaimer in the 121713bceaSmatthias.ringwald * documentation and/or other materials provided with the distribution. 131713bceaSmatthias.ringwald * 3. Neither the name of the copyright holders nor the names of 141713bceaSmatthias.ringwald * contributors may be used to endorse or promote products derived 151713bceaSmatthias.ringwald * from this software without specific prior written permission. 166b64433eSmatthias.ringwald * 4. Any redistribution, use, or modification is done solely for 176b64433eSmatthias.ringwald * personal benefit and not for any commercial purpose or for 186b64433eSmatthias.ringwald * monetary gain. 191713bceaSmatthias.ringwald * 201713bceaSmatthias.ringwald * THIS SOFTWARE IS PROVIDED BY MATTHIAS RINGWALD AND CONTRIBUTORS 211713bceaSmatthias.ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 221713bceaSmatthias.ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 231713bceaSmatthias.ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 241713bceaSmatthias.ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 251713bceaSmatthias.ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 261713bceaSmatthias.ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 271713bceaSmatthias.ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 281713bceaSmatthias.ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 291713bceaSmatthias.ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 301713bceaSmatthias.ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 311713bceaSmatthias.ringwald * SUCH DAMAGE. 321713bceaSmatthias.ringwald * 336b64433eSmatthias.ringwald * Please inquire about commercial licensing options at [email protected] 346b64433eSmatthias.ringwald * 351713bceaSmatthias.ringwald */ 361713bceaSmatthias.ringwald 371713bceaSmatthias.ringwald /* 381f504dbdSmatthias.ringwald * hci.c 391f504dbdSmatthias.ringwald * 401f504dbdSmatthias.ringwald * Created by Matthias Ringwald on 4/29/09. 411f504dbdSmatthias.ringwald * 421f504dbdSmatthias.ringwald */ 431f504dbdSmatthias.ringwald 44bde315ceS[email protected] #include "btstack-config.h" 4528171530Smatthias.ringwald 467f2435e6Smatthias.ringwald #include "hci.h" 474c57c146S[email protected] #include "gap.h" 487f2435e6Smatthias.ringwald 4993b8dc03Smatthias.ringwald #include <stdarg.h> 5093b8dc03Smatthias.ringwald #include <string.h> 5156fe0872Smatthias.ringwald #include <stdio.h> 527f2435e6Smatthias.ringwald 53549e6ebeSmatthias.ringwald #ifndef EMBEDDED 54549e6ebeSmatthias.ringwald #include <unistd.h> // gethostbyname 5509ba8edeSmatthias.ringwald #include <btstack/version.h> 56549e6ebeSmatthias.ringwald #endif 57549e6ebeSmatthias.ringwald 58a3b02b71Smatthias.ringwald #include "btstack_memory.h" 597f2435e6Smatthias.ringwald #include "debug.h" 60d8905019Smatthias.ringwald #include "hci_dump.h" 6193b8dc03Smatthias.ringwald 62ae1fd9f3Smatthias.ringwald #include <btstack/hci_cmds.h> 631b0e3922Smatthias.ringwald 64169f8b28Smatthias.ringwald #define HCI_CONNECTION_TIMEOUT_MS 10000 65ee091cf1Smatthias.ringwald 66a45d6b9fS[email protected] #define HCI_INTIALIZING_SUBSTATE_AFTER_SLEEP 11 67da5275c5S[email protected] 6828171530Smatthias.ringwald #ifdef USE_BLUETOOL 693d7a3f67S[email protected] #include "../platforms/ios/src/bt_control_iphone.h" 7028171530Smatthias.ringwald #endif 7128171530Smatthias.ringwald 72758b46ceSmatthias.ringwald static void hci_update_scan_enable(void); 73a00031e2S[email protected] static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection); 7496a45072S[email protected] static void hci_connection_timeout_handler(timer_source_t *timer); 7596a45072S[email protected] static void hci_connection_timestamp(hci_connection_t *connection); 767586ee35S[email protected] static int hci_power_control_on(void); 777586ee35S[email protected] static void hci_power_control_off(void); 786155b3d3S[email protected] static void hci_state_reset(); 79758b46ceSmatthias.ringwald 8006b35ec0Smatthias.ringwald // the STACK is here 813a9fb326S[email protected] #ifndef HAVE_MALLOC 823a9fb326S[email protected] static hci_stack_t hci_stack_static; 833a9fb326S[email protected] #endif 843a9fb326S[email protected] static hci_stack_t * hci_stack = NULL; 8516833f0aSmatthias.ringwald 8666fb9560S[email protected] // test helper 8766fb9560S[email protected] static uint8_t disable_l2cap_timeouts = 0; 8866fb9560S[email protected] 8996a45072S[email protected] /** 9096a45072S[email protected] * create connection for given address 9196a45072S[email protected] * 9296a45072S[email protected] * @return connection OR NULL, if no memory left 9396a45072S[email protected] */ 9496a45072S[email protected] static hci_connection_t * create_connection_for_bd_addr_and_type(bd_addr_t addr, bd_addr_type_t addr_type){ 9596a45072S[email protected] 965127cc62S[email protected] log_info("create_connection_for_addr %s", bd_addr_to_str(addr)); 97bb69aaaeS[email protected] hci_connection_t * conn = btstack_memory_hci_connection_get(); 9896a45072S[email protected] if (!conn) return NULL; 9996a45072S[email protected] BD_ADDR_COPY(conn->address, addr); 10096a45072S[email protected] conn->address_type = addr_type; 10196a45072S[email protected] conn->con_handle = 0xffff; 10296a45072S[email protected] conn->authentication_flags = AUTH_FLAGS_NONE; 10396a45072S[email protected] conn->bonding_flags = 0; 10496a45072S[email protected] conn->requested_security_level = LEVEL_0; 10596a45072S[email protected] linked_item_set_user(&conn->timeout.item, conn); 10696a45072S[email protected] conn->timeout.process = hci_connection_timeout_handler; 10796a45072S[email protected] hci_connection_timestamp(conn); 10896a45072S[email protected] conn->acl_recombination_length = 0; 10996a45072S[email protected] conn->acl_recombination_pos = 0; 11096a45072S[email protected] conn->num_acl_packets_sent = 0; 11196a45072S[email protected] linked_list_add(&hci_stack->connections, (linked_item_t *) conn); 11296a45072S[email protected] return conn; 11396a45072S[email protected] } 11466fb9560S[email protected] 11597addcc5Smatthias.ringwald /** 116ee091cf1Smatthias.ringwald * get connection for a given handle 117ee091cf1Smatthias.ringwald * 118ee091cf1Smatthias.ringwald * @return connection OR NULL, if not found 119ee091cf1Smatthias.ringwald */ 1205061f3afS[email protected] hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){ 121ee091cf1Smatthias.ringwald linked_item_t *it; 1223a9fb326S[email protected] for (it = (linked_item_t *) hci_stack->connections; it ; it = it->next){ 123ee091cf1Smatthias.ringwald if ( ((hci_connection_t *) it)->con_handle == con_handle){ 124ee091cf1Smatthias.ringwald return (hci_connection_t *) it; 125ee091cf1Smatthias.ringwald } 126ee091cf1Smatthias.ringwald } 127ee091cf1Smatthias.ringwald return NULL; 128ee091cf1Smatthias.ringwald } 129ee091cf1Smatthias.ringwald 13096a45072S[email protected] /** 13196a45072S[email protected] * get connection for given address 13296a45072S[email protected] * 13396a45072S[email protected] * @return connection OR NULL, if not found 13496a45072S[email protected] */ 13596a45072S[email protected] hci_connection_t * hci_connection_for_bd_addr_and_type(bd_addr_t * addr, bd_addr_type_t addr_type){ 13662bda3fbS[email protected] linked_item_t *it; 13762bda3fbS[email protected] for (it = (linked_item_t *) hci_stack->connections; it ; it = it->next){ 13862bda3fbS[email protected] hci_connection_t * connection = (hci_connection_t *) it; 13996a45072S[email protected] if (connection->address_type != addr_type) continue; 14096a45072S[email protected] if (memcmp(addr, connection->address, 6) != 0) continue; 14162bda3fbS[email protected] return connection; 14262bda3fbS[email protected] } 14362bda3fbS[email protected] return NULL; 14462bda3fbS[email protected] } 14562bda3fbS[email protected] 1462b12a0b9Smatthias.ringwald static void hci_connection_timeout_handler(timer_source_t *timer){ 14728ca2b46S[email protected] hci_connection_t * connection = (hci_connection_t *) linked_item_get_user(&timer->item); 148c785ef68Smatthias.ringwald #ifdef HAVE_TIME 149ee091cf1Smatthias.ringwald struct timeval tv; 150ee091cf1Smatthias.ringwald gettimeofday(&tv, NULL); 151c21e6239Smatthias.ringwald if (tv.tv_sec >= connection->timestamp.tv_sec + HCI_CONNECTION_TIMEOUT_MS/1000) { 152ee091cf1Smatthias.ringwald // connections might be timed out 153ee091cf1Smatthias.ringwald hci_emit_l2cap_check_timeout(connection); 154ee091cf1Smatthias.ringwald } 1552b12a0b9Smatthias.ringwald #endif 156e5780900Smatthias.ringwald #ifdef HAVE_TICK 157c785ef68Smatthias.ringwald if (embedded_get_ticks() > connection->timestamp + embedded_ticks_for_ms(HCI_CONNECTION_TIMEOUT_MS)){ 158c785ef68Smatthias.ringwald // connections might be timed out 159c785ef68Smatthias.ringwald hci_emit_l2cap_check_timeout(connection); 160c785ef68Smatthias.ringwald } 161c785ef68Smatthias.ringwald #endif 162c785ef68Smatthias.ringwald run_loop_set_timer(timer, HCI_CONNECTION_TIMEOUT_MS); 163c785ef68Smatthias.ringwald run_loop_add_timer(timer); 164c785ef68Smatthias.ringwald } 165ee091cf1Smatthias.ringwald 166ee091cf1Smatthias.ringwald static void hci_connection_timestamp(hci_connection_t *connection){ 167c7492964Smatthias.ringwald #ifdef HAVE_TIME 168ee091cf1Smatthias.ringwald gettimeofday(&connection->timestamp, NULL); 169c7492964Smatthias.ringwald #endif 170e5780900Smatthias.ringwald #ifdef HAVE_TICK 171c785ef68Smatthias.ringwald connection->timestamp = embedded_get_ticks(); 172c785ef68Smatthias.ringwald #endif 173ee091cf1Smatthias.ringwald } 174ee091cf1Smatthias.ringwald 17506b35ec0Smatthias.ringwald 17628ca2b46S[email protected] inline static void connectionSetAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){ 17728ca2b46S[email protected] conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags | flags); 17828ca2b46S[email protected] } 17928ca2b46S[email protected] 18028ca2b46S[email protected] inline static void connectionClearAuthenticationFlags(hci_connection_t * conn, hci_authentication_flags_t flags){ 18128ca2b46S[email protected] conn->authentication_flags = (hci_authentication_flags_t)(conn->authentication_flags & ~flags); 18228ca2b46S[email protected] } 18328ca2b46S[email protected] 18428ca2b46S[email protected] 18543bfb1bdSmatthias.ringwald /** 18680ca58a0Smatthias.ringwald * add authentication flags and reset timer 18796a45072S[email protected] * @note: assumes classic connection 1887fde4af9Smatthias.ringwald */ 1897fde4af9Smatthias.ringwald static void hci_add_connection_flags_for_flipped_bd_addr(uint8_t *bd_addr, hci_authentication_flags_t flags){ 1907fde4af9Smatthias.ringwald bd_addr_t addr; 1917fde4af9Smatthias.ringwald bt_flip_addr(addr, *(bd_addr_t *) bd_addr); 19296a45072S[email protected] hci_connection_t * conn = hci_connection_for_bd_addr_and_type(&addr, BD_ADDR_TYPE_CLASSIC); 1937fde4af9Smatthias.ringwald if (conn) { 19428ca2b46S[email protected] connectionSetAuthenticationFlags(conn, flags); 19580ca58a0Smatthias.ringwald hci_connection_timestamp(conn); 1967fde4af9Smatthias.ringwald } 1977fde4af9Smatthias.ringwald } 1987fde4af9Smatthias.ringwald 19980ca58a0Smatthias.ringwald int hci_authentication_active_for_handle(hci_con_handle_t handle){ 2005061f3afS[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 20180ca58a0Smatthias.ringwald if (!conn) return 0; 2026724cd9eS[email protected] if (conn->authentication_flags & LEGACY_PAIRING_ACTIVE) return 1; 2036724cd9eS[email protected] if (conn->authentication_flags & SSP_PAIRING_ACTIVE) return 1; 2046724cd9eS[email protected] return 0; 20580ca58a0Smatthias.ringwald } 20680ca58a0Smatthias.ringwald 207c12e46e7Smatthias.ringwald void hci_drop_link_key_for_bd_addr(bd_addr_t *addr){ 2083a9fb326S[email protected] if (hci_stack->remote_device_db) { 2093a9fb326S[email protected] hci_stack->remote_device_db->delete_link_key(addr); 210c12e46e7Smatthias.ringwald } 211c12e46e7Smatthias.ringwald } 212c12e46e7Smatthias.ringwald 2130bf6344aS[email protected] int hci_is_le_connection(hci_connection_t * connection){ 2140bf6344aS[email protected] return connection->address_type == BD_ADDR_TYPE_LE_PUBLIC || 2150bf6344aS[email protected] connection->address_type == BD_ADDR_TYPE_LE_RANDOM; 2160bf6344aS[email protected] } 2170bf6344aS[email protected] 2187fde4af9Smatthias.ringwald 2197fde4af9Smatthias.ringwald /** 22043bfb1bdSmatthias.ringwald * count connections 22143bfb1bdSmatthias.ringwald */ 22240d1c7a4Smatthias.ringwald static int nr_hci_connections(void){ 22356c253c9Smatthias.ringwald int count = 0; 22443bfb1bdSmatthias.ringwald linked_item_t *it; 2253a9fb326S[email protected] for (it = (linked_item_t *) hci_stack->connections; it ; it = it->next, count++); 22643bfb1bdSmatthias.ringwald return count; 22743bfb1bdSmatthias.ringwald } 228c8e4258aSmatthias.ringwald 22997addcc5Smatthias.ringwald /** 230ba681a6cSmatthias.ringwald * Dummy handler called by HCI 23116833f0aSmatthias.ringwald */ 2322718e2e7Smatthias.ringwald static void dummy_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){ 23316833f0aSmatthias.ringwald } 23416833f0aSmatthias.ringwald 235998906cdSmatthias.ringwald uint8_t hci_number_outgoing_packets(hci_con_handle_t handle){ 2365061f3afS[email protected] hci_connection_t * connection = hci_connection_for_handle(handle); 237998906cdSmatthias.ringwald if (!connection) { 2389da54300S[email protected] log_error("hci_number_outgoing_packets: connection for handle %u does not exist!", handle); 239998906cdSmatthias.ringwald return 0; 240998906cdSmatthias.ringwald } 241998906cdSmatthias.ringwald return connection->num_acl_packets_sent; 242998906cdSmatthias.ringwald } 243998906cdSmatthias.ringwald 244e79abdd6S[email protected] uint8_t hci_number_free_acl_slots_for_handle(hci_con_handle_t con_handle){ 245ee303eddS[email protected] 246ee303eddS[email protected] int num_packets_sent_classic = 0; 247ee303eddS[email protected] int num_packets_sent_le = 0; 248ee303eddS[email protected] 249ee303eddS[email protected] bd_addr_type_t address_type = BD_ADDR_TYPE_UNKNOWN; 250ee303eddS[email protected] 251998906cdSmatthias.ringwald linked_item_t *it; 2523a9fb326S[email protected] for (it = (linked_item_t *) hci_stack->connections; it ; it = it->next){ 253998906cdSmatthias.ringwald hci_connection_t * connection = (hci_connection_t *) it; 254ee303eddS[email protected] if (connection->address_type == BD_ADDR_TYPE_CLASSIC){ 255ee303eddS[email protected] num_packets_sent_classic += connection->num_acl_packets_sent; 256ee303eddS[email protected] } else { 257ee303eddS[email protected] num_packets_sent_le += connection->num_acl_packets_sent; 258ee303eddS[email protected] } 259ee303eddS[email protected] if (connection->con_handle == con_handle){ 260ee303eddS[email protected] address_type = connection->address_type; 261ee303eddS[email protected] } 262ee303eddS[email protected] } 263ee303eddS[email protected] 264ee303eddS[email protected] int free_slots_classic = hci_stack->acl_packets_total_num - num_packets_sent_classic; 265ee303eddS[email protected] int free_slots_le = 0; 266ee303eddS[email protected] 267ee303eddS[email protected] if (free_slots_classic < 0){ 2689da54300S[email protected] log_error("hci_number_free_acl_slots: outgoing classic packets (%u) > total classic packets (%u)", num_packets_sent_classic, hci_stack->acl_packets_total_num); 269998906cdSmatthias.ringwald return 0; 270998906cdSmatthias.ringwald } 271ee303eddS[email protected] 272ee303eddS[email protected] if (hci_stack->le_acl_packets_total_num){ 273ee303eddS[email protected] // if we have LE slots, they are used 274ee303eddS[email protected] free_slots_le = hci_stack->le_acl_packets_total_num - num_packets_sent_le; 275ee303eddS[email protected] if (free_slots_le < 0){ 2769da54300S[email protected] log_error("hci_number_free_acl_slots: outgoing le packets (%u) > total le packets (%u)", num_packets_sent_le, hci_stack->le_acl_packets_total_num); 277ee303eddS[email protected] return 0; 278998906cdSmatthias.ringwald } 279ee303eddS[email protected] } else { 280ee303eddS[email protected] // otherwise, classic slots are used for LE, too 281ee303eddS[email protected] free_slots_classic -= num_packets_sent_le; 282ee303eddS[email protected] if (free_slots_classic < 0){ 2839da54300S[email protected] log_error("hci_number_free_acl_slots: outgoing classic + le packets (%u + %u) > total packets (%u)", num_packets_sent_classic, num_packets_sent_le, hci_stack->acl_packets_total_num); 284ee303eddS[email protected] return 0; 285ee303eddS[email protected] } 286ee303eddS[email protected] } 287ee303eddS[email protected] 288ee303eddS[email protected] switch (address_type){ 289ee303eddS[email protected] case BD_ADDR_TYPE_UNKNOWN: 2909da54300S[email protected] log_error("hci_number_free_acl_slots: handle 0x%04x not in connection list", con_handle); 291ee303eddS[email protected] return 0; 292ee303eddS[email protected] 293ee303eddS[email protected] case BD_ADDR_TYPE_CLASSIC: 294ee303eddS[email protected] return free_slots_classic; 295ee303eddS[email protected] 296ee303eddS[email protected] default: 297cb00d3aaS[email protected] if (hci_stack->le_acl_packets_total_num){ 298ee303eddS[email protected] return free_slots_le; 299ee303eddS[email protected] } 300cb00d3aaS[email protected] return free_slots_classic; 301cb00d3aaS[email protected] } 302998906cdSmatthias.ringwald } 303998906cdSmatthias.ringwald 304ac928cc2S[email protected] 305ac928cc2S[email protected] // @deprecated 306c24735b1Smatthias.ringwald int hci_can_send_packet_now(uint8_t packet_type){ 307c24735b1Smatthias.ringwald switch (packet_type) { 308c24735b1Smatthias.ringwald case HCI_ACL_DATA_PACKET: 309ac928cc2S[email protected] return hci_can_send_prepared_acl_packet_now(0); 310c24735b1Smatthias.ringwald case HCI_COMMAND_DATA_PACKET: 311ac928cc2S[email protected] return hci_can_send_command_packet_now(); 312c24735b1Smatthias.ringwald default: 313c24735b1Smatthias.ringwald return 0; 314c24735b1Smatthias.ringwald } 315c24735b1Smatthias.ringwald } 316c24735b1Smatthias.ringwald 317ac928cc2S[email protected] // @deprecated 3186b4af23dS[email protected] // same as hci_can_send_packet_now, but also checks if packet buffer is free for use 3196b4af23dS[email protected] int hci_can_send_packet_now_using_packet_buffer(uint8_t packet_type){ 320ac928cc2S[email protected] 3216b4af23dS[email protected] if (hci_stack->hci_packet_buffer_reserved) return 0; 322ac928cc2S[email protected] 323ac928cc2S[email protected] switch (packet_type) { 324ac928cc2S[email protected] case HCI_ACL_DATA_PACKET: 325ac928cc2S[email protected] return hci_can_send_acl_packet_now(0); 326ac928cc2S[email protected] case HCI_COMMAND_DATA_PACKET: 327ac928cc2S[email protected] return hci_can_send_command_packet_now(); 328ac928cc2S[email protected] default: 329ac928cc2S[email protected] return 0; 330ac928cc2S[email protected] } 331ac928cc2S[email protected] } 332ac928cc2S[email protected] 333ac928cc2S[email protected] 334ac928cc2S[email protected] // new functions replacing hci_can_send_packet_now[_using_packet_buffer] 335ac928cc2S[email protected] int hci_can_send_command_packet_now(void){ 336ac928cc2S[email protected] if (hci_stack->hci_packet_buffer_reserved) return 0; 337ac928cc2S[email protected] 338ac928cc2S[email protected] // check for async hci transport implementations 339ac928cc2S[email protected] if (hci_stack->hci_transport->can_send_packet_now){ 340ac928cc2S[email protected] if (!hci_stack->hci_transport->can_send_packet_now(HCI_COMMAND_DATA_PACKET)){ 341ac928cc2S[email protected] return 0; 342ac928cc2S[email protected] } 343ac928cc2S[email protected] } 344ac928cc2S[email protected] 345ac928cc2S[email protected] return hci_stack->num_cmd_packets > 0; 346ac928cc2S[email protected] } 347ac928cc2S[email protected] 348ac928cc2S[email protected] int hci_can_send_prepared_acl_packet_now(hci_con_handle_t con_handle) { 349ac928cc2S[email protected] // check for async hci transport implementations 350ac928cc2S[email protected] if (hci_stack->hci_transport->can_send_packet_now){ 351ac928cc2S[email protected] if (!hci_stack->hci_transport->can_send_packet_now(HCI_ACL_DATA_PACKET)){ 352ac928cc2S[email protected] return 0; 353ac928cc2S[email protected] } 354ac928cc2S[email protected] } 355e79abdd6S[email protected] return hci_number_free_acl_slots_for_handle(con_handle) > 0; 356ac928cc2S[email protected] } 357ac928cc2S[email protected] 358ac928cc2S[email protected] int hci_can_send_acl_packet_now(hci_con_handle_t con_handle){ 359ac928cc2S[email protected] if (hci_stack->hci_packet_buffer_reserved) return 0; 360ac928cc2S[email protected] return hci_can_send_prepared_acl_packet_now(con_handle); 3616b4af23dS[email protected] } 3626b4af23dS[email protected] 363c8b9416aS[email protected] // used for internal checks in l2cap[-le].c 364c8b9416aS[email protected] int hci_is_packet_buffer_reserved(void){ 365c8b9416aS[email protected] return hci_stack->hci_packet_buffer_reserved; 366c8b9416aS[email protected] } 367c8b9416aS[email protected] 3686b4af23dS[email protected] // reserves outgoing packet buffer. @returns 1 if successful 3696b4af23dS[email protected] int hci_reserve_packet_buffer(void){ 3709d14b626S[email protected] if (hci_stack->hci_packet_buffer_reserved) { 3719d14b626S[email protected] log_error("hci_reserve_packet_buffer called but buffer already reserved"); 3729d14b626S[email protected] return 0; 3739d14b626S[email protected] } 3746b4af23dS[email protected] hci_stack->hci_packet_buffer_reserved = 1; 3756b4af23dS[email protected] return 1; 3766b4af23dS[email protected] } 3776b4af23dS[email protected] 37868a0fcf7S[email protected] void hci_release_packet_buffer(void){ 37968a0fcf7S[email protected] hci_stack->hci_packet_buffer_reserved = 0; 38068a0fcf7S[email protected] } 38168a0fcf7S[email protected] 3826b4af23dS[email protected] // assumption: synchronous implementations don't provide can_send_packet_now as they don't keep the buffer after the call 3836b4af23dS[email protected] int hci_transport_synchronous(void){ 3846b4af23dS[email protected] return hci_stack->hci_transport->can_send_packet_now == NULL; 3856b4af23dS[email protected] } 3866b4af23dS[email protected] 387*452cf3bbS[email protected] static int hci_send_acl_packet_fragments(hci_connection_t *connection){ 388*452cf3bbS[email protected] 389*452cf3bbS[email protected] // log_info("hci_send_acl_packet_fragments %u/%u (con 0x%04x)", hci_stack->acl_fragmentation_pos, hci_stack->acl_fragmentation_total_size, connection->con_handle); 390*452cf3bbS[email protected] 391*452cf3bbS[email protected] // max ACL data packet length depends on connection type (LE vs. Classic) and available buffers 392*452cf3bbS[email protected] uint16_t max_acl_data_packet_length = hci_stack->acl_data_packet_length; 393*452cf3bbS[email protected] if (hci_is_le_connection(connection) && hci_stack->le_data_packets_length > 0){ 394*452cf3bbS[email protected] max_acl_data_packet_length = hci_stack->le_data_packets_length; 395*452cf3bbS[email protected] } 396*452cf3bbS[email protected] 397*452cf3bbS[email protected] // testing: reduce buffer to minimum 398*452cf3bbS[email protected] // max_acl_data_packet_length = 52; 399*452cf3bbS[email protected] 400*452cf3bbS[email protected] int err; 401*452cf3bbS[email protected] // multiple packets could be send on a synchronous HCI transport 402*452cf3bbS[email protected] while (1){ 403*452cf3bbS[email protected] 404*452cf3bbS[email protected] // get current data 405*452cf3bbS[email protected] const uint16_t acl_header_pos = hci_stack->acl_fragmentation_pos - 4; 406*452cf3bbS[email protected] int current_acl_data_packet_length = hci_stack->acl_fragmentation_total_size - hci_stack->acl_fragmentation_pos; 407*452cf3bbS[email protected] int more_fragments = 0; 408*452cf3bbS[email protected] 409*452cf3bbS[email protected] // if ACL packet is larger than Bluetooth packet buffer, only send max_acl_data_packet_length 410*452cf3bbS[email protected] if (current_acl_data_packet_length > max_acl_data_packet_length){ 411*452cf3bbS[email protected] more_fragments = 1; 412*452cf3bbS[email protected] current_acl_data_packet_length = max_acl_data_packet_length; 413*452cf3bbS[email protected] } 414*452cf3bbS[email protected] 415*452cf3bbS[email protected] // copy handle_and_flags if not first fragment and update packet boundary flags to be 01 (continuing fragmnent) 416*452cf3bbS[email protected] if (acl_header_pos > 0){ 417*452cf3bbS[email protected] uint16_t handle_and_flags = READ_BT_16(hci_stack->hci_packet_buffer, 0); 418*452cf3bbS[email protected] handle_and_flags = (handle_and_flags & 0xcfff) | (1 << 12); 419*452cf3bbS[email protected] bt_store_16(hci_stack->hci_packet_buffer, acl_header_pos, handle_and_flags); 420*452cf3bbS[email protected] } 421*452cf3bbS[email protected] 422*452cf3bbS[email protected] // update header len 423*452cf3bbS[email protected] bt_store_16(hci_stack->hci_packet_buffer, acl_header_pos + 2, current_acl_data_packet_length); 424*452cf3bbS[email protected] 425*452cf3bbS[email protected] // count packet 426*452cf3bbS[email protected] connection->num_acl_packets_sent++; 427*452cf3bbS[email protected] 428*452cf3bbS[email protected] // send packet 429*452cf3bbS[email protected] uint8_t * packet = &hci_stack->hci_packet_buffer[acl_header_pos]; 430*452cf3bbS[email protected] const int size = current_acl_data_packet_length + 4; 431*452cf3bbS[email protected] // hexdump(packet, size); 432*452cf3bbS[email protected] err = hci_stack->hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size); 433*452cf3bbS[email protected] 434*452cf3bbS[email protected] // done yet? 435*452cf3bbS[email protected] if (!more_fragments) break; 436*452cf3bbS[email protected] 437*452cf3bbS[email protected] // update start of next fragment to send 438*452cf3bbS[email protected] hci_stack->acl_fragmentation_pos += current_acl_data_packet_length; 439*452cf3bbS[email protected] 440*452cf3bbS[email protected] // can send more? 441*452cf3bbS[email protected] if (!hci_can_send_prepared_acl_packet_now(connection->con_handle)) return err; 442*452cf3bbS[email protected] } 443*452cf3bbS[email protected] 444*452cf3bbS[email protected] // done 445*452cf3bbS[email protected] hci_stack->acl_fragmentation_pos = 0; 446*452cf3bbS[email protected] hci_stack->acl_fragmentation_total_size = 0; 447*452cf3bbS[email protected] 448*452cf3bbS[email protected] // free buffer now for synchronous transport 449*452cf3bbS[email protected] if (!hci_transport_synchronous()){ 450*452cf3bbS[email protected] hci_release_packet_buffer(); 451*452cf3bbS[email protected] } 452*452cf3bbS[email protected] 453*452cf3bbS[email protected] return err; 454*452cf3bbS[email protected] } 455*452cf3bbS[email protected] 456826f7347S[email protected] // pre: caller has reserved the packet buffer 457826f7347S[email protected] int hci_send_acl_packet_buffer(int size){ 4587856c818Smatthias.ringwald 459*452cf3bbS[email protected] // log_info("hci_send_acl_packet_buffer size %u", size); 460*452cf3bbS[email protected] 461826f7347S[email protected] if (!hci_stack->hci_packet_buffer_reserved) { 462826f7347S[email protected] log_error("hci_send_acl_packet_buffer called without reserving packet buffer"); 463826f7347S[email protected] return 0; 464826f7347S[email protected] } 465826f7347S[email protected] 466d713a683S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 467d713a683S[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 468d713a683S[email protected] 469826f7347S[email protected] // check for free places on Bluetooth module 470d713a683S[email protected] if (!hci_can_send_prepared_acl_packet_now(con_handle)) { 471826f7347S[email protected] log_error("hci_send_acl_packet_buffer called but no free ACL buffers on controller"); 47297b61c7bS[email protected] hci_release_packet_buffer(); 47397b61c7bS[email protected] return BTSTACK_ACL_BUFFERS_FULL; 47497b61c7bS[email protected] } 4756218e6f1Smatthias.ringwald 4765061f3afS[email protected] hci_connection_t *connection = hci_connection_for_handle( con_handle); 47797b61c7bS[email protected] if (!connection) { 4785fa0b7cfS[email protected] log_error("hci_send_acl_packet_buffer called but no connection for handle 0x%04x", con_handle); 47997b61c7bS[email protected] hci_release_packet_buffer(); 48097b61c7bS[email protected] return 0; 48197b61c7bS[email protected] } 48256cf178bSmatthias.ringwald hci_connection_timestamp(connection); 48356cf178bSmatthias.ringwald 484*452cf3bbS[email protected] // hci_dump_packet( HCI_ACL_DATA_PACKET, 0, packet, size); 4857856c818Smatthias.ringwald 486*452cf3bbS[email protected] // setup data 487*452cf3bbS[email protected] hci_stack->acl_fragmentation_total_size = size; 488*452cf3bbS[email protected] hci_stack->acl_fragmentation_pos = 4; // start of L2CAP packet 4896218e6f1Smatthias.ringwald 490*452cf3bbS[email protected] return hci_send_acl_packet_fragments(connection); 491ee091cf1Smatthias.ringwald } 492ee091cf1Smatthias.ringwald 49316833f0aSmatthias.ringwald static void acl_handler(uint8_t *packet, int size){ 4947856c818Smatthias.ringwald 495e76a89eeS[email protected] // log_info("acl_handler: size %u", size); 496e76a89eeS[email protected] 4977856c818Smatthias.ringwald // get info 4987856c818Smatthias.ringwald hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 4995061f3afS[email protected] hci_connection_t *conn = hci_connection_for_handle(con_handle); 5007856c818Smatthias.ringwald uint8_t acl_flags = READ_ACL_FLAGS(packet); 5017856c818Smatthias.ringwald uint16_t acl_length = READ_ACL_LENGTH(packet); 5027856c818Smatthias.ringwald 5037856c818Smatthias.ringwald // ignore non-registered handle 5047856c818Smatthias.ringwald if (!conn){ 5059da54300S[email protected] log_error( "hci.c: acl_handler called with non-registered handle %u!" , con_handle); 5067856c818Smatthias.ringwald return; 5077856c818Smatthias.ringwald } 5087856c818Smatthias.ringwald 509e76a89eeS[email protected] // assert packet is complete 5109ecc3e17S[email protected] if (acl_length + 4 != size){ 511e76a89eeS[email protected] log_error("hci.c: acl_handler called with ACL packet of wrong size %u, expected %u => dropping packet", size, acl_length + 4); 512e76a89eeS[email protected] return; 513e76a89eeS[email protected] } 514e76a89eeS[email protected] 5157856c818Smatthias.ringwald // update idle timestamp 5167856c818Smatthias.ringwald hci_connection_timestamp(conn); 5177856c818Smatthias.ringwald 5187856c818Smatthias.ringwald // handle different packet types 5197856c818Smatthias.ringwald switch (acl_flags & 0x03) { 5207856c818Smatthias.ringwald 5217856c818Smatthias.ringwald case 0x01: // continuation fragment 5227856c818Smatthias.ringwald 5237856c818Smatthias.ringwald // sanity check 5247856c818Smatthias.ringwald if (conn->acl_recombination_pos == 0) { 5259da54300S[email protected] log_error( "ACL Cont Fragment but no first fragment for handle 0x%02x", con_handle); 5267856c818Smatthias.ringwald return; 5277856c818Smatthias.ringwald } 5287856c818Smatthias.ringwald 5297856c818Smatthias.ringwald // append fragment payload (header already stored) 5307856c818Smatthias.ringwald memcpy(&conn->acl_recombination_buffer[conn->acl_recombination_pos], &packet[4], acl_length ); 5317856c818Smatthias.ringwald conn->acl_recombination_pos += acl_length; 5327856c818Smatthias.ringwald 5339da54300S[email protected] // log_error( "ACL Cont Fragment: acl_len %u, combined_len %u, l2cap_len %u", acl_length, 534decc01a8Smatthias.ringwald // conn->acl_recombination_pos, conn->acl_recombination_length); 5357856c818Smatthias.ringwald 5367856c818Smatthias.ringwald // forward complete L2CAP packet if complete. 5377856c818Smatthias.ringwald if (conn->acl_recombination_pos >= conn->acl_recombination_length + 4 + 4){ // pos already incl. ACL header 5387856c818Smatthias.ringwald 5393a9fb326S[email protected] hci_stack->packet_handler(HCI_ACL_DATA_PACKET, conn->acl_recombination_buffer, conn->acl_recombination_pos); 5407856c818Smatthias.ringwald // reset recombination buffer 5417856c818Smatthias.ringwald conn->acl_recombination_length = 0; 5427856c818Smatthias.ringwald conn->acl_recombination_pos = 0; 5437856c818Smatthias.ringwald } 5447856c818Smatthias.ringwald break; 5457856c818Smatthias.ringwald 5467856c818Smatthias.ringwald case 0x02: { // first fragment 5477856c818Smatthias.ringwald 5487856c818Smatthias.ringwald // sanity check 5497856c818Smatthias.ringwald if (conn->acl_recombination_pos) { 5509da54300S[email protected] log_error( "ACL First Fragment but data in buffer for handle 0x%02x", con_handle); 5517856c818Smatthias.ringwald return; 5527856c818Smatthias.ringwald } 5537856c818Smatthias.ringwald 5547856c818Smatthias.ringwald // peek into L2CAP packet! 5557856c818Smatthias.ringwald uint16_t l2cap_length = READ_L2CAP_LENGTH( packet ); 5567856c818Smatthias.ringwald 5579da54300S[email protected] // log_info( "ACL First Fragment: acl_len %u, l2cap_len %u", acl_length, l2cap_length); 558decc01a8Smatthias.ringwald 5597856c818Smatthias.ringwald // compare fragment size to L2CAP packet size 5607856c818Smatthias.ringwald if (acl_length >= l2cap_length + 4){ 5617856c818Smatthias.ringwald 5627856c818Smatthias.ringwald // forward fragment as L2CAP packet 5633a9fb326S[email protected] hci_stack->packet_handler(HCI_ACL_DATA_PACKET, packet, acl_length + 4); 5647856c818Smatthias.ringwald 5657856c818Smatthias.ringwald } else { 5667856c818Smatthias.ringwald // store first fragment and tweak acl length for complete package 5677856c818Smatthias.ringwald memcpy(conn->acl_recombination_buffer, packet, acl_length + 4); 5687856c818Smatthias.ringwald conn->acl_recombination_pos = acl_length + 4; 5697856c818Smatthias.ringwald conn->acl_recombination_length = l2cap_length; 570decc01a8Smatthias.ringwald bt_store_16(conn->acl_recombination_buffer, 2, l2cap_length +4); 5717856c818Smatthias.ringwald } 5727856c818Smatthias.ringwald break; 5737856c818Smatthias.ringwald 5747856c818Smatthias.ringwald } 5757856c818Smatthias.ringwald default: 5769da54300S[email protected] log_error( "hci.c: acl_handler called with invalid packet boundary flags %u", acl_flags & 0x03); 5777856c818Smatthias.ringwald return; 5787856c818Smatthias.ringwald } 57994ab26f8Smatthias.ringwald 58094ab26f8Smatthias.ringwald // execute main loop 58194ab26f8Smatthias.ringwald hci_run(); 58216833f0aSmatthias.ringwald } 58322909952Smatthias.ringwald 58467a3e8ecSmatthias.ringwald static void hci_shutdown_connection(hci_connection_t *conn){ 5859da54300S[email protected] log_info("Connection closed: handle 0x%x, %s", conn->con_handle, bd_addr_to_str(conn->address)); 5863c4d4b90Smatthias.ringwald 587c7e0c5f6Smatthias.ringwald run_loop_remove_timer(&conn->timeout); 588c785ef68Smatthias.ringwald 5893a9fb326S[email protected] linked_list_remove(&hci_stack->connections, (linked_item_t *) conn); 590a3b02b71Smatthias.ringwald btstack_memory_hci_connection_free( conn ); 5913c4d4b90Smatthias.ringwald 5923c4d4b90Smatthias.ringwald // now it's gone 593c7e0c5f6Smatthias.ringwald hci_emit_nr_connections_changed(); 594c7e0c5f6Smatthias.ringwald } 595c7e0c5f6Smatthias.ringwald 5960c042179S[email protected] static const uint16_t packet_type_sizes[] = { 5978f8108aaSmatthias.ringwald 0, HCI_ACL_2DH1_SIZE, HCI_ACL_3DH1_SIZE, HCI_ACL_DM1_SIZE, 5988f8108aaSmatthias.ringwald HCI_ACL_DH1_SIZE, 0, 0, 0, 5998f8108aaSmatthias.ringwald HCI_ACL_2DH3_SIZE, HCI_ACL_3DH3_SIZE, HCI_ACL_DM3_SIZE, HCI_ACL_DH3_SIZE, 6008f8108aaSmatthias.ringwald HCI_ACL_2DH5_SIZE, HCI_ACL_3DH5_SIZE, HCI_ACL_DM5_SIZE, HCI_ACL_DH5_SIZE 6018f8108aaSmatthias.ringwald }; 60265389bfcS[email protected] static const uint8_t packet_type_feature_requirement_bit[] = { 60365389bfcS[email protected] 0, // 3 slot packets 60465389bfcS[email protected] 1, // 5 slot packets 60565389bfcS[email protected] 25, // EDR 2 mpbs 60665389bfcS[email protected] 26, // EDR 3 mbps 60765389bfcS[email protected] 39, // 3 slot EDR packts 60865389bfcS[email protected] 40, // 5 slot EDR packet 60965389bfcS[email protected] }; 61065389bfcS[email protected] static const uint16_t packet_type_feature_packet_mask[] = { 61165389bfcS[email protected] 0x0f00, // 3 slot packets 61265389bfcS[email protected] 0xf000, // 5 slot packets 61365389bfcS[email protected] 0x1102, // EDR 2 mpbs 61465389bfcS[email protected] 0x2204, // EDR 3 mbps 61565389bfcS[email protected] 0x0300, // 3 slot EDR packts 61665389bfcS[email protected] 0x3000, // 5 slot EDR packet 61765389bfcS[email protected] }; 6188f8108aaSmatthias.ringwald 61965389bfcS[email protected] static uint16_t hci_acl_packet_types_for_buffer_size_and_local_features(uint16_t buffer_size, uint8_t * local_supported_features){ 62065389bfcS[email protected] // enable packet types based on size 6218f8108aaSmatthias.ringwald uint16_t packet_types = 0; 6228f8108aaSmatthias.ringwald int i; 6238f8108aaSmatthias.ringwald for (i=0;i<16;i++){ 6248f8108aaSmatthias.ringwald if (packet_type_sizes[i] == 0) continue; 6258f8108aaSmatthias.ringwald if (packet_type_sizes[i] <= buffer_size){ 6268f8108aaSmatthias.ringwald packet_types |= 1 << i; 6278f8108aaSmatthias.ringwald } 6288f8108aaSmatthias.ringwald } 62965389bfcS[email protected] // disable packet types due to missing local supported features 63065389bfcS[email protected] for (i=0;i<sizeof(packet_type_feature_requirement_bit);i++){ 63165389bfcS[email protected] int bit_idx = packet_type_feature_requirement_bit[i]; 63265389bfcS[email protected] int feature_set = (local_supported_features[bit_idx >> 3] & (1<<(bit_idx & 7))) != 0; 63365389bfcS[email protected] if (feature_set) continue; 63465389bfcS[email protected] log_info("Features bit %02u is not set, removing packet types 0x%04x", bit_idx, packet_type_feature_packet_mask[i]); 63565389bfcS[email protected] packet_types &= ~packet_type_feature_packet_mask[i]; 63665389bfcS[email protected] } 6378f8108aaSmatthias.ringwald // flip bits for "may not be used" 6388f8108aaSmatthias.ringwald packet_types ^= 0x3306; 6398f8108aaSmatthias.ringwald return packet_types; 6408f8108aaSmatthias.ringwald } 6418f8108aaSmatthias.ringwald 6428f8108aaSmatthias.ringwald uint16_t hci_usable_acl_packet_types(void){ 6433a9fb326S[email protected] return hci_stack->packet_types; 6448f8108aaSmatthias.ringwald } 6458f8108aaSmatthias.ringwald 646facf93fdS[email protected] uint8_t* hci_get_outgoing_packet_buffer(void){ 6477dc17943Smatthias.ringwald // hci packet buffer is >= acl data packet length 6483a9fb326S[email protected] return hci_stack->hci_packet_buffer; 6497dc17943Smatthias.ringwald } 6507dc17943Smatthias.ringwald 651f5d8d141S[email protected] uint16_t hci_max_acl_data_packet_length(void){ 6523a9fb326S[email protected] return hci_stack->acl_data_packet_length; 6537dc17943Smatthias.ringwald } 6547dc17943Smatthias.ringwald 6556ac9a97eS[email protected] int hci_non_flushable_packet_boundary_flag_supported(void){ 6566ac9a97eS[email protected] // No. 54, byte 6, bit 6 6576ac9a97eS[email protected] return (hci_stack->local_supported_features[6] & (1 << 6)) != 0; 6586ac9a97eS[email protected] } 6596ac9a97eS[email protected] 660f5d8d141S[email protected] int hci_ssp_supported(void){ 6616ac9a97eS[email protected] // No. 51, byte 6, bit 3 6623a9fb326S[email protected] return (hci_stack->local_supported_features[6] & (1 << 3)) != 0; 663f5d8d141S[email protected] } 664f5d8d141S[email protected] 665f5d8d141S[email protected] int hci_classic_supported(void){ 6666ac9a97eS[email protected] // No. 37, byte 4, bit 5, = No BR/EDR Support 6673a9fb326S[email protected] return (hci_stack->local_supported_features[4] & (1 << 5)) == 0; 668f5d8d141S[email protected] } 669f5d8d141S[email protected] 670f5d8d141S[email protected] int hci_le_supported(void){ 671f5d8d141S[email protected] #ifdef HAVE_BLE 6726ac9a97eS[email protected] // No. 37, byte 4, bit 6 = LE Supported (Controller) 6733a9fb326S[email protected] return (hci_stack->local_supported_features[4] & (1 << 6)) != 0; 674f5d8d141S[email protected] #else 675f5d8d141S[email protected] return 0; 676f5d8d141S[email protected] #endif 677f5d8d141S[email protected] } 678f5d8d141S[email protected] 67969a97523S[email protected] // get addr type and address used in advertisement packets 68018904abdS[email protected] void hci_le_advertisement_address(uint8_t * addr_type, bd_addr_t * addr){ 6813a9fb326S[email protected] *addr_type = hci_stack->adv_addr_type; 6823a9fb326S[email protected] if (hci_stack->adv_addr_type){ 6833a9fb326S[email protected] memcpy(addr, hci_stack->adv_address, 6); 68469a97523S[email protected] } else { 6853a9fb326S[email protected] memcpy(addr, hci_stack->local_bd_addr, 6); 68669a97523S[email protected] } 68769a97523S[email protected] } 68869a97523S[email protected] 689b2f949feS[email protected] #ifdef HAVE_BLE 690e01fe8b6S[email protected] void le_handle_advertisement_report(uint8_t *packet, int size){ 691d1dc057bS[email protected] int offset = 3; 692d1dc057bS[email protected] int num_reports = packet[offset]; 693d1dc057bS[email protected] offset += 1; 694d1dc057bS[email protected] 69557c9da5bS[email protected] int i; 6964f4b43f3S[email protected] log_info("HCI: handle adv report with num reports: %d", num_reports); 69757c9da5bS[email protected] for (i=0; i<num_reports;i++){ 698210c6774S[email protected] uint8_t data_length = packet[offset + 8]; 6992b552b23S[email protected] uint8_t event_size = 10 + data_length; 7002b552b23S[email protected] uint8_t event[2 + event_size ]; 701d1dc057bS[email protected] int pos = 0; 7022b552b23S[email protected] event[pos++] = GAP_LE_ADVERTISING_REPORT; 70357c9da5bS[email protected] event[pos++] = event_size; 704210c6774S[email protected] memcpy(&event[pos], &packet[offset], 1+1+6); // event type + address type + address 705d1dc057bS[email protected] offset += 8; 706d1dc057bS[email protected] pos += 8; 707d1dc057bS[email protected] event[pos++] = packet[offset + 1 + data_length]; // rssi 708d1dc057bS[email protected] event[pos++] = packet[offset++]; //data_length; 709d1dc057bS[email protected] memcpy(&event[pos], &packet[offset], data_length); 71057c9da5bS[email protected] pos += data_length; 711d1dc057bS[email protected] offset += data_length + 1; // rssi 7124f4b43f3S[email protected] hci_dump_packet( HCI_EVENT_PACKET, 0, event, sizeof(event)); 71357c9da5bS[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 71457c9da5bS[email protected] } 71557c9da5bS[email protected] } 716b2f949feS[email protected] #endif 71757c9da5bS[email protected] 7186155b3d3S[email protected] static void hci_initializing_event_handler(uint8_t * packet, uint16_t size){ 719a2481739S[email protected] uint8_t command_completed = 0; 720a2481739S[email protected] if ((hci_stack->substate % 2) == 0) return; 7216155b3d3S[email protected] // odd: waiting for event 7226155b3d3S[email protected] if (packet[0] == HCI_EVENT_COMMAND_COMPLETE){ 7236155b3d3S[email protected] uint16_t opcode = READ_BT_16(packet,3); 7246155b3d3S[email protected] if (opcode == hci_stack->last_cmd_opcode){ 725a2481739S[email protected] command_completed = 1; 7266155b3d3S[email protected] log_info("Command complete for expected opcode %04x -> new substate %u", opcode, hci_stack->substate); 7276155b3d3S[email protected] } else { 7286155b3d3S[email protected] log_info("Command complete for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode); 7296155b3d3S[email protected] } 7306155b3d3S[email protected] } 7316155b3d3S[email protected] if (packet[0] == HCI_EVENT_COMMAND_STATUS){ 7326155b3d3S[email protected] uint8_t status = packet[2]; 7336155b3d3S[email protected] uint16_t opcode = READ_BT_16(packet,4); 7346155b3d3S[email protected] if (opcode == hci_stack->last_cmd_opcode){ 7356155b3d3S[email protected] if (status){ 736a2481739S[email protected] command_completed = 1; 7376155b3d3S[email protected] log_error("Command status error 0x%02x for expected opcode %04x -> new substate %u", status, opcode, hci_stack->substate); 7386155b3d3S[email protected] } else { 7396155b3d3S[email protected] log_info("Command status OK for expected opcode %04x, waiting for command complete", opcode); 7406155b3d3S[email protected] } 7416155b3d3S[email protected] } else { 7426155b3d3S[email protected] log_info("Command status for opcode %04x, expected %04x", opcode, hci_stack->last_cmd_opcode); 7436155b3d3S[email protected] } 7446155b3d3S[email protected] } 745a2481739S[email protected] 746a2481739S[email protected] if (!command_completed) return; 747a2481739S[email protected] 748a2481739S[email protected] switch(hci_stack->substate >> 1){ 749a2481739S[email protected] default: 750a2481739S[email protected] hci_stack->substate++; 751a2481739S[email protected] break; 7526155b3d3S[email protected] } 7536155b3d3S[email protected] } 7546155b3d3S[email protected] 7556155b3d3S[email protected] static void hci_initializing_state_machine(){ 7569da54300S[email protected] // log_info("hci_init: substate %u", hci_stack->substate); 7576155b3d3S[email protected] if (hci_stack->substate % 2) { 7586155b3d3S[email protected] // odd: waiting for command completion 7596155b3d3S[email protected] return; 7606155b3d3S[email protected] } 7616155b3d3S[email protected] switch (hci_stack->substate >> 1){ 7626155b3d3S[email protected] case 0: // RESET 7636155b3d3S[email protected] hci_state_reset(); 7646155b3d3S[email protected] 7656155b3d3S[email protected] hci_send_cmd(&hci_reset); 7666155b3d3S[email protected] if (hci_stack->config == NULL || ((hci_uart_config_t *)hci_stack->config)->baudrate_main == 0){ 7676155b3d3S[email protected] // skip baud change 7686155b3d3S[email protected] hci_stack->substate = 4; // >> 1 = 2 7696155b3d3S[email protected] } 7706155b3d3S[email protected] break; 7716155b3d3S[email protected] case 1: // SEND BAUD CHANGE 7726155b3d3S[email protected] hci_stack->control->baudrate_cmd(hci_stack->config, ((hci_uart_config_t *)hci_stack->config)->baudrate_main, hci_stack->hci_packet_buffer); 77388789c61Smatthias.ringwald hci_stack->last_cmd_opcode = READ_BT_16(hci_stack->hci_packet_buffer, 0); 7746155b3d3S[email protected] hci_send_cmd_packet(hci_stack->hci_packet_buffer, 3 + hci_stack->hci_packet_buffer[2]); 7756155b3d3S[email protected] break; 7766155b3d3S[email protected] case 2: // LOCAL BAUD CHANGE 7776155b3d3S[email protected] log_info("Local baud rate change"); 7786155b3d3S[email protected] hci_stack->hci_transport->set_baudrate(((hci_uart_config_t *)hci_stack->config)->baudrate_main); 7796155b3d3S[email protected] hci_stack->substate += 2; 7806155b3d3S[email protected] // break missing here for fall through 7816155b3d3S[email protected] 7826155b3d3S[email protected] case 3: 7836155b3d3S[email protected] log_info("Custom init"); 7846155b3d3S[email protected] // Custom initialization 7856155b3d3S[email protected] if (hci_stack->control && hci_stack->control->next_cmd){ 7866155b3d3S[email protected] int valid_cmd = (*hci_stack->control->next_cmd)(hci_stack->config, hci_stack->hci_packet_buffer); 7876155b3d3S[email protected] if (valid_cmd){ 7886155b3d3S[email protected] int size = 3 + hci_stack->hci_packet_buffer[2]; 7896155b3d3S[email protected] hci_stack->last_cmd_opcode = READ_BT_16(hci_stack->hci_packet_buffer, 0); 7906155b3d3S[email protected] hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, hci_stack->hci_packet_buffer, size); 7916155b3d3S[email protected] hci_stack->substate = 4; // more init commands 7926155b3d3S[email protected] break; 7936155b3d3S[email protected] } 7949da54300S[email protected] log_info("hci_run: init script done"); 7956155b3d3S[email protected] } 7966155b3d3S[email protected] // otherwise continue 7976155b3d3S[email protected] hci_send_cmd(&hci_read_bd_addr); 7986155b3d3S[email protected] break; 7996155b3d3S[email protected] case 4: 8006155b3d3S[email protected] hci_send_cmd(&hci_read_buffer_size); 8016155b3d3S[email protected] break; 8026155b3d3S[email protected] case 5: 8036155b3d3S[email protected] hci_send_cmd(&hci_read_local_supported_features); 8046155b3d3S[email protected] break; 8056155b3d3S[email protected] case 6: 8066155b3d3S[email protected] if (hci_le_supported()){ 8076155b3d3S[email protected] hci_send_cmd(&hci_set_event_mask,0xffffffff, 0x3FFFFFFF); 8086155b3d3S[email protected] } else { 8096155b3d3S[email protected] // Kensington Bluetoot 2.1 USB Dongle (CSR Chipset) returns an error for 0xffff... 8106155b3d3S[email protected] hci_send_cmd(&hci_set_event_mask,0xffffffff, 0x1FFFFFFF); 8116155b3d3S[email protected] } 8126155b3d3S[email protected] 8136155b3d3S[email protected] // skip Classic init commands for LE only chipsets 8146155b3d3S[email protected] if (!hci_classic_supported()){ 8156155b3d3S[email protected] if (hci_le_supported()){ 8166155b3d3S[email protected] hci_stack->substate = 11 << 1; // skip all classic command 8176155b3d3S[email protected] } else { 8186155b3d3S[email protected] log_error("Neither BR/EDR nor LE supported"); 8196155b3d3S[email protected] hci_stack->substate = 14 << 1; // skip all 8206155b3d3S[email protected] } 8216155b3d3S[email protected] } 8226155b3d3S[email protected] break; 8236155b3d3S[email protected] case 7: 8246155b3d3S[email protected] if (hci_ssp_supported()){ 8256155b3d3S[email protected] hci_send_cmd(&hci_write_simple_pairing_mode, hci_stack->ssp_enable); 8266155b3d3S[email protected] break; 8276155b3d3S[email protected] } 8286155b3d3S[email protected] hci_stack->substate += 2; 8296155b3d3S[email protected] // break missing here for fall through 8306155b3d3S[email protected] 8316155b3d3S[email protected] case 8: 8326155b3d3S[email protected] // ca. 15 sec 8336155b3d3S[email protected] hci_send_cmd(&hci_write_page_timeout, 0x6000); 8346155b3d3S[email protected] break; 8356155b3d3S[email protected] case 9: 8366155b3d3S[email protected] hci_send_cmd(&hci_write_class_of_device, hci_stack->class_of_device); 8376155b3d3S[email protected] break; 8386155b3d3S[email protected] case 10: 8396155b3d3S[email protected] if (hci_stack->local_name){ 8406155b3d3S[email protected] hci_send_cmd(&hci_write_local_name, hci_stack->local_name); 8416155b3d3S[email protected] } else { 8426155b3d3S[email protected] char hostname[30]; 8436155b3d3S[email protected] #ifdef EMBEDDED 8446155b3d3S[email protected] // BTstack-11:22:33:44:55:66 8456155b3d3S[email protected] strcpy(hostname, "BTstack "); 8466155b3d3S[email protected] strcat(hostname, bd_addr_to_str(hci_stack->local_bd_addr)); 8476155b3d3S[email protected] log_info("---> Name %s", hostname); 8486155b3d3S[email protected] #else 8496155b3d3S[email protected] // hostname for POSIX systems 8506155b3d3S[email protected] gethostname(hostname, 30); 8516155b3d3S[email protected] hostname[29] = '\0'; 8526155b3d3S[email protected] #endif 8536155b3d3S[email protected] hci_send_cmd(&hci_write_local_name, hostname); 8546155b3d3S[email protected] } 8556155b3d3S[email protected] break; 8566155b3d3S[email protected] case 11: 8576155b3d3S[email protected] hci_send_cmd(&hci_write_scan_enable, (hci_stack->connectable << 1) | hci_stack->discoverable); // page scan 8586155b3d3S[email protected] if (!hci_le_supported()){ 8596155b3d3S[email protected] // SKIP LE init for Classic only configuration 8606155b3d3S[email protected] hci_stack->substate = 14 << 1; 8616155b3d3S[email protected] } 8626155b3d3S[email protected] break; 8636155b3d3S[email protected] 8646155b3d3S[email protected] #ifdef HAVE_BLE 8656155b3d3S[email protected] // LE INIT 8666155b3d3S[email protected] case 12: 8676155b3d3S[email protected] hci_send_cmd(&hci_le_read_buffer_size); 8686155b3d3S[email protected] break; 8696155b3d3S[email protected] case 13: 8706155b3d3S[email protected] // LE Supported Host = 1, Simultaneous Host = 0 8716155b3d3S[email protected] hci_send_cmd(&hci_write_le_host_supported, 1, 0); 8726155b3d3S[email protected] break; 8736155b3d3S[email protected] case 14: 8746155b3d3S[email protected] // LE Scan Parameters: active scanning, 300 ms interval, 30 ms window, public address, accept all advs 8756155b3d3S[email protected] hci_send_cmd(&hci_le_set_scan_parameters, 1, 0x1e0, 0x30, 0, 0); 8766155b3d3S[email protected] break; 8776155b3d3S[email protected] #endif 8786155b3d3S[email protected] 8796155b3d3S[email protected] // DONE 8806155b3d3S[email protected] case 15: 8816155b3d3S[email protected] // done. 8826155b3d3S[email protected] hci_stack->state = HCI_STATE_WORKING; 8836155b3d3S[email protected] hci_emit_state(); 8846155b3d3S[email protected] break; 8856155b3d3S[email protected] default: 8866155b3d3S[email protected] break; 8876155b3d3S[email protected] } 8886155b3d3S[email protected] hci_stack->substate++; 8896155b3d3S[email protected] } 8906155b3d3S[email protected] 89174ec757aSmatthias.ringwald // avoid huge local variables 892223aafc1Smatthias.ringwald #ifndef EMBEDDED 89374ec757aSmatthias.ringwald static device_name_t device_name; 894223aafc1Smatthias.ringwald #endif 89516833f0aSmatthias.ringwald static void event_handler(uint8_t *packet, int size){ 896e76a89eeS[email protected] 897e76a89eeS[email protected] uint16_t event_length = packet[1]; 898e76a89eeS[email protected] 899e76a89eeS[email protected] // assert packet is complete 900e76a89eeS[email protected] if (size != event_length + 2){ 901e76a89eeS[email protected] log_error("hci.c: event_handler called with event packet of wrong size %u, expected %u => dropping packet", size, event_length + 2); 902e76a89eeS[email protected] return; 903e76a89eeS[email protected] } 904e76a89eeS[email protected] 9051281a47eSmatthias.ringwald bd_addr_t addr; 90696a45072S[email protected] bd_addr_type_t addr_type; 9072d00edd4Smatthias.ringwald uint8_t link_type; 908fe1ed1b8Smatthias.ringwald hci_con_handle_t handle; 9091f7b95a1Smatthias.ringwald hci_connection_t * conn; 91056cf178bSmatthias.ringwald int i; 91122909952Smatthias.ringwald 9129da54300S[email protected] // log_info("HCI:EVENT:%02x", packet[0]); 9135909f7f2Smatthias.ringwald 9146772a24cSmatthias.ringwald switch (packet[0]) { 91522909952Smatthias.ringwald 9166772a24cSmatthias.ringwald case HCI_EVENT_COMMAND_COMPLETE: 9177ec5eeaaSmatthias.ringwald // get num cmd packets 9189da54300S[email protected] // log_info("HCI_EVENT_COMMAND_COMPLETE cmds old %u - new %u", hci_stack->num_cmd_packets, packet[2]); 9193a9fb326S[email protected] hci_stack->num_cmd_packets = packet[2]; 9207ec5eeaaSmatthias.ringwald 921e2edc0c3Smatthias.ringwald if (COMMAND_COMPLETE_EVENT(packet, hci_read_buffer_size)){ 922e2edc0c3Smatthias.ringwald // from offset 5 923e2edc0c3Smatthias.ringwald // status 9241d279b20Smatthias.ringwald // "The HC_ACL_Data_Packet_Length return parameter will be used to determine the size of the L2CAP segments contained in ACL Data Packets" 9253a9fb326S[email protected] hci_stack->acl_data_packet_length = READ_BT_16(packet, 6); 92656cf178bSmatthias.ringwald // ignore: SCO data packet len (8) 927ee303eddS[email protected] hci_stack->acl_packets_total_num = packet[9]; 92856cf178bSmatthias.ringwald // ignore: total num SCO packets 9293a9fb326S[email protected] if (hci_stack->state == HCI_STATE_INITIALIZING){ 930a7a04bd9Smatthias.ringwald // determine usable ACL payload size 9313a9fb326S[email protected] if (HCI_ACL_PAYLOAD_SIZE < hci_stack->acl_data_packet_length){ 9323a9fb326S[email protected] hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE; 9338f8108aaSmatthias.ringwald } 9349da54300S[email protected] log_info("hci_read_buffer_size: used size %u, count %u", 935ee303eddS[email protected] hci_stack->acl_data_packet_length, hci_stack->acl_packets_total_num); 936e2edc0c3Smatthias.ringwald } 93756cf178bSmatthias.ringwald } 93865a46ef3S[email protected] #ifdef HAVE_BLE 93965a46ef3S[email protected] if (COMMAND_COMPLETE_EVENT(packet, hci_le_read_buffer_size)){ 940219eea5fS[email protected] hci_stack->le_data_packets_length = READ_BT_16(packet, 6); 941ee303eddS[email protected] hci_stack->le_acl_packets_total_num = packet[8]; 9429da54300S[email protected] log_info("hci_le_read_buffer_size: size %u, count %u", hci_stack->le_data_packets_length, hci_stack->le_acl_packets_total_num); 94365a46ef3S[email protected] } 94465a46ef3S[email protected] #endif 945188981d2Smatthias.ringwald // Dump local address 946188981d2Smatthias.ringwald if (COMMAND_COMPLETE_EVENT(packet, hci_read_bd_addr)) { 9473a9fb326S[email protected] bt_flip_addr(hci_stack->local_bd_addr, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE + 1]); 9489da54300S[email protected] log_info("Local Address, Status: 0x%02x: Addr: %s", 9493a9fb326S[email protected] packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE], bd_addr_to_str(hci_stack->local_bd_addr)); 950188981d2Smatthias.ringwald } 951381fbed8Smatthias.ringwald if (COMMAND_COMPLETE_EVENT(packet, hci_write_scan_enable)){ 9523a9fb326S[email protected] hci_emit_discoverable_enabled(hci_stack->discoverable); 953381fbed8Smatthias.ringwald } 95465389bfcS[email protected] // Note: HCI init checks 955559e517eS[email protected] if (COMMAND_COMPLETE_EVENT(packet, hci_read_local_supported_features)){ 9563a9fb326S[email protected] memcpy(hci_stack->local_supported_features, &packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1], 8); 957559e517eS[email protected] log_info("Local Supported Features: 0x%02x%02x%02x%02x%02x%02x%02x%02x", 9583a9fb326S[email protected] hci_stack->local_supported_features[0], hci_stack->local_supported_features[1], 9593a9fb326S[email protected] hci_stack->local_supported_features[2], hci_stack->local_supported_features[3], 9603a9fb326S[email protected] hci_stack->local_supported_features[4], hci_stack->local_supported_features[5], 9613a9fb326S[email protected] hci_stack->local_supported_features[6], hci_stack->local_supported_features[7]); 96265389bfcS[email protected] 96365389bfcS[email protected] // determine usable ACL packet types based buffer size and supported features 9643a9fb326S[email protected] hci_stack->packet_types = hci_acl_packet_types_for_buffer_size_and_local_features(hci_stack->acl_data_packet_length, &hci_stack->local_supported_features[0]); 9653a9fb326S[email protected] log_info("packet types %04x", hci_stack->packet_types); 966f5d8d141S[email protected] 967f5d8d141S[email protected] // Classic/LE 968f5d8d141S[email protected] log_info("BR/EDR support %u, LE support %u", hci_classic_supported(), hci_le_supported()); 969559e517eS[email protected] } 97056cf178bSmatthias.ringwald break; 97156cf178bSmatthias.ringwald 9727ec5eeaaSmatthias.ringwald case HCI_EVENT_COMMAND_STATUS: 9737ec5eeaaSmatthias.ringwald // get num cmd packets 9749da54300S[email protected] // log_info("HCI_EVENT_COMMAND_STATUS cmds - old %u - new %u", hci_stack->num_cmd_packets, packet[3]); 9753a9fb326S[email protected] hci_stack->num_cmd_packets = packet[3]; 9767ec5eeaaSmatthias.ringwald break; 9777ec5eeaaSmatthias.ringwald 9782e440c8aS[email protected] case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS:{ 9792e440c8aS[email protected] int offset = 3; 98056cf178bSmatthias.ringwald for (i=0; i<packet[2];i++){ 9812e440c8aS[email protected] handle = READ_BT_16(packet, offset); 9822e440c8aS[email protected] offset += 2; 9832e440c8aS[email protected] uint16_t num_packets = READ_BT_16(packet, offset); 9842e440c8aS[email protected] offset += 2; 9852e440c8aS[email protected] 9865061f3afS[email protected] conn = hci_connection_for_handle(handle); 98756cf178bSmatthias.ringwald if (!conn){ 9889da54300S[email protected] log_error("hci_number_completed_packet lists unused con handle %u", handle); 98956cf178bSmatthias.ringwald continue; 99056cf178bSmatthias.ringwald } 99123bed257S[email protected] 99223bed257S[email protected] if (conn->num_acl_packets_sent >= num_packets){ 99356cf178bSmatthias.ringwald conn->num_acl_packets_sent -= num_packets; 99423bed257S[email protected] } else { 99523bed257S[email protected] log_error("hci_number_completed_packets, more slots freed then sent."); 99623bed257S[email protected] conn->num_acl_packets_sent = 0; 99723bed257S[email protected] } 9989da54300S[email protected] // log_info("hci_number_completed_packet %u processed for handle %u, outstanding %u", num_packets, handle, conn->num_acl_packets_sent); 99956cf178bSmatthias.ringwald } 10006772a24cSmatthias.ringwald break; 10012e440c8aS[email protected] } 10021f7b95a1Smatthias.ringwald case HCI_EVENT_CONNECTION_REQUEST: 100337eaa4cfSmatthias.ringwald bt_flip_addr(addr, &packet[2]); 100437eaa4cfSmatthias.ringwald // TODO: eval COD 8-10 10052d00edd4Smatthias.ringwald link_type = packet[11]; 10069da54300S[email protected] log_info("Connection_incoming: %s, type %u", bd_addr_to_str(addr), link_type); 100737eaa4cfSmatthias.ringwald if (link_type == 1) { // ACL 100896a45072S[email protected] conn = hci_connection_for_bd_addr_and_type(&addr, BD_ADDR_TYPE_CLASSIC); 10091f7b95a1Smatthias.ringwald if (!conn) { 101096a45072S[email protected] conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC); 10111f7b95a1Smatthias.ringwald } 1012ce4c8fabSmatthias.ringwald if (!conn) { 1013ce4c8fabSmatthias.ringwald // CONNECTION REJECTED DUE TO LIMITED RESOURCES (0X0D) 10143a9fb326S[email protected] hci_stack->decline_reason = 0x0d; 10153a9fb326S[email protected] BD_ADDR_COPY(hci_stack->decline_addr, addr); 1016ce4c8fabSmatthias.ringwald break; 1017ce4c8fabSmatthias.ringwald } 101832ab9390Smatthias.ringwald conn->state = RECEIVED_CONNECTION_REQUEST; 101932ab9390Smatthias.ringwald hci_run(); 102037eaa4cfSmatthias.ringwald } else { 1021ce4c8fabSmatthias.ringwald // SYNCHRONOUS CONNECTION LIMIT TO A DEVICE EXCEEDED (0X0A) 10223a9fb326S[email protected] hci_stack->decline_reason = 0x0a; 10233a9fb326S[email protected] BD_ADDR_COPY(hci_stack->decline_addr, addr); 102437eaa4cfSmatthias.ringwald } 10251f7b95a1Smatthias.ringwald break; 10261f7b95a1Smatthias.ringwald 10276772a24cSmatthias.ringwald case HCI_EVENT_CONNECTION_COMPLETE: 1028fe1ed1b8Smatthias.ringwald // Connection management 1029fe1ed1b8Smatthias.ringwald bt_flip_addr(addr, &packet[5]); 10309da54300S[email protected] log_info("Connection_complete (status=%u) %s", packet[2], bd_addr_to_str(addr)); 103196a45072S[email protected] addr_type = BD_ADDR_TYPE_CLASSIC; 103296a45072S[email protected] conn = hci_connection_for_bd_addr_and_type(&addr, addr_type); 1033fe1ed1b8Smatthias.ringwald if (conn) { 1034b448a0e7Smatthias.ringwald if (!packet[2]){ 1035c8e4258aSmatthias.ringwald conn->state = OPEN; 1036fe1ed1b8Smatthias.ringwald conn->con_handle = READ_BT_16(packet, 3); 1037ad83dc6aS[email protected] conn->bonding_flags |= BONDING_REQUEST_REMOTE_FEATURES; 1038ee091cf1Smatthias.ringwald 1039c785ef68Smatthias.ringwald // restart timer 1040c21e6239Smatthias.ringwald run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 1041ee091cf1Smatthias.ringwald run_loop_add_timer(&conn->timeout); 1042c785ef68Smatthias.ringwald 10439da54300S[email protected] log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address)); 104443bfb1bdSmatthias.ringwald 104543bfb1bdSmatthias.ringwald hci_emit_nr_connections_changed(); 1046b448a0e7Smatthias.ringwald } else { 10471bd5283dS[email protected] int notify_dedicated_bonding_failed = conn->bonding_flags & BONDING_DEDICATED; 10481bd5283dS[email protected] uint8_t status = packet[2]; 10491bd5283dS[email protected] bd_addr_t bd_address; 10501bd5283dS[email protected] memcpy(&bd_address, conn->address, 6); 1051ad83dc6aS[email protected] 1052b448a0e7Smatthias.ringwald // connection failed, remove entry 10533a9fb326S[email protected] linked_list_remove(&hci_stack->connections, (linked_item_t *) conn); 1054a3b02b71Smatthias.ringwald btstack_memory_hci_connection_free( conn ); 1055c12e46e7Smatthias.ringwald 10561bd5283dS[email protected] // notify client if dedicated bonding 10571bd5283dS[email protected] if (notify_dedicated_bonding_failed){ 10581bd5283dS[email protected] log_info("hci notify_dedicated_bonding_failed"); 10591bd5283dS[email protected] hci_emit_dedicated_bonding_result(bd_address, status); 10601bd5283dS[email protected] } 10611bd5283dS[email protected] 1062c12e46e7Smatthias.ringwald // if authentication error, also delete link key 1063c12e46e7Smatthias.ringwald if (packet[2] == 0x05) { 1064c12e46e7Smatthias.ringwald hci_drop_link_key_for_bd_addr(&addr); 1065c12e46e7Smatthias.ringwald } 1066fe1ed1b8Smatthias.ringwald } 1067fe1ed1b8Smatthias.ringwald } 10686772a24cSmatthias.ringwald break; 1069fe1ed1b8Smatthias.ringwald 1070afd4e962S[email protected] case HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE: 1071afd4e962S[email protected] handle = READ_BT_16(packet, 3); 1072afd4e962S[email protected] conn = hci_connection_for_handle(handle); 1073afd4e962S[email protected] if (!conn) break; 1074afd4e962S[email protected] if (!packet[2]){ 1075afd4e962S[email protected] uint8_t * features = &packet[5]; 1076afd4e962S[email protected] if (features[6] & (1 << 3)){ 1077afd4e962S[email protected] conn->bonding_flags |= BONDING_REMOTE_SUPPORTS_SSP; 1078afd4e962S[email protected] } 1079afd4e962S[email protected] } 1080afd4e962S[email protected] conn->bonding_flags |= BONDING_RECEIVED_REMOTE_FEATURES; 1081ad83dc6aS[email protected] log_info("HCI_EVENT_READ_REMOTE_SUPPORTED_FEATURES_COMPLETE, bonding flags %x", conn->bonding_flags); 1082ad83dc6aS[email protected] if (conn->bonding_flags & BONDING_DEDICATED){ 1083ad83dc6aS[email protected] conn->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 1084ad83dc6aS[email protected] } 1085afd4e962S[email protected] break; 1086afd4e962S[email protected] 10877fde4af9Smatthias.ringwald case HCI_EVENT_LINK_KEY_REQUEST: 10889da54300S[email protected] log_info("HCI_EVENT_LINK_KEY_REQUEST"); 10897fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_LINK_KEY_REQUEST); 109074d716b5S[email protected] // non-bondable mode: link key negative reply will be sent by HANDLE_LINK_KEY_REQUEST 10913a9fb326S[email protected] if (hci_stack->bondable && !hci_stack->remote_device_db) break; 109232ab9390Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], HANDLE_LINK_KEY_REQUEST); 109364472d52Smatthias.ringwald hci_run(); 1094d9a327f9Smatthias.ringwald // request handled by hci_run() as HANDLE_LINK_KEY_REQUEST gets set 109529d53098Smatthias.ringwald return; 10967fde4af9Smatthias.ringwald 10979ab95c90S[email protected] case HCI_EVENT_LINK_KEY_NOTIFICATION: { 109829d53098Smatthias.ringwald bt_flip_addr(addr, &packet[2]); 109996a45072S[email protected] conn = hci_connection_for_bd_addr_and_type(&addr, BD_ADDR_TYPE_CLASSIC); 11009ab95c90S[email protected] if (!conn) break; 11019ab95c90S[email protected] conn->authentication_flags |= RECV_LINK_KEY_NOTIFICATION; 11027bdc6798S[email protected] link_key_type_t link_key_type = (link_key_type_t)packet[24]; 11039ab95c90S[email protected] // Change Connection Encryption keeps link key type 11049ab95c90S[email protected] if (link_key_type != CHANGED_COMBINATION_KEY){ 11059ab95c90S[email protected] conn->link_key_type = link_key_type; 11069ab95c90S[email protected] } 11073a9fb326S[email protected] if (!hci_stack->remote_device_db) break; 11083a9fb326S[email protected] hci_stack->remote_device_db->put_link_key(&addr, (link_key_t *) &packet[8], conn->link_key_type); 110929d53098Smatthias.ringwald // still forward event to allow dismiss of pairing dialog 11107fde4af9Smatthias.ringwald break; 11119ab95c90S[email protected] } 11127fde4af9Smatthias.ringwald 11137fde4af9Smatthias.ringwald case HCI_EVENT_PIN_CODE_REQUEST: 11146724cd9eS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], LEGACY_PAIRING_ACTIVE); 11154c57c146S[email protected] // non-bondable mode: pin code negative reply will be sent 11163a9fb326S[email protected] if (!hci_stack->bondable){ 1117899283eaS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], DENY_PIN_CODE_REQUEST); 1118f8fb5f6eS[email protected] hci_run(); 1119f8fb5f6eS[email protected] return; 11204c57c146S[email protected] } 1121d9a327f9Smatthias.ringwald // PIN CODE REQUEST means the link key request didn't succee -> delete stored link key 11223a9fb326S[email protected] if (!hci_stack->remote_device_db) break; 1123d9a327f9Smatthias.ringwald bt_flip_addr(addr, &packet[2]); 11243a9fb326S[email protected] hci_stack->remote_device_db->delete_link_key(&addr); 11257fde4af9Smatthias.ringwald break; 11267fde4af9Smatthias.ringwald 11271d6b20aeS[email protected] case HCI_EVENT_IO_CAPABILITY_REQUEST: 11281d6b20aeS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_IO_CAPABILITIES_REQUEST); 1129dbe1a790S[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_IO_CAPABILITIES_REPLY); 1130dbe1a790S[email protected] break; 1131dbe1a790S[email protected] 1132dbe1a790S[email protected] case HCI_EVENT_USER_CONFIRMATION_REQUEST: 11336724cd9eS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SSP_PAIRING_ACTIVE); 11343a9fb326S[email protected] if (!hci_stack->ssp_auto_accept) break; 1135dbe1a790S[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_USER_CONFIRM_REPLY); 1136dbe1a790S[email protected] break; 1137dbe1a790S[email protected] 1138dbe1a790S[email protected] case HCI_EVENT_USER_PASSKEY_REQUEST: 11396724cd9eS[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SSP_PAIRING_ACTIVE); 11403a9fb326S[email protected] if (!hci_stack->ssp_auto_accept) break; 1141dbe1a790S[email protected] hci_add_connection_flags_for_flipped_bd_addr(&packet[2], SEND_USER_PASSKEY_REPLY); 11421d6b20aeS[email protected] break; 11431d6b20aeS[email protected] 1144f0944df2S[email protected] case HCI_EVENT_ENCRYPTION_CHANGE: 1145f0944df2S[email protected] handle = READ_BT_16(packet, 3); 1146f0944df2S[email protected] conn = hci_connection_for_handle(handle); 1147f0944df2S[email protected] if (!conn) break; 1148ad83dc6aS[email protected] if (packet[2] == 0) { 1149f0944df2S[email protected] if (packet[5]){ 1150f0944df2S[email protected] conn->authentication_flags |= CONNECTION_ENCRYPTED; 1151f0944df2S[email protected] } else { 1152536f9994S[email protected] conn->authentication_flags &= ~CONNECTION_ENCRYPTED; 1153f0944df2S[email protected] } 1154ad83dc6aS[email protected] } 1155a00031e2S[email protected] hci_emit_security_level(handle, gap_security_level_for_connection(conn)); 1156f0944df2S[email protected] break; 1157f0944df2S[email protected] 11581eb2563eS[email protected] case HCI_EVENT_AUTHENTICATION_COMPLETE_EVENT: 11591eb2563eS[email protected] handle = READ_BT_16(packet, 3); 11601eb2563eS[email protected] conn = hci_connection_for_handle(handle); 11611eb2563eS[email protected] if (!conn) break; 1162ad83dc6aS[email protected] 1163ad83dc6aS[email protected] // dedicated bonding: send result and disconnect 1164ad83dc6aS[email protected] if (conn->bonding_flags & BONDING_DEDICATED){ 1165ad83dc6aS[email protected] conn->bonding_flags &= ~BONDING_DEDICATED; 1166ad83dc6aS[email protected] conn->bonding_flags |= BONDING_DISCONNECT_DEDICATED_DONE; 11671bd5283dS[email protected] conn->bonding_status = packet[2]; 1168ad83dc6aS[email protected] break; 1169ad83dc6aS[email protected] } 1170ad83dc6aS[email protected] 1171b5cb6874S[email protected] if (packet[2] == 0 && gap_security_level_for_link_key_type(conn->link_key_type) >= conn->requested_security_level){ 11721eb2563eS[email protected] // link key sufficient for requested security 11731eb2563eS[email protected] conn->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST; 1174ad83dc6aS[email protected] break; 1175ad83dc6aS[email protected] } 11761eb2563eS[email protected] // not enough 11771eb2563eS[email protected] hci_emit_security_level(handle, gap_security_level_for_connection(conn)); 11781eb2563eS[email protected] break; 117934d2123cS[email protected] 1180223aafc1Smatthias.ringwald #ifndef EMBEDDED 118174ec757aSmatthias.ringwald case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE: 11823a9fb326S[email protected] if (!hci_stack->remote_device_db) break; 118374ec757aSmatthias.ringwald if (packet[2]) break; // status not ok 118474ec757aSmatthias.ringwald bt_flip_addr(addr, &packet[3]); 11855a06394aSmatthias.ringwald // fix for invalid remote names - terminate on 0xff 11865a06394aSmatthias.ringwald for (i=0; i<248;i++){ 11875a06394aSmatthias.ringwald if (packet[9+i] == 0xff){ 11885a06394aSmatthias.ringwald packet[9+i] = 0; 11895a06394aSmatthias.ringwald break; 1190cdc9101dSmatthias.ringwald } 11915a06394aSmatthias.ringwald } 1192d2fe945cS[email protected] memset(&device_name, 0, sizeof(device_name_t)); 119374ec757aSmatthias.ringwald strncpy((char*) device_name, (char*) &packet[9], 248); 11943a9fb326S[email protected] hci_stack->remote_device_db->put_name(&addr, &device_name); 119574ec757aSmatthias.ringwald break; 119674ec757aSmatthias.ringwald 119774ec757aSmatthias.ringwald case HCI_EVENT_INQUIRY_RESULT: 1198206a9031S[email protected] case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:{ 11993a9fb326S[email protected] if (!hci_stack->remote_device_db) break; 120074ec757aSmatthias.ringwald // first send inq result packet 12013a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, packet, size); 120274ec757aSmatthias.ringwald // then send cached remote names 1203206a9031S[email protected] int offset = 3; 120474ec757aSmatthias.ringwald for (i=0; i<packet[2];i++){ 1205206a9031S[email protected] bt_flip_addr(addr, &packet[offset]); 1206206a9031S[email protected] offset += 14; // 6 + 1 + 1 + 1 + 3 + 2; 12073a9fb326S[email protected] if (hci_stack->remote_device_db->get_name(&addr, &device_name)){ 120874ec757aSmatthias.ringwald hci_emit_remote_name_cached(&addr, &device_name); 120974ec757aSmatthias.ringwald } 121074ec757aSmatthias.ringwald } 121174ec757aSmatthias.ringwald return; 1212206a9031S[email protected] } 1213223aafc1Smatthias.ringwald #endif 121474ec757aSmatthias.ringwald 121586805605S[email protected] // HCI_EVENT_DISCONNECTION_COMPLETE 121686805605S[email protected] // has been moved down, to first notify stack before shutting connection down 12176772a24cSmatthias.ringwald 1218c68bdf90Smatthias.ringwald case HCI_EVENT_HARDWARE_ERROR: 12193a9fb326S[email protected] if(hci_stack->control && hci_stack->control->hw_error){ 12203a9fb326S[email protected] (*hci_stack->control->hw_error)(); 12217586ee35S[email protected] } else { 12227586ee35S[email protected] // if no special requests, just reboot stack 12237586ee35S[email protected] hci_power_control_off(); 12247586ee35S[email protected] hci_power_control_on(); 1225c68bdf90Smatthias.ringwald } 1226c68bdf90Smatthias.ringwald break; 1227c68bdf90Smatthias.ringwald 12286b4af23dS[email protected] case DAEMON_EVENT_HCI_PACKET_SENT: 12296b4af23dS[email protected] // free packet buffer for asynchronous transport 12306b4af23dS[email protected] if (hci_transport_synchronous()) break; 12316b4af23dS[email protected] hci_stack->hci_packet_buffer_reserved = 0; 12326b4af23dS[email protected] break; 12336b4af23dS[email protected] 12345909f7f2Smatthias.ringwald #ifdef HAVE_BLE 12355909f7f2Smatthias.ringwald case HCI_EVENT_LE_META: 12365909f7f2Smatthias.ringwald switch (packet[2]){ 123757c9da5bS[email protected] case HCI_SUBEVENT_LE_ADVERTISING_REPORT: 12389da54300S[email protected] log_info("advertising report received"); 12397bdc6798S[email protected] if (hci_stack->le_scanning_state != LE_SCANNING) break; 124057c9da5bS[email protected] le_handle_advertisement_report(packet, size); 12417bdc6798S[email protected] break; 12425909f7f2Smatthias.ringwald case HCI_SUBEVENT_LE_CONNECTION_COMPLETE: 12435909f7f2Smatthias.ringwald // Connection management 12445909f7f2Smatthias.ringwald bt_flip_addr(addr, &packet[8]); 12457bdc6798S[email protected] addr_type = (bd_addr_type_t)packet[7]; 12469da54300S[email protected] log_info("LE Connection_complete (status=%u) type %u, %s", packet[3], addr_type, bd_addr_to_str(addr)); 12475909f7f2Smatthias.ringwald // LE connections are auto-accepted, so just create a connection if there isn't one already 124896a45072S[email protected] conn = hci_connection_for_bd_addr_and_type(&addr, addr_type); 12495909f7f2Smatthias.ringwald if (packet[3]){ 12505909f7f2Smatthias.ringwald if (conn){ 12515909f7f2Smatthias.ringwald // outgoing connection failed, remove entry 12523a9fb326S[email protected] linked_list_remove(&hci_stack->connections, (linked_item_t *) conn); 12535909f7f2Smatthias.ringwald btstack_memory_hci_connection_free( conn ); 12545909f7f2Smatthias.ringwald } 12555909f7f2Smatthias.ringwald // if authentication error, also delete link key 12565909f7f2Smatthias.ringwald if (packet[3] == 0x05) { 12575909f7f2Smatthias.ringwald hci_drop_link_key_for_bd_addr(&addr); 12585909f7f2Smatthias.ringwald } 12595909f7f2Smatthias.ringwald break; 12605909f7f2Smatthias.ringwald } 12615909f7f2Smatthias.ringwald if (!conn){ 126296a45072S[email protected] conn = create_connection_for_bd_addr_and_type(addr, addr_type); 12635909f7f2Smatthias.ringwald } 12645909f7f2Smatthias.ringwald if (!conn){ 12655909f7f2Smatthias.ringwald // no memory 12665909f7f2Smatthias.ringwald break; 12675909f7f2Smatthias.ringwald } 12685909f7f2Smatthias.ringwald 12695909f7f2Smatthias.ringwald conn->state = OPEN; 12705909f7f2Smatthias.ringwald conn->con_handle = READ_BT_16(packet, 4); 12715909f7f2Smatthias.ringwald 12725909f7f2Smatthias.ringwald // TODO: store - role, peer address type, conn_interval, conn_latency, supervision timeout, master clock 12735909f7f2Smatthias.ringwald 12745909f7f2Smatthias.ringwald // restart timer 12755909f7f2Smatthias.ringwald // run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 12765909f7f2Smatthias.ringwald // run_loop_add_timer(&conn->timeout); 12775909f7f2Smatthias.ringwald 12789da54300S[email protected] log_info("New connection: handle %u, %s", conn->con_handle, bd_addr_to_str(conn->address)); 12795909f7f2Smatthias.ringwald 12805909f7f2Smatthias.ringwald hci_emit_nr_connections_changed(); 12815909f7f2Smatthias.ringwald break; 12825909f7f2Smatthias.ringwald 12839da54300S[email protected] // log_info("LE buffer size: %u, count %u", READ_BT_16(packet,6), packet[8]); 128465a46ef3S[email protected] 12855909f7f2Smatthias.ringwald default: 12865909f7f2Smatthias.ringwald break; 12875909f7f2Smatthias.ringwald } 12885909f7f2Smatthias.ringwald break; 12895909f7f2Smatthias.ringwald #endif 12906772a24cSmatthias.ringwald default: 12916772a24cSmatthias.ringwald break; 1292fe1ed1b8Smatthias.ringwald } 1293fe1ed1b8Smatthias.ringwald 12943429f56bSmatthias.ringwald // handle BT initialization 12953a9fb326S[email protected] if (hci_stack->state == HCI_STATE_INITIALIZING){ 12966155b3d3S[email protected] hci_initializing_event_handler(packet, size); 1297c9af4d3fS[email protected] } 129822909952Smatthias.ringwald 129989db417bSmatthias.ringwald // help with BT sleep 13003a9fb326S[email protected] if (hci_stack->state == HCI_STATE_FALLING_ASLEEP 13013a9fb326S[email protected] && hci_stack->substate == 1 130289db417bSmatthias.ringwald && COMMAND_COMPLETE_EVENT(packet, hci_write_scan_enable)){ 13033a9fb326S[email protected] hci_stack->substate++; 130489db417bSmatthias.ringwald } 130589db417bSmatthias.ringwald 130686805605S[email protected] // notify upper stack 13073a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, packet, size); 130894ab26f8Smatthias.ringwald 130986805605S[email protected] // moved here to give upper stack a chance to close down everything with hci_connection_t intact 131086805605S[email protected] if (packet[0] == HCI_EVENT_DISCONNECTION_COMPLETE){ 131186805605S[email protected] if (!packet[2]){ 131286805605S[email protected] handle = READ_BT_16(packet, 3); 131386805605S[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 131486805605S[email protected] if (conn) { 131586805605S[email protected] uint8_t status = conn->bonding_status; 131686805605S[email protected] bd_addr_t bd_address; 131786805605S[email protected] memcpy(&bd_address, conn->address, 6); 131886805605S[email protected] hci_shutdown_connection(conn); 131986805605S[email protected] if (conn->bonding_flags & BONDING_EMIT_COMPLETE_ON_DISCONNECT){ 132086805605S[email protected] hci_emit_dedicated_bonding_result(bd_address, status); 132186805605S[email protected] } 132286805605S[email protected] } 132386805605S[email protected] } 132486805605S[email protected] } 132586805605S[email protected] 132694ab26f8Smatthias.ringwald // execute main loop 132794ab26f8Smatthias.ringwald hci_run(); 132816833f0aSmatthias.ringwald } 132916833f0aSmatthias.ringwald 13300a57e69fSmatthias.ringwald static void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){ 133110e830c9Smatthias.ringwald switch (packet_type) { 133210e830c9Smatthias.ringwald case HCI_EVENT_PACKET: 133310e830c9Smatthias.ringwald event_handler(packet, size); 133410e830c9Smatthias.ringwald break; 133510e830c9Smatthias.ringwald case HCI_ACL_DATA_PACKET: 133610e830c9Smatthias.ringwald acl_handler(packet, size); 133710e830c9Smatthias.ringwald break; 133810e830c9Smatthias.ringwald default: 133910e830c9Smatthias.ringwald break; 134010e830c9Smatthias.ringwald } 134110e830c9Smatthias.ringwald } 134210e830c9Smatthias.ringwald 1343fcadd0caSmatthias.ringwald /** Register HCI packet handlers */ 13442718e2e7Smatthias.ringwald void hci_register_packet_handler(void (*handler)(uint8_t packet_type, uint8_t *packet, uint16_t size)){ 13453a9fb326S[email protected] hci_stack->packet_handler = handler; 134616833f0aSmatthias.ringwald } 134716833f0aSmatthias.ringwald 13486155b3d3S[email protected] static void hci_state_reset(){ 1349595bdbfbS[email protected] // no connections yet 1350595bdbfbS[email protected] hci_stack->connections = NULL; 135174308b23Smatthias.ringwald 135274308b23Smatthias.ringwald // keep discoverable/connectable as this has been requested by the client(s) 135374308b23Smatthias.ringwald // hci_stack->discoverable = 0; 135474308b23Smatthias.ringwald // hci_stack->connectable = 0; 135574308b23Smatthias.ringwald // hci_stack->bondable = 1; 1356595bdbfbS[email protected] 135744935e40S[email protected] // buffer is free 135844935e40S[email protected] hci_stack->hci_packet_buffer_reserved = 0; 135944935e40S[email protected] 1360595bdbfbS[email protected] // no pending cmds 1361595bdbfbS[email protected] hci_stack->decline_reason = 0; 1362595bdbfbS[email protected] hci_stack->new_scan_enable_value = 0xff; 1363595bdbfbS[email protected] 1364595bdbfbS[email protected] // LE 1365595bdbfbS[email protected] hci_stack->adv_addr_type = 0; 1366595bdbfbS[email protected] memset(hci_stack->adv_address, 0, 6); 1367595bdbfbS[email protected] hci_stack->le_scanning_state = LE_SCAN_IDLE; 1368e2602ea2Smatthias.ringwald hci_stack->le_scan_type = 0xff; 1369595bdbfbS[email protected] } 1370595bdbfbS[email protected] 13714f4fc1dfSmatthias.ringwald void hci_init(hci_transport_t *transport, void *config, bt_control_t *control, remote_device_db_t const* remote_device_db){ 1372475c8125Smatthias.ringwald 13733a9fb326S[email protected] #ifdef HAVE_MALLOC 13743a9fb326S[email protected] if (!hci_stack) { 13753a9fb326S[email protected] hci_stack = (hci_stack_t*) malloc(sizeof(hci_stack_t)); 13763a9fb326S[email protected] } 13773a9fb326S[email protected] #else 13783a9fb326S[email protected] hci_stack = &hci_stack_static; 13793a9fb326S[email protected] #endif 138066fb9560S[email protected] memset(hci_stack, 0, sizeof(hci_stack_t)); 13813a9fb326S[email protected] 1382475c8125Smatthias.ringwald // reference to use transport layer implementation 13833a9fb326S[email protected] hci_stack->hci_transport = transport; 1384475c8125Smatthias.ringwald 138511e23e5fSmatthias.ringwald // references to used control implementation 13863a9fb326S[email protected] hci_stack->control = control; 138711e23e5fSmatthias.ringwald 138811e23e5fSmatthias.ringwald // reference to used config 13893a9fb326S[email protected] hci_stack->config = config; 139011e23e5fSmatthias.ringwald 139116833f0aSmatthias.ringwald // higher level handler 13923a9fb326S[email protected] hci_stack->packet_handler = dummy_handler; 139316833f0aSmatthias.ringwald 1394404843c1Smatthias.ringwald // store and open remote device db 13953a9fb326S[email protected] hci_stack->remote_device_db = remote_device_db; 13963a9fb326S[email protected] if (hci_stack->remote_device_db) { 13973a9fb326S[email protected] hci_stack->remote_device_db->open(); 1398404843c1Smatthias.ringwald } 139929d53098Smatthias.ringwald 14008fcba05dSmatthias.ringwald // max acl payload size defined in config.h 14013a9fb326S[email protected] hci_stack->acl_data_packet_length = HCI_ACL_PAYLOAD_SIZE; 14028fcba05dSmatthias.ringwald 140316833f0aSmatthias.ringwald // register packet handlers with transport 140410e830c9Smatthias.ringwald transport->register_packet_handler(&packet_handler); 1405f5454fc6Smatthias.ringwald 14063a9fb326S[email protected] hci_stack->state = HCI_STATE_OFF; 1407e2386ba1S[email protected] 1408e2386ba1S[email protected] // class of device 14093a9fb326S[email protected] hci_stack->class_of_device = 0x007a020c; // Smartphone 1410a45d6b9fS[email protected] 1411f20168b8Smatthias.ringwald // bondable by default 1412f20168b8Smatthias.ringwald hci_stack->bondable = 1; 1413f20168b8Smatthias.ringwald 141463048403S[email protected] // Secure Simple Pairing default: enable, no I/O capabilities, general bonding, mitm not required, auto accept 14153a9fb326S[email protected] hci_stack->ssp_enable = 1; 14163a9fb326S[email protected] hci_stack->ssp_io_capability = SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT; 14173a9fb326S[email protected] hci_stack->ssp_authentication_requirement = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING; 14183a9fb326S[email protected] hci_stack->ssp_auto_accept = 1; 141969a97523S[email protected] 1420595bdbfbS[email protected] hci_state_reset(); 1421475c8125Smatthias.ringwald } 1422475c8125Smatthias.ringwald 1423404843c1Smatthias.ringwald void hci_close(){ 1424404843c1Smatthias.ringwald // close remote device db 14253a9fb326S[email protected] if (hci_stack->remote_device_db) { 14263a9fb326S[email protected] hci_stack->remote_device_db->close(); 1427404843c1Smatthias.ringwald } 14283a9fb326S[email protected] while (hci_stack->connections) { 1429bc68afe2S[email protected] // cancel all l2cap connections 1430bc68afe2S[email protected] hci_emit_disconnection_complete(((hci_connection_t *) hci_stack->connections)->con_handle, 0x16); // terminated by local host 14313a9fb326S[email protected] hci_shutdown_connection((hci_connection_t *) hci_stack->connections); 1432f5454fc6Smatthias.ringwald } 1433f5454fc6Smatthias.ringwald hci_power_control(HCI_POWER_OFF); 14343a9fb326S[email protected] 14353a9fb326S[email protected] #ifdef HAVE_MALLOC 14363a9fb326S[email protected] free(hci_stack); 14373a9fb326S[email protected] #endif 14383a9fb326S[email protected] hci_stack = NULL; 1439404843c1Smatthias.ringwald } 1440404843c1Smatthias.ringwald 14419e61646fS[email protected] void hci_set_class_of_device(uint32_t class_of_device){ 14429e61646fS[email protected] hci_stack->class_of_device = class_of_device; 14439e61646fS[email protected] } 14449e61646fS[email protected] 144566fb9560S[email protected] void hci_disable_l2cap_timeout_check(){ 144666fb9560S[email protected] disable_l2cap_timeouts = 1; 144766fb9560S[email protected] } 14488d213e1aSmatthias.ringwald // State-Module-Driver overview 14498d213e1aSmatthias.ringwald // state module low-level 14508d213e1aSmatthias.ringwald // HCI_STATE_OFF off close 14518d213e1aSmatthias.ringwald // HCI_STATE_INITIALIZING, on open 14528d213e1aSmatthias.ringwald // HCI_STATE_WORKING, on open 14538d213e1aSmatthias.ringwald // HCI_STATE_HALTING, on open 1454d661ed19Smatthias.ringwald // HCI_STATE_SLEEPING, off/sleep close 1455d661ed19Smatthias.ringwald // HCI_STATE_FALLING_ASLEEP on open 1456c7e0c5f6Smatthias.ringwald 145740d1c7a4Smatthias.ringwald static int hci_power_control_on(void){ 14587301ad89Smatthias.ringwald 1459038bc64cSmatthias.ringwald // power on 1460f9a30166Smatthias.ringwald int err = 0; 14613a9fb326S[email protected] if (hci_stack->control && hci_stack->control->on){ 14623a9fb326S[email protected] err = (*hci_stack->control->on)(hci_stack->config); 1463f9a30166Smatthias.ringwald } 1464038bc64cSmatthias.ringwald if (err){ 14659da54300S[email protected] log_error( "POWER_ON failed"); 1466038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 1467038bc64cSmatthias.ringwald return err; 1468038bc64cSmatthias.ringwald } 1469038bc64cSmatthias.ringwald 1470038bc64cSmatthias.ringwald // open low-level device 14713a9fb326S[email protected] err = hci_stack->hci_transport->open(hci_stack->config); 1472038bc64cSmatthias.ringwald if (err){ 14739da54300S[email protected] log_error( "HCI_INIT failed, turning Bluetooth off again"); 14743a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 14753a9fb326S[email protected] (*hci_stack->control->off)(hci_stack->config); 1476f9a30166Smatthias.ringwald } 1477038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 1478038bc64cSmatthias.ringwald return err; 1479038bc64cSmatthias.ringwald } 14808d213e1aSmatthias.ringwald return 0; 14818d213e1aSmatthias.ringwald } 1482038bc64cSmatthias.ringwald 148340d1c7a4Smatthias.ringwald static void hci_power_control_off(void){ 14848d213e1aSmatthias.ringwald 14859da54300S[email protected] log_info("hci_power_control_off"); 14869418f9c9Smatthias.ringwald 14878d213e1aSmatthias.ringwald // close low-level device 14883a9fb326S[email protected] hci_stack->hci_transport->close(hci_stack->config); 14898d213e1aSmatthias.ringwald 14909da54300S[email protected] log_info("hci_power_control_off - hci_transport closed"); 14919418f9c9Smatthias.ringwald 14928d213e1aSmatthias.ringwald // power off 14933a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 14943a9fb326S[email protected] (*hci_stack->control->off)(hci_stack->config); 14958d213e1aSmatthias.ringwald } 14969418f9c9Smatthias.ringwald 14979da54300S[email protected] log_info("hci_power_control_off - control closed"); 14989418f9c9Smatthias.ringwald 14993a9fb326S[email protected] hci_stack->state = HCI_STATE_OFF; 150072ea5239Smatthias.ringwald } 150172ea5239Smatthias.ringwald 150240d1c7a4Smatthias.ringwald static void hci_power_control_sleep(void){ 150372ea5239Smatthias.ringwald 15049da54300S[email protected] log_info("hci_power_control_sleep"); 15053144bce4Smatthias.ringwald 1506b429b9b7Smatthias.ringwald #if 0 1507b429b9b7Smatthias.ringwald // don't close serial port during sleep 1508b429b9b7Smatthias.ringwald 150972ea5239Smatthias.ringwald // close low-level device 15103a9fb326S[email protected] hci_stack->hci_transport->close(hci_stack->config); 1511b429b9b7Smatthias.ringwald #endif 151272ea5239Smatthias.ringwald 151372ea5239Smatthias.ringwald // sleep mode 15143a9fb326S[email protected] if (hci_stack->control && hci_stack->control->sleep){ 15153a9fb326S[email protected] (*hci_stack->control->sleep)(hci_stack->config); 151672ea5239Smatthias.ringwald } 1517b429b9b7Smatthias.ringwald 15183a9fb326S[email protected] hci_stack->state = HCI_STATE_SLEEPING; 15198d213e1aSmatthias.ringwald } 15208d213e1aSmatthias.ringwald 152140d1c7a4Smatthias.ringwald static int hci_power_control_wake(void){ 1522b429b9b7Smatthias.ringwald 15239da54300S[email protected] log_info("hci_power_control_wake"); 1524b429b9b7Smatthias.ringwald 1525b429b9b7Smatthias.ringwald // wake on 15263a9fb326S[email protected] if (hci_stack->control && hci_stack->control->wake){ 15273a9fb326S[email protected] (*hci_stack->control->wake)(hci_stack->config); 1528b429b9b7Smatthias.ringwald } 1529b429b9b7Smatthias.ringwald 1530b429b9b7Smatthias.ringwald #if 0 1531b429b9b7Smatthias.ringwald // open low-level device 15323a9fb326S[email protected] int err = hci_stack->hci_transport->open(hci_stack->config); 1533b429b9b7Smatthias.ringwald if (err){ 15349da54300S[email protected] log_error( "HCI_INIT failed, turning Bluetooth off again"); 15353a9fb326S[email protected] if (hci_stack->control && hci_stack->control->off){ 15363a9fb326S[email protected] (*hci_stack->control->off)(hci_stack->config); 1537b429b9b7Smatthias.ringwald } 1538b429b9b7Smatthias.ringwald hci_emit_hci_open_failed(); 1539b429b9b7Smatthias.ringwald return err; 1540b429b9b7Smatthias.ringwald } 1541b429b9b7Smatthias.ringwald #endif 1542b429b9b7Smatthias.ringwald 1543b429b9b7Smatthias.ringwald return 0; 1544b429b9b7Smatthias.ringwald } 1545b429b9b7Smatthias.ringwald 154644935e40S[email protected] static void hci_power_transition_to_initializing(void){ 154744935e40S[email protected] // set up state machine 154844935e40S[email protected] hci_stack->num_cmd_packets = 1; // assume that one cmd can be sent 154944935e40S[email protected] hci_stack->hci_packet_buffer_reserved = 0; 155044935e40S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 155144935e40S[email protected] hci_stack->substate = 0; 155244935e40S[email protected] } 1553b429b9b7Smatthias.ringwald 15548d213e1aSmatthias.ringwald int hci_power_control(HCI_POWER_MODE power_mode){ 1555d661ed19Smatthias.ringwald 15569da54300S[email protected] log_info("hci_power_control: %u, current mode %u", power_mode, hci_stack->state); 1557d661ed19Smatthias.ringwald 15588d213e1aSmatthias.ringwald int err = 0; 15593a9fb326S[email protected] switch (hci_stack->state){ 15608d213e1aSmatthias.ringwald 15618d213e1aSmatthias.ringwald case HCI_STATE_OFF: 15628d213e1aSmatthias.ringwald switch (power_mode){ 15638d213e1aSmatthias.ringwald case HCI_POWER_ON: 15648d213e1aSmatthias.ringwald err = hci_power_control_on(); 156597b61c7bS[email protected] if (err) { 156697b61c7bS[email protected] log_error("hci_power_control_on() error %u", err); 156797b61c7bS[email protected] return err; 156897b61c7bS[email protected] } 156944935e40S[email protected] hci_power_transition_to_initializing(); 15708d213e1aSmatthias.ringwald break; 15718d213e1aSmatthias.ringwald case HCI_POWER_OFF: 15728d213e1aSmatthias.ringwald // do nothing 15738d213e1aSmatthias.ringwald break; 15748d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 1575b546ac54Smatthias.ringwald // do nothing (with SLEEP == OFF) 15768d213e1aSmatthias.ringwald break; 15778d213e1aSmatthias.ringwald } 15788d213e1aSmatthias.ringwald break; 15797301ad89Smatthias.ringwald 15808d213e1aSmatthias.ringwald case HCI_STATE_INITIALIZING: 15818d213e1aSmatthias.ringwald switch (power_mode){ 15828d213e1aSmatthias.ringwald case HCI_POWER_ON: 15838d213e1aSmatthias.ringwald // do nothing 15848d213e1aSmatthias.ringwald break; 15858d213e1aSmatthias.ringwald case HCI_POWER_OFF: 15868d213e1aSmatthias.ringwald // no connections yet, just turn it off 15878d213e1aSmatthias.ringwald hci_power_control_off(); 15888d213e1aSmatthias.ringwald break; 15898d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 1590b546ac54Smatthias.ringwald // no connections yet, just turn it off 159172ea5239Smatthias.ringwald hci_power_control_sleep(); 15928d213e1aSmatthias.ringwald break; 15938d213e1aSmatthias.ringwald } 15948d213e1aSmatthias.ringwald break; 15957301ad89Smatthias.ringwald 15968d213e1aSmatthias.ringwald case HCI_STATE_WORKING: 15978d213e1aSmatthias.ringwald switch (power_mode){ 15988d213e1aSmatthias.ringwald case HCI_POWER_ON: 15998d213e1aSmatthias.ringwald // do nothing 16008d213e1aSmatthias.ringwald break; 16018d213e1aSmatthias.ringwald case HCI_POWER_OFF: 1602c7e0c5f6Smatthias.ringwald // see hci_run 16033a9fb326S[email protected] hci_stack->state = HCI_STATE_HALTING; 16048d213e1aSmatthias.ringwald break; 16058d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 1606b546ac54Smatthias.ringwald // see hci_run 16073a9fb326S[email protected] hci_stack->state = HCI_STATE_FALLING_ASLEEP; 16083a9fb326S[email protected] hci_stack->substate = 0; 16098d213e1aSmatthias.ringwald break; 16108d213e1aSmatthias.ringwald } 16118d213e1aSmatthias.ringwald break; 16127301ad89Smatthias.ringwald 16138d213e1aSmatthias.ringwald case HCI_STATE_HALTING: 16148d213e1aSmatthias.ringwald switch (power_mode){ 16158d213e1aSmatthias.ringwald case HCI_POWER_ON: 161644935e40S[email protected] hci_power_transition_to_initializing(); 16178d213e1aSmatthias.ringwald break; 16188d213e1aSmatthias.ringwald case HCI_POWER_OFF: 16198d213e1aSmatthias.ringwald // do nothing 16208d213e1aSmatthias.ringwald break; 16218d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 1622b546ac54Smatthias.ringwald // see hci_run 16233a9fb326S[email protected] hci_stack->state = HCI_STATE_FALLING_ASLEEP; 16243a9fb326S[email protected] hci_stack->substate = 0; 16258d213e1aSmatthias.ringwald break; 16268d213e1aSmatthias.ringwald } 16278d213e1aSmatthias.ringwald break; 16288d213e1aSmatthias.ringwald 16298d213e1aSmatthias.ringwald case HCI_STATE_FALLING_ASLEEP: 16308d213e1aSmatthias.ringwald switch (power_mode){ 16318d213e1aSmatthias.ringwald case HCI_POWER_ON: 163228171530Smatthias.ringwald 163328171530Smatthias.ringwald #if defined(USE_POWERMANAGEMENT) && defined(USE_BLUETOOL) 163428171530Smatthias.ringwald // nothing to do, if H4 supports power management 163528171530Smatthias.ringwald if (bt_control_iphone_power_management_enabled()){ 16363a9fb326S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 16373a9fb326S[email protected] hci_stack->substate = HCI_INTIALIZING_SUBSTATE_AFTER_SLEEP; 163828171530Smatthias.ringwald break; 163928171530Smatthias.ringwald } 164028171530Smatthias.ringwald #endif 164144935e40S[email protected] hci_power_transition_to_initializing(); 16428d213e1aSmatthias.ringwald break; 16438d213e1aSmatthias.ringwald case HCI_POWER_OFF: 1644b546ac54Smatthias.ringwald // see hci_run 16453a9fb326S[email protected] hci_stack->state = HCI_STATE_HALTING; 16468d213e1aSmatthias.ringwald break; 16478d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 1648b546ac54Smatthias.ringwald // do nothing 16498d213e1aSmatthias.ringwald break; 16508d213e1aSmatthias.ringwald } 16518d213e1aSmatthias.ringwald break; 16528d213e1aSmatthias.ringwald 16538d213e1aSmatthias.ringwald case HCI_STATE_SLEEPING: 16548d213e1aSmatthias.ringwald switch (power_mode){ 16558d213e1aSmatthias.ringwald case HCI_POWER_ON: 165628171530Smatthias.ringwald 165728171530Smatthias.ringwald #if defined(USE_POWERMANAGEMENT) && defined(USE_BLUETOOL) 165828171530Smatthias.ringwald // nothing to do, if H4 supports power management 165928171530Smatthias.ringwald if (bt_control_iphone_power_management_enabled()){ 16603a9fb326S[email protected] hci_stack->state = HCI_STATE_INITIALIZING; 16613a9fb326S[email protected] hci_stack->substate = HCI_INTIALIZING_SUBSTATE_AFTER_SLEEP; 1662758b46ceSmatthias.ringwald hci_update_scan_enable(); 166328171530Smatthias.ringwald break; 166428171530Smatthias.ringwald } 166528171530Smatthias.ringwald #endif 16663144bce4Smatthias.ringwald err = hci_power_control_wake(); 16673144bce4Smatthias.ringwald if (err) return err; 166844935e40S[email protected] hci_power_transition_to_initializing(); 16698d213e1aSmatthias.ringwald break; 16708d213e1aSmatthias.ringwald case HCI_POWER_OFF: 16713a9fb326S[email protected] hci_stack->state = HCI_STATE_HALTING; 16728d213e1aSmatthias.ringwald break; 16738d213e1aSmatthias.ringwald case HCI_POWER_SLEEP: 1674b546ac54Smatthias.ringwald // do nothing 16758d213e1aSmatthias.ringwald break; 16768d213e1aSmatthias.ringwald } 16778d213e1aSmatthias.ringwald break; 167811e23e5fSmatthias.ringwald } 167968d92d03Smatthias.ringwald 1680038bc64cSmatthias.ringwald // create internal event 1681ee8bf225Smatthias.ringwald hci_emit_state(); 1682ee8bf225Smatthias.ringwald 168368d92d03Smatthias.ringwald // trigger next/first action 168468d92d03Smatthias.ringwald hci_run(); 168568d92d03Smatthias.ringwald 1686475c8125Smatthias.ringwald return 0; 1687475c8125Smatthias.ringwald } 1688475c8125Smatthias.ringwald 1689758b46ceSmatthias.ringwald static void hci_update_scan_enable(void){ 1690758b46ceSmatthias.ringwald // 2 = page scan, 1 = inq scan 16913a9fb326S[email protected] hci_stack->new_scan_enable_value = hci_stack->connectable << 1 | hci_stack->discoverable; 1692758b46ceSmatthias.ringwald hci_run(); 1693758b46ceSmatthias.ringwald } 1694758b46ceSmatthias.ringwald 1695381fbed8Smatthias.ringwald void hci_discoverable_control(uint8_t enable){ 1696381fbed8Smatthias.ringwald if (enable) enable = 1; // normalize argument 1697381fbed8Smatthias.ringwald 16983a9fb326S[email protected] if (hci_stack->discoverable == enable){ 16993a9fb326S[email protected] hci_emit_discoverable_enabled(hci_stack->discoverable); 1700381fbed8Smatthias.ringwald return; 1701381fbed8Smatthias.ringwald } 1702381fbed8Smatthias.ringwald 17033a9fb326S[email protected] hci_stack->discoverable = enable; 1704758b46ceSmatthias.ringwald hci_update_scan_enable(); 1705758b46ceSmatthias.ringwald } 1706b031bebbSmatthias.ringwald 1707758b46ceSmatthias.ringwald void hci_connectable_control(uint8_t enable){ 1708758b46ceSmatthias.ringwald if (enable) enable = 1; // normalize argument 1709758b46ceSmatthias.ringwald 1710758b46ceSmatthias.ringwald // don't emit event 17113a9fb326S[email protected] if (hci_stack->connectable == enable) return; 1712758b46ceSmatthias.ringwald 17133a9fb326S[email protected] hci_stack->connectable = enable; 1714758b46ceSmatthias.ringwald hci_update_scan_enable(); 1715381fbed8Smatthias.ringwald } 1716381fbed8Smatthias.ringwald 17175061f3afS[email protected] bd_addr_t * hci_local_bd_addr(void){ 17183a9fb326S[email protected] return &hci_stack->local_bd_addr; 17195061f3afS[email protected] } 17205061f3afS[email protected] 172106b35ec0Smatthias.ringwald void hci_run(){ 17228a485f27Smatthias.ringwald 172332ab9390Smatthias.ringwald hci_connection_t * connection; 172432ab9390Smatthias.ringwald linked_item_t * it; 172532ab9390Smatthias.ringwald 1726d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 1727ce4c8fabSmatthias.ringwald 1728b031bebbSmatthias.ringwald // global/non-connection oriented commands 1729b031bebbSmatthias.ringwald 1730b031bebbSmatthias.ringwald // decline incoming connections 17313a9fb326S[email protected] if (hci_stack->decline_reason){ 17323a9fb326S[email protected] uint8_t reason = hci_stack->decline_reason; 17333a9fb326S[email protected] hci_stack->decline_reason = 0; 17343a9fb326S[email protected] hci_send_cmd(&hci_reject_connection_request, hci_stack->decline_addr, reason); 1735dbe1a790S[email protected] return; 1736ce4c8fabSmatthias.ringwald } 1737ce4c8fabSmatthias.ringwald 1738b031bebbSmatthias.ringwald // send scan enable 17393a9fb326S[email protected] if (hci_stack->state == HCI_STATE_WORKING && hci_stack->new_scan_enable_value != 0xff && hci_classic_supported()){ 17403a9fb326S[email protected] hci_send_cmd(&hci_write_scan_enable, hci_stack->new_scan_enable_value); 17413a9fb326S[email protected] hci_stack->new_scan_enable_value = 0xff; 1742dbe1a790S[email protected] return; 1743b031bebbSmatthias.ringwald } 1744b031bebbSmatthias.ringwald 1745b2f949feS[email protected] #ifdef HAVE_BLE 17467bdc6798S[email protected] // handle le scan 17477bdc6798S[email protected] if (hci_stack->state == HCI_STATE_WORKING){ 17487bdc6798S[email protected] switch(hci_stack->le_scanning_state){ 17497bdc6798S[email protected] case LE_START_SCAN: 17507bdc6798S[email protected] hci_stack->le_scanning_state = LE_SCANNING; 17517bdc6798S[email protected] hci_send_cmd(&hci_le_set_scan_enable, 1, 0); 17527bdc6798S[email protected] return; 17537bdc6798S[email protected] 17547bdc6798S[email protected] case LE_STOP_SCAN: 17557bdc6798S[email protected] hci_stack->le_scanning_state = LE_SCAN_IDLE; 17567bdc6798S[email protected] hci_send_cmd(&hci_le_set_scan_enable, 0, 0); 17577bdc6798S[email protected] return; 17587bdc6798S[email protected] default: 17597bdc6798S[email protected] break; 17607bdc6798S[email protected] } 1761e2602ea2Smatthias.ringwald if (hci_stack->le_scan_type != 0xff){ 1762e2602ea2Smatthias.ringwald // defaults: active scanning, accept all advertisement packets 1763e2602ea2Smatthias.ringwald int scan_type = hci_stack->le_scan_type; 1764e2602ea2Smatthias.ringwald hci_stack->le_scan_type = 0xff; 1765e2602ea2Smatthias.ringwald hci_send_cmd(&hci_le_set_scan_parameters, scan_type, hci_stack->le_scan_interval, hci_stack->le_scan_window, hci_stack->adv_addr_type, 0); 1766e2602ea2Smatthias.ringwald return; 1767e2602ea2Smatthias.ringwald } 17687bdc6798S[email protected] } 1769b2f949feS[email protected] #endif 17707bdc6798S[email protected] 177132ab9390Smatthias.ringwald // send pending HCI commands 17723a9fb326S[email protected] for (it = (linked_item_t *) hci_stack->connections; it ; it = it->next){ 1773b031bebbSmatthias.ringwald connection = (hci_connection_t *) it; 177432ab9390Smatthias.ringwald 17750bf6344aS[email protected] switch(connection->state){ 17760bf6344aS[email protected] case SEND_CREATE_CONNECTION: 17774f3229d8S[email protected] switch(connection->address_type){ 17784f3229d8S[email protected] case BD_ADDR_TYPE_CLASSIC: 17799da54300S[email protected] log_info("sending hci_create_connection"); 1780ad83dc6aS[email protected] hci_send_cmd(&hci_create_connection, connection->address, hci_usable_acl_packet_types(), 0, 0, 0, 1); 17814f3229d8S[email protected] break; 17824f3229d8S[email protected] default: 1783b2f949feS[email protected] #ifdef HAVE_BLE 17849da54300S[email protected] log_info("sending hci_le_create_connection"); 17854f3229d8S[email protected] hci_send_cmd(&hci_le_create_connection, 1786b2571179Smatthias.ringwald 0x0060, // scan interval: 60 ms 1787b2571179Smatthias.ringwald 0x0030, // scan interval: 30 ms 17884f3229d8S[email protected] 0, // don't use whitelist 17894f3229d8S[email protected] connection->address_type, // peer address type 17904f3229d8S[email protected] connection->address, // peer bd addr 1791b2571179Smatthias.ringwald hci_stack->adv_addr_type, // our addr type: 1792b2571179Smatthias.ringwald 0x0008, // conn interval min 1793b2571179Smatthias.ringwald 0x0018, // conn interval max 17944f3229d8S[email protected] 0, // conn latency 1795b2571179Smatthias.ringwald 0x0048, // supervision timeout 1796b2571179Smatthias.ringwald 0x0001, // min ce length 1797b2571179Smatthias.ringwald 0x0001 // max ce length 17984f3229d8S[email protected] ); 17994f3229d8S[email protected] 18004f3229d8S[email protected] connection->state = SENT_CREATE_CONNECTION; 1801b2f949feS[email protected] #endif 18024f3229d8S[email protected] break; 18034f3229d8S[email protected] } 1804ad83dc6aS[email protected] return; 1805ad83dc6aS[email protected] 18060bf6344aS[email protected] case RECEIVED_CONNECTION_REQUEST: 18079da54300S[email protected] log_info("sending hci_accept_connection_request"); 180832ab9390Smatthias.ringwald connection->state = ACCEPTED_CONNECTION_REQUEST; 180934d2123cS[email protected] hci_send_cmd(&hci_accept_connection_request, connection->address, 1); 1810dbe1a790S[email protected] return; 18110bf6344aS[email protected] 1812a6725849S[email protected] #ifdef HAVE_BLE 18130bf6344aS[email protected] case SEND_CANCEL_CONNECTION: 18140bf6344aS[email protected] connection->state = SENT_CANCEL_CONNECTION; 18150bf6344aS[email protected] hci_send_cmd(&hci_le_create_connection_cancel); 18160bf6344aS[email protected] return; 1817a6725849S[email protected] #endif 18180bf6344aS[email protected] case SEND_DISCONNECT: 18190bf6344aS[email protected] connection->state = SENT_DISCONNECT; 18207851196eSmatthias.ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13); // remote closed connection 18210bf6344aS[email protected] return; 18220bf6344aS[email protected] 18230bf6344aS[email protected] default: 18240bf6344aS[email protected] break; 1825c7e0c5f6Smatthias.ringwald } 1826c7e0c5f6Smatthias.ringwald 182732ab9390Smatthias.ringwald if (connection->authentication_flags & HANDLE_LINK_KEY_REQUEST){ 18289da54300S[email protected] log_info("responding to link key request"); 182934d2123cS[email protected] connectionClearAuthenticationFlags(connection, HANDLE_LINK_KEY_REQUEST); 183032ab9390Smatthias.ringwald link_key_t link_key; 1831c77e8838S[email protected] link_key_type_t link_key_type; 18323a9fb326S[email protected] if ( hci_stack->remote_device_db 18333a9fb326S[email protected] && hci_stack->remote_device_db->get_link_key( &connection->address, &link_key, &link_key_type) 183434d2123cS[email protected] && gap_security_level_for_link_key_type(link_key_type) >= connection->requested_security_level){ 18359ab95c90S[email protected] connection->link_key_type = link_key_type; 183632ab9390Smatthias.ringwald hci_send_cmd(&hci_link_key_request_reply, connection->address, &link_key); 183732ab9390Smatthias.ringwald } else { 183832ab9390Smatthias.ringwald hci_send_cmd(&hci_link_key_request_negative_reply, connection->address); 183932ab9390Smatthias.ringwald } 1840dbe1a790S[email protected] return; 184132ab9390Smatthias.ringwald } 18421d6b20aeS[email protected] 1843899283eaS[email protected] if (connection->authentication_flags & DENY_PIN_CODE_REQUEST){ 18449da54300S[email protected] log_info("denying to pin request"); 1845899283eaS[email protected] connectionClearAuthenticationFlags(connection, DENY_PIN_CODE_REQUEST); 184634d2123cS[email protected] hci_send_cmd(&hci_pin_code_request_negative_reply, connection->address); 18474c57c146S[email protected] return; 18484c57c146S[email protected] } 18494c57c146S[email protected] 1850dbe1a790S[email protected] if (connection->authentication_flags & SEND_IO_CAPABILITIES_REPLY){ 185134d2123cS[email protected] connectionClearAuthenticationFlags(connection, SEND_IO_CAPABILITIES_REPLY); 185282d8f825S[email protected] log_info("IO Capability Request received, stack bondable %u, io cap %u", hci_stack->bondable, hci_stack->ssp_io_capability); 185382d8f825S[email protected] if (hci_stack->bondable && (hci_stack->ssp_io_capability != SSP_IO_CAPABILITY_UNKNOWN)){ 1854106d6d11S[email protected] // tweak authentication requirements 18553a9fb326S[email protected] uint8_t authreq = hci_stack->ssp_authentication_requirement; 1856106d6d11S[email protected] if (connection->bonding_flags & BONDING_DEDICATED){ 18579faad3abS[email protected] authreq = SSP_IO_AUTHREQ_MITM_PROTECTION_NOT_REQUIRED_DEDICATED_BONDING; 18589faad3abS[email protected] } 18599faad3abS[email protected] if (gap_mitm_protection_required_for_security_level(connection->requested_security_level)){ 18609faad3abS[email protected] authreq |= 1; 1861106d6d11S[email protected] } 18623a9fb326S[email protected] hci_send_cmd(&hci_io_capability_request_reply, &connection->address, hci_stack->ssp_io_capability, NULL, authreq); 1863f8fb5f6eS[email protected] } else { 1864f8fb5f6eS[email protected] hci_send_cmd(&hci_io_capability_request_negative_reply, &connection->address, ERROR_CODE_PAIRING_NOT_ALLOWED); 1865f8fb5f6eS[email protected] } 1866dbe1a790S[email protected] return; 186732ab9390Smatthias.ringwald } 186832ab9390Smatthias.ringwald 1869dbe1a790S[email protected] if (connection->authentication_flags & SEND_USER_CONFIRM_REPLY){ 1870dbe1a790S[email protected] connectionClearAuthenticationFlags(connection, SEND_USER_CONFIRM_REPLY); 187134d2123cS[email protected] hci_send_cmd(&hci_user_confirmation_request_reply, &connection->address); 1872dbe1a790S[email protected] return; 1873dbe1a790S[email protected] } 1874dbe1a790S[email protected] 1875dbe1a790S[email protected] if (connection->authentication_flags & SEND_USER_PASSKEY_REPLY){ 1876dbe1a790S[email protected] connectionClearAuthenticationFlags(connection, SEND_USER_PASSKEY_REPLY); 187734d2123cS[email protected] hci_send_cmd(&hci_user_passkey_request_reply, &connection->address, 000000); 1878dbe1a790S[email protected] return; 1879dbe1a790S[email protected] } 1880afd4e962S[email protected] 1881afd4e962S[email protected] if (connection->bonding_flags & BONDING_REQUEST_REMOTE_FEATURES){ 1882afd4e962S[email protected] connection->bonding_flags &= ~BONDING_REQUEST_REMOTE_FEATURES; 188334d2123cS[email protected] hci_send_cmd(&hci_read_remote_supported_features_command, connection->con_handle); 18842bd8b7e7S[email protected] return; 18852bd8b7e7S[email protected] } 18862bd8b7e7S[email protected] 18872bd8b7e7S[email protected] if (connection->bonding_flags & BONDING_DISCONNECT_SECURITY_BLOCK){ 18882bd8b7e7S[email protected] connection->bonding_flags &= ~BONDING_DISCONNECT_SECURITY_BLOCK; 188934d2123cS[email protected] hci_send_cmd(&hci_disconnect, connection->con_handle, 0x0005); // authentication failure 189034d2123cS[email protected] return; 189134d2123cS[email protected] } 1892ad83dc6aS[email protected] if (connection->bonding_flags & BONDING_DISCONNECT_DEDICATED_DONE){ 1893ad83dc6aS[email protected] connection->bonding_flags &= ~BONDING_DISCONNECT_DEDICATED_DONE; 18941bd5283dS[email protected] connection->bonding_flags |= BONDING_EMIT_COMPLETE_ON_DISCONNECT; 189552d34f98S[email protected] hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13); // authentication done 1896ad83dc6aS[email protected] return; 1897ad83dc6aS[email protected] } 189834d2123cS[email protected] if (connection->bonding_flags & BONDING_SEND_AUTHENTICATE_REQUEST){ 189934d2123cS[email protected] connection->bonding_flags &= ~BONDING_SEND_AUTHENTICATE_REQUEST; 190034d2123cS[email protected] hci_send_cmd(&hci_authentication_requested, connection->con_handle); 19012bd8b7e7S[email protected] return; 1902afd4e962S[email protected] } 1903dce78009S[email protected] if (connection->bonding_flags & BONDING_SEND_ENCRYPTION_REQUEST){ 1904dce78009S[email protected] connection->bonding_flags &= ~BONDING_SEND_ENCRYPTION_REQUEST; 1905dce78009S[email protected] hci_send_cmd(&hci_set_connection_encryption, connection->con_handle, 1); 1906dce78009S[email protected] return; 1907dce78009S[email protected] } 1908c37a3166S[email protected] #ifdef HAVE_BLE 1909c37a3166S[email protected] if (connection->le_conn_interval_min){ 1910c37a3166S[email protected] uint16_t connection_interval_min = connection->le_conn_interval_min; 1911c37a3166S[email protected] connection->le_conn_interval_min = 0; 1912c37a3166S[email protected] hci_send_cmd(&hci_le_connection_update, connection->con_handle, connection_interval_min, 1913c37a3166S[email protected] connection->le_conn_interval_max, connection->le_conn_latency, connection->le_supervision_timeout, 1914c37a3166S[email protected] 0x0000, 0xffff); 1915c37a3166S[email protected] } 1916c37a3166S[email protected] #endif 1917dbe1a790S[email protected] } 1918c7e0c5f6Smatthias.ringwald 1919*452cf3bbS[email protected] // send continuation fragments 1920*452cf3bbS[email protected] if (hci_stack->acl_fragmentation_total_size > 0) { 1921*452cf3bbS[email protected] hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(hci_stack->hci_packet_buffer); 1922*452cf3bbS[email protected] if (hci_can_send_prepared_acl_packet_now(con_handle)){ 1923*452cf3bbS[email protected] hci_connection_t *connection = hci_connection_for_handle(con_handle); 1924*452cf3bbS[email protected] if (connection) { 1925*452cf3bbS[email protected] hci_send_acl_packet_fragments(connection); 1926*452cf3bbS[email protected] return; 1927*452cf3bbS[email protected] } 1928*452cf3bbS[email protected] // connection gone -> discard further fragments 1929*452cf3bbS[email protected] hci_stack->acl_fragmentation_total_size = 0; 1930*452cf3bbS[email protected] hci_stack->acl_fragmentation_pos = 0; 1931*452cf3bbS[email protected] } 1932*452cf3bbS[email protected] } 1933*452cf3bbS[email protected] 19343a9fb326S[email protected] switch (hci_stack->state){ 19353429f56bSmatthias.ringwald case HCI_STATE_INITIALIZING: 1936bd88fde9S[email protected] hci_initializing_state_machine(); 19373429f56bSmatthias.ringwald break; 1938c7e0c5f6Smatthias.ringwald 1939c7e0c5f6Smatthias.ringwald case HCI_STATE_HALTING: 1940c7e0c5f6Smatthias.ringwald 19419da54300S[email protected] log_info("HCI_STATE_HALTING"); 1942c7e0c5f6Smatthias.ringwald // close all open connections 19433a9fb326S[email protected] connection = (hci_connection_t *) hci_stack->connections; 1944c7e0c5f6Smatthias.ringwald if (connection){ 194532ab9390Smatthias.ringwald 1946c7e0c5f6Smatthias.ringwald // send disconnect 1947d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 194832ab9390Smatthias.ringwald 19499da54300S[email protected] log_info("HCI_STATE_HALTING, connection %p, handle %u", connection, (uint16_t)connection->con_handle); 19506ad890d3Smatthias.ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13); // remote closed connection 1951c7e0c5f6Smatthias.ringwald 1952c7e0c5f6Smatthias.ringwald // send disconnected event right away - causes higher layer connections to get closed, too. 1953c7e0c5f6Smatthias.ringwald hci_shutdown_connection(connection); 1954c7e0c5f6Smatthias.ringwald return; 1955c7e0c5f6Smatthias.ringwald } 19569da54300S[email protected] log_info("HCI_STATE_HALTING, calling off"); 1957c7e0c5f6Smatthias.ringwald 195872ea5239Smatthias.ringwald // switch mode 1959c7e0c5f6Smatthias.ringwald hci_power_control_off(); 19609418f9c9Smatthias.ringwald 19619da54300S[email protected] log_info("HCI_STATE_HALTING, emitting state"); 196272ea5239Smatthias.ringwald hci_emit_state(); 19639da54300S[email protected] log_info("HCI_STATE_HALTING, done"); 196472ea5239Smatthias.ringwald break; 1965c7e0c5f6Smatthias.ringwald 196672ea5239Smatthias.ringwald case HCI_STATE_FALLING_ASLEEP: 19673a9fb326S[email protected] switch(hci_stack->substate) { 196889db417bSmatthias.ringwald case 0: 19699da54300S[email protected] log_info("HCI_STATE_FALLING_ASLEEP"); 197072ea5239Smatthias.ringwald // close all open connections 19713a9fb326S[email protected] connection = (hci_connection_t *) hci_stack->connections; 197266da7044Smatthias.ringwald 197328171530Smatthias.ringwald #if defined(USE_POWERMANAGEMENT) && defined(USE_BLUETOOL) 197466da7044Smatthias.ringwald // don't close connections, if H4 supports power management 197566da7044Smatthias.ringwald if (bt_control_iphone_power_management_enabled()){ 197666da7044Smatthias.ringwald connection = NULL; 197766da7044Smatthias.ringwald } 197866da7044Smatthias.ringwald #endif 197972ea5239Smatthias.ringwald if (connection){ 198032ab9390Smatthias.ringwald 198172ea5239Smatthias.ringwald // send disconnect 1982d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 198332ab9390Smatthias.ringwald 19849da54300S[email protected] log_info("HCI_STATE_FALLING_ASLEEP, connection %p, handle %u", connection, (uint16_t)connection->con_handle); 19856ad890d3Smatthias.ringwald hci_send_cmd(&hci_disconnect, connection->con_handle, 0x13); // remote closed connection 198672ea5239Smatthias.ringwald 198772ea5239Smatthias.ringwald // send disconnected event right away - causes higher layer connections to get closed, too. 198872ea5239Smatthias.ringwald hci_shutdown_connection(connection); 198972ea5239Smatthias.ringwald return; 199072ea5239Smatthias.ringwald } 199172ea5239Smatthias.ringwald 199292368cd3S[email protected] if (hci_classic_supported()){ 199389db417bSmatthias.ringwald // disable page and inquiry scan 1994d94d3cafS[email protected] if (!hci_can_send_command_packet_now()) return; 199532ab9390Smatthias.ringwald 19969da54300S[email protected] log_info("HCI_STATE_HALTING, disabling inq scans"); 19973a9fb326S[email protected] hci_send_cmd(&hci_write_scan_enable, hci_stack->connectable << 1); // drop inquiry scan but keep page scan 199889db417bSmatthias.ringwald 199989db417bSmatthias.ringwald // continue in next sub state 20003a9fb326S[email protected] hci_stack->substate++; 200189db417bSmatthias.ringwald break; 200292368cd3S[email protected] } 200392368cd3S[email protected] // fall through for ble-only chips 200492368cd3S[email protected] 200589db417bSmatthias.ringwald case 2: 20069da54300S[email protected] log_info("HCI_STATE_HALTING, calling sleep"); 200728171530Smatthias.ringwald #if defined(USE_POWERMANAGEMENT) && defined(USE_BLUETOOL) 200828171530Smatthias.ringwald // don't actually go to sleep, if H4 supports power management 200928171530Smatthias.ringwald if (bt_control_iphone_power_management_enabled()){ 201028171530Smatthias.ringwald // SLEEP MODE reached 20113a9fb326S[email protected] hci_stack->state = HCI_STATE_SLEEPING; 201228171530Smatthias.ringwald hci_emit_state(); 201328171530Smatthias.ringwald break; 201428171530Smatthias.ringwald } 201528171530Smatthias.ringwald #endif 201672ea5239Smatthias.ringwald // switch mode 20173a9fb326S[email protected] hci_power_control_sleep(); // changes hci_stack->state to SLEEP 2018c7e0c5f6Smatthias.ringwald hci_emit_state(); 201928171530Smatthias.ringwald break; 202028171530Smatthias.ringwald 202189db417bSmatthias.ringwald default: 202289db417bSmatthias.ringwald break; 202389db417bSmatthias.ringwald } 2024c7e0c5f6Smatthias.ringwald break; 2025c7e0c5f6Smatthias.ringwald 20263429f56bSmatthias.ringwald default: 20273429f56bSmatthias.ringwald break; 20281f504dbdSmatthias.ringwald } 20293429f56bSmatthias.ringwald } 203016833f0aSmatthias.ringwald 203131452debSmatthias.ringwald int hci_send_cmd_packet(uint8_t *packet, int size){ 2032c8e4258aSmatthias.ringwald bd_addr_t addr; 2033c8e4258aSmatthias.ringwald hci_connection_t * conn; 2034c8e4258aSmatthias.ringwald // house-keeping 2035c8e4258aSmatthias.ringwald 2036c8e4258aSmatthias.ringwald // create_connection? 2037c8e4258aSmatthias.ringwald if (IS_COMMAND(packet, hci_create_connection)){ 2038c8e4258aSmatthias.ringwald bt_flip_addr(addr, &packet[3]); 20399da54300S[email protected] log_info("Create_connection to %s", bd_addr_to_str(addr)); 2040c8e4258aSmatthias.ringwald 204196a45072S[email protected] conn = hci_connection_for_bd_addr_and_type(&addr, BD_ADDR_TYPE_CLASSIC); 2042ad83dc6aS[email protected] if (!conn){ 204396a45072S[email protected] conn = create_connection_for_bd_addr_and_type(addr, BD_ADDR_TYPE_CLASSIC); 204417f1ba2aSmatthias.ringwald if (!conn){ 204517f1ba2aSmatthias.ringwald // notify client that alloc failed 204617f1ba2aSmatthias.ringwald hci_emit_connection_complete(conn, BTSTACK_MEMORY_ALLOC_FAILED); 204717f1ba2aSmatthias.ringwald return 0; // don't sent packet to controller 204817f1ba2aSmatthias.ringwald } 2049ad83dc6aS[email protected] conn->state = SEND_CREATE_CONNECTION; 2050ad83dc6aS[email protected] } 2051ad83dc6aS[email protected] log_info("conn state %u", conn->state); 2052ad83dc6aS[email protected] switch (conn->state){ 2053ad83dc6aS[email protected] // if connection active exists 2054ad83dc6aS[email protected] case OPEN: 205562bda3fbS[email protected] // and OPEN, emit connection complete command, don't send to controller 2056ad83dc6aS[email protected] hci_emit_connection_complete(conn, 0); 205762bda3fbS[email protected] return 0; 2058ad83dc6aS[email protected] case SEND_CREATE_CONNECTION: 2059ad83dc6aS[email protected] // connection created by hci, e.g. dedicated bonding 2060ad83dc6aS[email protected] break; 2061ad83dc6aS[email protected] default: 2062ad83dc6aS[email protected] // otherwise, just ignore as it is already in the open process 2063ad83dc6aS[email protected] return 0; 2064ad83dc6aS[email protected] } 2065c8e4258aSmatthias.ringwald conn->state = SENT_CREATE_CONNECTION; 2066c8e4258aSmatthias.ringwald } 2067c8e4258aSmatthias.ringwald 20687fde4af9Smatthias.ringwald if (IS_COMMAND(packet, hci_link_key_request_reply)){ 20697fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_REPLY); 20707fde4af9Smatthias.ringwald } 20717fde4af9Smatthias.ringwald if (IS_COMMAND(packet, hci_link_key_request_negative_reply)){ 20727fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_NEGATIVE_REQUEST); 20737fde4af9Smatthias.ringwald } 20747fde4af9Smatthias.ringwald 20758ef73945Smatthias.ringwald if (IS_COMMAND(packet, hci_delete_stored_link_key)){ 20763a9fb326S[email protected] if (hci_stack->remote_device_db){ 20778ef73945Smatthias.ringwald bt_flip_addr(addr, &packet[3]); 20783a9fb326S[email protected] hci_stack->remote_device_db->delete_link_key(&addr); 20798ef73945Smatthias.ringwald } 20808ef73945Smatthias.ringwald } 2081c8e4258aSmatthias.ringwald 20826724cd9eS[email protected] if (IS_COMMAND(packet, hci_pin_code_request_negative_reply) 20836724cd9eS[email protected] || IS_COMMAND(packet, hci_pin_code_request_reply)){ 20846724cd9eS[email protected] bt_flip_addr(addr, &packet[3]); 208596a45072S[email protected] conn = hci_connection_for_bd_addr_and_type(&addr, BD_ADDR_TYPE_CLASSIC); 20866724cd9eS[email protected] if (conn){ 20876724cd9eS[email protected] connectionClearAuthenticationFlags(conn, LEGACY_PAIRING_ACTIVE); 20886724cd9eS[email protected] } 20896724cd9eS[email protected] } 20906724cd9eS[email protected] 20916724cd9eS[email protected] if (IS_COMMAND(packet, hci_user_confirmation_request_negative_reply) 20926724cd9eS[email protected] || IS_COMMAND(packet, hci_user_confirmation_request_reply) 20936724cd9eS[email protected] || IS_COMMAND(packet, hci_user_passkey_request_negative_reply) 20946724cd9eS[email protected] || IS_COMMAND(packet, hci_user_passkey_request_reply)) { 20956724cd9eS[email protected] bt_flip_addr(addr, &packet[3]); 209696a45072S[email protected] conn = hci_connection_for_bd_addr_and_type(&addr, BD_ADDR_TYPE_CLASSIC); 20976724cd9eS[email protected] if (conn){ 20986724cd9eS[email protected] connectionClearAuthenticationFlags(conn, SSP_PAIRING_ACTIVE); 20996724cd9eS[email protected] } 21006724cd9eS[email protected] } 21016724cd9eS[email protected] 210269a97523S[email protected] #ifdef HAVE_BLE 210369a97523S[email protected] if (IS_COMMAND(packet, hci_le_set_advertising_parameters)){ 21043a9fb326S[email protected] hci_stack->adv_addr_type = packet[8]; 210569a97523S[email protected] } 210669a97523S[email protected] if (IS_COMMAND(packet, hci_le_set_random_address)){ 21073a9fb326S[email protected] bt_flip_addr(hci_stack->adv_address, &packet[3]); 210869a97523S[email protected] } 210969a97523S[email protected] #endif 211069a97523S[email protected] 21113a9fb326S[email protected] hci_stack->num_cmd_packets--; 21126b4af23dS[email protected] int err = hci_stack->hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size); 21136b4af23dS[email protected] 21146b4af23dS[email protected] // free packet buffer for synchronous transport implementations 2115c8b9416aS[email protected] if (hci_transport_synchronous() && (packet == hci_stack->hci_packet_buffer)){ 21166b4af23dS[email protected] hci_stack->hci_packet_buffer_reserved = 0; 21176b4af23dS[email protected] } 21186b4af23dS[email protected] 21196b4af23dS[email protected] return err; 212031452debSmatthias.ringwald } 21218adf0ddaSmatthias.ringwald 21222bd8b7e7S[email protected] // disconnect because of security block 21232bd8b7e7S[email protected] void hci_disconnect_security_block(hci_con_handle_t con_handle){ 21242bd8b7e7S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 21252bd8b7e7S[email protected] if (!connection) return; 21262bd8b7e7S[email protected] connection->bonding_flags |= BONDING_DISCONNECT_SECURITY_BLOCK; 21272bd8b7e7S[email protected] } 21282bd8b7e7S[email protected] 21292bd8b7e7S[email protected] 2130dbe1a790S[email protected] // Configure Secure Simple Pairing 2131dbe1a790S[email protected] 2132dbe1a790S[email protected] // enable will enable SSP during init 2133dbe1a790S[email protected] void hci_ssp_set_enable(int enable){ 21343a9fb326S[email protected] hci_stack->ssp_enable = enable; 2135dbe1a790S[email protected] } 2136dbe1a790S[email protected] 21372bd8b7e7S[email protected] int hci_local_ssp_activated(){ 21383a9fb326S[email protected] return hci_ssp_supported() && hci_stack->ssp_enable; 21392bd8b7e7S[email protected] } 21402bd8b7e7S[email protected] 2141dbe1a790S[email protected] // if set, BTstack will respond to io capability request using authentication requirement 2142dbe1a790S[email protected] void hci_ssp_set_io_capability(int io_capability){ 21433a9fb326S[email protected] hci_stack->ssp_io_capability = io_capability; 2144dbe1a790S[email protected] } 2145dbe1a790S[email protected] void hci_ssp_set_authentication_requirement(int authentication_requirement){ 21463a9fb326S[email protected] hci_stack->ssp_authentication_requirement = authentication_requirement; 2147dbe1a790S[email protected] } 2148dbe1a790S[email protected] 2149dbe1a790S[email protected] // if set, BTstack will confirm a numberic comparion and enter '000000' if requested 2150dbe1a790S[email protected] void hci_ssp_set_auto_accept(int auto_accept){ 21513a9fb326S[email protected] hci_stack->ssp_auto_accept = auto_accept; 2152dbe1a790S[email protected] } 2153dbe1a790S[email protected] 21541cd208adSmatthias.ringwald /** 21551cd208adSmatthias.ringwald * pre: numcmds >= 0 - it's allowed to send a command to the controller 21561cd208adSmatthias.ringwald */ 2157fe35119dSmatthias.ringwald int hci_send_cmd(const hci_cmd_t *cmd, ...){ 21585127cc62S[email protected] 2159d94d3cafS[email protected] if (!hci_can_send_command_packet_now()){ 21609d14b626S[email protected] log_error("hci_send_cmd called but cannot send packet now"); 21619d14b626S[email protected] return 0; 21629d14b626S[email protected] } 21639d14b626S[email protected] 21645127cc62S[email protected] // for HCI INITIALIZATION 21659da54300S[email protected] // log_info("hci_send_cmd: opcode %04x", cmd->opcode); 21665127cc62S[email protected] hci_stack->last_cmd_opcode = cmd->opcode; 21675127cc62S[email protected] 21689d14b626S[email protected] hci_reserve_packet_buffer(); 21699d14b626S[email protected] uint8_t * packet = hci_stack->hci_packet_buffer; 21709d14b626S[email protected] 21711cd208adSmatthias.ringwald va_list argptr; 21721cd208adSmatthias.ringwald va_start(argptr, cmd); 21739d14b626S[email protected] uint16_t size = hci_create_cmd_internal(packet, cmd, argptr); 21741cd208adSmatthias.ringwald va_end(argptr); 21759d14b626S[email protected] 21769d14b626S[email protected] return hci_send_cmd_packet(packet, size); 217793b8dc03Smatthias.ringwald } 2178c8e4258aSmatthias.ringwald 2179ee091cf1Smatthias.ringwald // Create various non-HCI events. 2180ee091cf1Smatthias.ringwald // TODO: generalize, use table similar to hci_create_command 2181ee091cf1Smatthias.ringwald 2182c8e4258aSmatthias.ringwald void hci_emit_state(){ 21833a9fb326S[email protected] log_info("BTSTACK_EVENT_STATE %u", hci_stack->state); 2184425d1371Smatthias.ringwald uint8_t event[3]; 218580d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_STATE; 2186425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 21873a9fb326S[email protected] event[2] = hci_stack->state; 2188425d1371Smatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, sizeof(event)); 21893a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 2190c8e4258aSmatthias.ringwald } 2191c8e4258aSmatthias.ringwald 219217f1ba2aSmatthias.ringwald void hci_emit_connection_complete(hci_connection_t *conn, uint8_t status){ 2193425d1371Smatthias.ringwald uint8_t event[13]; 2194c8e4258aSmatthias.ringwald event[0] = HCI_EVENT_CONNECTION_COMPLETE; 2195425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 219617f1ba2aSmatthias.ringwald event[2] = status; 2197c8e4258aSmatthias.ringwald bt_store_16(event, 3, conn->con_handle); 2198c8e4258aSmatthias.ringwald bt_flip_addr(&event[5], conn->address); 2199c8e4258aSmatthias.ringwald event[11] = 1; // ACL connection 2200c8e4258aSmatthias.ringwald event[12] = 0; // encryption disabled 2201425d1371Smatthias.ringwald hci_dump_packet(HCI_EVENT_PACKET, 0, event, sizeof(event)); 22023a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 2203c8e4258aSmatthias.ringwald } 2204c8e4258aSmatthias.ringwald 22054f3229d8S[email protected] void hci_emit_le_connection_complete(hci_connection_t *conn, uint8_t status){ 22064f3229d8S[email protected] uint8_t event[21]; 22074f3229d8S[email protected] event[0] = HCI_EVENT_LE_META; 22084f3229d8S[email protected] event[1] = sizeof(event) - 2; 22094f3229d8S[email protected] event[2] = HCI_SUBEVENT_LE_CONNECTION_COMPLETE; 22104f3229d8S[email protected] event[3] = status; 22114f3229d8S[email protected] bt_store_16(event, 4, conn->con_handle); 22124f3229d8S[email protected] event[6] = 0; // TODO: role 22134f3229d8S[email protected] event[7] = conn->address_type; 22144f3229d8S[email protected] bt_flip_addr(&event[8], conn->address); 22154f3229d8S[email protected] bt_store_16(event, 14, 0); // interval 22164f3229d8S[email protected] bt_store_16(event, 16, 0); // latency 22174f3229d8S[email protected] bt_store_16(event, 18, 0); // supervision timeout 22184f3229d8S[email protected] event[20] = 0; // master clock accuracy 22194f3229d8S[email protected] hci_dump_packet(HCI_EVENT_PACKET, 0, event, sizeof(event)); 22204f3229d8S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 22214f3229d8S[email protected] } 22224f3229d8S[email protected] 22233c4d4b90Smatthias.ringwald void hci_emit_disconnection_complete(uint16_t handle, uint8_t reason){ 2224425d1371Smatthias.ringwald uint8_t event[6]; 22253c4d4b90Smatthias.ringwald event[0] = HCI_EVENT_DISCONNECTION_COMPLETE; 2226e518c4b8Smatthias.ringwald event[1] = sizeof(event) - 2; 22273c4d4b90Smatthias.ringwald event[2] = 0; // status = OK 22283c4d4b90Smatthias.ringwald bt_store_16(event, 3, handle); 22293c4d4b90Smatthias.ringwald event[5] = reason; 2230425d1371Smatthias.ringwald hci_dump_packet(HCI_EVENT_PACKET, 0, event, sizeof(event)); 22313a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 22323c4d4b90Smatthias.ringwald } 22333c4d4b90Smatthias.ringwald 2234ee091cf1Smatthias.ringwald void hci_emit_l2cap_check_timeout(hci_connection_t *conn){ 223566fb9560S[email protected] if (disable_l2cap_timeouts) return; 2236e0abb8e7S[email protected] log_info("L2CAP_EVENT_TIMEOUT_CHECK"); 2237425d1371Smatthias.ringwald uint8_t event[4]; 223880d52d6bSmatthias.ringwald event[0] = L2CAP_EVENT_TIMEOUT_CHECK; 2239425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 2240ee091cf1Smatthias.ringwald bt_store_16(event, 2, conn->con_handle); 2241425d1371Smatthias.ringwald hci_dump_packet(HCI_EVENT_PACKET, 0, event, sizeof(event)); 22423a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 2243ee091cf1Smatthias.ringwald } 224443bfb1bdSmatthias.ringwald 224543bfb1bdSmatthias.ringwald void hci_emit_nr_connections_changed(){ 2246e0abb8e7S[email protected] log_info("BTSTACK_EVENT_NR_CONNECTIONS_CHANGED %u", nr_hci_connections()); 2247425d1371Smatthias.ringwald uint8_t event[3]; 224880d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED; 2249425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 225043bfb1bdSmatthias.ringwald event[2] = nr_hci_connections(); 2251425d1371Smatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, sizeof(event)); 22523a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 225343bfb1bdSmatthias.ringwald } 2254038bc64cSmatthias.ringwald 2255038bc64cSmatthias.ringwald void hci_emit_hci_open_failed(){ 2256e0abb8e7S[email protected] log_info("BTSTACK_EVENT_POWERON_FAILED"); 2257425d1371Smatthias.ringwald uint8_t event[2]; 225880d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_POWERON_FAILED; 2259425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 2260425d1371Smatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, sizeof(event)); 22613a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 2262038bc64cSmatthias.ringwald } 22631b0e3922Smatthias.ringwald 226409ba8edeSmatthias.ringwald #ifndef EMBEDDED 22651b0e3922Smatthias.ringwald void hci_emit_btstack_version() { 2266e0abb8e7S[email protected] log_info("BTSTACK_EVENT_VERSION %u.%u", BTSTACK_MAJOR, BTSTACK_MINOR); 2267425d1371Smatthias.ringwald uint8_t event[6]; 22681b0e3922Smatthias.ringwald event[0] = BTSTACK_EVENT_VERSION; 2269425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 2270425d1371Smatthias.ringwald event[2] = BTSTACK_MAJOR; 2271425d1371Smatthias.ringwald event[3] = BTSTACK_MINOR; 2272425d1371Smatthias.ringwald bt_store_16(event, 4, BTSTACK_REVISION); 2273425d1371Smatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, sizeof(event)); 22743a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 22751b0e3922Smatthias.ringwald } 227609ba8edeSmatthias.ringwald #endif 22771b0e3922Smatthias.ringwald 22782ed6235cSmatthias.ringwald void hci_emit_system_bluetooth_enabled(uint8_t enabled){ 2279e0abb8e7S[email protected] log_info("BTSTACK_EVENT_SYSTEM_BLUETOOTH_ENABLED %u", enabled); 2280425d1371Smatthias.ringwald uint8_t event[3]; 22812ed6235cSmatthias.ringwald event[0] = BTSTACK_EVENT_SYSTEM_BLUETOOTH_ENABLED; 2282425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 22832ed6235cSmatthias.ringwald event[2] = enabled; 2284425d1371Smatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, sizeof(event)); 22853a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 22862ed6235cSmatthias.ringwald } 2287627c2f45Smatthias.ringwald 2288627c2f45Smatthias.ringwald void hci_emit_remote_name_cached(bd_addr_t *addr, device_name_t *name){ 2289e0abb8e7S[email protected] uint8_t event[2+1+6+248+1]; // +1 for \0 in log_info 2290627c2f45Smatthias.ringwald event[0] = BTSTACK_EVENT_REMOTE_NAME_CACHED; 2291e0abb8e7S[email protected] event[1] = sizeof(event) - 2 - 1; 2292f653b6bdSmatthias.ringwald event[2] = 0; // just to be compatible with HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE 22932f89d309Smatthias.ringwald bt_flip_addr(&event[3], *addr); 2294f653b6bdSmatthias.ringwald memcpy(&event[9], name, 248); 2295e0abb8e7S[email protected] 2296e0abb8e7S[email protected] event[9+248] = 0; // assert \0 for log_info 2297e0abb8e7S[email protected] log_info("BTSTACK_EVENT_REMOTE_NAME_CACHED %s = '%s'", bd_addr_to_str(*addr), &event[9]); 2298e0abb8e7S[email protected] 2299e0abb8e7S[email protected] hci_dump_packet(HCI_EVENT_PACKET, 0, event, sizeof(event)-1); 23003a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)-1); 2301627c2f45Smatthias.ringwald } 2302381fbed8Smatthias.ringwald 2303381fbed8Smatthias.ringwald void hci_emit_discoverable_enabled(uint8_t enabled){ 2304e0abb8e7S[email protected] log_info("BTSTACK_EVENT_DISCOVERABLE_ENABLED %u", enabled); 2305425d1371Smatthias.ringwald uint8_t event[3]; 2306381fbed8Smatthias.ringwald event[0] = BTSTACK_EVENT_DISCOVERABLE_ENABLED; 2307425d1371Smatthias.ringwald event[1] = sizeof(event) - 2; 2308381fbed8Smatthias.ringwald event[2] = enabled; 2309425d1371Smatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, sizeof(event)); 23103a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 2311381fbed8Smatthias.ringwald } 2312458bf4e8S[email protected] 2313a00031e2S[email protected] void hci_emit_security_level(hci_con_handle_t con_handle, gap_security_level_t level){ 2314df3354fcS[email protected] log_info("hci_emit_security_level %u for handle %x", level, con_handle); 2315a00031e2S[email protected] uint8_t event[5]; 2316e00caf9cS[email protected] int pos = 0; 2317a00031e2S[email protected] event[pos++] = GAP_SECURITY_LEVEL; 2318e00caf9cS[email protected] event[pos++] = sizeof(event) - 2; 2319a00031e2S[email protected] bt_store_16(event, 2, con_handle); 2320e00caf9cS[email protected] pos += 2; 2321e00caf9cS[email protected] event[pos++] = level; 2322e00caf9cS[email protected] hci_dump_packet( HCI_EVENT_PACKET, 0, event, sizeof(event)); 23233a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 2324e00caf9cS[email protected] } 2325e00caf9cS[email protected] 23261bd5283dS[email protected] void hci_emit_dedicated_bonding_result(bd_addr_t address, uint8_t status){ 2327ad83dc6aS[email protected] log_info("hci_emit_dedicated_bonding_result %u ", status); 2328ad83dc6aS[email protected] uint8_t event[9]; 2329ad83dc6aS[email protected] int pos = 0; 2330ad83dc6aS[email protected] event[pos++] = GAP_DEDICATED_BONDING_COMPLETED; 2331ad83dc6aS[email protected] event[pos++] = sizeof(event) - 2; 2332ad83dc6aS[email protected] event[pos++] = status; 23331bd5283dS[email protected] bt_flip_addr( * (bd_addr_t *) &event[pos], address); 2334ad83dc6aS[email protected] pos += 6; 2335ad83dc6aS[email protected] hci_dump_packet( HCI_EVENT_PACKET, 0, event, sizeof(event)); 23363a9fb326S[email protected] hci_stack->packet_handler(HCI_EVENT_PACKET, event, sizeof(event)); 2337ad83dc6aS[email protected] } 2338ad83dc6aS[email protected] 23392bd8b7e7S[email protected] // query if remote side supports SSP 23402bd8b7e7S[email protected] int hci_remote_ssp_supported(hci_con_handle_t con_handle){ 23412bd8b7e7S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 23422bd8b7e7S[email protected] if (!connection) return 0; 23432bd8b7e7S[email protected] return (connection->bonding_flags & BONDING_REMOTE_SUPPORTS_SSP) ? 1 : 0; 23442bd8b7e7S[email protected] } 23452bd8b7e7S[email protected] 2346df3354fcS[email protected] int hci_ssp_supported_on_both_sides(hci_con_handle_t handle){ 2347df3354fcS[email protected] return hci_local_ssp_activated() && hci_remote_ssp_supported(handle); 2348df3354fcS[email protected] } 2349df3354fcS[email protected] 2350458bf4e8S[email protected] // GAP API 2351458bf4e8S[email protected] /** 2352458bf4e8S[email protected] * @bbrief enable/disable bonding. default is enabled 2353458bf4e8S[email protected] * @praram enabled 2354458bf4e8S[email protected] */ 23554c57c146S[email protected] void gap_set_bondable_mode(int enable){ 23563a9fb326S[email protected] hci_stack->bondable = enable ? 1 : 0; 2357458bf4e8S[email protected] } 2358cb230b9dS[email protected] 2359cb230b9dS[email protected] /** 236034d2123cS[email protected] * @brief map link keys to security levels 2361cb230b9dS[email protected] */ 236234d2123cS[email protected] gap_security_level_t gap_security_level_for_link_key_type(link_key_type_t link_key_type){ 236334d2123cS[email protected] switch (link_key_type){ 23643c68dfa9S[email protected] case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P256: 23653c68dfa9S[email protected] return LEVEL_4; 23663c68dfa9S[email protected] case COMBINATION_KEY: 23673c68dfa9S[email protected] case AUTHENTICATED_COMBINATION_KEY_GENERATED_FROM_P192: 23683c68dfa9S[email protected] return LEVEL_3; 23693c68dfa9S[email protected] default: 23703c68dfa9S[email protected] return LEVEL_2; 23713c68dfa9S[email protected] } 2372cb230b9dS[email protected] } 2373cb230b9dS[email protected] 2374a00031e2S[email protected] static gap_security_level_t gap_security_level_for_connection(hci_connection_t * connection){ 237534d2123cS[email protected] if (!connection) return LEVEL_0; 237634d2123cS[email protected] if ((connection->authentication_flags & CONNECTION_ENCRYPTED) == 0) return LEVEL_0; 237734d2123cS[email protected] return gap_security_level_for_link_key_type(connection->link_key_type); 237834d2123cS[email protected] } 237934d2123cS[email protected] 238034d2123cS[email protected] 2381106d6d11S[email protected] int gap_mitm_protection_required_for_security_level(gap_security_level_t level){ 23825127cc62S[email protected] log_info("gap_mitm_protection_required_for_security_level %u", level); 2383106d6d11S[email protected] return level > LEVEL_2; 2384106d6d11S[email protected] } 2385106d6d11S[email protected] 238634d2123cS[email protected] /** 238734d2123cS[email protected] * @brief get current security level 238834d2123cS[email protected] */ 238934d2123cS[email protected] gap_security_level_t gap_security_level(hci_con_handle_t con_handle){ 239034d2123cS[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 239134d2123cS[email protected] if (!connection) return LEVEL_0; 239234d2123cS[email protected] return gap_security_level_for_connection(connection); 239334d2123cS[email protected] } 239434d2123cS[email protected] 2395cb230b9dS[email protected] /** 2396cb230b9dS[email protected] * @brief request connection to device to 2397cb230b9dS[email protected] * @result GAP_AUTHENTICATION_RESULT 2398cb230b9dS[email protected] */ 239934d2123cS[email protected] void gap_request_security_level(hci_con_handle_t con_handle, gap_security_level_t requested_level){ 240034d2123cS[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 240134d2123cS[email protected] if (!connection){ 2402a00031e2S[email protected] hci_emit_security_level(con_handle, LEVEL_0); 240334d2123cS[email protected] return; 240434d2123cS[email protected] } 240534d2123cS[email protected] gap_security_level_t current_level = gap_security_level(con_handle); 240634d2123cS[email protected] log_info("gap_request_security_level %u, current level %u", requested_level, current_level); 240734d2123cS[email protected] if (current_level >= requested_level){ 2408a00031e2S[email protected] hci_emit_security_level(con_handle, current_level); 240934d2123cS[email protected] return; 241034d2123cS[email protected] } 2411a00031e2S[email protected] 241234d2123cS[email protected] connection->requested_security_level = requested_level; 2413a00031e2S[email protected] 2414fb8ba0dbS[email protected] // would enabling ecnryption suffice (>= LEVEL_2)? 24153a9fb326S[email protected] if (hci_stack->remote_device_db){ 2416a00031e2S[email protected] link_key_type_t link_key_type; 2417a00031e2S[email protected] link_key_t link_key; 24183a9fb326S[email protected] if (hci_stack->remote_device_db->get_link_key( &connection->address, &link_key, &link_key_type)){ 2419a00031e2S[email protected] if (gap_security_level_for_link_key_type(link_key_type) >= requested_level){ 2420a00031e2S[email protected] connection->bonding_flags |= BONDING_SEND_ENCRYPTION_REQUEST; 2421a00031e2S[email protected] return; 2422a00031e2S[email protected] } 2423a00031e2S[email protected] } 2424a00031e2S[email protected] } 2425a00031e2S[email protected] 24261eb2563eS[email protected] // try to authenticate connection 24271eb2563eS[email protected] connection->bonding_flags |= BONDING_SEND_AUTHENTICATE_REQUEST; 2428e80b2cf9S[email protected] hci_run(); 2429e00caf9cS[email protected] } 2430ad83dc6aS[email protected] 2431ad83dc6aS[email protected] /** 2432ad83dc6aS[email protected] * @brief start dedicated bonding with device. disconnect after bonding 2433ad83dc6aS[email protected] * @param device 2434ad83dc6aS[email protected] * @param request MITM protection 2435ad83dc6aS[email protected] * @result GAP_DEDICATED_BONDING_COMPLETE 2436ad83dc6aS[email protected] */ 2437ad83dc6aS[email protected] int gap_dedicated_bonding(bd_addr_t device, int mitm_protection_required){ 2438ad83dc6aS[email protected] 2439ad83dc6aS[email protected] // create connection state machine 244096a45072S[email protected] hci_connection_t * connection = create_connection_for_bd_addr_and_type(device, BD_ADDR_TYPE_CLASSIC); 2441ad83dc6aS[email protected] 2442ad83dc6aS[email protected] if (!connection){ 2443ad83dc6aS[email protected] return BTSTACK_MEMORY_ALLOC_FAILED; 2444ad83dc6aS[email protected] } 2445ad83dc6aS[email protected] 2446ad83dc6aS[email protected] // delete linkn key 2447ad83dc6aS[email protected] hci_drop_link_key_for_bd_addr( (bd_addr_t *) &device); 2448ad83dc6aS[email protected] 2449ad83dc6aS[email protected] // configure LEVEL_2/3, dedicated bonding 2450ad83dc6aS[email protected] connection->state = SEND_CREATE_CONNECTION; 2451ad83dc6aS[email protected] connection->requested_security_level = mitm_protection_required ? LEVEL_3 : LEVEL_2; 24525127cc62S[email protected] log_info("gap_dedicated_bonding, mitm %u -> level %u", mitm_protection_required, connection->requested_security_level); 2453ad83dc6aS[email protected] connection->bonding_flags = BONDING_DEDICATED; 2454ad83dc6aS[email protected] 2455ad83dc6aS[email protected] // wait for GAP Security Result and send GAP Dedicated Bonding complete 2456ad83dc6aS[email protected] 2457ad83dc6aS[email protected] // handle: connnection failure (connection complete != ok) 2458ad83dc6aS[email protected] // handle: authentication failure 2459ad83dc6aS[email protected] // handle: disconnect on done 2460ad83dc6aS[email protected] 2461ad83dc6aS[email protected] hci_run(); 2462ad83dc6aS[email protected] 2463ad83dc6aS[email protected] return 0; 2464ad83dc6aS[email protected] } 24658e618f72S[email protected] 24668e618f72S[email protected] void gap_set_local_name(const char * local_name){ 24678e618f72S[email protected] hci_stack->local_name = local_name; 24688e618f72S[email protected] } 24698e618f72S[email protected] 24707bdc6798S[email protected] le_command_status_t le_central_start_scan(){ 247136af3e18S[email protected] if (hci_stack->le_scanning_state == LE_SCANNING) return BLE_PERIPHERAL_OK; 24727bdc6798S[email protected] hci_stack->le_scanning_state = LE_START_SCAN; 24737bdc6798S[email protected] hci_run(); 24747bdc6798S[email protected] return BLE_PERIPHERAL_OK; 24757bdc6798S[email protected] } 24768e618f72S[email protected] 24777bdc6798S[email protected] le_command_status_t le_central_stop_scan(){ 247836af3e18S[email protected] if ( hci_stack->le_scanning_state == LE_SCAN_IDLE) return BLE_PERIPHERAL_OK; 24797bdc6798S[email protected] hci_stack->le_scanning_state = LE_STOP_SCAN; 24807bdc6798S[email protected] hci_run(); 24817bdc6798S[email protected] return BLE_PERIPHERAL_OK; 24827bdc6798S[email protected] } 24834f3229d8S[email protected] 2484ef11999fSmatthias.ringwald void le_central_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){ 2485ef11999fSmatthias.ringwald hci_stack->le_scan_type = scan_type; 2486ef11999fSmatthias.ringwald hci_stack->le_scan_interval = scan_interval; 2487ef11999fSmatthias.ringwald hci_stack->le_scan_window = scan_window; 2488ef11999fSmatthias.ringwald hci_run(); 2489ef11999fSmatthias.ringwald } 24904f3229d8S[email protected] 24914f3229d8S[email protected] le_command_status_t le_central_connect(bd_addr_t * addr, bd_addr_type_t addr_type){ 24924f3229d8S[email protected] hci_connection_t * conn = hci_connection_for_bd_addr_and_type(addr, addr_type); 24934f3229d8S[email protected] if (!conn){ 24941f479f8cS[email protected] log_info("le_central_connect: no connection exists yet, creating context"); 24954f3229d8S[email protected] conn = create_connection_for_bd_addr_and_type(*addr, addr_type); 24964f3229d8S[email protected] if (!conn){ 24974f3229d8S[email protected] // notify client that alloc failed 24984f3229d8S[email protected] hci_emit_le_connection_complete(conn, BTSTACK_MEMORY_ALLOC_FAILED); 24991f479f8cS[email protected] log_info("le_central_connect: failed to alloc context"); 25004f3229d8S[email protected] return BLE_PERIPHERAL_NOT_CONNECTED; // don't sent packet to controller 25014f3229d8S[email protected] } 25024f3229d8S[email protected] conn->state = SEND_CREATE_CONNECTION; 25031f479f8cS[email protected] log_info("le_central_connect: send create connection next"); 2504564fca32S[email protected] hci_run(); 25054f3229d8S[email protected] return BLE_PERIPHERAL_OK; 25064f3229d8S[email protected] } 25070bf6344aS[email protected] 25080bf6344aS[email protected] if (!hci_is_le_connection(conn) || 25090bf6344aS[email protected] conn->state == SEND_CREATE_CONNECTION || 25100bf6344aS[email protected] conn->state == SENT_CREATE_CONNECTION) { 25110bf6344aS[email protected] hci_emit_le_connection_complete(conn, ERROR_CODE_COMMAND_DISALLOWED); 25121f479f8cS[email protected] log_error("le_central_connect: classic connection or connect is already being created"); 25130bf6344aS[email protected] return BLE_PERIPHERAL_IN_WRONG_STATE; 25140bf6344aS[email protected] } 25150bf6344aS[email protected] 25161f479f8cS[email protected] log_info("le_central_connect: context exists with state %u", conn->state); 25174f3229d8S[email protected] hci_emit_le_connection_complete(conn, 0); 25184f3229d8S[email protected] hci_run(); 25194f3229d8S[email protected] return BLE_PERIPHERAL_OK; 25204f3229d8S[email protected] } 25214f3229d8S[email protected] 25227851196eSmatthias.ringwald // @assumption: only a single outgoing LE Connection exists 25237851196eSmatthias.ringwald static hci_connection_t * le_central_get_outgoing_connection(){ 25240bf6344aS[email protected] linked_item_t *it; 25250bf6344aS[email protected] for (it = (linked_item_t *) hci_stack->connections; it ; it = it->next){ 25260bf6344aS[email protected] hci_connection_t * conn = (hci_connection_t *) it; 25270bf6344aS[email protected] if (!hci_is_le_connection(conn)) continue; 25280bf6344aS[email protected] switch (conn->state){ 2529a6725849S[email protected] case SEND_CREATE_CONNECTION: 25307851196eSmatthias.ringwald case SENT_CREATE_CONNECTION: 25317851196eSmatthias.ringwald return conn; 25327851196eSmatthias.ringwald default: 25337851196eSmatthias.ringwald break; 25347851196eSmatthias.ringwald }; 25357851196eSmatthias.ringwald } 25367851196eSmatthias.ringwald return NULL; 25377851196eSmatthias.ringwald } 25387851196eSmatthias.ringwald 25397851196eSmatthias.ringwald le_command_status_t le_central_connect_cancel(){ 25407851196eSmatthias.ringwald hci_connection_t * conn = le_central_get_outgoing_connection(); 25417851196eSmatthias.ringwald switch (conn->state){ 25427851196eSmatthias.ringwald case SEND_CREATE_CONNECTION: 25437851196eSmatthias.ringwald // skip sending create connection and emit event instead 25440bf6344aS[email protected] hci_emit_le_connection_complete(conn, ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER); 25457851196eSmatthias.ringwald linked_list_remove(&hci_stack->connections, (linked_item_t *) conn); 25467851196eSmatthias.ringwald btstack_memory_hci_connection_free( conn ); 25470bf6344aS[email protected] break; 2548a6725849S[email protected] case SENT_CREATE_CONNECTION: 25497851196eSmatthias.ringwald // request to send cancel connection 25500bf6344aS[email protected] conn->state = SEND_CANCEL_CONNECTION; 25510bf6344aS[email protected] hci_run(); 25520bf6344aS[email protected] break; 25530bf6344aS[email protected] default: 25540bf6344aS[email protected] break; 25550bf6344aS[email protected] } 2556e31f89a7S[email protected] return BLE_PERIPHERAL_OK; 2557e31f89a7S[email protected] } 25584f3229d8S[email protected] 2559c37a3166S[email protected] /** 2560c37a3166S[email protected] * @brief Updates the connection parameters for a given LE connection 2561c37a3166S[email protected] * @param handle 2562c37a3166S[email protected] * @param conn_interval_min (unit: 1.25ms) 2563c37a3166S[email protected] * @param conn_interval_max (unit: 1.25ms) 2564c37a3166S[email protected] * @param conn_latency 2565c37a3166S[email protected] * @param supervision_timeout (unit: 10ms) 2566c37a3166S[email protected] * @returns 0 if ok 2567c37a3166S[email protected] */ 2568c37a3166S[email protected] int gap_update_connection_parameters(hci_con_handle_t con_handle, uint16_t conn_interval_min, 2569c37a3166S[email protected] uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){ 2570c37a3166S[email protected] hci_connection_t * connection = hci_connection_for_handle(con_handle); 2571c37a3166S[email protected] if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 2572c37a3166S[email protected] connection->le_conn_interval_min = conn_interval_min; 2573c37a3166S[email protected] connection->le_conn_interval_max = conn_interval_max; 2574c37a3166S[email protected] connection->le_conn_latency = conn_latency; 2575c37a3166S[email protected] connection->le_supervision_timeout = supervision_timeout; 2576c37a3166S[email protected] return 0; 2577c37a3166S[email protected] } 2578c37a3166S[email protected] 25795917a5c5S[email protected] le_command_status_t gap_disconnect(hci_con_handle_t handle){ 25805917a5c5S[email protected] hci_connection_t * conn = hci_connection_for_handle(handle); 25815917a5c5S[email protected] if (!conn){ 25827851196eSmatthias.ringwald hci_emit_disconnection_complete(handle, 0); 25835917a5c5S[email protected] return BLE_PERIPHERAL_OK; 25845917a5c5S[email protected] } 25855917a5c5S[email protected] conn->state = SEND_DISCONNECT; 25865917a5c5S[email protected] hci_run(); 25874f3229d8S[email protected] return BLE_PERIPHERAL_OK; 25884f3229d8S[email protected] } 258904a6ef8cSmatthias.ringwald 259004a6ef8cSmatthias.ringwald void hci_disconnect_all(){ 259104a6ef8cSmatthias.ringwald linked_list_iterator_t it; 259204a6ef8cSmatthias.ringwald linked_list_iterator_init(&it, &hci_stack->connections); 259304a6ef8cSmatthias.ringwald while (linked_list_iterator_has_next(&it)){ 259404a6ef8cSmatthias.ringwald hci_connection_t * con = (hci_connection_t*) linked_list_iterator_next(&it); 259504a6ef8cSmatthias.ringwald if (con->state == SENT_DISCONNECT) continue; 259604a6ef8cSmatthias.ringwald con->state = SEND_DISCONNECT; 259704a6ef8cSmatthias.ringwald } 2598d31fba26S[email protected] hci_run(); 259904a6ef8cSmatthias.ringwald } 2600