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 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. Neither the name of the copyright holders nor the names of 14 * contributors may be used to endorse or promote products derived 15 * from this software without specific prior written permission. 16 * 4. Any redistribution, use, or modification is done solely for 17 * personal benefit and not for any commercial purpose or for 18 * monetary gain. 19 * 20 * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 21 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 22 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 23 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN 24 * GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 25 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 26 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 27 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 28 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 29 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 30 * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31 * SUCH DAMAGE. 32 * 33 * Please inquire about commercial licensing options at 34 * [email protected] 35 * 36 */ 37 38 #define BTSTACK_FILE__ "main.c" 39 40 // ***************************************************************************** 41 // 42 // minimal setup for HCI code 43 // 44 // ***************************************************************************** 45 46 #include <stdint.h> 47 #include <stdio.h> 48 #include <stdlib.h> 49 #include <string.h> 50 #include <signal.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" 59 #include "btstack_memory.h" 60 #include "btstack_run_loop.h" 61 #include "btstack_run_loop_posix.h" 62 #include "btstack_signal.h" 63 #include "btstack_stdin.h" 64 #include "btstack_tlv_posix.h" 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" 73 74 #define HCI_OPCODE_ZEPHYR_READ_STATIC_ADDRESS 0xFC09 75 const 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" 81 static char tlv_db_path[100]; 82 static const btstack_tlv_t * tlv_impl; 83 static btstack_tlv_posix_t tlv_context; 84 85 static btstack_packet_callback_registration_t hci_event_callback_registration; 86 87 static bool is_zephyr; 88 static bool zephyr_read_static_address; 89 static bd_addr_t zephyr_static_address; 90 91 // shutdown 92 static bool shutdown_triggered; 93 94 int btstack_main(int argc, const char * argv[]); 95 static void local_version_information_handler(uint8_t * packet); 96 97 static hci_transport_config_uart_t config = { 98 HCI_TRANSPORT_CONFIG_UART, 99 115200, 100 0, // main baudrate 101 1, // flow control 102 NULL, 103 }; 104 105 static void setup_tlv(bd_addr_t addr){ 106 printf("BTstack up and running on %s.\n", bd_addr_to_str(addr)); 107 btstack_strcpy(tlv_db_path, sizeof(tlv_db_path), TLV_DB_PATH_PREFIX); 108 btstack_strcat(tlv_db_path, sizeof(tlv_db_path), bd_addr_to_str(addr)); 109 btstack_strcat(tlv_db_path, sizeof(tlv_db_path), TLV_DB_PATH_POSTFIX); 110 tlv_impl = btstack_tlv_posix_init_instance(&tlv_context, tlv_db_path); 111 btstack_tlv_set_instance(tlv_impl, &tlv_context); 112 #ifdef ENABLE_CLASSIC 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 120 static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 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: 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); 132 } 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: 143 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; 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); 155 break; 156 default: 157 break; 158 } 159 break; 160 default: 161 break; 162 } 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 170 static 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 } 176 177 static int led_state = 0; 178 void hal_led_toggle(void){ 179 led_state = 1 - led_state; 180 printf("LED State %u\n", led_state); 181 } 182 183 static void local_version_information_handler(uint8_t * packet){ 184 printf("Local version information:\n"); 185 uint16_t hci_version = packet[6]; 186 uint16_t hci_revision = little_endian_read_16(packet, 7); 187 uint16_t lmp_version = packet[9]; 188 uint16_t manufacturer = little_endian_read_16(packet, 10); 189 uint16_t lmp_subversion = little_endian_read_16(packet, 12); 190 printf("- HCI Version 0x%04x\n", hci_version); 191 printf("- HCI Revision 0x%04x\n", hci_revision); 192 printf("- LMP Version 0x%04x\n", lmp_version); 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"); 201 is_zephyr = true; 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 215 int 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()); 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 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 } 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); 251 hci_init(transport, (void*) &config); 252 253 #ifdef HAVE_PORTAUDIO 254 btstack_audio_sink_set_instance(btstack_audio_portaudio_sink_get_instance()); 255 btstack_audio_source_set_instance(btstack_audio_portaudio_source_get_instance()); 256 #endif 257 258 // inform about BTstack state 259 hci_event_callback_registration.callback = &packet_handler; 260 hci_add_event_handler(&hci_event_callback_registration); 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 269 btstack_run_loop_execute(); 270 271 return 0; 272 } 273