main.c (0c608997094b86b83d8b170fab92c8a0e7512b06) | main.c (9c228539c3642b8deb9946ec408199dd181ab24d) |
---|---|
1/* 2 * Copyright (C) 2014 BlueKitchen GmbH 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions 6 * are met: 7 * 8 * 1. Redistributions of source code must retain the above copyright --- 34 unchanged lines hidden (view full) --- 43// 44// ***************************************************************************** 45 46#include <stdint.h> 47#include <stdio.h> 48#include <stdlib.h> 49#include <string.h> 50#include <signal.h> | 1/* 2 * Copyright (C) 2014 BlueKitchen GmbH 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions 6 * are met: 7 * 8 * 1. Redistributions of source code must retain the above copyright --- 34 unchanged lines hidden (view full) --- 43// 44// ***************************************************************************** 45 46#include <stdint.h> 47#include <stdio.h> 48#include <stdlib.h> 49#include <string.h> 50#include <signal.h> |
51#include <limits.h> 52#include <libgen.h> |
|
51 52#include "btstack_config.h" 53 54#include "ble/le_device_db_tlv.h" 55#include "bluetooth_company_id.h" 56#include "btstack_audio.h" 57#include "btstack_debug.h" 58#include "btstack_event.h" --- 6 unchanged lines hidden (view full) --- 65#include "btstack_uart.h" 66#include "classic/btstack_link_key_db_tlv.h" 67#include "hci.h" 68#include "hci_dump.h" 69#include "hci_dump_posix_fs.h" 70#include "hci_transport.h" 71#include "hci_transport_h4.h" 72#include "btstack_chipset_bcm.h" | 53 54#include "btstack_config.h" 55 56#include "ble/le_device_db_tlv.h" 57#include "bluetooth_company_id.h" 58#include "btstack_audio.h" 59#include "btstack_debug.h" 60#include "btstack_event.h" --- 6 unchanged lines hidden (view full) --- 67#include "btstack_uart.h" 68#include "classic/btstack_link_key_db_tlv.h" 69#include "hci.h" 70#include "hci_dump.h" 71#include "hci_dump_posix_fs.h" 72#include "hci_transport.h" 73#include "hci_transport_h4.h" 74#include "btstack_chipset_bcm.h" |
75#include "btstack_chipset_zephyr.h" |
|
73 | 76 |
74#define HCI_OPCODE_ZEPHYR_READ_STATIC_ADDRESS 0xFC09 75const hci_cmd_t hci_zephyr_read_static_address = { 76 HCI_OPCODE_ZEPHYR_READ_STATIC_ADDRESS, "" 77}; 78 | |
79#define TLV_DB_PATH_PREFIX "/tmp/btstack_" 80#define TLV_DB_PATH_POSTFIX ".tlv" 81static char tlv_db_path[100]; 82static const btstack_tlv_t * tlv_impl; 83static btstack_tlv_posix_t tlv_context; 84 85static btstack_packet_callback_registration_t hci_event_callback_registration; 86 | 77#define TLV_DB_PATH_PREFIX "/tmp/btstack_" 78#define TLV_DB_PATH_POSTFIX ".tlv" 79static char tlv_db_path[100]; 80static const btstack_tlv_t * tlv_impl; 81static btstack_tlv_posix_t tlv_context; 82 83static btstack_packet_callback_registration_t hci_event_callback_registration; 84 |
87static bool is_zephyr; 88static bool zephyr_read_static_address; 89static bd_addr_t zephyr_static_address; | 85static bd_addr_t static_address; |
90 | 86 |
87// random MAC address for the device, used if nothing else is available 88static const bd_addr_t random_address = { 0xC1, 0x01, 0x01, 0x01, 0x01, 0x01 }; 89 |
|
91// shutdown 92static bool shutdown_triggered; 93 94int btstack_main(int argc, const char * argv[]); 95static void local_version_information_handler(uint8_t * packet); 96 97static hci_transport_config_uart_t config = { 98 HCI_TRANSPORT_CONFIG_UART, --- 14 unchanged lines hidden (view full) --- 113 hci_set_link_key_db(btstack_link_key_db_tlv_get_instance(tlv_impl, &tlv_context)); 114#endif 115#ifdef ENABLE_BLE 116 le_device_db_tlv_configure(tlv_impl, &tlv_context); 117#endif 118} 119 120static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ | 90// shutdown 91static bool shutdown_triggered; 92 93int btstack_main(int argc, const char * argv[]); 94static void local_version_information_handler(uint8_t * packet); 95 96static hci_transport_config_uart_t config = { 97 HCI_TRANSPORT_CONFIG_UART, --- 14 unchanged lines hidden (view full) --- 112 hci_set_link_key_db(btstack_link_key_db_tlv_get_instance(tlv_impl, &tlv_context)); 113#endif 114#ifdef ENABLE_BLE 115 le_device_db_tlv_configure(tlv_impl, &tlv_context); 116#endif 117} 118 119static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ |
120 bd_addr_t local_addr; 121 const uint8_t *params; |
|
121 if (packet_type != HCI_EVENT_PACKET) return; 122 switch (hci_event_packet_get_type(packet)){ 123 case BTSTACK_EVENT_STATE: 124 switch(btstack_event_state_get_state(packet)){ 125 case HCI_STATE_WORKING: | 122 if (packet_type != HCI_EVENT_PACKET) return; 123 switch (hci_event_packet_get_type(packet)){ 124 case BTSTACK_EVENT_STATE: 125 switch(btstack_event_state_get_state(packet)){ 126 case HCI_STATE_WORKING: |
126 if (is_zephyr){ 127 zephyr_read_static_address = true; 128 } else { 129 bd_addr_t local_addr; 130 gap_local_bd_addr(local_addr); 131 setup_tlv(local_addr); | 127 gap_local_bd_addr(local_addr); 128 if( btstack_is_null_bd_addr(local_addr) && !btstack_is_null_bd_addr(static_address) ) { 129 memcpy(local_addr, static_address, sizeof(bd_addr_t)); 130 } else if( btstack_is_null_bd_addr(local_addr ) && btstack_is_null_bd_addr(static_address) ) { 131 memcpy(local_addr, random_address, sizeof(bd_addr_t)); 132 gap_random_address_set(local_addr); |
132 } | 133 } |
134 setup_tlv(local_addr); |
|
133 break; 134 case HCI_STATE_OFF: 135 btstack_tlv_posix_deinit(&tlv_context); 136 if (!shutdown_triggered) break; 137 // reset stdin 138 btstack_stdin_reset(); 139 log_info("Good bye, see you.\n"); 140 exit(0); 141 break; 142 default: | 135 break; 136 case HCI_STATE_OFF: 137 btstack_tlv_posix_deinit(&tlv_context); 138 if (!shutdown_triggered) break; 139 // reset stdin 140 btstack_stdin_reset(); 141 log_info("Good bye, see you.\n"); 142 exit(0); 143 break; 144 default: |
143 break; | 145 break; |
144 } 145 break; 146 case HCI_EVENT_COMMAND_COMPLETE: 147 switch (hci_event_command_complete_get_command_opcode(packet)){ 148 case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION: 149 local_version_information_handler(packet); 150 break; | 146 } 147 break; 148 case HCI_EVENT_COMMAND_COMPLETE: 149 switch (hci_event_command_complete_get_command_opcode(packet)){ 150 case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION: 151 local_version_information_handler(packet); 152 break; |
151 case HCI_OPCODE_ZEPHYR_READ_STATIC_ADDRESS: 152 reverse_48(&packet[7], zephyr_static_address); 153 gap_random_address_set(zephyr_static_address); 154 setup_tlv(zephyr_static_address); | 153 case HCI_OPCODE_HCI_ZEPHYR_READ_STATIC_ADDRESS: 154 params = hci_event_command_complete_get_return_parameters(packet); 155 if(params[0] != 0) 156 break; 157 if(size < 13) 158 break; 159 reverse_48(¶ms[2], static_address); 160 gap_random_address_set(static_address); |
155 break; 156 default: 157 break; 158 } 159 break; 160 default: 161 break; 162 } | 161 break; 162 default: 163 break; 164 } 165 break; 166 default: 167 break; 168 } |
163 164 if (zephyr_read_static_address && hci_can_send_command_packet_now()){ 165 zephyr_read_static_address = false; 166 hci_send_cmd(&hci_zephyr_read_static_address); 167 } | |
168} 169 170static void trigger_shutdown(void){ 171 printf("CTRL-C - SIGINT received, shutting down..\n"); 172 log_info("sigint_handler: shutting down"); 173 shutdown_triggered = true; 174 hci_power_control(HCI_POWER_OFF); 175} --- 17 unchanged lines hidden (view full) --- 193 printf("- LMP Subversion 0x%04x\n", lmp_subversion); 194 printf("- Manufacturer 0x%04x\n", manufacturer); 195 switch (manufacturer){ 196 case BLUETOOTH_COMPANY_ID_PACKETCRAFT_INC: 197 printf("PacketCraft HCI Controller\n"); 198 break; 199 case BLUETOOTH_COMPANY_ID_THE_LINUX_FOUNDATION: 200 printf("Zephyr HCI Controller\n"); | 169} 170 171static void trigger_shutdown(void){ 172 printf("CTRL-C - SIGINT received, shutting down..\n"); 173 log_info("sigint_handler: shutting down"); 174 shutdown_triggered = true; 175 hci_power_control(HCI_POWER_OFF); 176} --- 17 unchanged lines hidden (view full) --- 194 printf("- LMP Subversion 0x%04x\n", lmp_subversion); 195 printf("- Manufacturer 0x%04x\n", manufacturer); 196 switch (manufacturer){ 197 case BLUETOOTH_COMPANY_ID_PACKETCRAFT_INC: 198 printf("PacketCraft HCI Controller\n"); 199 break; 200 case BLUETOOTH_COMPANY_ID_THE_LINUX_FOUNDATION: 201 printf("Zephyr HCI Controller\n"); |
201 is_zephyr = true; | 202 printf("WARNING - untested probably won't work!\n"); 203 hci_set_chipset(btstack_chipset_zephyr_instance()); |
202 break; 203 case BLUETOOTH_COMPANY_ID_INFINEON_TECHNOLOGIES_AG: 204 case BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION: 205 printf("Broadcom/Cypress/Infineon Controller\n"); 206 config.baudrate_main = 921600; 207 hci_set_chipset(btstack_chipset_bcm_instance()); 208 break; 209 default: 210 printf("Unknown manufacturer / manufacturer not supported yet.\n"); 211 break; 212 } 213} 214 215int main(int argc, const char * argv[]){ 216 217 /// GET STARTED with BTstack /// 218 btstack_memory_init(); 219 btstack_run_loop_init(btstack_run_loop_posix_get_instance()); | 204 break; 205 case BLUETOOTH_COMPANY_ID_INFINEON_TECHNOLOGIES_AG: 206 case BLUETOOTH_COMPANY_ID_BROADCOM_CORPORATION: 207 printf("Broadcom/Cypress/Infineon Controller\n"); 208 config.baudrate_main = 921600; 209 hci_set_chipset(btstack_chipset_bcm_instance()); 210 break; 211 default: 212 printf("Unknown manufacturer / manufacturer not supported yet.\n"); 213 break; 214 } 215} 216 217int main(int argc, const char * argv[]){ 218 219 /// GET STARTED with BTstack /// 220 btstack_memory_init(); 221 btstack_run_loop_init(btstack_run_loop_posix_get_instance()); |
220 | |
221 222 // pre-select serial device 223 config.device_name = "/dev/tty.usbmodemEA7EB9D612C31"; // BL654 with PTS Firmware 224 225 // accept path from command line 226 bool second_device = false; 227 if (argc >= 3 && strcmp(argv[1], "-u") == 0){ 228 config.device_name = argv[2]; 229 second_device = true; 230 argc -= 2; 231 memmove((void *) &argv[1], &argv[3], (argc-1) * sizeof(char *)); 232 } 233 printf("H4 device: %s\n", config.device_name); 234 235 // log into file using HCI_DUMP_BTSNOOP format | 222 223 // pre-select serial device 224 config.device_name = "/dev/tty.usbmodemEA7EB9D612C31"; // BL654 with PTS Firmware 225 226 // accept path from command line 227 bool second_device = false; 228 if (argc >= 3 && strcmp(argv[1], "-u") == 0){ 229 config.device_name = argv[2]; 230 second_device = true; 231 argc -= 2; 232 memmove((void *) &argv[1], &argv[3], (argc-1) * sizeof(char *)); 233 } 234 printf("H4 device: %s\n", config.device_name); 235 236 // log into file using HCI_DUMP_BTSNOOP format |
236 char * pklg_path = "/tmp/hci_dump.btsnoop"; 237 if (strcmp(config.device_name, "/dev/tty.usbmodemEF437DF524C51") == 0){ 238 pklg_path = "/tmp/hci_dump_source.btsnoop"; 239 } 240 if (strcmp(config.device_name, "/dev/tty.usbmodemE6589B44933B1") == 0){ 241 pklg_path = "/tmp/hci_dump_sink.btsnoop"; 242 } | 237 char *app_name = strndup( argv[0], PATH_MAX ); 238 char *base_name = basename( app_name ); 239 const char *pklg_postfix = ".btsnoop"; 240 char pklg_path[PATH_MAX] = "/tmp/hci_dump_"; 241 242 btstack_strcat( pklg_path, sizeof(pklg_path), base_name ); 243 btstack_strcat( pklg_path, sizeof(pklg_path), pklg_postfix ); 244 free( app_name ); 245 |
243 hci_dump_posix_fs_open(pklg_path, HCI_DUMP_BTSNOOP); 244 const hci_dump_t * hci_dump_impl = hci_dump_posix_fs_get_instance(); 245 hci_dump_init(hci_dump_impl); 246 printf("Packet Log: %s\n", pklg_path); 247 248 // init HCI 249 const btstack_uart_t * uart_driver = btstack_uart_posix_instance(); 250 const hci_transport_t * transport = hci_transport_h4_instance_for_uart(uart_driver); --- 10 unchanged lines hidden (view full) --- 261 262 // register callback for CTRL-c 263 btstack_signal_register_callback(SIGINT, &trigger_shutdown); 264 265 // setup app 266 btstack_main(argc, argv); 267 268 // go | 246 hci_dump_posix_fs_open(pklg_path, HCI_DUMP_BTSNOOP); 247 const hci_dump_t * hci_dump_impl = hci_dump_posix_fs_get_instance(); 248 hci_dump_init(hci_dump_impl); 249 printf("Packet Log: %s\n", pklg_path); 250 251 // init HCI 252 const btstack_uart_t * uart_driver = btstack_uart_posix_instance(); 253 const hci_transport_t * transport = hci_transport_h4_instance_for_uart(uart_driver); --- 10 unchanged lines hidden (view full) --- 264 265 // register callback for CTRL-c 266 btstack_signal_register_callback(SIGINT, &trigger_shutdown); 267 268 // setup app 269 btstack_main(argc, argv); 270 271 // go |
269 btstack_run_loop_execute(); | 272 btstack_run_loop_execute(); |
270 271 return 0; 272} | 273 274 return 0; 275} |