1 #include <stdint.h> 2 #include <stdio.h> 3 #include <stdlib.h> 4 #include <string.h> 5 6 #include <btstack/btstack.h> 7 #include "att.h" 8 #include "hci.h" 9 #include "hci_dump.h" 10 #include "l2cap.h" 11 #include "ble_client.h" 12 13 static btstack_packet_handler_t att_packet_handler; 14 static void (*gatt_central_packet_handler) (void * connection, uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) = NULL; 15 16 static const uint16_t max_mtu = 23; 17 static uint8_t l2cap_stack_buffer[max_mtu]; 18 19 void mock_simulate_command_complete(const hci_cmd_t *cmd){ 20 uint8_t packet[] = {HCI_EVENT_COMMAND_COMPLETE, 4, 1, cmd->opcode & 0xff, cmd->opcode >> 8, 0}; 21 gatt_central_packet_handler(NULL, HCI_EVENT_PACKET, NULL, (uint8_t *)&packet, sizeof(packet)); 22 } 23 24 void mock_simulate_hci_state_working(){ 25 uint8_t packet[3] = {BTSTACK_EVENT_STATE, 0, HCI_STATE_WORKING}; 26 gatt_central_packet_handler(NULL, HCI_EVENT_PACKET, NULL, (uint8_t *)&packet, 3); 27 } 28 29 void mock_simulate_connected(){ 30 uint8_t packet[] = {0x3E, 0x13, 0x01, 0x00, 0x40, 0x00, 0x00, 0x00, 0x9B, 0x77, 0xD1, 0xF7, 0xB1, 0x34, 0x50, 0x00, 0x00, 0x00, 0xD0, 0x07, 0x05}; 31 gatt_central_packet_handler(NULL, HCI_EVENT_PACKET, NULL, (uint8_t *)&packet, sizeof(packet)); 32 } 33 34 35 void mock_simulate_scan_response(){ 36 uint8_t packet[] = {0x3E, 0x0F, 0x02, 0x01, 0x00, 0x00, 0x9B, 0x77, 0xD1, 0xF7, 0xB1, 0x34, 0x03, 0x02, 0x01, 0x05, 0xBC}; 37 gatt_central_packet_handler(NULL, HCI_EVENT_PACKET, NULL, (uint8_t *)&packet, sizeof(packet)); 38 } 39 40 void mock_simulate_exchange_mtu(){ 41 // uint8_t packet[] = {0x03, 0x17, 0x00}; 42 // att_packet_handler(ATT_DATA_PACKET, 0x40, (uint8_t *)&packet, sizeof(packet)); 43 } 44 45 static void att_init_connection(att_connection_t * att_connection){ 46 att_connection->mtu = 23; 47 att_connection->encryption_key_size = 0; 48 att_connection->authenticated = 0; 49 att_connection->authorized = 0; 50 } 51 52 int hci_can_send_packet_now_using_packet_buffer(uint8_t packet_type){ 53 return 1; 54 } 55 56 int l2cap_can_send_connectionless_packet_now(void){ 57 return 1; 58 } 59 60 int hci_send_cmd(const hci_cmd_t *cmd, ...){ 61 printf("hci_send_cmd opcode 0x%02x\n", cmd->opcode); 62 return 0; 63 } 64 65 66 uint8_t *l2cap_get_outgoing_buffer(void){ 67 // printf("l2cap_get_outgoing_buffer\n"); 68 return (uint8_t *)&l2cap_stack_buffer; // 8 bytes 69 } 70 71 uint16_t l2cap_max_mtu(void){ 72 // printf("l2cap_max_mtu\n"); 73 return max_mtu; 74 } 75 76 77 void l2cap_register_fixed_channel(btstack_packet_handler_t packet_handler, uint16_t channel_id) { 78 att_packet_handler = packet_handler; 79 } 80 81 void l2cap_register_packet_handler(void (*handler)(void * connection, uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size)){ 82 gatt_central_packet_handler = handler; 83 } 84 85 int l2cap_reserve_packet_buffer(void){ 86 // printf("l2cap_reserve_packet_buffer\n"); 87 return 1; 88 } 89 90 int l2cap_send_prepared_connectionless(uint16_t handle, uint16_t cid, uint16_t len){ 91 // printf("l2cap_send_prepared_connectionless\n"); 92 // assert handle = current connection 93 // assert cid = att 94 95 att_connection_t att_connection; 96 att_init_connection(&att_connection); 97 uint8_t response[max_mtu]; 98 uint16_t response_len = att_handle_request(&att_connection, l2cap_get_outgoing_buffer(), len, &response[0]); 99 att_packet_handler(ATT_DATA_PACKET, 0x40, &response[0], response_len); 100 101 return 0; 102 } 103 104 105 void hci_disconnect_security_block(hci_con_handle_t con_handle){ 106 printf("hci_disconnect_security_block \n"); 107 } 108 109 void hci_dump_log(const char * format, ...){ 110 printf("hci_disconnect_security_block \n"); 111 } 112 113 void l2cap_run(void){ 114 } 115