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