xref: /btstack/test/gatt_server/mock.c (revision 18cd0f45756bd438d3799d7aa67a6d3611dd4be2)
1f9739491SMatthias Ringwald #include <stdint.h>
2f9739491SMatthias Ringwald #include <stdio.h>
3f9739491SMatthias Ringwald #include <stdlib.h>
4f9739491SMatthias Ringwald #include <string.h>
5f9739491SMatthias Ringwald 
6f9739491SMatthias Ringwald #include "hci.h"
7e0ff5d41SMatthias Ringwald #include "gap.h"
8f9739491SMatthias Ringwald #include "hci_dump.h"
9f9739491SMatthias Ringwald #include "l2cap.h"
10f9739491SMatthias Ringwald 
11f9739491SMatthias Ringwald #include "ble/att_db.h"
121b37bf00SMilanka Ringwald #include "ble/att_dispatch.h"
13f9739491SMatthias Ringwald #include "ble/sm.h"
14f9739491SMatthias Ringwald 
15ae970bb9SMilanka Ringwald #include "btstack_debug.h"
16ae970bb9SMilanka Ringwald 
171b37bf00SMilanka Ringwald static btstack_packet_handler_t att_server_packet_handler;
18f9739491SMatthias Ringwald static void (*registered_hci_event_handler) (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) = NULL;
19f9739491SMatthias Ringwald 
20f9739491SMatthias Ringwald static btstack_linked_list_t     connections;
218206902cSMilanka Ringwald static uint16_t max_mtu = 23;
228206902cSMilanka Ringwald static uint8_t  l2cap_stack_buffer[HCI_INCOMING_PRE_BUFFER_SIZE + 8 + ATT_DEFAULT_MTU];	// pre buffer + HCI Header + L2CAP header
23f9739491SMatthias Ringwald static uint16_t gatt_client_handle = 0x40;
24f9739491SMatthias Ringwald static hci_connection_t hci_connection;
25f9739491SMatthias Ringwald 
26f9739491SMatthias Ringwald uint16_t get_gatt_client_handle(void){
27f9739491SMatthias Ringwald 	return gatt_client_handle;
28f9739491SMatthias Ringwald }
29f9739491SMatthias Ringwald 
30f9739491SMatthias Ringwald void mock_simulate_command_complete(const hci_cmd_t *cmd){
31f9739491SMatthias Ringwald 	uint8_t packet[] = {HCI_EVENT_COMMAND_COMPLETE, 4, 1, (uint8_t) (cmd->opcode & 0xff), (uint8_t) (cmd->opcode >> 8), 0};
32f9739491SMatthias Ringwald 	registered_hci_event_handler(HCI_EVENT_PACKET, 0, (uint8_t *)&packet, sizeof(packet));
33f9739491SMatthias Ringwald }
34f9739491SMatthias Ringwald 
35f9739491SMatthias Ringwald void mock_simulate_hci_state_working(void){
36f9739491SMatthias Ringwald 	uint8_t packet[3] = {BTSTACK_EVENT_STATE, 0, HCI_STATE_WORKING};
37f9739491SMatthias Ringwald 	registered_hci_event_handler(HCI_EVENT_PACKET, 0, (uint8_t *)&packet, 3);
38f9739491SMatthias Ringwald }
39f9739491SMatthias Ringwald 
40f9739491SMatthias Ringwald void mock_simulate_connected(void){
41f9739491SMatthias Ringwald 	uint8_t packet[] = {0x3E, 0x13, 0x01, 0x00, 0x40, 0x00, 0x00, 0x00, 0x9B, 0x77, 0xD1, 0xF7, 0xB1, 0x34, 0x50, 0x00, 0x00, 0x00, 0xD0, 0x07, 0x05};
42f9739491SMatthias Ringwald 	registered_hci_event_handler(HCI_EVENT_PACKET, 0, (uint8_t *)&packet, sizeof(packet));
43f9739491SMatthias Ringwald }
44f9739491SMatthias Ringwald 
45f9739491SMatthias Ringwald void mock_simulate_scan_response(void){
46f9739491SMatthias Ringwald 	uint8_t packet[] = {0xE2, 0x13, 0xE2, 0x01, 0x34, 0xB1, 0xF7, 0xD1, 0x77, 0x9B, 0xCC, 0x09, 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08};
47f9739491SMatthias Ringwald 	registered_hci_event_handler(HCI_EVENT_PACKET, 0, (uint8_t *)&packet, sizeof(packet));
48f9739491SMatthias Ringwald }
49f9739491SMatthias Ringwald 
50f9739491SMatthias Ringwald void gap_start_scan(void){
51f9739491SMatthias Ringwald }
52f9739491SMatthias Ringwald void gap_stop_scan(void){
53f9739491SMatthias Ringwald }
54e0ff5d41SMatthias Ringwald uint8_t gap_connect(const bd_addr_t addr, bd_addr_type_t addr_type){
55f9739491SMatthias Ringwald 	return 0;
56f9739491SMatthias Ringwald }
57f9739491SMatthias Ringwald void gap_set_scan_parameters(uint8_t scan_type, uint16_t scan_interval, uint16_t scan_window){
58f9739491SMatthias Ringwald }
59f9739491SMatthias Ringwald 
60f9739491SMatthias Ringwald int gap_reconnect_security_setup_active(hci_con_handle_t con_handle){
61f9739491SMatthias Ringwald 	UNUSED(con_handle);
62f9739491SMatthias Ringwald 	return 0;
63f9739491SMatthias Ringwald }
64f9739491SMatthias Ringwald 
658206902cSMilanka Ringwald void hci_setup_le_connection(uint16_t con_handle){
6625336c94SMilanka Ringwald     hci_connection.att_connection.mtu = 23;
6725336c94SMilanka Ringwald     hci_connection.att_connection.con_handle = con_handle;
6825336c94SMilanka Ringwald     hci_connection.att_connection.max_mtu = 23;
6925336c94SMilanka Ringwald     hci_connection.att_connection.encryption_key_size = 0;
7025336c94SMilanka Ringwald     hci_connection.att_connection.authenticated = 0;
7125336c94SMilanka Ringwald     hci_connection.att_connection.authorized = 0;
7225336c94SMilanka Ringwald 
7325336c94SMilanka Ringwald     hci_connection.att_server.ir_le_device_db_index = 0;
7425336c94SMilanka Ringwald 
758206902cSMilanka Ringwald     hci_connection.con_handle = con_handle;
768206902cSMilanka Ringwald 
7725336c94SMilanka Ringwald     if (btstack_linked_list_empty(&connections)){
7825336c94SMilanka Ringwald         btstack_linked_list_add(&connections, (btstack_linked_item_t *)&hci_connection);
7925336c94SMilanka Ringwald     }
80f9739491SMatthias Ringwald }
81f9739491SMatthias Ringwald 
828206902cSMilanka Ringwald void mock_l2cap_set_max_mtu(uint16_t mtu){
838206902cSMilanka Ringwald     max_mtu = mtu;
841a47f80bSMatthias Ringwald }
851a47f80bSMatthias Ringwald 
868206902cSMilanka Ringwald void hci_deinit(void){
878206902cSMilanka Ringwald     hci_connection.att_connection.mtu = 0;
888206902cSMilanka Ringwald     hci_connection.att_connection.con_handle = HCI_CON_HANDLE_INVALID;
898206902cSMilanka Ringwald     hci_connection.att_connection.max_mtu = 0;
908206902cSMilanka Ringwald     hci_connection.att_connection.encryption_key_size = 0;
918206902cSMilanka Ringwald     hci_connection.att_connection.authenticated = 0;
928206902cSMilanka Ringwald     hci_connection.att_connection.authorized = 0;
938206902cSMilanka Ringwald     hci_connection.att_server.ir_le_device_db_index = 0;
948206902cSMilanka Ringwald     hci_connection.att_server.notification_requests = NULL;
958206902cSMilanka Ringwald     hci_connection.att_server.indication_requests = NULL;
968206902cSMilanka Ringwald     connections = NULL;
978206902cSMilanka Ringwald }
988206902cSMilanka Ringwald 
998206902cSMilanka Ringwald void hci_add_event_handler(btstack_packet_callback_registration_t * callback_handler){
1008206902cSMilanka Ringwald     registered_hci_event_handler = callback_handler->callback;
101f9739491SMatthias Ringwald }
102f9739491SMatthias Ringwald 
10377fc16acSMatthias Ringwald bool hci_can_send_command_packet_now(void){
10477fc16acSMatthias Ringwald 	return true;
105ae970bb9SMilanka Ringwald }
106ae970bb9SMilanka Ringwald 
107ae970bb9SMilanka Ringwald HCI_STATE hci_get_state(void){
108ae970bb9SMilanka Ringwald 	return HCI_STATE_WORKING;
109ae970bb9SMilanka Ringwald }
110ae970bb9SMilanka Ringwald 
11177fc16acSMatthias Ringwald uint8_t hci_send_cmd(const hci_cmd_t *cmd, ...){
112ae970bb9SMilanka Ringwald 	btstack_assert(false);
11377fc16acSMatthias Ringwald 	return ERROR_CODE_SUCCESS;
114ae970bb9SMilanka Ringwald }
115ae970bb9SMilanka Ringwald 
116ae970bb9SMilanka Ringwald void hci_halting_defer(void){
117ae970bb9SMilanka Ringwald }
118ae970bb9SMilanka Ringwald 
11977fc16acSMatthias Ringwald bool l2cap_can_send_connectionless_packet_now(void){
120f9739491SMatthias Ringwald 	return 1;
121f9739491SMatthias Ringwald }
122f9739491SMatthias Ringwald 
1231a47f80bSMatthias Ringwald void l2cap_add_event_handler(btstack_packet_callback_registration_t * callback_handler){
1241a47f80bSMatthias Ringwald     UNUSED(callback_handler);
1251a47f80bSMatthias Ringwald }
1261a47f80bSMatthias Ringwald 
127f9739491SMatthias Ringwald uint8_t *l2cap_get_outgoing_buffer(void){
128f9739491SMatthias Ringwald 	// printf("l2cap_get_outgoing_buffer\n");
129f9739491SMatthias Ringwald 	return (uint8_t *)&l2cap_stack_buffer; // 8 bytes
130f9739491SMatthias Ringwald }
131f9739491SMatthias Ringwald 
132f9739491SMatthias Ringwald uint16_t l2cap_max_mtu(void){
133f9739491SMatthias Ringwald 	// printf("l2cap_max_mtu\n");
134f9739491SMatthias Ringwald     return max_mtu;
135f9739491SMatthias Ringwald }
136f9739491SMatthias Ringwald 
137f9739491SMatthias Ringwald uint16_t l2cap_max_le_mtu(void){
138f9739491SMatthias Ringwald 	return max_mtu;
139f9739491SMatthias Ringwald }
140f9739491SMatthias Ringwald 
141f9739491SMatthias Ringwald void l2cap_init(void){}
142f9739491SMatthias Ringwald 
14377fc16acSMatthias Ringwald bool l2cap_reserve_packet_buffer(void){
14477fc16acSMatthias Ringwald 	return true;
145f9739491SMatthias Ringwald }
146f9739491SMatthias Ringwald 
147f9739491SMatthias Ringwald void l2cap_release_packet_buffer(void){
148f9739491SMatthias Ringwald }
149f9739491SMatthias Ringwald 
150782c1ae9SMilanka Ringwald static uint8_t l2cap_can_send_fixed_channel_packet_now_status = 1;
151782c1ae9SMilanka Ringwald 
152782c1ae9SMilanka Ringwald void l2cap_can_send_fixed_channel_packet_now_set_status(uint8_t status){
153782c1ae9SMilanka Ringwald 	l2cap_can_send_fixed_channel_packet_now_status = status;
154782c1ae9SMilanka Ringwald }
155782c1ae9SMilanka Ringwald 
15677fc16acSMatthias Ringwald bool l2cap_can_send_fixed_channel_packet_now(uint16_t handle, uint16_t channel_id){
157782c1ae9SMilanka Ringwald 	return l2cap_can_send_fixed_channel_packet_now_status;
158f9739491SMatthias Ringwald }
159f9739491SMatthias Ringwald 
160f9739491SMatthias Ringwald void l2cap_request_can_send_fix_channel_now_event(uint16_t handle, uint16_t channel_id){
161f9739491SMatthias Ringwald 	uint8_t event[] = { L2CAP_EVENT_CAN_SEND_NOW, 2, 1, 0};
1621b37bf00SMilanka Ringwald     att_server_packet_handler(HCI_EVENT_PACKET, 0, (uint8_t*)event, sizeof(event));
163f9739491SMatthias Ringwald }
164f9739491SMatthias Ringwald 
16577fc16acSMatthias Ringwald uint8_t l2cap_send_prepared_connectionless(uint16_t handle, uint16_t cid, uint16_t len){
166f9739491SMatthias Ringwald 	att_connection_t att_connection;
1678206902cSMilanka Ringwald     hci_setup_le_connection(handle);
168f9739491SMatthias Ringwald 	uint8_t response[max_mtu];
169f9739491SMatthias Ringwald 	uint16_t response_len = att_handle_request(&att_connection, l2cap_get_outgoing_buffer(), len, &response[0]);
170f9739491SMatthias Ringwald 	if (response_len){
1711b37bf00SMilanka Ringwald         att_server_packet_handler(ATT_DATA_PACKET, gatt_client_handle, &response[0], response_len);
172f9739491SMatthias Ringwald 	}
17377fc16acSMatthias Ringwald 	return ERROR_CODE_SUCCESS;
174f9739491SMatthias Ringwald }
175f9739491SMatthias Ringwald 
176f9739491SMatthias Ringwald void sm_add_event_handler(btstack_packet_callback_registration_t * callback_handler){
177f9739491SMatthias Ringwald }
178f9739491SMatthias Ringwald 
179f9739491SMatthias Ringwald int  sm_cmac_ready(void){
180f9739491SMatthias Ringwald 	return 1;
181f9739491SMatthias Ringwald }
182f9739491SMatthias Ringwald 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)){
183f9739491SMatthias Ringwald 	//sm_notify_client(SM_EVENT_IDENTITY_RESOLVING_SUCCEEDED, sm_central_device_addr_type, sm_central_device_address, 0, sm_central_device_matched);
184f9739491SMatthias Ringwald }
185f9739491SMatthias Ringwald int sm_le_device_index(uint16_t handle ){
186f9739491SMatthias Ringwald 	return -1;
187f9739491SMatthias Ringwald }
188f9739491SMatthias Ringwald 
189f9739491SMatthias Ringwald irk_lookup_state_t sm_identity_resolving_state(hci_con_handle_t con_handle){
190f9739491SMatthias Ringwald 	return IRK_LOOKUP_SUCCEEDED;
191f9739491SMatthias Ringwald }
192f9739491SMatthias Ringwald 
193f9739491SMatthias Ringwald void sm_request_pairing(hci_con_handle_t con_handle){
194f9739491SMatthias Ringwald }
195f9739491SMatthias Ringwald 
196f9739491SMatthias Ringwald void btstack_run_loop_set_timer(btstack_timer_source_t *a, uint32_t timeout_in_ms){
197f9739491SMatthias Ringwald }
198f9739491SMatthias Ringwald 
199f9739491SMatthias Ringwald // Set callback that will be executed when timer expires.
200f9739491SMatthias Ringwald void btstack_run_loop_set_timer_handler(btstack_timer_source_t *ts, void (*process)(btstack_timer_source_t *_ts)){
201f9739491SMatthias Ringwald }
202f9739491SMatthias Ringwald 
203f9739491SMatthias Ringwald // Add/Remove timer source.
204f9739491SMatthias Ringwald void btstack_run_loop_add_timer(btstack_timer_source_t *timer){
205f9739491SMatthias Ringwald }
206f9739491SMatthias Ringwald 
207f9739491SMatthias Ringwald int  btstack_run_loop_remove_timer(btstack_timer_source_t *timer){
208f9739491SMatthias Ringwald 	return 1;
209f9739491SMatthias Ringwald }
210f9739491SMatthias Ringwald 
211f9739491SMatthias Ringwald void * btstack_run_loop_get_timer_context(btstack_timer_source_t *ts){
212f9739491SMatthias Ringwald     return ts->context;
213f9739491SMatthias Ringwald }
214f9739491SMatthias Ringwald 
215f9739491SMatthias Ringwald // todo:
216e0ff5d41SMatthias Ringwald hci_connection_t * hci_connection_for_bd_addr_and_type(const bd_addr_t addr, bd_addr_type_t addr_type){
217f9739491SMatthias Ringwald 	printf("hci_connection_for_bd_addr_and_type not implemented in mock backend\n");
218f9739491SMatthias Ringwald 	return NULL;
219f9739491SMatthias Ringwald }
220f9739491SMatthias Ringwald hci_connection_t * hci_connection_for_handle(hci_con_handle_t con_handle){
2218206902cSMilanka Ringwald     if (hci_connection.con_handle != con_handle){
2228206902cSMilanka Ringwald         return NULL;
2238206902cSMilanka Ringwald     }
224f9739491SMatthias Ringwald     return &hci_connection;
225f9739491SMatthias Ringwald }
2268206902cSMilanka Ringwald 
227f9739491SMatthias Ringwald void hci_connections_get_iterator(btstack_linked_list_iterator_t *it){
228f9739491SMatthias Ringwald 	// printf("hci_connections_get_iterator not implemented in mock backend\n");
229f9739491SMatthias Ringwald     btstack_linked_list_iterator_init(it, &connections);
230f9739491SMatthias Ringwald }
231f9739491SMatthias Ringwald 
232f9739491SMatthias Ringwald 
233f9739491SMatthias Ringwald void l2cap_run(void){
234f9739491SMatthias Ringwald }
235f9739491SMatthias Ringwald 
2361a449638SMatthias Ringwald void l2cap_register_packet_handler(void (*handler)(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size)){
2371a449638SMatthias Ringwald }
2381a449638SMatthias Ringwald 
2392e7076acSMatthias Ringwald bool gap_authenticated(hci_con_handle_t con_handle){
2402e7076acSMatthias Ringwald 	return false;
241f9739491SMatthias Ringwald }
242f9739491SMatthias Ringwald authorization_state_t gap_authorization_state(hci_con_handle_t con_handle){
243f9739491SMatthias Ringwald 	return AUTHORIZATION_UNKNOWN;
244f9739491SMatthias Ringwald }
2452e7076acSMatthias Ringwald uint8_t gap_encryption_key_size(hci_con_handle_t con_handle){
246f9739491SMatthias Ringwald 	return 0;
247f9739491SMatthias Ringwald }
2482e7076acSMatthias Ringwald bool gap_secure_connection(hci_con_handle_t con_handle){
2492e7076acSMatthias Ringwald 	return false;
250f9739491SMatthias Ringwald }
251*18cd0f45SMilanka Ringwald gap_connection_type_t gap_get_connection_type(hci_con_handle_t con_handle){
252*18cd0f45SMilanka Ringwald     if (hci_connection.con_handle != con_handle){
253f9739491SMatthias Ringwald         return GAP_CONNECTION_INVALID;
254f9739491SMatthias Ringwald     }
255*18cd0f45SMilanka Ringwald     switch (hci_connection.address_type){
256*18cd0f45SMilanka Ringwald         case BD_ADDR_TYPE_LE_PUBLIC:
257*18cd0f45SMilanka Ringwald         case BD_ADDR_TYPE_LE_RANDOM:
258*18cd0f45SMilanka Ringwald             return GAP_CONNECTION_LE;
259*18cd0f45SMilanka Ringwald         case BD_ADDR_TYPE_SCO:
260*18cd0f45SMilanka Ringwald             return GAP_CONNECTION_SCO;
261*18cd0f45SMilanka Ringwald         case BD_ADDR_TYPE_ACL:
262*18cd0f45SMilanka Ringwald             return GAP_CONNECTION_ACL;
263*18cd0f45SMilanka Ringwald         default:
264*18cd0f45SMilanka Ringwald             return GAP_CONNECTION_INVALID;
265*18cd0f45SMilanka Ringwald     }
266*18cd0f45SMilanka Ringwald }
267*18cd0f45SMilanka Ringwald 
2681a449638SMatthias Ringwald int gap_request_connection_parameter_update(hci_con_handle_t con_handle, uint16_t conn_interval_min,
2691a449638SMatthias Ringwald 	uint16_t conn_interval_max, uint16_t conn_latency, uint16_t supervision_timeout){
2701a449638SMatthias Ringwald 	return 0;
2711a449638SMatthias Ringwald }
2721b37bf00SMilanka Ringwald 
2731b37bf00SMilanka Ringwald void mock_call_att_server_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
2741b37bf00SMilanka Ringwald     (*att_server_packet_handler)(packet_type, channel, packet, size);
2751b37bf00SMilanka Ringwald }
2761b37bf00SMilanka Ringwald 
2778206902cSMilanka Ringwald void mock_call_att_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
2788206902cSMilanka Ringwald     (*registered_hci_event_handler)(packet_type, channel, packet, size);
2798206902cSMilanka Ringwald }
2808206902cSMilanka Ringwald 
2811b37bf00SMilanka Ringwald void att_dispatch_register_server(btstack_packet_handler_t packet_handler){
2821b37bf00SMilanka Ringwald     att_server_packet_handler = packet_handler;
2831b37bf00SMilanka Ringwald }
2841b37bf00SMilanka Ringwald 
2851b37bf00SMilanka Ringwald int att_dispatch_server_can_send_now(hci_con_handle_t con_handle){
2861b37bf00SMilanka Ringwald     UNUSED(con_handle);
2871b37bf00SMilanka Ringwald     return l2cap_can_send_fixed_channel_packet_now_status;
2881b37bf00SMilanka Ringwald }
2891b37bf00SMilanka Ringwald 
2901b37bf00SMilanka Ringwald void att_dispatch_server_mtu_exchanged(hci_con_handle_t con_handle, uint16_t new_mtu){
2911b37bf00SMilanka Ringwald     UNUSED(con_handle);
2921b37bf00SMilanka Ringwald     UNUSED(new_mtu);
2931b37bf00SMilanka Ringwald }
2941b37bf00SMilanka Ringwald 
2951b37bf00SMilanka Ringwald void att_dispatch_server_request_can_send_now_event(hci_con_handle_t con_handle){
29694c4ec6bSMilanka Ringwald     if (l2cap_can_send_fixed_channel_packet_now_status){
29725336c94SMilanka Ringwald         uint8_t event[] = { L2CAP_EVENT_CAN_SEND_NOW, 2, 1, 0};
29825336c94SMilanka Ringwald         att_server_packet_handler(HCI_EVENT_PACKET, 0, (uint8_t*)event, sizeof(event));
2991b37bf00SMilanka Ringwald     }
30094c4ec6bSMilanka Ringwald }
3018206902cSMilanka Ringwald 
302