1 #include <stdint.h> 2 #include <stdio.h> 3 #include <stdlib.h> 4 #include <string.h> 5 6 #include "btstack.h" 7 #include "att.h" 8 #include "hci.h" 9 #include "hci_dump.h" 10 #include "l2cap.h" 11 #include "gatt_client.h" 12 #include "sm.h" 13 14 static btstack_packet_handler_t att_packet_handler; 15 static void (*registered_l2cap_packet_handler) (void * connection, uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) = NULL; 16 17 static linked_list_t connections; 18 static const uint16_t max_mtu = 23; 19 static uint8_t l2cap_stack_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + 8 + max_mtu]; // pre buffer + HCI Header + L2CAP header 20 uint16_t gatt_client_handle = 0x40; 21 22 uint16_t get_gatt_client_handle(void){ 23 return gatt_client_handle; 24 } 25 26 void mock_simulate_command_complete(const hci_cmd_t *cmd){ 27 uint8_t packet[] = {HCI_EVENT_COMMAND_COMPLETE, 4, 1, cmd->opcode & 0xff, cmd->opcode >> 8, 0}; 28 registered_l2cap_packet_handler(NULL, HCI_EVENT_PACKET, NULL, (uint8_t *)&packet, sizeof(packet)); 29 } 30 31 void mock_simulate_hci_state_working(void){ 32 uint8_t packet[3] = {BTSTACK_EVENT_STATE, 0, HCI_STATE_WORKING}; 33 registered_l2cap_packet_handler(NULL, HCI_EVENT_PACKET, NULL, (uint8_t *)&packet, 3); 34 } 35 36 void mock_simulate_connected(void){ 37 uint8_t packet[] = {0x3E, 0x13, 0x01, 0x00, 0x40, 0x00, 0x00, 0x00, 0x9B, 0x77, 0xD1, 0xF7, 0xB1, 0x34, 0x50, 0x00, 0x00, 0x00, 0xD0, 0x07, 0x05}; 38 registered_l2cap_packet_handler(NULL, HCI_EVENT_PACKET, NULL, (uint8_t *)&packet, sizeof(packet)); 39 } 40 41 void mock_simulate_scan_response(void){ 42 uint8_t packet[] = {0xE2, 0x13, 0xE2, 0x01, 0x34, 0xB1, 0xF7, 0xD1, 0x77, 0x9B, 0xCC, 0x09, 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08}; 43 registered_l2cap_packet_handler(NULL, HCI_EVENT_PACKET, NULL, (uint8_t *)&packet, sizeof(packet)); 44 } 45 46 le_command_status_t le_central_start_scan(void){ 47 return BLE_PERIPHERAL_OK; 48 } 49 le_command_status_t le_central_stop_scan(void){ 50 return BLE_PERIPHERAL_OK; 51 } 52 le_command_status_t le_central_connect(bd_addr_t addr, bd_addr_type_t addr_type){ 53 return BLE_PERIPHERAL_OK; 54 } 55 void le_central_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){ 56 } 57 58 static void att_init_connection(att_connection_t * att_connection){ 59 att_connection->mtu = 23; 60 att_connection->max_mtu = 23; 61 att_connection->encryption_key_size = 0; 62 att_connection->authenticated = 0; 63 att_connection->authorized = 0; 64 } 65 66 int l2cap_can_send_connectionless_packet_now(void){ 67 return 1; 68 } 69 70 71 uint8_t *l2cap_get_outgoing_buffer(void){ 72 // printf("l2cap_get_outgoing_buffer\n"); 73 return (uint8_t *)&l2cap_stack_buffer; // 8 bytes 74 } 75 76 uint16_t l2cap_max_mtu(void){ 77 // printf("l2cap_max_mtu\n"); 78 return max_mtu; 79 } 80 81 uint16_t l2cap_max_le_mtu(void){ 82 // printf("l2cap_max_mtu\n"); 83 return max_mtu; 84 } 85 86 void l2cap_init(){} 87 88 void l2cap_register_fixed_channel(btstack_packet_handler_t packet_handler, uint16_t channel_id) { 89 att_packet_handler = packet_handler; 90 } 91 92 void l2cap_register_packet_handler(void (*handler)(void * connection, uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size)){ 93 registered_l2cap_packet_handler = handler; 94 } 95 96 97 int l2cap_reserve_packet_buffer(void){ 98 return 1; 99 } 100 101 int l2cap_can_send_fixed_channel_packet_now(uint16_t handle){ 102 return 1; 103 } 104 105 int l2cap_send_prepared_connectionless(uint16_t handle, uint16_t cid, uint16_t len){ 106 att_connection_t att_connection; 107 att_init_connection(&att_connection); 108 uint8_t response[max_mtu]; 109 uint16_t response_len = att_handle_request(&att_connection, l2cap_get_outgoing_buffer(), len, &response[0]); 110 if (response_len){ 111 att_packet_handler(ATT_DATA_PACKET, gatt_client_handle, &response[0], response_len); 112 } 113 return 0; 114 } 115 116 int sm_cmac_ready(void){ 117 return 1; 118 } 119 void sm_cmac_start(sm_key_t k, uint8_t opcode, uint16_t attribute_handle, uint16_t message_len, uint8_t * message, uint32_t sign_counter, void (*done_handler)(uint8_t hash[8])){ 120 //sm_notify_client(SM_IDENTITY_RESOLVING_SUCCEEDED, sm_central_device_addr_type, sm_central_device_address, 0, sm_central_device_matched); 121 } 122 int sm_le_device_index(uint16_t handle ){ 123 return -1; 124 } 125 126 void run_loop_set_timer(timer_source_t *a, uint32_t timeout_in_ms){ 127 } 128 129 // Set callback that will be executed when timer expires. 130 void run_loop_set_timer_handler(timer_source_t *ts, void (*process)(timer_source_t *_ts)){ 131 } 132 133 // Add/Remove timer source. 134 void run_loop_add_timer(timer_source_t *timer){ 135 } 136 137 int run_loop_remove_timer(timer_source_t *timer){ 138 return 1; 139 } 140 141 // todo: 142 hci_connection_t * hci_connection_for_bd_addr_and_type(bd_addr_t addr, bd_addr_type_t addr_type){ 143 printf("hci_connection_for_bd_addr_and_type not implemented in mock backend\n"); 144 return NULL; 145 } 146 hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){ 147 printf("hci_connection_for_handle not implemented in mock backend\n"); 148 return NULL; 149 } 150 void hci_connections_get_iterator(linked_list_iterator_t *it){ 151 // printf("hci_connections_get_iterator not implemented in mock backend\n"); 152 linked_list_iterator_init(it, &connections); 153 } 154 155 // int hci_send_cmd(const hci_cmd_t *cmd, ...){ 156 // // printf("hci_send_cmd opcode 0x%02x\n", cmd->opcode); 157 // return 0; 158 // } 159 160 // int hci_can_send_packet_now_using_packet_buffer(uint8_t packet_type){ 161 // return 1; 162 // } 163 164 // void hci_disconnect_security_block(hci_con_handle_t con_handle){ 165 // printf("hci_disconnect_security_block \n"); 166 // } 167 168 // void hci_dump_log(const char * format, ...){ 169 // printf("hci_disconnect_security_block \n"); 170 // } 171 172 void l2cap_run(void){ 173 } 174