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