xref: /btstack/src/hci.c (revision 404843c191373c94cf4d4feed87debe5393ba25c)
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