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 73 #define HCI_OPCODE_ZEPHYR_READ_STATIC_ADDRESS 0xFC09 74 const hci_cmd_t hci_zephyr_read_static_address = { 75 HCI_OPCODE_ZEPHYR_READ_STATIC_ADDRESS, "" 76 }; 77 78 #define TLV_DB_PATH_PREFIX "/tmp/btstack_" 79 #define TLV_DB_PATH_POSTFIX ".tlv" 80 static char tlv_db_path[100]; 81 static const btstack_tlv_t * tlv_impl; 82 static btstack_tlv_posix_t tlv_context; 83 84 static btstack_packet_callback_registration_t hci_event_callback_registration; 85 86 static bool is_zephyr; 87 static bool zephyr_read_static_address; 88 static bd_addr_t zephyr_static_address; 89 90 // shutdown 91 static bool shutdown_triggered; 92 93 int btstack_main(int argc, const char * argv[]); 94 static void local_version_information_handler(uint8_t * packet); 95 96 static hci_transport_config_uart_t config = { 97 HCI_TRANSPORT_CONFIG_UART, 98 1000000, 99 0, // main baudrate 100 1, // flow control 101 NULL, 102 }; 103 104 static void setup_tlv(bd_addr_t addr){ 105 printf("BTstack up and running on %s.\n", bd_addr_to_str(addr)); 106 btstack_strcpy(tlv_db_path, sizeof(tlv_db_path), TLV_DB_PATH_PREFIX); 107 btstack_strcat(tlv_db_path, sizeof(tlv_db_path), bd_addr_to_str(addr)); 108 btstack_strcat(tlv_db_path, sizeof(tlv_db_path), TLV_DB_PATH_POSTFIX); 109 tlv_impl = btstack_tlv_posix_init_instance(&tlv_context, tlv_db_path); 110 btstack_tlv_set_instance(tlv_impl, &tlv_context); 111 #ifdef ENABLE_CLASSIC 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 119 static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 120 if (packet_type != HCI_EVENT_PACKET) return; 121 switch (hci_event_packet_get_type(packet)){ 122 case BTSTACK_EVENT_STATE: 123 switch(btstack_event_state_get_state(packet)){ 124 case HCI_STATE_WORKING: 125 if (is_zephyr){ 126 zephyr_read_static_address = true; 127 } else { 128 bd_addr_t local_addr; 129 gap_local_bd_addr(local_addr); 130 setup_tlv(local_addr); 131 } 132 break; 133 case HCI_STATE_OFF: 134 btstack_tlv_posix_deinit(&tlv_context); 135 if (!shutdown_triggered) break; 136 // reset stdin 137 btstack_stdin_reset(); 138 log_info("Good bye, see you.\n"); 139 exit(0); 140 break; 141 default: 142 break; 143 } 144 break; 145 case HCI_EVENT_COMMAND_COMPLETE: 146 switch (hci_event_command_complete_get_command_opcode(packet)){ 147 case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION: 148 local_version_information_handler(packet); 149 break; 150 case HCI_OPCODE_ZEPHYR_READ_STATIC_ADDRESS: 151 reverse_48(&packet[7], zephyr_static_address); 152 gap_random_address_set(zephyr_static_address); 153 setup_tlv(zephyr_static_address); 154 break; 155 default: 156 break; 157 } 158 break; 159 default: 160 break; 161 } 162 163 if (zephyr_read_static_address && hci_can_send_command_packet_now()){ 164 zephyr_read_static_address = false; 165 hci_send_cmd(&hci_zephyr_read_static_address); 166 } 167 } 168 169 static void trigger_shutdown(void){ 170 printf("CTRL-C - SIGINT received, shutting down..\n"); 171 log_info("sigint_handler: shutting down"); 172 shutdown_triggered = true; 173 hci_power_control(HCI_POWER_OFF); 174 } 175 176 static int led_state = 0; 177 void hal_led_toggle(void){ 178 led_state = 1 - led_state; 179 printf("LED State %u\n", led_state); 180 } 181 182 static void local_version_information_handler(uint8_t * packet){ 183 printf("Local version information:\n"); 184 uint16_t hci_version = packet[6]; 185 uint16_t hci_revision = little_endian_read_16(packet, 7); 186 uint16_t lmp_version = packet[9]; 187 uint16_t manufacturer = little_endian_read_16(packet, 10); 188 uint16_t lmp_subversion = little_endian_read_16(packet, 12); 189 printf("- HCI Version 0x%04x\n", hci_version); 190 printf("- HCI Revision 0x%04x\n", hci_revision); 191 printf("- LMP Version 0x%04x\n", lmp_version); 192 printf("- LMP Subversion 0x%04x\n", lmp_subversion); 193 printf("- Manufacturer 0x%04x\n", manufacturer); 194 switch (manufacturer){ 195 case BLUETOOTH_COMPANY_ID_PACKETCRAFT_INC: 196 printf("PacketCraft HCI Controller\n"); 197 break; 198 case BLUETOOTH_COMPANY_ID_THE_LINUX_FOUNDATION: 199 printf("Zephyr HCI Controller\n"); 200 is_zephyr = true; 201 break; 202 default: 203 printf("Unknown manufacturer / manufacturer not supported yet.\n"); 204 break; 205 } 206 } 207 208 int main(int argc, const char * argv[]){ 209 210 /// GET STARTED with BTstack /// 211 btstack_memory_init(); 212 btstack_run_loop_init(btstack_run_loop_posix_get_instance()); 213 214 215 // pre-select serial device 216 config.device_name = "/dev/tty.usbmodemD5D5237DC25B1"; // BL654 with PTS Firmware 217 218 // accept path from command line 219 bool second_device = false; 220 if (argc >= 3 && strcmp(argv[1], "-u") == 0){ 221 config.device_name = argv[2]; 222 second_device = true; 223 argc -= 2; 224 memmove((void *) &argv[1], &argv[3], (argc-1) * sizeof(char *)); 225 } 226 printf("H4 device: %s\n", config.device_name); 227 228 // log into file using HCI_DUMP_BTSNOOP format 229 char * pklg_path = "/tmp/hci_dump.btsnoop"; 230 if (second_device){ 231 pklg_path = "/tmp/hci_dump2.btsnoop"; 232 } 233 hci_dump_posix_fs_open(pklg_path, HCI_DUMP_BTSNOOP); 234 const hci_dump_t * hci_dump_impl = hci_dump_posix_fs_get_instance(); 235 hci_dump_init(hci_dump_impl); 236 printf("Packet Log: %s\n", pklg_path); 237 238 // init HCI 239 const btstack_uart_t * uart_driver = btstack_uart_posix_instance(); 240 const hci_transport_t * transport = hci_transport_h4_instance_for_uart(uart_driver); 241 hci_init(transport, (void*) &config); 242 243 #ifdef HAVE_PORTAUDIO 244 btstack_audio_sink_set_instance(btstack_audio_portaudio_sink_get_instance()); 245 btstack_audio_source_set_instance(btstack_audio_portaudio_source_get_instance()); 246 #endif 247 248 // inform about BTstack state 249 hci_event_callback_registration.callback = &packet_handler; 250 hci_add_event_handler(&hci_event_callback_registration); 251 252 // register callback for CTRL-c 253 btstack_signal_register_callback(SIGINT, &trigger_shutdown); 254 255 // setup app 256 btstack_main(argc, argv); 257 258 // go 259 btstack_run_loop_execute(); 260 261 return 0; 262 } 263