mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-04-09 21:45:54 +00:00
Code Issues Packages Projects Releases Wiki Activity

test/le_audio: read nRF5x static address after detecting Zephyr Controller

Browse Source
This commit is contained in:
Matthias Ringwald 2022-03-24 20:25:03 +01:00
parent 944898fe9c
commit 0fad7dbeef
1 changed files with 33 additions and 22 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

55
test/le_audio/main.c
View File

@ -54,7 +54,6 @@
#include "ble/le_device_db_tlv.h" #include "ble/le_device_db_tlv.h"
#include "bluetooth_company_id.h" #include "bluetooth_company_id.h"
#include "btstack_audio.h" #include "btstack_audio.h"
#include "btstack_chipset_zephyr.h"
#include "btstack_debug.h" #include "btstack_debug.h"
#include "btstack_event.h" #include "btstack_event.h"
#include "btstack_memory.h" #include "btstack_memory.h"
@ -71,20 +70,22 @@
#include "hci_transport.h" #include "hci_transport.h"
#include "hci_transport_h4.h" #include "hci_transport_h4.h"
#define HCI_OPCODE_ZEPHYR_READ_STATIC_ADDRESS 0xFC09
const hci_cmd_t hci_zephyr_read_static_address = {
HCI_OPCODE_ZEPHYR_READ_STATIC_ADDRESS, ""
};
#define TLV_DB_PATH_PREFIX "/tmp/btstack_" #define TLV_DB_PATH_PREFIX "/tmp/btstack_"
#define TLV_DB_PATH_POSTFIX ".tlv" #define TLV_DB_PATH_POSTFIX ".tlv"
static char tlv_db_path[100]; static char tlv_db_path[100];
static const btstack_tlv_t * tlv_impl; static const btstack_tlv_t * tlv_impl;
static btstack_tlv_posix_t tlv_context; static btstack_tlv_posix_t tlv_context;
static bd_addr_t local_addr;
static const uint8_t read_static_address_command_complete_prefix[] = { 0x0e, 0x1b, 0x01, 0x09, 0xfc };
static bd_addr_t static_address;
static btstack_packet_callback_registration_t hci_event_callback_registration; static btstack_packet_callback_registration_t hci_event_callback_registration;
static bool is_zephyr; static bool is_zephyr;
static bool zephyr_read_static_address;
static bd_addr_t zephyr_static_address;
// shutdown // shutdown
static bool shutdown_triggered; static bool shutdown_triggered;
@ -100,6 +101,21 @@ static hci_transport_config_uart_t config = {
NULL, NULL,
}; };
static void setup_tlv(bd_addr_t addr){
printf("BTstack up and running on %s.\n", bd_addr_to_str(addr));
strcpy(tlv_db_path, TLV_DB_PATH_PREFIX);
strcat(tlv_db_path, bd_addr_to_str(addr));
strcat(tlv_db_path, TLV_DB_PATH_POSTFIX);
tlv_impl = btstack_tlv_posix_init_instance(&tlv_context, tlv_db_path);
btstack_tlv_set_instance(tlv_impl, &tlv_context);
#ifdef ENABLE_CLASSIC
hci_set_link_key_db(btstack_link_key_db_tlv_get_instance(tlv_impl, &tlv_context));
#endif
#ifdef ENABLE_BLE
le_device_db_tlv_configure(tlv_impl, &tlv_context);
#endif
}
static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
if (packet_type != HCI_EVENT_PACKET) return; if (packet_type != HCI_EVENT_PACKET) return;
switch (hci_event_packet_get_type(packet)){ switch (hci_event_packet_get_type(packet)){
@ -107,22 +123,12 @@ static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *pack
switch(btstack_event_state_get_state(packet)){ switch(btstack_event_state_get_state(packet)){
case HCI_STATE_WORKING: case HCI_STATE_WORKING:
if (is_zephyr){ if (is_zephyr){
memcpy(local_addr, static_address, 6); zephyr_read_static_address = true;
} else { } else {
bd_addr_t local_addr;
gap_local_bd_addr(local_addr); gap_local_bd_addr(local_addr);
setup_tlv(local_addr);
} }
printf("BTstack up and running on %s.\n", bd_addr_to_str(local_addr));
strcpy(tlv_db_path, TLV_DB_PATH_PREFIX);
strcat(tlv_db_path, bd_addr_to_str(local_addr));
strcat(tlv_db_path, TLV_DB_PATH_POSTFIX);
tlv_impl = btstack_tlv_posix_init_instance(&tlv_context, tlv_db_path);
btstack_tlv_set_instance(tlv_impl, &tlv_context);
#ifdef ENABLE_CLASSIC
hci_set_link_key_db(btstack_link_key_db_tlv_get_instance(tlv_impl, &tlv_context));
#endif
#ifdef ENABLE_BLE
le_device_db_tlv_configure(tlv_impl, &tlv_context);
#endif
break; break;
case HCI_STATE_OFF: case HCI_STATE_OFF:
btstack_tlv_posix_deinit(&tlv_context); btstack_tlv_posix_deinit(&tlv_context);
@ -146,14 +152,20 @@ static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *pack
if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_version_information)){ if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_version_information)){
local_version_information_handler(packet); local_version_information_handler(packet);
} }
if (memcmp(packet, read_static_address_command_complete_prefix, sizeof(read_static_address_command_complete_prefix)) == 0){ if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_zephyr_read_static_address)){
reverse_48(&packet[7], static_address); reverse_48(&packet[7], zephyr_static_address);
gap_random_address_set(static_address); gap_random_address_set(zephyr_static_address);
setup_tlv(zephyr_static_address);
} }
break; break;
default: default:
break; break;
} }
if (zephyr_read_static_address && hci_can_send_command_packet_now()){
zephyr_read_static_address = false;
hci_send_cmd(&hci_zephyr_read_static_address);
}
} }
static void trigger_shutdown(void){ static void trigger_shutdown(void){
@ -229,7 +241,6 @@ int main(int argc, const char * argv[]){
const btstack_uart_t * uart_driver = btstack_uart_posix_instance(); const btstack_uart_t * uart_driver = btstack_uart_posix_instance();
const hci_transport_t * transport = hci_transport_h4_instance_for_uart(uart_driver); const hci_transport_t * transport = hci_transport_h4_instance_for_uart(uart_driver);
hci_init(transport, (void*) &config); hci_init(transport, (void*) &config);
hci_set_chipset(btstack_chipset_zephyr_instance());
#ifdef HAVE_PORTAUDIO #ifdef HAVE_PORTAUDIO
btstack_audio_sink_set_instance(btstack_audio_portaudio_sink_get_instance()); btstack_audio_sink_set_instance(btstack_audio_portaudio_sink_get_instance());