1 #include <stdint.h> 2 #include <stdio.h> 3 #include <string.h> 4 5 #include "hci.h" 6 #include "hci_dump.h" 7 #include "l2cap.h" 8 9 #include "ble/att_db.h" 10 #include "ble/sm.h" 11 #include "gap.h" 12 #include "btstack_debug.h" 13 14 #define PREBUFFER_SIZE (HCI_INCOMING_PRE_BUFFER_SIZE + 8) 15 #define TEST_MAX_MTU 23 16 17 static btstack_packet_handler_t att_packet_handler; 18 static void (*registered_hci_event_handler) (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) = NULL; 19 20 static btstack_linked_list_t connections; 21 static uint8_t l2cap_stack_buffer[PREBUFFER_SIZE + TEST_MAX_MTU]; // pre buffer + HCI Header + L2CAP header 22 static uint16_t gatt_client_handle = 0x40; 23 static hci_connection_t hci_connection; 24 25 static uint8_t packet_buffer[256]; 26 static uint16_t packet_buffer_len; 27 28 uint16_t get_gatt_client_handle(void){ 29 return gatt_client_handle; 30 } 31 32 void mock_simulate_command_complete(const hci_cmd_t *cmd){ 33 uint8_t packet[] = {HCI_EVENT_COMMAND_COMPLETE, 4, 1, (uint8_t) (cmd->opcode & 0xff), (uint8_t) (cmd->opcode >> 8), 0}; 34 registered_hci_event_handler(HCI_EVENT_PACKET, 0, (uint8_t *)&packet, sizeof(packet)); 35 } 36 37 void mock_simulate_hci_state_working(void){ 38 uint8_t packet[3] = {BTSTACK_EVENT_STATE, 0, HCI_STATE_WORKING}; 39 registered_hci_event_handler(HCI_EVENT_PACKET, 0, (uint8_t *)&packet, 3); 40 } 41 42 static void hci_create_gap_connection_complete_event(const uint8_t * hci_event, uint8_t * gap_event) { 43 gap_event[0] = HCI_EVENT_META_GAP; 44 gap_event[1] = 36 - 2; 45 gap_event[2] = GAP_SUBEVENT_LE_CONNECTION_COMPLETE; 46 switch (hci_event[2]){ 47 case HCI_SUBEVENT_LE_CONNECTION_COMPLETE: 48 memcpy(&gap_event[3], &hci_event[3], 11); 49 memset(&gap_event[14], 0, 12); 50 memcpy(&gap_event[26], &hci_event[14], 7); 51 memset(&gap_event[33], 0xff, 3); 52 break; 53 case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V1: 54 memcpy(&gap_event[3], &hci_event[3], 30); 55 memset(&gap_event[33], 0xff, 3); 56 break; 57 case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE_V2: 58 memcpy(&gap_event[3], &hci_event[3], 33); 59 break; 60 default: 61 btstack_unreachable(); 62 break; 63 } 64 } 65 66 void mock_simulate_connected(void){ 67 uint8_t packet[] = {HCI_EVENT_LE_META, 0x13, 0x01, 0x00, 0x40, 0x00, 0x00, 0x00, 0x9B, 0x77, 0xD1, 0xF7, 0xB1, 0x34, 0x50, 0x00, 0x00, 0x00, 0xD0, 0x07, 0x05}; 68 uint8_t gap_event[36]; 69 hci_create_gap_connection_complete_event(packet, gap_event); 70 registered_hci_event_handler(HCI_EVENT_PACKET, 0, gap_event, sizeof(gap_event)); 71 } 72 73 void mock_simulate_scan_response(void){ 74 uint8_t packet[] = {GAP_EVENT_ADVERTISING_REPORT, 0x13, 0xE2, 0x01, 0x34, 0xB1, 0xF7, 0xD1, 0x77, 0x9B, 0xCC, 0x09, 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08}; 75 registered_hci_event_handler(HCI_EVENT_PACKET, 0, (uint8_t *)&packet, sizeof(packet)); 76 } 77 78 bool gap_authenticated(hci_con_handle_t con_handle){ 79 UNUSED(con_handle); 80 return false; 81 } 82 uint8_t gap_encryption_key_size(hci_con_handle_t con_handle){ 83 UNUSED(con_handle); 84 return 0; 85 } 86 bool gap_bonded(hci_con_handle_t con_handle){ 87 UNUSED(con_handle); 88 return true; 89 } 90 void sm_request_pairing(hci_con_handle_t con_handle){ 91 UNUSED(con_handle); 92 } 93 void gap_start_scan(void){ 94 } 95 void gap_stop_scan(void){ 96 } 97 uint8_t gap_connect(const bd_addr_t addr, bd_addr_type_t addr_type){ 98 return 0; 99 } 100 void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){ 101 } 102 103 bool gap_reconnect_security_setup_active(hci_con_handle_t con_handle){ 104 UNUSED(con_handle); 105 return false; 106 } 107 108 static void att_init_connection(att_connection_t * att_connection){ 109 att_connection->mtu = TEST_MAX_MTU; 110 att_connection->max_mtu = TEST_MAX_MTU; 111 att_connection->encryption_key_size = 0; 112 att_connection->authenticated = 0; 113 att_connection->authorized = 0; 114 } 115 116 HCI_STATE hci_get_state(void){ 117 return HCI_STATE_WORKING; 118 } 119 120 uint8_t hci_send_cmd(const hci_cmd_t *cmd, ...){ 121 122 btstack_assert(false); 123 124 va_list argptr; 125 va_start(argptr, cmd); 126 uint16_t len = hci_cmd_create_from_template(packet_buffer, cmd, argptr); 127 va_end(argptr); 128 hci_dump_packet(HCI_COMMAND_DATA_PACKET, 0, packet_buffer, len); 129 // dump_packet(HCI_COMMAND_DATA_PACKET, packet_buffer, len); 130 packet_buffer_len = len; 131 return ERROR_CODE_SUCCESS; 132 } 133 134 bool hci_can_send_command_packet_now(void){ 135 return true; 136 } 137 138 bool hci_can_send_acl_le_packet_now(void){ 139 return true; 140 } 141 142 bool l2cap_can_send_connectionless_packet_now(void){ 143 return true; 144 } 145 146 uint8_t *l2cap_get_outgoing_buffer(void){ 147 return (uint8_t *)&l2cap_stack_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + 8]; 148 } 149 150 uint16_t l2cap_max_mtu(void){ 151 return TEST_MAX_MTU; 152 } 153 154 uint16_t l2cap_max_le_mtu(void){ 155 return TEST_MAX_MTU; 156 } 157 158 void l2cap_init(void){} 159 160 void l2cap_register_fixed_channel(btstack_packet_handler_t packet_handler, uint16_t channel_id) { 161 att_packet_handler = packet_handler; 162 } 163 164 void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){ 165 registered_hci_event_handler = callback_handler->callback; 166 } 167 168 bool l2cap_reserve_packet_buffer(void){ 169 return true; 170 } 171 172 bool l2cap_can_send_fixed_channel_packet_now(uint16_t handle, uint16_t channel_id){ 173 return true; 174 } 175 176 void l2cap_request_can_send_fix_channel_now_event(uint16_t handle, uint16_t channel_id){ 177 uint8_t event[] = { L2CAP_EVENT_CAN_SEND_NOW, 2, 1, 0}; 178 att_packet_handler(HCI_EVENT_PACKET, 0, (uint8_t*)event, sizeof(event)); 179 } 180 181 uint8_t l2cap_send_prepared_connectionless(uint16_t handle, uint16_t cid, uint16_t len){ 182 att_connection_t att_connection; 183 att_init_connection(&att_connection); 184 uint8_t response_buffer[PREBUFFER_SIZE + TEST_MAX_MTU]; 185 uint8_t * response = &response_buffer[PREBUFFER_SIZE]; 186 uint16_t response_len = att_handle_request(&att_connection, l2cap_get_outgoing_buffer(), len, response); 187 if (response_len){ 188 att_packet_handler(ATT_DATA_PACKET, gatt_client_handle, &response[0], response_len); 189 } 190 return ERROR_CODE_SUCCESS; 191 } 192 193 void sm_add_event_handler(btstack_packet_callback_registration_t * callback_handler){ 194 } 195 196 int sm_cmac_ready(void){ 197 return 1; 198 } 199 void sm_cmac_signed_write_start(const sm_key_t key, uint8_t opcode, uint16_t attribute_handle, uint16_t message_len, const uint8_t * message, uint32_t sign_counter, void (*done_callback)(uint8_t * hash)){ 200 //sm_notify_client(SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED, sm_central_device_addr_type, sm_central_device_address, 0, sm_central_device_matched); 201 } 202 int sm_le_device_index(uint16_t handle ){ 203 return 0; 204 } 205 void sm_send_security_request(hci_con_handle_t con_handle){ 206 } 207 208 uint8_t sm_get_ltk(hci_con_handle_t con_handle, sm_key_t ltk){ 209 memset((uint8_t*) ltk, 0x22, 16); 210 return ERROR_CODE_SUCCESS; 211 } 212 213 irk_lookup_state_t sm_identity_resolving_state(hci_con_handle_t con_handle){ 214 return IRK_LOOKUP_SUCCEEDED; 215 } 216 void btstack_run_loop_set_timer(btstack_timer_source_t *a, uint32_t timeout_in_ms){ 217 } 218 219 // Set callback that will be executed when timer expires. 220 void btstack_run_loop_set_timer_handler(btstack_timer_source_t *ts, void (*process)(btstack_timer_source_t *_ts)){ 221 } 222 223 // Add/Remove timer source. 224 void btstack_run_loop_add_timer(btstack_timer_source_t *timer){ 225 } 226 227 int btstack_run_loop_remove_timer(btstack_timer_source_t *timer){ 228 return 1; 229 } 230 231 // todo: 232 hci_connection_t * hci_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type){ 233 printf("hci_connection_for_bd_addr_and_type not implemented in mock backend\n"); 234 return NULL; 235 } 236 hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){ 237 if (con_handle == hci_connection.con_handle){ 238 return &hci_connection; 239 } else { 240 return NULL; 241 } 242 } 243 void hci_connections_get_iterator(btstack_linked_list_iterator_t *it){ 244 // printf("hci_connections_get_iterator not implemented in mock backend\n"); 245 btstack_linked_list_iterator_init(it, &connections); 246 } 247 248 static void hci_setup_connection(uint16_t con_handle, bd_addr_type_t type){ 249 hci_connection.att_connection.mtu = 23; 250 hci_connection.att_connection.con_handle = con_handle; 251 hci_connection.att_connection.max_mtu = 23; 252 hci_connection.att_connection.encryption_key_size = 0; 253 hci_connection.att_connection.authenticated = 0; 254 hci_connection.att_connection.authorized = 0; 255 256 hci_connection.att_server.ir_le_device_db_index = 0; 257 258 hci_connection.con_handle = con_handle; 259 hci_connection.address_type = type; 260 261 if (btstack_linked_list_empty(&connections)){ 262 btstack_linked_list_add(&connections, (btstack_linked_item_t *)&hci_connection); 263 } 264 } 265 266 void hci_setup_le_connection(uint16_t con_handle){ 267 hci_setup_connection(con_handle, BD_ADDR_TYPE_LE_PUBLIC); 268 } 269 270 void l2cap_run(void){ 271 } 272 #include "btstack_run_loop.h" 273 274 void btstack_run_loop_execute_on_main_thread(btstack_context_callback_registration_t * callback_registration){ 275 callback_registration->callback(callback_registration->context); 276 } 277