11f504dbdSmatthias.ringwald /* 21713bceaSmatthias.ringwald * Copyright (C) 2009 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. 161713bceaSmatthias.ringwald * 171713bceaSmatthias.ringwald * THIS SOFTWARE IS PROVIDED BY MATTHIAS RINGWALD AND CONTRIBUTORS 181713bceaSmatthias.ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 191713bceaSmatthias.ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 201713bceaSmatthias.ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 211713bceaSmatthias.ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 221713bceaSmatthias.ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 231713bceaSmatthias.ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 241713bceaSmatthias.ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 251713bceaSmatthias.ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 261713bceaSmatthias.ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 271713bceaSmatthias.ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 281713bceaSmatthias.ringwald * SUCH DAMAGE. 291713bceaSmatthias.ringwald * 301713bceaSmatthias.ringwald */ 311713bceaSmatthias.ringwald 321713bceaSmatthias.ringwald /* 331f504dbdSmatthias.ringwald * hci.c 341f504dbdSmatthias.ringwald * 351f504dbdSmatthias.ringwald * Created by Matthias Ringwald on 4/29/09. 361f504dbdSmatthias.ringwald * 371f504dbdSmatthias.ringwald */ 381f504dbdSmatthias.ringwald 397f2435e6Smatthias.ringwald #include "hci.h" 407f2435e6Smatthias.ringwald 41475c8125Smatthias.ringwald #include <unistd.h> 4293b8dc03Smatthias.ringwald #include <stdarg.h> 4393b8dc03Smatthias.ringwald #include <string.h> 4456fe0872Smatthias.ringwald #include <stdio.h> 457f2435e6Smatthias.ringwald 467f2435e6Smatthias.ringwald #include "debug.h" 47d8905019Smatthias.ringwald #include "hci_dump.h" 4893b8dc03Smatthias.ringwald 492ed6235cSmatthias.ringwald #include "../include/btstack/hci_cmds.h" 502ed6235cSmatthias.ringwald #include "../include/btstack/version.h" 511b0e3922Smatthias.ringwald 521e6aba47Smatthias.ringwald // temp 531e6aba47Smatthias.ringwald #include "l2cap.h" 541e6aba47Smatthias.ringwald 55169f8b28Smatthias.ringwald #define HCI_CONNECTION_TIMEOUT_MS 10000 56ee091cf1Smatthias.ringwald 5706b35ec0Smatthias.ringwald // the STACK is here 5816833f0aSmatthias.ringwald static hci_stack_t hci_stack; 5916833f0aSmatthias.ringwald 6097addcc5Smatthias.ringwald /** 61ee091cf1Smatthias.ringwald * get connection for a given handle 62ee091cf1Smatthias.ringwald * 63ee091cf1Smatthias.ringwald * @return connection OR NULL, if not found 64ee091cf1Smatthias.ringwald */ 65645658c9Smatthias.ringwald hci_connection_t * connection_for_handle(hci_con_handle_t con_handle){ 66ee091cf1Smatthias.ringwald linked_item_t *it; 67ee091cf1Smatthias.ringwald for (it = (linked_item_t *) hci_stack.connections; it ; it = it->next){ 68ee091cf1Smatthias.ringwald if ( ((hci_connection_t *) it)->con_handle == con_handle){ 69ee091cf1Smatthias.ringwald return (hci_connection_t *) it; 70ee091cf1Smatthias.ringwald } 71ee091cf1Smatthias.ringwald } 72ee091cf1Smatthias.ringwald return NULL; 73ee091cf1Smatthias.ringwald } 74ee091cf1Smatthias.ringwald 75981eb02eSmatthias.ringwald static void hci_connection_timeout_handler(timer_source_t *timer){ 76ee091cf1Smatthias.ringwald hci_connection_t * connection = linked_item_get_user(&timer->item); 77ee091cf1Smatthias.ringwald struct timeval tv; 78ee091cf1Smatthias.ringwald gettimeofday(&tv, NULL); 79c21e6239Smatthias.ringwald if (tv.tv_sec >= connection->timestamp.tv_sec + HCI_CONNECTION_TIMEOUT_MS/1000) { 80ee091cf1Smatthias.ringwald // connections might be timed out 81ee091cf1Smatthias.ringwald hci_emit_l2cap_check_timeout(connection); 82c21e6239Smatthias.ringwald run_loop_set_timer(timer, HCI_CONNECTION_TIMEOUT_MS); 83ee091cf1Smatthias.ringwald } else { 84ee091cf1Smatthias.ringwald // next timeout check at 85c21e6239Smatthias.ringwald timer->timeout.tv_sec = connection->timestamp.tv_sec + HCI_CONNECTION_TIMEOUT_MS/1000; 86ee091cf1Smatthias.ringwald } 87ee091cf1Smatthias.ringwald run_loop_add_timer(timer); 88ee091cf1Smatthias.ringwald } 89ee091cf1Smatthias.ringwald 90ee091cf1Smatthias.ringwald static void hci_connection_timestamp(hci_connection_t *connection){ 91ee091cf1Smatthias.ringwald gettimeofday(&connection->timestamp, NULL); 92ee091cf1Smatthias.ringwald } 93ee091cf1Smatthias.ringwald 94ee091cf1Smatthias.ringwald /** 95c8e4258aSmatthias.ringwald * create connection for given address 96c8e4258aSmatthias.ringwald * 97c8e4258aSmatthias.ringwald * @return connection OR NULL, if not found 98c8e4258aSmatthias.ringwald */ 99c8e4258aSmatthias.ringwald static hci_connection_t * create_connection_for_addr(bd_addr_t addr){ 100c8e4258aSmatthias.ringwald hci_connection_t * conn = malloc( sizeof(hci_connection_t) ); 101c8e4258aSmatthias.ringwald if (!conn) return NULL; 102c8e4258aSmatthias.ringwald BD_ADDR_COPY(conn->address, addr); 103c8e4258aSmatthias.ringwald conn->con_handle = 0xffff; 1047fde4af9Smatthias.ringwald conn->authentication_flags = 0; 105ee091cf1Smatthias.ringwald linked_item_set_user(&conn->timeout.item, conn); 106ee091cf1Smatthias.ringwald conn->timeout.process = hci_connection_timeout_handler; 107ee091cf1Smatthias.ringwald hci_connection_timestamp(conn); 108d55db49eSmatthias.ringwald conn->acl_recombination_length = 0; 1097856c818Smatthias.ringwald conn->acl_recombination_pos = 0; 11056cf178bSmatthias.ringwald conn->num_acl_packets_sent = 0; 111c8e4258aSmatthias.ringwald linked_list_add(&hci_stack.connections, (linked_item_t *) conn); 112c8e4258aSmatthias.ringwald return conn; 113c8e4258aSmatthias.ringwald } 114c8e4258aSmatthias.ringwald 115c8e4258aSmatthias.ringwald /** 11606b35ec0Smatthias.ringwald * get connection for given address 11797addcc5Smatthias.ringwald * 11897addcc5Smatthias.ringwald * @return connection OR NULL, if not found 11997addcc5Smatthias.ringwald */ 120fe1ed1b8Smatthias.ringwald static hci_connection_t * connection_for_address(bd_addr_t address){ 12106b35ec0Smatthias.ringwald linked_item_t *it; 12206b35ec0Smatthias.ringwald for (it = (linked_item_t *) hci_stack.connections; it ; it = it->next){ 12306b35ec0Smatthias.ringwald if ( ! BD_ADDR_CMP( ((hci_connection_t *) it)->address, address) ){ 12406b35ec0Smatthias.ringwald return (hci_connection_t *) it; 12506b35ec0Smatthias.ringwald } 12606b35ec0Smatthias.ringwald } 12706b35ec0Smatthias.ringwald return NULL; 12806b35ec0Smatthias.ringwald } 12906b35ec0Smatthias.ringwald 13043bfb1bdSmatthias.ringwald /** 13180ca58a0Smatthias.ringwald * add authentication flags and reset timer 1327fde4af9Smatthias.ringwald */ 1337fde4af9Smatthias.ringwald static void hci_add_connection_flags_for_flipped_bd_addr(uint8_t *bd_addr, hci_authentication_flags_t flags){ 1347fde4af9Smatthias.ringwald bd_addr_t addr; 1357fde4af9Smatthias.ringwald bt_flip_addr(addr, *(bd_addr_t *) bd_addr); 1367fde4af9Smatthias.ringwald hci_connection_t * conn = connection_for_address(addr); 1377fde4af9Smatthias.ringwald if (conn) { 1387fde4af9Smatthias.ringwald conn->authentication_flags |= flags; 13980ca58a0Smatthias.ringwald hci_connection_timestamp(conn); 1407fde4af9Smatthias.ringwald } 1417fde4af9Smatthias.ringwald } 1427fde4af9Smatthias.ringwald 14380ca58a0Smatthias.ringwald int hci_authentication_active_for_handle(hci_con_handle_t handle){ 14480ca58a0Smatthias.ringwald hci_connection_t * conn = connection_for_handle(handle); 14580ca58a0Smatthias.ringwald if (!conn) return 0; 14680ca58a0Smatthias.ringwald if (!conn->authentication_flags) return 0; 14780ca58a0Smatthias.ringwald if (conn->authentication_flags & SENT_LINK_KEY_REPLY) return 0; 14880ca58a0Smatthias.ringwald if (conn->authentication_flags & RECV_LINK_KEY_NOTIFICATION) return 0; 14980ca58a0Smatthias.ringwald return 1; 15080ca58a0Smatthias.ringwald } 15180ca58a0Smatthias.ringwald 152c12e46e7Smatthias.ringwald void hci_drop_link_key_for_bd_addr(bd_addr_t *addr){ 153c12e46e7Smatthias.ringwald if (hci_stack.remote_device_db) { 154c12e46e7Smatthias.ringwald hci_stack.remote_device_db->delete_link_key(addr); 155c12e46e7Smatthias.ringwald } 156c12e46e7Smatthias.ringwald } 157c12e46e7Smatthias.ringwald 1587fde4af9Smatthias.ringwald 1597fde4af9Smatthias.ringwald /** 16043bfb1bdSmatthias.ringwald * count connections 16143bfb1bdSmatthias.ringwald */ 16243bfb1bdSmatthias.ringwald static int nr_hci_connections(){ 16356c253c9Smatthias.ringwald int count = 0; 16443bfb1bdSmatthias.ringwald linked_item_t *it; 16543bfb1bdSmatthias.ringwald for (it = (linked_item_t *) hci_stack.connections; it ; it = it->next, count++); 16643bfb1bdSmatthias.ringwald return count; 16743bfb1bdSmatthias.ringwald } 168c8e4258aSmatthias.ringwald 16997addcc5Smatthias.ringwald /** 170ba681a6cSmatthias.ringwald * Dummy handler called by HCI 17116833f0aSmatthias.ringwald */ 1722718e2e7Smatthias.ringwald static void dummy_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){ 17316833f0aSmatthias.ringwald } 17416833f0aSmatthias.ringwald 175998906cdSmatthias.ringwald uint8_t hci_number_outgoing_packets(hci_con_handle_t handle){ 176998906cdSmatthias.ringwald hci_connection_t * connection = connection_for_handle(handle); 177998906cdSmatthias.ringwald if (!connection) { 178998906cdSmatthias.ringwald log_err("hci_number_outgoing_packets connectino for handle %u does not exist!\n", handle); 179998906cdSmatthias.ringwald return 0; 180998906cdSmatthias.ringwald } 181998906cdSmatthias.ringwald return connection->num_acl_packets_sent; 182998906cdSmatthias.ringwald } 183998906cdSmatthias.ringwald 184998906cdSmatthias.ringwald uint8_t hci_number_free_acl_slots(){ 185998906cdSmatthias.ringwald uint8_t free_slots = hci_stack.total_num_acl_packets; 186998906cdSmatthias.ringwald linked_item_t *it; 187998906cdSmatthias.ringwald for (it = (linked_item_t *) hci_stack.connections; it ; it = it->next){ 188998906cdSmatthias.ringwald hci_connection_t * connection = (hci_connection_t *) it; 189998906cdSmatthias.ringwald if (free_slots < connection->num_acl_packets_sent) { 190998906cdSmatthias.ringwald log_err("hci_number_free_acl_slots: sum of outgoing packets > total acl packets!\n"); 191998906cdSmatthias.ringwald return 0; 192998906cdSmatthias.ringwald } 193998906cdSmatthias.ringwald free_slots -= connection->num_acl_packets_sent; 194998906cdSmatthias.ringwald } 195998906cdSmatthias.ringwald return free_slots; 196998906cdSmatthias.ringwald } 197998906cdSmatthias.ringwald 198998906cdSmatthias.ringwald int hci_ready_to_send(hci_con_handle_t handle){ 199998906cdSmatthias.ringwald return hci_number_free_acl_slots() && hci_number_outgoing_packets(handle) < 2; 200998906cdSmatthias.ringwald } 201c8e4258aSmatthias.ringwald 202ee091cf1Smatthias.ringwald int hci_send_acl_packet(uint8_t *packet, int size){ 2037856c818Smatthias.ringwald 2046218e6f1Smatthias.ringwald // check for free places on BT module 2056218e6f1Smatthias.ringwald if (!hci_number_free_acl_slots()) return -1; 2066218e6f1Smatthias.ringwald 2077856c818Smatthias.ringwald hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 2087856c818Smatthias.ringwald hci_connection_t *connection = connection_for_handle( con_handle); 20956cf178bSmatthias.ringwald if (!connection) return 0; 21056cf178bSmatthias.ringwald hci_connection_timestamp(connection); 21156cf178bSmatthias.ringwald 21256cf178bSmatthias.ringwald // count packet 21356cf178bSmatthias.ringwald connection->num_acl_packets_sent++; 2148ea03fa5Smatthias.ringwald // log_dbg("hci_send_acl_packet - handle %u, sent %u\n", connection->con_handle, connection->num_acl_packets_sent); 2157856c818Smatthias.ringwald 2166218e6f1Smatthias.ringwald // send packet - ignore errors 217622d0de9Smatthias.ringwald hci_stack.hci_transport->send_packet(HCI_ACL_DATA_PACKET, packet, size); 2186218e6f1Smatthias.ringwald 2196218e6f1Smatthias.ringwald return 0; 220ee091cf1Smatthias.ringwald } 221ee091cf1Smatthias.ringwald 22216833f0aSmatthias.ringwald static void acl_handler(uint8_t *packet, int size){ 2237856c818Smatthias.ringwald 2247856c818Smatthias.ringwald // get info 2257856c818Smatthias.ringwald hci_con_handle_t con_handle = READ_ACL_CONNECTION_HANDLE(packet); 2267856c818Smatthias.ringwald hci_connection_t *conn = connection_for_handle(con_handle); 2277856c818Smatthias.ringwald uint8_t acl_flags = READ_ACL_FLAGS(packet); 2287856c818Smatthias.ringwald uint16_t acl_length = READ_ACL_LENGTH(packet); 2297856c818Smatthias.ringwald 2307856c818Smatthias.ringwald // ignore non-registered handle 2317856c818Smatthias.ringwald if (!conn){ 2327f2435e6Smatthias.ringwald log_err( "hci.c: acl_handler called with non-registered handle %u!\n" , con_handle); 2337856c818Smatthias.ringwald return; 2347856c818Smatthias.ringwald } 2357856c818Smatthias.ringwald 2367856c818Smatthias.ringwald // update idle timestamp 2377856c818Smatthias.ringwald hci_connection_timestamp(conn); 2387856c818Smatthias.ringwald 2397856c818Smatthias.ringwald // handle different packet types 2407856c818Smatthias.ringwald switch (acl_flags & 0x03) { 2417856c818Smatthias.ringwald 2427856c818Smatthias.ringwald case 0x01: // continuation fragment 2437856c818Smatthias.ringwald 2447856c818Smatthias.ringwald // sanity check 2457856c818Smatthias.ringwald if (conn->acl_recombination_pos == 0) { 2467f2435e6Smatthias.ringwald log_err( "ACL Cont Fragment but no first fragment for handle 0x%02x\n", con_handle); 2477856c818Smatthias.ringwald return; 2487856c818Smatthias.ringwald } 2497856c818Smatthias.ringwald 2507856c818Smatthias.ringwald // append fragment payload (header already stored) 2517856c818Smatthias.ringwald memcpy(&conn->acl_recombination_buffer[conn->acl_recombination_pos], &packet[4], acl_length ); 2527856c818Smatthias.ringwald conn->acl_recombination_pos += acl_length; 2537856c818Smatthias.ringwald 2547f2435e6Smatthias.ringwald // log_err( "ACL Cont Fragment: acl_len %u, combined_len %u, l2cap_len %u\n", 2557856c818Smatthias.ringwald // acl_length, connection->acl_recombination_pos, connection->acl_recombination_length); 2567856c818Smatthias.ringwald 2577856c818Smatthias.ringwald // forward complete L2CAP packet if complete. 2587856c818Smatthias.ringwald if (conn->acl_recombination_pos >= conn->acl_recombination_length + 4 + 4){ // pos already incl. ACL header 2597856c818Smatthias.ringwald 2602718e2e7Smatthias.ringwald hci_stack.packet_handler(HCI_ACL_DATA_PACKET, conn->acl_recombination_buffer, conn->acl_recombination_pos); 2617856c818Smatthias.ringwald // reset recombination buffer 2627856c818Smatthias.ringwald conn->acl_recombination_length = 0; 2637856c818Smatthias.ringwald conn->acl_recombination_pos = 0; 2647856c818Smatthias.ringwald } 2657856c818Smatthias.ringwald break; 2667856c818Smatthias.ringwald 2677856c818Smatthias.ringwald case 0x02: { // first fragment 2687856c818Smatthias.ringwald 2697856c818Smatthias.ringwald // sanity check 2707856c818Smatthias.ringwald if (conn->acl_recombination_pos) { 2717f2435e6Smatthias.ringwald log_err( "ACL First Fragment but data in buffer for handle 0x%02x\n", con_handle); 2727856c818Smatthias.ringwald return; 2737856c818Smatthias.ringwald } 2747856c818Smatthias.ringwald 2757856c818Smatthias.ringwald // peek into L2CAP packet! 2767856c818Smatthias.ringwald uint16_t l2cap_length = READ_L2CAP_LENGTH( packet ); 2777856c818Smatthias.ringwald 2787856c818Smatthias.ringwald // compare fragment size to L2CAP packet size 2797856c818Smatthias.ringwald if (acl_length >= l2cap_length + 4){ 2807856c818Smatthias.ringwald 2817856c818Smatthias.ringwald // forward fragment as L2CAP packet 2822718e2e7Smatthias.ringwald hci_stack.packet_handler(HCI_ACL_DATA_PACKET, packet, acl_length + 4); 2837856c818Smatthias.ringwald 2847856c818Smatthias.ringwald } else { 2857856c818Smatthias.ringwald // store first fragment and tweak acl length for complete package 2867856c818Smatthias.ringwald memcpy(conn->acl_recombination_buffer, packet, acl_length + 4); 2877856c818Smatthias.ringwald conn->acl_recombination_pos = acl_length + 4; 2887856c818Smatthias.ringwald conn->acl_recombination_length = l2cap_length; 2897856c818Smatthias.ringwald bt_store_16(conn->acl_recombination_buffer, 2, acl_length +4); 2907f2435e6Smatthias.ringwald // log_err( "ACL First Fragment: acl_len %u, l2cap_len %u\n", acl_length, l2cap_length); 2917856c818Smatthias.ringwald } 2927856c818Smatthias.ringwald break; 2937856c818Smatthias.ringwald 2947856c818Smatthias.ringwald } 2957856c818Smatthias.ringwald default: 2967f2435e6Smatthias.ringwald log_err( "hci.c: acl_handler called with invalid packet boundary flags %u\n", acl_flags & 0x03); 2977856c818Smatthias.ringwald return; 2987856c818Smatthias.ringwald } 29994ab26f8Smatthias.ringwald 30094ab26f8Smatthias.ringwald // execute main loop 30194ab26f8Smatthias.ringwald hci_run(); 30216833f0aSmatthias.ringwald } 30322909952Smatthias.ringwald 30416833f0aSmatthias.ringwald static void event_handler(uint8_t *packet, int size){ 3051281a47eSmatthias.ringwald bd_addr_t addr; 306fe1ed1b8Smatthias.ringwald hci_con_handle_t handle; 3071f7b95a1Smatthias.ringwald hci_connection_t * conn; 30856cf178bSmatthias.ringwald int i; 30929d53098Smatthias.ringwald link_key_t link_key; 31022909952Smatthias.ringwald 311e2edc0c3Smatthias.ringwald // get num_cmd_packets 312e2edc0c3Smatthias.ringwald if (packet[0] == HCI_EVENT_COMMAND_COMPLETE || packet[0] == HCI_EVENT_COMMAND_STATUS){ 313e2edc0c3Smatthias.ringwald // Get Num_HCI_Command_Packets 314e2edc0c3Smatthias.ringwald hci_stack.num_cmd_packets = packet[2]; 315e2edc0c3Smatthias.ringwald } 316e2edc0c3Smatthias.ringwald 3176772a24cSmatthias.ringwald switch (packet[0]) { 31822909952Smatthias.ringwald 3196772a24cSmatthias.ringwald case HCI_EVENT_COMMAND_COMPLETE: 320e2edc0c3Smatthias.ringwald if (COMMAND_COMPLETE_EVENT(packet, hci_read_buffer_size)){ 321e2edc0c3Smatthias.ringwald // from offset 5 322e2edc0c3Smatthias.ringwald // status 323e2edc0c3Smatthias.ringwald hci_stack.acl_data_packet_length = READ_BT_16(packet, 6); 32456cf178bSmatthias.ringwald // ignore: SCO data packet len (8) 325e2edc0c3Smatthias.ringwald hci_stack.total_num_acl_packets = packet[9]; 32656cf178bSmatthias.ringwald // ignore: total num SCO packets 32756cf178bSmatthias.ringwald if (hci_stack.state == HCI_STATE_INITIALIZING){ 328e2edc0c3Smatthias.ringwald log_dbg("hci_read_buffer_size: size %u, count %u\n", hci_stack.acl_data_packet_length, hci_stack.total_num_acl_packets); 329e2edc0c3Smatthias.ringwald } 33056cf178bSmatthias.ringwald } 33156cf178bSmatthias.ringwald break; 33256cf178bSmatthias.ringwald 33356cf178bSmatthias.ringwald case HCI_EVENT_NUMBER_OF_COMPLETED_PACKETS: 33456cf178bSmatthias.ringwald for (i=0; i<packet[2];i++){ 33556cf178bSmatthias.ringwald handle = READ_BT_16(packet, 3 + 2*i); 33656cf178bSmatthias.ringwald uint16_t num_packets = READ_BT_16(packet, 3 + packet[2]*2 + 2*i); 33756cf178bSmatthias.ringwald conn = connection_for_handle(handle); 33856cf178bSmatthias.ringwald if (!conn){ 33956cf178bSmatthias.ringwald log_err("hci_number_completed_packet lists unused con handle %u\n", handle); 34056cf178bSmatthias.ringwald continue; 34156cf178bSmatthias.ringwald } 34256cf178bSmatthias.ringwald conn->num_acl_packets_sent -= num_packets; 3438ea03fa5Smatthias.ringwald // log_dbg("hci_number_completed_packet %u processed for handle %u, outstanding %u\n", num_packets, handle, conn->num_acl_packets_sent); 34456cf178bSmatthias.ringwald } 3456772a24cSmatthias.ringwald break; 3466772a24cSmatthias.ringwald 3471f7b95a1Smatthias.ringwald case HCI_EVENT_CONNECTION_REQUEST: 34837eaa4cfSmatthias.ringwald bt_flip_addr(addr, &packet[2]); 34937eaa4cfSmatthias.ringwald // TODO: eval COD 8-10 35037eaa4cfSmatthias.ringwald uint8_t link_type = packet[11]; 351cf0b66f0Smatthias.ringwald log_dbg("Connection_incoming: "); print_bd_addr(addr); log_dbg(", type %u\n", link_type); 35237eaa4cfSmatthias.ringwald if (link_type == 1) { // ACL 3531f7b95a1Smatthias.ringwald conn = connection_for_address(addr); 3541f7b95a1Smatthias.ringwald if (!conn) { 3551f7b95a1Smatthias.ringwald conn = create_connection_for_addr(addr); 3561f7b95a1Smatthias.ringwald } 3571f7b95a1Smatthias.ringwald // TODO: check for malloc failure 3581f7b95a1Smatthias.ringwald conn->state = ACCEPTED_CONNECTION_REQUEST; 35937eaa4cfSmatthias.ringwald hci_send_cmd(&hci_accept_connection_request, addr, 1); 36037eaa4cfSmatthias.ringwald } else { 36137eaa4cfSmatthias.ringwald // TODO: decline request 36237eaa4cfSmatthias.ringwald } 3631f7b95a1Smatthias.ringwald break; 3641f7b95a1Smatthias.ringwald 3656772a24cSmatthias.ringwald case HCI_EVENT_CONNECTION_COMPLETE: 366fe1ed1b8Smatthias.ringwald // Connection management 367fe1ed1b8Smatthias.ringwald bt_flip_addr(addr, &packet[5]); 368cf0b66f0Smatthias.ringwald log_dbg("Connection_complete (status=%u)", packet[2]); print_bd_addr(addr); log_dbg("\n"); 3691f7b95a1Smatthias.ringwald conn = connection_for_address(addr); 370fe1ed1b8Smatthias.ringwald if (conn) { 371b448a0e7Smatthias.ringwald if (!packet[2]){ 372c8e4258aSmatthias.ringwald conn->state = OPEN; 373fe1ed1b8Smatthias.ringwald conn->con_handle = READ_BT_16(packet, 3); 374ee091cf1Smatthias.ringwald 375ee091cf1Smatthias.ringwald gettimeofday(&conn->timestamp, NULL); 376c21e6239Smatthias.ringwald run_loop_set_timer(&conn->timeout, HCI_CONNECTION_TIMEOUT_MS); 377ee091cf1Smatthias.ringwald run_loop_add_timer(&conn->timeout); 378ee091cf1Smatthias.ringwald 379cf0b66f0Smatthias.ringwald log_dbg("New connection: handle %u, ", conn->con_handle); 380fe1ed1b8Smatthias.ringwald print_bd_addr( conn->address ); 381cf0b66f0Smatthias.ringwald log_dbg("\n"); 38243bfb1bdSmatthias.ringwald 38343bfb1bdSmatthias.ringwald hci_emit_nr_connections_changed(); 384b448a0e7Smatthias.ringwald } else { 385c12e46e7Smatthias.ringwald 386b448a0e7Smatthias.ringwald // connection failed, remove entry 387b448a0e7Smatthias.ringwald linked_list_remove(&hci_stack.connections, (linked_item_t *) conn); 388b448a0e7Smatthias.ringwald free( conn ); 389c12e46e7Smatthias.ringwald 390c12e46e7Smatthias.ringwald // if authentication error, also delete link key 391c12e46e7Smatthias.ringwald if (packet[2] == 0x05) { 392c12e46e7Smatthias.ringwald hci_drop_link_key_for_bd_addr(&addr); 393c12e46e7Smatthias.ringwald } 394fe1ed1b8Smatthias.ringwald } 395fe1ed1b8Smatthias.ringwald } 3966772a24cSmatthias.ringwald break; 397fe1ed1b8Smatthias.ringwald 3987fde4af9Smatthias.ringwald case HCI_EVENT_LINK_KEY_REQUEST: 3997fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_LINK_KEY_REQUEST); 40029d53098Smatthias.ringwald if (hci_stack.remote_device_db) { 40129d53098Smatthias.ringwald bt_flip_addr(addr, &packet[2]); 40229d53098Smatthias.ringwald if ( hci_stack.remote_device_db->get_link_key( &addr, &link_key)){ 40329d53098Smatthias.ringwald hci_send_cmd(&hci_link_key_request_reply, &addr, &link_key); 40429d53098Smatthias.ringwald } else { 40529d53098Smatthias.ringwald hci_send_cmd(&hci_link_key_request_negative_reply, &addr); 40629d53098Smatthias.ringwald } 40729d53098Smatthias.ringwald // request already answered 40829d53098Smatthias.ringwald return; 40929d53098Smatthias.ringwald } 4107fde4af9Smatthias.ringwald break; 4117fde4af9Smatthias.ringwald 4127fde4af9Smatthias.ringwald case HCI_EVENT_LINK_KEY_NOTIFICATION: 4137fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_LINK_KEY_NOTIFICATION); 41429d53098Smatthias.ringwald if (hci_stack.remote_device_db) { 41529d53098Smatthias.ringwald bt_flip_addr(addr, &packet[2]); 41629d53098Smatthias.ringwald hci_stack.remote_device_db->put_link_key(&addr, &link_key); 41729d53098Smatthias.ringwald } 41829d53098Smatthias.ringwald // still forward event to allow dismiss of pairing dialog 4197fde4af9Smatthias.ringwald break; 4207fde4af9Smatthias.ringwald 4217fde4af9Smatthias.ringwald case HCI_EVENT_PIN_CODE_REQUEST: 4227fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[2], RECV_PIN_CODE_REQUEST); 4237fde4af9Smatthias.ringwald break; 4247fde4af9Smatthias.ringwald 4256772a24cSmatthias.ringwald case HCI_EVENT_DISCONNECTION_COMPLETE: 426fe1ed1b8Smatthias.ringwald if (!packet[2]){ 427fe1ed1b8Smatthias.ringwald handle = READ_BT_16(packet, 3); 428fe1ed1b8Smatthias.ringwald hci_connection_t * conn = connection_for_handle(handle); 429fe1ed1b8Smatthias.ringwald if (conn) { 430cf0b66f0Smatthias.ringwald log_dbg("Connection closed: handle %u, ", conn->con_handle); 431fe1ed1b8Smatthias.ringwald print_bd_addr( conn->address ); 432cf0b66f0Smatthias.ringwald log_dbg("\n"); 433ee091cf1Smatthias.ringwald run_loop_remove_timer(&conn->timeout); 434fe1ed1b8Smatthias.ringwald linked_list_remove(&hci_stack.connections, (linked_item_t *) conn); 435fe1ed1b8Smatthias.ringwald free( conn ); 43643bfb1bdSmatthias.ringwald hci_emit_nr_connections_changed(); 437fe1ed1b8Smatthias.ringwald } 438fe1ed1b8Smatthias.ringwald } 4396772a24cSmatthias.ringwald break; 4406772a24cSmatthias.ringwald 4416772a24cSmatthias.ringwald default: 4426772a24cSmatthias.ringwald break; 443fe1ed1b8Smatthias.ringwald } 444fe1ed1b8Smatthias.ringwald 4453429f56bSmatthias.ringwald // handle BT initialization 4463429f56bSmatthias.ringwald if (hci_stack.state == HCI_STATE_INITIALIZING){ 4477301ad89Smatthias.ringwald // handle H4 synchronization loss on restart 4487301ad89Smatthias.ringwald // if (hci_stack.substate == 1 && packet[0] == HCI_EVENT_HARDWARE_ERROR){ 4497301ad89Smatthias.ringwald // hci_stack.substate = 0; 4507301ad89Smatthias.ringwald // } 4517301ad89Smatthias.ringwald // handle normal init sequence 4523429f56bSmatthias.ringwald if (hci_stack.substate % 2){ 4533429f56bSmatthias.ringwald // odd: waiting for event 4543429f56bSmatthias.ringwald if (packet[0] == HCI_EVENT_COMMAND_COMPLETE){ 4553429f56bSmatthias.ringwald hci_stack.substate++; 4563429f56bSmatthias.ringwald } 4573429f56bSmatthias.ringwald } 45822909952Smatthias.ringwald } 45922909952Smatthias.ringwald 4602718e2e7Smatthias.ringwald hci_stack.packet_handler(HCI_EVENT_PACKET, packet, size); 46194ab26f8Smatthias.ringwald 46294ab26f8Smatthias.ringwald // execute main loop 46394ab26f8Smatthias.ringwald hci_run(); 46416833f0aSmatthias.ringwald } 46516833f0aSmatthias.ringwald 46610e830c9Smatthias.ringwald void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){ 46710e830c9Smatthias.ringwald switch (packet_type) { 46810e830c9Smatthias.ringwald case HCI_EVENT_PACKET: 46910e830c9Smatthias.ringwald event_handler(packet, size); 47010e830c9Smatthias.ringwald break; 47110e830c9Smatthias.ringwald case HCI_ACL_DATA_PACKET: 47210e830c9Smatthias.ringwald acl_handler(packet, size); 47310e830c9Smatthias.ringwald break; 47410e830c9Smatthias.ringwald default: 47510e830c9Smatthias.ringwald break; 47610e830c9Smatthias.ringwald } 47710e830c9Smatthias.ringwald } 47810e830c9Smatthias.ringwald 479fcadd0caSmatthias.ringwald /** Register HCI packet handlers */ 4802718e2e7Smatthias.ringwald void hci_register_packet_handler(void (*handler)(uint8_t packet_type, uint8_t *packet, uint16_t size)){ 4812718e2e7Smatthias.ringwald hci_stack.packet_handler = handler; 48216833f0aSmatthias.ringwald } 48316833f0aSmatthias.ringwald 484*404843c1Smatthias.ringwald void hci_init(hci_transport_t *transport, void *config, bt_control_t *control, remote_device_db_t * remote_device_db){ 485475c8125Smatthias.ringwald 486475c8125Smatthias.ringwald // reference to use transport layer implementation 48716833f0aSmatthias.ringwald hci_stack.hci_transport = transport; 488475c8125Smatthias.ringwald 48911e23e5fSmatthias.ringwald // references to used control implementation 49011e23e5fSmatthias.ringwald hci_stack.control = control; 49111e23e5fSmatthias.ringwald 49211e23e5fSmatthias.ringwald // reference to used config 49311e23e5fSmatthias.ringwald hci_stack.config = config; 49411e23e5fSmatthias.ringwald 495fe1ed1b8Smatthias.ringwald // no connections yet 496fe1ed1b8Smatthias.ringwald hci_stack.connections = NULL; 497fe1ed1b8Smatthias.ringwald 49802ea9861Smatthias.ringwald // empty cmd buffer 49916833f0aSmatthias.ringwald hci_stack.hci_cmd_buffer = malloc(3+255); 50016833f0aSmatthias.ringwald 50116833f0aSmatthias.ringwald // higher level handler 5022718e2e7Smatthias.ringwald hci_stack.packet_handler = dummy_handler; 50316833f0aSmatthias.ringwald 504*404843c1Smatthias.ringwald // store and open remote device db 505*404843c1Smatthias.ringwald hci_stack.remote_device_db = remote_device_db; 506*404843c1Smatthias.ringwald if (hci_stack.remote_device_db) { 507*404843c1Smatthias.ringwald hci_stack.remote_device_db->open(); 508*404843c1Smatthias.ringwald } 50929d53098Smatthias.ringwald 51016833f0aSmatthias.ringwald // register packet handlers with transport 51110e830c9Smatthias.ringwald transport->register_packet_handler(&packet_handler); 512475c8125Smatthias.ringwald } 513475c8125Smatthias.ringwald 514*404843c1Smatthias.ringwald void hci_close(){ 515*404843c1Smatthias.ringwald // close remote device db 516*404843c1Smatthias.ringwald if (hci_stack.remote_device_db) { 517*404843c1Smatthias.ringwald hci_stack.remote_device_db->close(); 518*404843c1Smatthias.ringwald } 519*404843c1Smatthias.ringwald } 520*404843c1Smatthias.ringwald 521475c8125Smatthias.ringwald int hci_power_control(HCI_POWER_MODE power_mode){ 522f12adbd6Smatthias.ringwald if (power_mode == HCI_POWER_ON && hci_stack.state == HCI_STATE_OFF) { 5237301ad89Smatthias.ringwald 524038bc64cSmatthias.ringwald // power on 525f9a30166Smatthias.ringwald int err = 0; 526f9a30166Smatthias.ringwald if (hci_stack.control && hci_stack.control->on){ 527f9a30166Smatthias.ringwald err = (*hci_stack.control->on)(hci_stack.config); 528f9a30166Smatthias.ringwald } 529038bc64cSmatthias.ringwald if (err){ 5307f2435e6Smatthias.ringwald log_err( "POWER_ON failed\n"); 531038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 532038bc64cSmatthias.ringwald return err; 533038bc64cSmatthias.ringwald } 534038bc64cSmatthias.ringwald 535038bc64cSmatthias.ringwald // open low-level device 536038bc64cSmatthias.ringwald err = hci_stack.hci_transport->open(hci_stack.config); 537038bc64cSmatthias.ringwald if (err){ 5387f2435e6Smatthias.ringwald log_err( "HCI_INIT failed, turning Bluetooth off again\n"); 539f9a30166Smatthias.ringwald if (hci_stack.control && hci_stack.control->off){ 540f9a30166Smatthias.ringwald (*hci_stack.control->off)(hci_stack.config); 541f9a30166Smatthias.ringwald } 542038bc64cSmatthias.ringwald hci_emit_hci_open_failed(); 543038bc64cSmatthias.ringwald return err; 544038bc64cSmatthias.ringwald } 545038bc64cSmatthias.ringwald 5467301ad89Smatthias.ringwald // set up state machine 5477301ad89Smatthias.ringwald hci_stack.num_cmd_packets = 1; // assume that one cmd can be sent 5487301ad89Smatthias.ringwald hci_stack.state = HCI_STATE_INITIALIZING; 5497301ad89Smatthias.ringwald hci_stack.substate = 0; 5507301ad89Smatthias.ringwald 551f12adbd6Smatthias.ringwald } else if (power_mode == HCI_POWER_OFF && hci_stack.state == HCI_STATE_WORKING){ 5527301ad89Smatthias.ringwald 5537301ad89Smatthias.ringwald // close low-level device 5547301ad89Smatthias.ringwald hci_stack.hci_transport->close(hci_stack.config); 5557301ad89Smatthias.ringwald 5567301ad89Smatthias.ringwald // power off 557f9a30166Smatthias.ringwald if (hci_stack.control && hci_stack.control->off){ 558f9a30166Smatthias.ringwald (*hci_stack.control->off)(hci_stack.config); 559f9a30166Smatthias.ringwald } 56043bfb1bdSmatthias.ringwald 56143bfb1bdSmatthias.ringwald // we're off now 56243bfb1bdSmatthias.ringwald hci_stack.state = HCI_STATE_OFF; 56311e23e5fSmatthias.ringwald } 56468d92d03Smatthias.ringwald 565038bc64cSmatthias.ringwald // create internal event 566ee8bf225Smatthias.ringwald hci_emit_state(); 567ee8bf225Smatthias.ringwald 56868d92d03Smatthias.ringwald // trigger next/first action 56968d92d03Smatthias.ringwald hci_run(); 57068d92d03Smatthias.ringwald 571475c8125Smatthias.ringwald return 0; 572475c8125Smatthias.ringwald } 573475c8125Smatthias.ringwald 57406b35ec0Smatthias.ringwald void hci_run(){ 5758a485f27Smatthias.ringwald 5763429f56bSmatthias.ringwald switch (hci_stack.state){ 5773429f56bSmatthias.ringwald case HCI_STATE_INITIALIZING: 5783429f56bSmatthias.ringwald if (hci_stack.substate % 2) { 5793429f56bSmatthias.ringwald // odd: waiting for command completion 58006b35ec0Smatthias.ringwald return; 5813429f56bSmatthias.ringwald } 5823429f56bSmatthias.ringwald if (hci_stack.num_cmd_packets == 0) { 5833429f56bSmatthias.ringwald // cannot send command yet 58406b35ec0Smatthias.ringwald return; 5853429f56bSmatthias.ringwald } 58690919203Smatthias.ringwald switch (hci_stack.substate >> 1){ 5873429f56bSmatthias.ringwald case 0: 58822909952Smatthias.ringwald hci_send_cmd(&hci_reset); 5893429f56bSmatthias.ringwald break; 5903429f56bSmatthias.ringwald case 1: 59190919203Smatthias.ringwald // custom initialization 59290919203Smatthias.ringwald if (hci_stack.control && hci_stack.control->next_command){ 59390919203Smatthias.ringwald uint8_t * cmd = (*hci_stack.control->next_command)(hci_stack.config); 59490919203Smatthias.ringwald if (cmd) { 59590919203Smatthias.ringwald int size = 3 + cmd[2]; 596622d0de9Smatthias.ringwald hci_stack.hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, cmd, size); 5972f6c30e1Smatthias.ringwald hci_stack.substate = 0; // more init commands 59890919203Smatthias.ringwald break; 59990919203Smatthias.ringwald } 60090919203Smatthias.ringwald } 6012f6c30e1Smatthias.ringwald // otherwise continue 602f432a6ddSmatthias.ringwald hci_send_cmd(&hci_read_bd_addr); 603f432a6ddSmatthias.ringwald break; 6042f6c30e1Smatthias.ringwald case 2: 605e2edc0c3Smatthias.ringwald hci_send_cmd(&hci_read_buffer_size); 606e2edc0c3Smatthias.ringwald break; 6072f6c30e1Smatthias.ringwald case 3: 6083429f56bSmatthias.ringwald // ca. 15 sec 6093429f56bSmatthias.ringwald hci_send_cmd(&hci_write_page_timeout, 0x6000); 6103429f56bSmatthias.ringwald break; 6112f6c30e1Smatthias.ringwald case 4: 612bd67ef2fSmatthias.ringwald hci_send_cmd(&hci_write_scan_enable, 3); // 3 inq scan + page scan 613f432a6ddSmatthias.ringwald break; 6142f6c30e1Smatthias.ringwald case 5: 6158a485f27Smatthias.ringwald #ifndef EMBEDDED 6168a485f27Smatthias.ringwald { 6178a485f27Smatthias.ringwald char hostname[30]; 6188a485f27Smatthias.ringwald gethostname(hostname, 30); 6198a485f27Smatthias.ringwald hostname[29] = '\0'; 6208a485f27Smatthias.ringwald hci_send_cmd(&hci_write_local_name, hostname); 6218a485f27Smatthias.ringwald break; 6228a485f27Smatthias.ringwald } 6238a485f27Smatthias.ringwald case 6: 6248a485f27Smatthias.ringwald #endif 6253429f56bSmatthias.ringwald // done. 6263429f56bSmatthias.ringwald hci_stack.state = HCI_STATE_WORKING; 627b360b6adSmatthias.ringwald hci_emit_state(); 6283429f56bSmatthias.ringwald break; 6293429f56bSmatthias.ringwald default: 6303429f56bSmatthias.ringwald break; 631475c8125Smatthias.ringwald } 6323429f56bSmatthias.ringwald hci_stack.substate++; 6333429f56bSmatthias.ringwald break; 6343429f56bSmatthias.ringwald default: 6353429f56bSmatthias.ringwald break; 6361f504dbdSmatthias.ringwald } 6373429f56bSmatthias.ringwald } 63816833f0aSmatthias.ringwald 63931452debSmatthias.ringwald int hci_send_cmd_packet(uint8_t *packet, int size){ 640c8e4258aSmatthias.ringwald bd_addr_t addr; 641c8e4258aSmatthias.ringwald hci_connection_t * conn; 642c8e4258aSmatthias.ringwald // house-keeping 643c8e4258aSmatthias.ringwald 644c8e4258aSmatthias.ringwald // create_connection? 645c8e4258aSmatthias.ringwald if (IS_COMMAND(packet, hci_create_connection)){ 646c8e4258aSmatthias.ringwald bt_flip_addr(addr, &packet[3]); 647cf0b66f0Smatthias.ringwald log_dbg("Create_connection to "); print_bd_addr(addr); log_dbg("\n"); 648c8e4258aSmatthias.ringwald conn = connection_for_address(addr); 649c8e4258aSmatthias.ringwald if (conn) { 650c8e4258aSmatthias.ringwald // if connection exists 651c8e4258aSmatthias.ringwald if (conn->state == OPEN) { 652c8e4258aSmatthias.ringwald // if OPEN, emit connection complete command 653c8e4258aSmatthias.ringwald hci_emit_connection_complete(conn); 654c8e4258aSmatthias.ringwald } 655c8e4258aSmatthias.ringwald // otherwise, just ignore 656c8e4258aSmatthias.ringwald return 0; // don't sent packet to controller 657c8e4258aSmatthias.ringwald 658c8e4258aSmatthias.ringwald } else{ 659c8e4258aSmatthias.ringwald conn = create_connection_for_addr(addr); 660c8e4258aSmatthias.ringwald if (conn){ 661c8e4258aSmatthias.ringwald // create connection struct and register, state = SENT_CREATE_CONNECTION 662c8e4258aSmatthias.ringwald conn->state = SENT_CREATE_CONNECTION; 663c8e4258aSmatthias.ringwald } 664c8e4258aSmatthias.ringwald } 665c8e4258aSmatthias.ringwald } 666c8e4258aSmatthias.ringwald 6677fde4af9Smatthias.ringwald if (IS_COMMAND(packet, hci_link_key_request_reply)){ 6687fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_REPLY); 6697fde4af9Smatthias.ringwald } 6707fde4af9Smatthias.ringwald if (IS_COMMAND(packet, hci_link_key_request_negative_reply)){ 6717fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_LINK_KEY_NEGATIVE_REQUEST); 6727fde4af9Smatthias.ringwald } 6737fde4af9Smatthias.ringwald if (IS_COMMAND(packet, hci_pin_code_request_reply)){ 6747fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_PIN_CODE_REPLY); 6757fde4af9Smatthias.ringwald } 6767fde4af9Smatthias.ringwald if (IS_COMMAND(packet, hci_pin_code_request_negative_reply)){ 6777fde4af9Smatthias.ringwald hci_add_connection_flags_for_flipped_bd_addr(&packet[3], SENT_PIN_CODE_NEGATIVE_REPLY); 6787fde4af9Smatthias.ringwald } 6797fde4af9Smatthias.ringwald 680c8e4258aSmatthias.ringwald // accept connection 681c8e4258aSmatthias.ringwald 682c8e4258aSmatthias.ringwald // reject connection 683c8e4258aSmatthias.ringwald 684c8e4258aSmatthias.ringwald // close_connection? 685c8e4258aSmatthias.ringwald // set state = SENT_DISCONNECT 686c8e4258aSmatthias.ringwald 68731452debSmatthias.ringwald hci_stack.num_cmd_packets--; 688622d0de9Smatthias.ringwald return hci_stack.hci_transport->send_packet(HCI_COMMAND_DATA_PACKET, packet, size); 68931452debSmatthias.ringwald } 6908adf0ddaSmatthias.ringwald 6911cd208adSmatthias.ringwald /** 6921cd208adSmatthias.ringwald * pre: numcmds >= 0 - it's allowed to send a command to the controller 6931cd208adSmatthias.ringwald */ 694fe35119dSmatthias.ringwald int hci_send_cmd(const hci_cmd_t *cmd, ...){ 6951cd208adSmatthias.ringwald va_list argptr; 6961cd208adSmatthias.ringwald va_start(argptr, cmd); 6971cd208adSmatthias.ringwald uint8_t * hci_cmd_buffer = hci_stack.hci_cmd_buffer; 6981cd208adSmatthias.ringwald uint16_t size = hci_create_cmd_internal(hci_stack.hci_cmd_buffer, cmd, argptr); 6991cd208adSmatthias.ringwald va_end(argptr); 7001cd208adSmatthias.ringwald return hci_send_cmd_packet(hci_cmd_buffer, size); 70193b8dc03Smatthias.ringwald } 702c8e4258aSmatthias.ringwald 703ee091cf1Smatthias.ringwald // Create various non-HCI events. 704ee091cf1Smatthias.ringwald // TODO: generalize, use table similar to hci_create_command 705ee091cf1Smatthias.ringwald 706c8e4258aSmatthias.ringwald void hci_emit_state(){ 707c8e4258aSmatthias.ringwald uint8_t len = 3; 708c8e4258aSmatthias.ringwald uint8_t event[len]; 70980d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_STATE; 7101b0e3922Smatthias.ringwald event[1] = len - 3; 711c8e4258aSmatthias.ringwald event[2] = hci_stack.state; 712c8e4258aSmatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, len); 7132718e2e7Smatthias.ringwald hci_stack.packet_handler(HCI_EVENT_PACKET, event, len); 714c8e4258aSmatthias.ringwald } 715c8e4258aSmatthias.ringwald 716c8e4258aSmatthias.ringwald void hci_emit_connection_complete(hci_connection_t *conn){ 717c8e4258aSmatthias.ringwald uint8_t len = 13; 718c8e4258aSmatthias.ringwald uint8_t event[len]; 719c8e4258aSmatthias.ringwald event[0] = HCI_EVENT_CONNECTION_COMPLETE; 7201b0e3922Smatthias.ringwald event[1] = len - 3; 721c8e4258aSmatthias.ringwald event[2] = 0; // status = OK 722c8e4258aSmatthias.ringwald bt_store_16(event, 3, conn->con_handle); 723c8e4258aSmatthias.ringwald bt_flip_addr(&event[5], conn->address); 724c8e4258aSmatthias.ringwald event[11] = 1; // ACL connection 725c8e4258aSmatthias.ringwald event[12] = 0; // encryption disabled 726c8e4258aSmatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, len); 7272718e2e7Smatthias.ringwald hci_stack.packet_handler(HCI_EVENT_PACKET, event, len); 728c8e4258aSmatthias.ringwald } 729c8e4258aSmatthias.ringwald 730ee091cf1Smatthias.ringwald void hci_emit_l2cap_check_timeout(hci_connection_t *conn){ 731ee091cf1Smatthias.ringwald uint8_t len = 4; 732ee091cf1Smatthias.ringwald uint8_t event[len]; 73380d52d6bSmatthias.ringwald event[0] = L2CAP_EVENT_TIMEOUT_CHECK; 7341b0e3922Smatthias.ringwald event[1] = len - 2; 735ee091cf1Smatthias.ringwald bt_store_16(event, 2, conn->con_handle); 736ee091cf1Smatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, len); 7372718e2e7Smatthias.ringwald hci_stack.packet_handler(HCI_EVENT_PACKET, event, len); 738ee091cf1Smatthias.ringwald } 73943bfb1bdSmatthias.ringwald 74043bfb1bdSmatthias.ringwald void hci_emit_nr_connections_changed(){ 74143bfb1bdSmatthias.ringwald uint8_t len = 3; 74243bfb1bdSmatthias.ringwald uint8_t event[len]; 74380d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_NR_CONNECTIONS_CHANGED; 7441b0e3922Smatthias.ringwald event[1] = len - 2; 74543bfb1bdSmatthias.ringwald event[2] = nr_hci_connections(); 74643bfb1bdSmatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, len); 7472718e2e7Smatthias.ringwald hci_stack.packet_handler(HCI_EVENT_PACKET, event, len); 74843bfb1bdSmatthias.ringwald } 749038bc64cSmatthias.ringwald 750038bc64cSmatthias.ringwald void hci_emit_hci_open_failed(){ 7511b0e3922Smatthias.ringwald uint8_t len = 2; 752038bc64cSmatthias.ringwald uint8_t event[len]; 75380d52d6bSmatthias.ringwald event[0] = BTSTACK_EVENT_POWERON_FAILED; 7541b0e3922Smatthias.ringwald event[1] = len - 2; 755038bc64cSmatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, len); 7562718e2e7Smatthias.ringwald hci_stack.packet_handler(HCI_EVENT_PACKET, event, len); 757038bc64cSmatthias.ringwald } 7581b0e3922Smatthias.ringwald 7591b0e3922Smatthias.ringwald 7601b0e3922Smatthias.ringwald void hci_emit_btstack_version() { 7611b0e3922Smatthias.ringwald uint8_t len = 6; 7621b0e3922Smatthias.ringwald uint8_t event[len]; 7631b0e3922Smatthias.ringwald event[0] = BTSTACK_EVENT_VERSION; 7641b0e3922Smatthias.ringwald event[1] = len - 2; 7651b0e3922Smatthias.ringwald event[len++] = BTSTACK_MAJOR; 7661b0e3922Smatthias.ringwald event[len++] = BTSTACK_MINOR; 7671b0e3922Smatthias.ringwald bt_store_16(event, len, BTSTACK_REVISION); 7681b0e3922Smatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, len); 7692718e2e7Smatthias.ringwald hci_stack.packet_handler(HCI_EVENT_PACKET, event, len); 7701b0e3922Smatthias.ringwald } 7711b0e3922Smatthias.ringwald 7722ed6235cSmatthias.ringwald void hci_emit_system_bluetooth_enabled(uint8_t enabled){ 7732ed6235cSmatthias.ringwald uint8_t len = 3; 7742ed6235cSmatthias.ringwald uint8_t event[len]; 7752ed6235cSmatthias.ringwald event[0] = BTSTACK_EVENT_SYSTEM_BLUETOOTH_ENABLED; 776ddce1d8dSmatthias.ringwald event[1] = len - 2; 7772ed6235cSmatthias.ringwald event[2] = enabled; 7782ed6235cSmatthias.ringwald hci_dump_packet( HCI_EVENT_PACKET, 0, event, len); 7792718e2e7Smatthias.ringwald hci_stack.packet_handler(HCI_EVENT_PACKET, event, len); 7802ed6235cSmatthias.ringwald } 781