mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-04-07 16:20:19 +00:00
Code Issues Packages Projects Releases Wiki Activity

example/le_data_channel: allow to send from both sides

Browse Source
This commit is contained in:
Matthias Ringwald 2018-01-13 21:44:32 +01:00
parent 1add4db554
commit 13171b9312
2 changed files with 137 additions and 81 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

168
example/le_data_channel_client.c
View File

@ -55,6 +55,8 @@
#include "btstack.h" #include "btstack.h"
// #define TEST_STREAM_DATA
static enum { static enum {
TC_OFF, TC_OFF,
TC_IDLE, TC_IDLE,
@ -155,6 +157,7 @@ static int advertisement_report_contains_name(const char * name, uint8_t * adver
return 0; return 0;
} }
#ifdef TEST_STREAM_DATA
/* LISTING_END */ /* LISTING_END */
/* /*
* @section Streamer * @section Streamer
@ -181,6 +184,7 @@ static void streamer(void){
l2cap_le_request_can_send_now_event(le_data_channel_connection.cid); l2cap_le_request_can_send_now_event(le_data_channel_connection.cid);
} }
/* LISTING_END */ /* LISTING_END */
#endif
// Either connect to remote specified on command line or start scan for device with "LE Data Channel" in advertisement // Either connect to remote specified on command line or start scan for device with "LE Data Channel" in advertisement
static void le_data_channel_client_start(void){ static void le_data_channel_client_start(void){
@ -206,84 +210,96 @@ static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packe
uint16_t conn_interval; uint16_t conn_interval;
hci_con_handle_t handle; hci_con_handle_t handle;
if (packet_type != HCI_EVENT_PACKET) return; switch (packet_type) {
case HCI_EVENT_PACKET:
uint8_t event = hci_event_packet_get_type(packet); switch (hci_event_packet_get_type(packet)) {
switch (event) { case BTSTACK_EVENT_STATE:
case BTSTACK_EVENT_STATE: // BTstack activated, get started
// BTstack activated, get started if (btstack_event_state_get_state(packet) == HCI_STATE_WORKING) {
if (btstack_event_state_get_state(packet) == HCI_STATE_WORKING) { le_data_channel_client_start();
le_data_channel_client_start(); } else {
} else { state = TC_OFF;
state = TC_OFF; }
} break;
break; case GAP_EVENT_ADVERTISING_REPORT:
case GAP_EVENT_ADVERTISING_REPORT: if (state != TC_W4_SCAN_RESULT) return;
if (state != TC_W4_SCAN_RESULT) return; // check name in advertisement
// check name in advertisement if (!advertisement_report_contains_name("LE Data Channel", packet)) return;
if (!advertisement_report_contains_name("LE Data Channel", packet)) return; // store address and type
// store address and type gap_event_advertising_report_get_address(packet, le_data_channel_addr);
gap_event_advertising_report_get_address(packet, le_data_channel_addr); le_data_channel_addr_type = gap_event_advertising_report_get_address_type(packet);
le_data_channel_addr_type = gap_event_advertising_report_get_address_type(packet); // stop scanning, and connect to the device
// stop scanning, and connect to the device state = TC_W4_CONNECT;
state = TC_W4_CONNECT; gap_stop_scan();
gap_stop_scan(); printf("Stop scan. Connect to device with addr %s.\n", bd_addr_to_str(le_data_channel_addr));
printf("Stop scan. Connect to device with addr %s.\n", bd_addr_to_str(le_data_channel_addr)); gap_connect(le_data_channel_addr,le_data_channel_addr_type);
gap_connect(le_data_channel_addr,le_data_channel_addr_type); break;
break; case HCI_EVENT_LE_META:
case HCI_EVENT_LE_META: // wait for connection complete
// wait for connection complete if (hci_event_le_meta_get_subevent_code(packet) != HCI_SUBEVENT_LE_CONNECTION_COMPLETE) break;
if (hci_event_le_meta_get_subevent_code(packet) != HCI_SUBEVENT_LE_CONNECTION_COMPLETE) break; if (state != TC_W4_CONNECT) return;
if (state != TC_W4_CONNECT) return; connection_handle = hci_subevent_le_connection_complete_get_connection_handle(packet);
connection_handle = hci_subevent_le_connection_complete_get_connection_handle(packet); // print connection parameters (without using float operations)
// print connection parameters (without using float operations) conn_interval = hci_subevent_le_connection_complete_get_conn_interval(packet);
conn_interval = hci_subevent_le_connection_complete_get_conn_interval(packet); printf("Connection Interval: %u.%02u ms\n", conn_interval * 125 / 100, 25 * (conn_interval & 3));
printf("Connection Interval: %u.%02u ms\n", conn_interval * 125 / 100, 25 * (conn_interval & 3)); printf("Connection Latency: %u\n", hci_subevent_le_connection_complete_get_conn_latency(packet));
printf("Connection Latency: %u\n", hci_subevent_le_connection_complete_get_conn_latency(packet)); // initialize gatt client context with handle, and add it to the list of active clients
// initialize gatt client context with handle, and add it to the list of active clients // query primary services
// query primary services printf("Connect to performance test channel.\n");
printf("Connect to performance test channel.\n"); state = TC_W4_CHANNEL;
state = TC_W4_CHANNEL; l2cap_le_create_channel(&packet_handler, connection_handle, TSPX_le_psm, data_channel_buffer,
l2cap_le_create_channel(&packet_handler, connection_handle, TSPX_le_psm, data_channel_buffer, sizeof(data_channel_buffer), L2CAP_LE_AUTOMATIC_CREDITS, LEVEL_0, &le_data_channel_connection.cid);
sizeof(data_channel_buffer), L2CAP_LE_AUTOMATIC_CREDITS, LEVEL_0, &le_data_channel_connection.cid); break;
break; case HCI_EVENT_DISCONNECTION_COMPLETE:
case HCI_EVENT_DISCONNECTION_COMPLETE: if (cmdline_addr_found){
if (cmdline_addr_found){ printf("Disconnected %s\n", bd_addr_to_str(cmdline_addr));
printf("Disconnected %s\n", bd_addr_to_str(cmdline_addr)); return;
return; }
} printf("Disconnected %s\n", bd_addr_to_str(le_data_channel_addr));
printf("Disconnected %s\n", bd_addr_to_str(le_data_channel_addr)); if (state == TC_OFF) break;
if (state == TC_OFF) break; le_data_channel_client_start();
le_data_channel_client_start(); break;
break; case L2CAP_EVENT_LE_CHANNEL_OPENED:
case L2CAP_EVENT_LE_CHANNEL_OPENED: // inform about new l2cap connection
// inform about new l2cap connection l2cap_event_le_channel_opened_get_address(packet, event_address);
l2cap_event_le_channel_opened_get_address(packet, event_address); psm = l2cap_event_le_channel_opened_get_psm(packet);
psm = l2cap_event_le_channel_opened_get_psm(packet); cid = l2cap_event_le_channel_opened_get_local_cid(packet);
cid = l2cap_event_le_channel_opened_get_local_cid(packet); handle = l2cap_event_le_channel_opened_get_handle(packet);
handle = l2cap_event_le_channel_opened_get_handle(packet); if (packet[2] == 0) {
if (packet[2] == 0) { printf("L2CAP: LE Data Channel successfully opened: %s, handle 0x%02x, psm 0x%02x, local cid 0x%02x, remote cid 0x%02x\n",
printf("L2CAP: LE Data Channel successfully opened: %s, handle 0x%02x, psm 0x%02x, local cid 0x%02x, remote cid 0x%02x\n", bd_addr_to_str(event_address), handle, psm, cid, little_endian_read_16(packet, 15));
bd_addr_to_str(event_address), handle, psm, cid, little_endian_read_16(packet, 15)); le_data_channel_connection.cid = cid;
le_data_channel_connection.cid = cid; le_data_channel_connection.connection_handle = handle;
le_data_channel_connection.connection_handle = handle; le_data_channel_connection.test_data_len = btstack_min(l2cap_event_le_channel_opened_get_remote_mtu(packet), sizeof(le_data_channel_connection.test_data));
le_data_channel_connection.test_data_len = btstack_min(l2cap_event_le_channel_opened_get_remote_mtu(packet), sizeof(le_data_channel_connection.test_data)); state = TC_TEST_DATA;
state = TC_TEST_DATA; printf("Test packet size: %u\n", le_data_channel_connection.test_data_len);
printf("Test packet size: %u\n", le_data_channel_connection.test_data_len); test_reset(&le_data_channel_connection);
test_reset(&le_data_channel_connection); #ifdef TEST_STREAM_DATA
l2cap_le_request_can_send_now_event(le_data_channel_connection.cid); l2cap_le_request_can_send_now_event(le_data_channel_connection.cid);
} else { #endif
printf("L2CAP: LE Data Channel connection to device %s failed. status code %u\n", bd_addr_to_str(event_address), packet[2]); } else {
} printf("L2CAP: LE Data Channel connection to device %s failed. status code %u\n", bd_addr_to_str(event_address), packet[2]);
break; }
break;
case L2CAP_EVENT_LE_CAN_SEND_NOW: #ifdef TEST_STREAM_DATA
streamer(); case L2CAP_EVENT_LE_CAN_SEND_NOW:
break; streamer();
break;
#endif
case L2CAP_EVENT_LE_CHANNEL_CLOSED: case L2CAP_EVENT_LE_CHANNEL_CLOSED:
cid = l2cap_event_le_channel_closed_get_local_cid(packet); cid = l2cap_event_le_channel_closed_get_local_cid(packet);
printf("L2CAP: LE Data Channel closed 0x%02x\n", cid); printf("L2CAP: LE Data Channel closed 0x%02x\n", cid);
break;
default:
break;
}
break;
case L2CAP_DATA_PACKET:
test_track_data(&le_data_channel_connection, size);
break; break;
default: default:

50
example/le_data_channel_server.c
View File

@ -52,6 +52,8 @@
#include "btstack.h" #include "btstack.h"
#define TEST_STREAM_DATA
#define REPORT_INTERVAL_MS 3000 #define REPORT_INTERVAL_MS 3000
#define MAX_NR_CONNECTIONS 3 #define MAX_NR_CONNECTIONS 3
@ -139,7 +141,7 @@ static void test_reset(le_data_channel_connection_t * context){
context->test_data_sent = 0; context->test_data_sent = 0;
} }
static void test_track_transferred(le_data_channel_connection_t * context, int bytes_transferred){ static void test_track_data(le_data_channel_connection_t * context, int bytes_transferred){
context->test_data_sent += bytes_transferred; context->test_data_sent += bytes_transferred;
// evaluate // evaluate
uint32_t now = btstack_run_loop_get_time_ms(); uint32_t now = btstack_run_loop_get_time_ms();
@ -155,6 +157,36 @@ static void test_track_transferred(le_data_channel_connection_t * context, int b
} }
/* LISTING_END(tracking): Tracking throughput */ /* LISTING_END(tracking): Tracking throughput */
#ifdef TEST_STREAM_DATA
/* LISTING_END */
/*
* @section Streamer
*
* @text The streamer function checks if notifications are enabled and if a notification can be sent now.
* It creates some test data - a single letter that gets increased every time - and tracks the data sent.
*/
/* LISTING_START(streamer): Streaming code */
static void streamer(void){
// create test data
le_data_channel_connection.counter++;
if (le_data_channel_connection.counter > 'Z') le_data_channel_connection.counter = 'A';
memset(le_data_channel_connection.test_data, le_data_channel_connection.counter, le_data_channel_connection.test_data_len);
// send
l2cap_le_send_data(le_data_channel_connection.cid, (uint8_t *) le_data_channel_connection.test_data, le_data_channel_connection.test_data_len);
// track
test_track_data(&le_data_channel_connection, le_data_channel_connection.test_data_len);
// request another packet
l2cap_le_request_can_send_now_event(le_data_channel_connection.cid);
}
/* LISTING_END */
#endif
/* /*
* @section Packet Handler * @section Packet Handler
* *
@ -229,6 +261,12 @@ static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *pack
bd_addr_to_str(event_address), handle, psm, cid, little_endian_read_16(packet, 15)); bd_addr_to_str(event_address), handle, psm, cid, little_endian_read_16(packet, 15));
le_data_channel_connection.cid = cid; le_data_channel_connection.cid = cid;
le_data_channel_connection.connection_handle = handle; le_data_channel_connection.connection_handle = handle;
le_data_channel_connection.test_data_len = btstack_min(l2cap_event_le_channel_opened_get_remote_mtu(packet), sizeof(le_data_channel_connection.test_data));
printf("Test packet size: %u\n", le_data_channel_connection.test_data_len);
test_reset(&le_data_channel_connection);
#ifdef TEST_STREAM_DATA
l2cap_le_request_can_send_now_event(le_data_channel_connection.cid);
#endif
} else { } else {
printf("L2CAP: LE Data Channel connection to device %s failed. status code %u\n", bd_addr_to_str(event_address), packet[2]); printf("L2CAP: LE Data Channel connection to device %s failed. status code %u\n", bd_addr_to_str(event_address), packet[2]);
} }
@ -239,17 +277,19 @@ static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *pack
printf("L2CAP: LE Data Channel closed 0x%02x\n", cid); printf("L2CAP: LE Data Channel closed 0x%02x\n", cid);
break; break;
case L2CAP_EVENT_LE_PACKET_SENT: #ifdef TEST_STREAM_DATA
cid = l2cap_event_le_packet_sent_get_local_cid(packet); case L2CAP_EVENT_LE_CAN_SEND_NOW:
printf("L2CAP: LE Data Channel Packet sent0x%02x\n", cid); streamer();
break; break;
#endif
default: default:
break; break;
} }
break; break;
case L2CAP_DATA_PACKET: case L2CAP_DATA_PACKET:
test_track_transferred(&le_data_channel_connection, size); test_track_data(&le_data_channel_connection, size);
break; break;
default: default: