1*1b464e99SMatthias Ringwald /* 2*1b464e99SMatthias Ringwald * Copyright (C) 2019 BlueKitchen GmbH 3*1b464e99SMatthias Ringwald * 4*1b464e99SMatthias Ringwald * Redistribution and use in source and binary forms, with or without 5*1b464e99SMatthias Ringwald * modification, are permitted provided that the following conditions 6*1b464e99SMatthias Ringwald * are met: 7*1b464e99SMatthias Ringwald * 8*1b464e99SMatthias Ringwald * 1. Redistributions of source code must retain the above copyright 9*1b464e99SMatthias Ringwald * notice, this list of conditions and the following disclaimer. 10*1b464e99SMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright 11*1b464e99SMatthias Ringwald * notice, this list of conditions and the following disclaimer in the 12*1b464e99SMatthias Ringwald * documentation and/or other materials provided with the distribution. 13*1b464e99SMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of 14*1b464e99SMatthias Ringwald * contributors may be used to endorse or promote products derived 15*1b464e99SMatthias Ringwald * from this software without specific prior written permission. 16*1b464e99SMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for 17*1b464e99SMatthias Ringwald * personal benefit and not for any commercial purpose or for 18*1b464e99SMatthias Ringwald * monetary gain. 19*1b464e99SMatthias Ringwald * 20*1b464e99SMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 21*1b464e99SMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 22*1b464e99SMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 23*1b464e99SMatthias Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 24*1b464e99SMatthias Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 25*1b464e99SMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 26*1b464e99SMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 27*1b464e99SMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 28*1b464e99SMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 29*1b464e99SMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 30*1b464e99SMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31*1b464e99SMatthias Ringwald * SUCH DAMAGE. 32*1b464e99SMatthias Ringwald * 33*1b464e99SMatthias Ringwald * Please inquire about commercial licensing options at 34*1b464e99SMatthias Ringwald * [email protected] 35*1b464e99SMatthias Ringwald * 36*1b464e99SMatthias Ringwald */ 37*1b464e99SMatthias Ringwald 38*1b464e99SMatthias Ringwald #define __BTSTACK_FILE__ "main.c" 39*1b464e99SMatthias Ringwald 40*1b464e99SMatthias Ringwald // ***************************************************************************** 41*1b464e99SMatthias Ringwald // 42*1b464e99SMatthias Ringwald // minimal setup for HCI code 43*1b464e99SMatthias Ringwald // 44*1b464e99SMatthias Ringwald // ***************************************************************************** 45*1b464e99SMatthias Ringwald 46*1b464e99SMatthias Ringwald #include <QCoreApplication> 47*1b464e99SMatthias Ringwald 48*1b464e99SMatthias Ringwald #include <stdint.h> 49*1b464e99SMatthias Ringwald #include <stdio.h> 50*1b464e99SMatthias Ringwald #include <stdlib.h> 51*1b464e99SMatthias Ringwald #include <string.h> 52*1b464e99SMatthias Ringwald #include <signal.h> 53*1b464e99SMatthias Ringwald 54*1b464e99SMatthias Ringwald #include "btstack_config.h" 55*1b464e99SMatthias Ringwald 56*1b464e99SMatthias Ringwald #include "bluetooth_company_id.h" 57*1b464e99SMatthias Ringwald #include "btstack_debug.h" 58*1b464e99SMatthias Ringwald #include "btstack_event.h" 59*1b464e99SMatthias Ringwald #include "ble/le_device_db_tlv.h" 60*1b464e99SMatthias Ringwald #include "classic/btstack_link_key_db_tlv.h" 61*1b464e99SMatthias Ringwald #include "btstack_memory.h" 62*1b464e99SMatthias Ringwald #include "btstack_run_loop.h" 63*1b464e99SMatthias Ringwald #include "btstack_run_loop_qt.h" 64*1b464e99SMatthias Ringwald #include "hal_led.h" 65*1b464e99SMatthias Ringwald #include "hci.h" 66*1b464e99SMatthias Ringwald #include "hci_dump.h" 67*1b464e99SMatthias Ringwald #include "btstack_stdin.h" 68*1b464e99SMatthias Ringwald #include "btstack_audio.h" 69*1b464e99SMatthias Ringwald #include "btstack_tlv_posix.h" 70*1b464e99SMatthias Ringwald 71*1b464e99SMatthias Ringwald #define TLV_DB_PATH_PREFIX "/tmp/btstack_" 72*1b464e99SMatthias Ringwald #define TLV_DB_PATH_POSTFIX ".tlv" 73*1b464e99SMatthias Ringwald static char tlv_db_path[100]; 74*1b464e99SMatthias Ringwald static const btstack_tlv_t * tlv_impl; 75*1b464e99SMatthias Ringwald static btstack_tlv_posix_t tlv_context; 76*1b464e99SMatthias Ringwald static bd_addr_t local_addr; 77*1b464e99SMatthias Ringwald 78*1b464e99SMatthias Ringwald extern "C" int btstack_main(int argc, const char * argv[]); 79*1b464e99SMatthias Ringwald 80*1b464e99SMatthias Ringwald static const uint8_t read_static_address_command_complete_prefix[] = { 0x0e, 0x1b, 0x01, 0x09, 0xfc }; 81*1b464e99SMatthias Ringwald 82*1b464e99SMatthias Ringwald static bd_addr_t static_address; 83*1b464e99SMatthias Ringwald static int using_static_address; 84*1b464e99SMatthias Ringwald 85*1b464e99SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration; 86*1b464e99SMatthias Ringwald 87*1b464e99SMatthias Ringwald static void local_version_information_handler(uint8_t * packet){ 88*1b464e99SMatthias Ringwald printf("Local version information:\n"); 89*1b464e99SMatthias Ringwald uint16_t hci_version = packet[6]; 90*1b464e99SMatthias Ringwald uint16_t hci_revision = little_endian_read_16(packet, 7); 91*1b464e99SMatthias Ringwald uint16_t lmp_version = packet[9]; 92*1b464e99SMatthias Ringwald uint16_t manufacturer = little_endian_read_16(packet, 10); 93*1b464e99SMatthias Ringwald uint16_t lmp_subversion = little_endian_read_16(packet, 12); 94*1b464e99SMatthias Ringwald printf("- HCI Version 0x%04x\n", hci_version); 95*1b464e99SMatthias Ringwald printf("- HCI Revision 0x%04x\n", hci_revision); 96*1b464e99SMatthias Ringwald printf("- LMP Version 0x%04x\n", lmp_version); 97*1b464e99SMatthias Ringwald printf("- LMP Subversion 0x%04x\n", lmp_subversion); 98*1b464e99SMatthias Ringwald printf("- Manufacturer 0x%04x\n", manufacturer); 99*1b464e99SMatthias Ringwald } 100*1b464e99SMatthias Ringwald 101*1b464e99SMatthias Ringwald static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 102*1b464e99SMatthias Ringwald UNUSED(channel); 103*1b464e99SMatthias Ringwald UNUSED(size); 104*1b464e99SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 105*1b464e99SMatthias Ringwald switch (hci_event_packet_get_type(packet)){ 106*1b464e99SMatthias Ringwald case BTSTACK_EVENT_STATE: 107*1b464e99SMatthias Ringwald if (btstack_event_state_get_state(packet) != HCI_STATE_WORKING) return; 108*1b464e99SMatthias Ringwald gap_local_bd_addr(local_addr); 109*1b464e99SMatthias Ringwald if (using_static_address){ 110*1b464e99SMatthias Ringwald memcpy(local_addr, static_address, 6); 111*1b464e99SMatthias Ringwald } 112*1b464e99SMatthias Ringwald printf("BTstack up and running on %s.\n", bd_addr_to_str(local_addr)); 113*1b464e99SMatthias Ringwald strcpy(tlv_db_path, TLV_DB_PATH_PREFIX); 114*1b464e99SMatthias Ringwald strcat(tlv_db_path, bd_addr_to_str(local_addr)); 115*1b464e99SMatthias Ringwald strcat(tlv_db_path, TLV_DB_PATH_POSTFIX); 116*1b464e99SMatthias Ringwald tlv_impl = btstack_tlv_posix_init_instance(&tlv_context, tlv_db_path); 117*1b464e99SMatthias Ringwald btstack_tlv_set_instance(tlv_impl, &tlv_context); 118*1b464e99SMatthias Ringwald #ifdef ENABLE_CLASSIC 119*1b464e99SMatthias Ringwald hci_set_link_key_db(btstack_link_key_db_tlv_get_instance(tlv_impl, &tlv_context)); 120*1b464e99SMatthias Ringwald #endif 121*1b464e99SMatthias Ringwald #ifdef ENABLE_BLE 122*1b464e99SMatthias Ringwald le_device_db_tlv_configure(tlv_impl, &tlv_context); 123*1b464e99SMatthias Ringwald #endif 124*1b464e99SMatthias Ringwald break; 125*1b464e99SMatthias Ringwald case HCI_EVENT_COMMAND_COMPLETE: 126*1b464e99SMatthias Ringwald if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_version_information)){ 127*1b464e99SMatthias Ringwald local_version_information_handler(packet); 128*1b464e99SMatthias Ringwald } 129*1b464e99SMatthias Ringwald if (memcmp(packet, read_static_address_command_complete_prefix, sizeof(read_static_address_command_complete_prefix)) == 0){ 130*1b464e99SMatthias Ringwald reverse_48(&packet[7], static_address); 131*1b464e99SMatthias Ringwald gap_random_address_set(static_address); 132*1b464e99SMatthias Ringwald using_static_address = 1; 133*1b464e99SMatthias Ringwald } 134*1b464e99SMatthias Ringwald break; 135*1b464e99SMatthias Ringwald default: 136*1b464e99SMatthias Ringwald break; 137*1b464e99SMatthias Ringwald } 138*1b464e99SMatthias Ringwald } 139*1b464e99SMatthias Ringwald 140*1b464e99SMatthias Ringwald static void sigint_handler(int param){ 141*1b464e99SMatthias Ringwald UNUSED(param); 142*1b464e99SMatthias Ringwald 143*1b464e99SMatthias Ringwald printf("CTRL-C - SIGINT received, shutting down..\n"); 144*1b464e99SMatthias Ringwald log_info("sigint_handler: shutting down"); 145*1b464e99SMatthias Ringwald 146*1b464e99SMatthias Ringwald // reset anyway 147*1b464e99SMatthias Ringwald btstack_stdin_reset(); 148*1b464e99SMatthias Ringwald 149*1b464e99SMatthias Ringwald // power down 150*1b464e99SMatthias Ringwald hci_power_control(HCI_POWER_OFF); 151*1b464e99SMatthias Ringwald hci_close(); 152*1b464e99SMatthias Ringwald log_info("Good bye, see you.\n"); 153*1b464e99SMatthias Ringwald exit(0); 154*1b464e99SMatthias Ringwald } 155*1b464e99SMatthias Ringwald 156*1b464e99SMatthias Ringwald static int led_state = 0; 157*1b464e99SMatthias Ringwald void hal_led_toggle(void){ 158*1b464e99SMatthias Ringwald led_state = 1 - led_state; 159*1b464e99SMatthias Ringwald printf("LED State %u\n", led_state); 160*1b464e99SMatthias Ringwald } 161*1b464e99SMatthias Ringwald 162*1b464e99SMatthias Ringwald #define USB_MAX_PATH_LEN 7 163*1b464e99SMatthias Ringwald int btstack_main(int argc, const char * argv[]); 164*1b464e99SMatthias Ringwald 165*1b464e99SMatthias Ringwald int main(int argc, char * argv[]){ 166*1b464e99SMatthias Ringwald 167*1b464e99SMatthias Ringwald uint8_t usb_path[USB_MAX_PATH_LEN]; 168*1b464e99SMatthias Ringwald int usb_path_len = 0; 169*1b464e99SMatthias Ringwald const char * usb_path_string = NULL; 170*1b464e99SMatthias Ringwald if (argc >= 3 && strcmp(argv[1], "-u") == 0){ 171*1b464e99SMatthias Ringwald // parse command line options for "-u 11:22:33" 172*1b464e99SMatthias Ringwald usb_path_string = argv[2]; 173*1b464e99SMatthias Ringwald printf("Specified USB Path: "); 174*1b464e99SMatthias Ringwald while (1){ 175*1b464e99SMatthias Ringwald char * delimiter; 176*1b464e99SMatthias Ringwald int port = strtol(usb_path_string, &delimiter, 16); 177*1b464e99SMatthias Ringwald usb_path[usb_path_len] = port; 178*1b464e99SMatthias Ringwald usb_path_len++; 179*1b464e99SMatthias Ringwald printf("%02x ", port); 180*1b464e99SMatthias Ringwald if (!delimiter) break; 181*1b464e99SMatthias Ringwald if (*delimiter != ':' && *delimiter != '-') break; 182*1b464e99SMatthias Ringwald usb_path_string = delimiter+1; 183*1b464e99SMatthias Ringwald } 184*1b464e99SMatthias Ringwald printf("\n"); 185*1b464e99SMatthias Ringwald argc -= 2; 186*1b464e99SMatthias Ringwald memmove(&argv[1], &argv[3], (argc-1) * sizeof(char *)); 187*1b464e99SMatthias Ringwald } 188*1b464e99SMatthias Ringwald 189*1b464e99SMatthias Ringwald QCoreApplication a(argc, argv); 190*1b464e99SMatthias Ringwald 191*1b464e99SMatthias Ringwald /// GET STARTED with BTstack /// 192*1b464e99SMatthias Ringwald btstack_memory_init(); 193*1b464e99SMatthias Ringwald btstack_run_loop_init(btstack_run_loop_qt_get_instance()); 194*1b464e99SMatthias Ringwald 195*1b464e99SMatthias Ringwald if (usb_path_len){ 196*1b464e99SMatthias Ringwald hci_transport_usb_set_path(usb_path_len, usb_path); 197*1b464e99SMatthias Ringwald } 198*1b464e99SMatthias Ringwald 199*1b464e99SMatthias Ringwald // use logger: format HCI_DUMP_PACKETLOGGER, HCI_DUMP_BLUEZ or HCI_DUMP_STDOUT 200*1b464e99SMatthias Ringwald 201*1b464e99SMatthias Ringwald char pklg_path[100]; 202*1b464e99SMatthias Ringwald strcpy(pklg_path, "/tmp/hci_dump"); 203*1b464e99SMatthias Ringwald if (usb_path_len){ 204*1b464e99SMatthias Ringwald strcat(pklg_path, "_"); 205*1b464e99SMatthias Ringwald strcat(pklg_path, usb_path_string); 206*1b464e99SMatthias Ringwald } 207*1b464e99SMatthias Ringwald strcat(pklg_path, ".pklg"); 208*1b464e99SMatthias Ringwald printf("Packet Log: %s\n", pklg_path); 209*1b464e99SMatthias Ringwald hci_dump_open(pklg_path, HCI_DUMP_PACKETLOGGER); 210*1b464e99SMatthias Ringwald 211*1b464e99SMatthias Ringwald // init HCI 212*1b464e99SMatthias Ringwald hci_init(hci_transport_usb_instance(), NULL); 213*1b464e99SMatthias Ringwald 214*1b464e99SMatthias Ringwald #ifdef HAVE_PORTAUDIO 215*1b464e99SMatthias Ringwald btstack_audio_sink_set_instance(btstack_audio_portaudio_sink_get_instance()); 216*1b464e99SMatthias Ringwald btstack_audio_source_set_instance(btstack_audio_portaudio_source_get_instance()); 217*1b464e99SMatthias Ringwald #endif 218*1b464e99SMatthias Ringwald 219*1b464e99SMatthias Ringwald // inform about BTstack state 220*1b464e99SMatthias Ringwald hci_event_callback_registration.callback = &packet_handler; 221*1b464e99SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 222*1b464e99SMatthias Ringwald 223*1b464e99SMatthias Ringwald // handle CTRL-c 224*1b464e99SMatthias Ringwald signal(SIGINT, sigint_handler); 225*1b464e99SMatthias Ringwald 226*1b464e99SMatthias Ringwald // setup app 227*1b464e99SMatthias Ringwald btstack_main(argc, (const char **) argv); 228*1b464e99SMatthias Ringwald 229*1b464e99SMatthias Ringwald // enter Qt run loop 230*1b464e99SMatthias Ringwald return a.exec(); 231*1b464e99SMatthias Ringwald } 232