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 strcpy(tlv_db_path, TLV_DB_PATH_PREFIX); 107 strcat(tlv_db_path, bd_addr_to_str(addr)); 108 strcat(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 if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_name)){ 147 if (hci_event_command_complete_get_return_parameters(packet)[0]) break; 148 // terminate, name 248 chars 149 packet[6+248] = 0; 150 printf("Local name: %s\n", &packet[6]); 151 } 152 if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_version_information)){ 153 local_version_information_handler(packet); 154 } 155 if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_zephyr_read_static_address)){ 156 reverse_48(&packet[7], zephyr_static_address); 157 gap_random_address_set(zephyr_static_address); 158 setup_tlv(zephyr_static_address); 159 } 160 break; 161 default: 162 break; 163 } 164 165 if (zephyr_read_static_address && hci_can_send_command_packet_now()){ 166 zephyr_read_static_address = false; 167 hci_send_cmd(&hci_zephyr_read_static_address); 168 } 169 } 170 171 static 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 } 177 178 static int led_state = 0; 179 void hal_led_toggle(void){ 180 led_state = 1 - led_state; 181 printf("LED State %u\n", led_state); 182 } 183 184 static void local_version_information_handler(uint8_t * packet){ 185 printf("Local version information:\n"); 186 uint16_t hci_version = packet[6]; 187 uint16_t hci_revision = little_endian_read_16(packet, 7); 188 uint16_t lmp_version = packet[9]; 189 uint16_t manufacturer = little_endian_read_16(packet, 10); 190 uint16_t lmp_subversion = little_endian_read_16(packet, 12); 191 printf("- HCI Version 0x%04x\n", hci_version); 192 printf("- HCI Revision 0x%04x\n", hci_revision); 193 printf("- LMP Version 0x%04x\n", lmp_version); 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"); 202 is_zephyr = true; 203 break; 204 default: 205 printf("Unknown manufacturer / manufacturer not supported yet.\n"); 206 break; 207 } 208 } 209 210 int main(int argc, const char * argv[]){ 211 212 /// GET STARTED with BTstack /// 213 btstack_memory_init(); 214 btstack_run_loop_init(btstack_run_loop_posix_get_instance()); 215 216 217 // pre-select serial device 218 config.device_name = "/dev/tty.usbmodemD5D5237DC25B1"; // BL654 with PTS Firmware 219 220 // accept path from command line 221 bool second_device = false; 222 if (argc >= 3 && strcmp(argv[1], "-u") == 0){ 223 config.device_name = argv[2]; 224 second_device = true; 225 argc -= 2; 226 memmove(&argv[1], &argv[3], (argc-1) * sizeof(char *)); 227 } 228 printf("H4 device: %s\n", config.device_name); 229 230 // log into file using HCI_DUMP_BTSNOOP format 231 char * pklg_path = "/tmp/hci_dump.btsnoop"; 232 if (second_device){ 233 pklg_path = "/tmp/hci_dump2.btsnoop"; 234 } 235 hci_dump_posix_fs_open(pklg_path, HCI_DUMP_BTSNOOP); 236 const hci_dump_t * hci_dump_impl = hci_dump_posix_fs_get_instance(); 237 hci_dump_init(hci_dump_impl); 238 printf("Packet Log: %s\n", pklg_path); 239 240 // init HCI 241 const btstack_uart_t * uart_driver = btstack_uart_posix_instance(); 242 const hci_transport_t * transport = hci_transport_h4_instance_for_uart(uart_driver); 243 hci_init(transport, (void*) &config); 244 245 #ifdef HAVE_PORTAUDIO 246 btstack_audio_sink_set_instance(btstack_audio_portaudio_sink_get_instance()); 247 btstack_audio_source_set_instance(btstack_audio_portaudio_source_get_instance()); 248 #endif 249 250 // inform about BTstack state 251 hci_event_callback_registration.callback = &packet_handler; 252 hci_add_event_handler(&hci_event_callback_registration); 253 254 // register callback for CTRL-c 255 btstack_signal_register_callback(SIGINT, &trigger_shutdown); 256 257 // setup app 258 btstack_main(argc, argv); 259 260 // go 261 btstack_run_loop_execute(); 262 263 return 0; 264 } 265