xref: /btstack/port/libusb/main.c (revision 24a31dc7623dcd0979e8b00926f0cc94b91565a9)
18caefee3SMatthias Ringwald /*
28caefee3SMatthias Ringwald  * Copyright (C) 2014 BlueKitchen GmbH
38caefee3SMatthias Ringwald  *
48caefee3SMatthias Ringwald  * Redistribution and use in source and binary forms, with or without
58caefee3SMatthias Ringwald  * modification, are permitted provided that the following conditions
68caefee3SMatthias Ringwald  * are met:
78caefee3SMatthias Ringwald  *
88caefee3SMatthias Ringwald  * 1. Redistributions of source code must retain the above copyright
98caefee3SMatthias Ringwald  *    notice, this list of conditions and the following disclaimer.
108caefee3SMatthias Ringwald  * 2. Redistributions in binary form must reproduce the above copyright
118caefee3SMatthias Ringwald  *    notice, this list of conditions and the following disclaimer in the
128caefee3SMatthias Ringwald  *    documentation and/or other materials provided with the distribution.
138caefee3SMatthias Ringwald  * 3. Neither the name of the copyright holders nor the names of
148caefee3SMatthias Ringwald  *    contributors may be used to endorse or promote products derived
158caefee3SMatthias Ringwald  *    from this software without specific prior written permission.
168caefee3SMatthias Ringwald  * 4. Any redistribution, use, or modification is done solely for
178caefee3SMatthias Ringwald  *    personal benefit and not for any commercial purpose or for
188caefee3SMatthias Ringwald  *    monetary gain.
198caefee3SMatthias Ringwald  *
208caefee3SMatthias Ringwald  * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
218caefee3SMatthias Ringwald  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
228caefee3SMatthias Ringwald  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
232fca4dadSMilanka Ringwald  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN
242fca4dadSMilanka Ringwald  * GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
258caefee3SMatthias Ringwald  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
268caefee3SMatthias Ringwald  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
278caefee3SMatthias Ringwald  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
288caefee3SMatthias Ringwald  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
298caefee3SMatthias Ringwald  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
308caefee3SMatthias Ringwald  * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
318caefee3SMatthias Ringwald  * SUCH DAMAGE.
328caefee3SMatthias Ringwald  *
338caefee3SMatthias Ringwald  * Please inquire about commercial licensing options at
348caefee3SMatthias Ringwald  * [email protected]
358caefee3SMatthias Ringwald  *
368caefee3SMatthias Ringwald  */
378caefee3SMatthias Ringwald 
38f11fd9a9SMatthias Ringwald #define BTSTACK_FILE__ "main.c"
39ab2c6ae4SMatthias Ringwald 
408caefee3SMatthias Ringwald // *****************************************************************************
418caefee3SMatthias Ringwald //
428caefee3SMatthias Ringwald // minimal setup for HCI code
438caefee3SMatthias Ringwald //
448caefee3SMatthias Ringwald // *****************************************************************************
458caefee3SMatthias Ringwald 
468caefee3SMatthias Ringwald #include <stdint.h>
478caefee3SMatthias Ringwald #include <stdio.h>
488caefee3SMatthias Ringwald #include <stdlib.h>
498caefee3SMatthias Ringwald #include <string.h>
50dbc40e82SMatthias Ringwald #include <signal.h>
518caefee3SMatthias Ringwald 
527907f069SMatthias Ringwald #include "btstack_config.h"
538caefee3SMatthias Ringwald 
54f11fd9a9SMatthias Ringwald #include "ble/le_device_db_tlv.h"
55f9563b89SMatthias Ringwald #include "bluetooth_company_id.h"
56f11fd9a9SMatthias Ringwald #include "btstack_audio.h"
57f11fd9a9SMatthias Ringwald #include "btstack_chipset_zephyr.h"
58a98592bcSMatthias Ringwald #include "btstack_debug.h"
59d356a6daSMatthias Ringwald #include "btstack_event.h"
60a98592bcSMatthias Ringwald #include "btstack_memory.h"
6182636622SMatthias Ringwald #include "btstack_run_loop.h"
62b7d596c1SMatthias Ringwald #include "btstack_run_loop_posix.h"
63f11fd9a9SMatthias Ringwald #include "btstack_signal.h"
64f11fd9a9SMatthias Ringwald #include "btstack_stdin.h"
65f11fd9a9SMatthias Ringwald #include "btstack_tlv_posix.h"
66f11fd9a9SMatthias Ringwald #include "classic/btstack_link_key_db_tlv.h"
678caefee3SMatthias Ringwald #include "hal_led.h"
688caefee3SMatthias Ringwald #include "hci.h"
698caefee3SMatthias Ringwald #include "hci_dump.h"
707435ec7bSMatthias Ringwald #include "hci_dump_posix_fs.h"
71c8dfe071SMatthias Ringwald #include "hci_transport.h"
72c8dfe071SMatthias Ringwald #include "hci_transport_usb.h"
7359bdfe96SMatthias Ringwald 
7459bdfe96SMatthias Ringwald #define TLV_DB_PATH_PREFIX "/tmp/btstack_"
7559bdfe96SMatthias Ringwald #define TLV_DB_PATH_POSTFIX ".tlv"
7659bdfe96SMatthias Ringwald static char tlv_db_path[100];
7759bdfe96SMatthias Ringwald static const btstack_tlv_t * tlv_impl;
7859bdfe96SMatthias Ringwald static btstack_tlv_posix_t   tlv_context;
7959bdfe96SMatthias Ringwald static bd_addr_t             local_addr;
808caefee3SMatthias Ringwald 
818caefee3SMatthias Ringwald int btstack_main(int argc, const char * argv[]);
828caefee3SMatthias Ringwald 
83f9563b89SMatthias Ringwald static const uint8_t read_static_address_command_complete_prefix[] = { 0x0e, 0x1b, 0x01, 0x09, 0xfc };
84f9563b89SMatthias Ringwald 
85f9563b89SMatthias Ringwald static bd_addr_t static_address;
86f9563b89SMatthias Ringwald static int using_static_address;
87f9563b89SMatthias Ringwald 
88d356a6daSMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration;
89d356a6daSMatthias Ringwald 
90f11fd9a9SMatthias Ringwald // shutdown
91f11fd9a9SMatthias Ringwald static bool shutdown_triggered;
92f11fd9a9SMatthias Ringwald 
93f9563b89SMatthias Ringwald static void local_version_information_handler(uint8_t * packet){
94f9563b89SMatthias Ringwald     printf("Local version information:\n");
95f9563b89SMatthias Ringwald     uint16_t hci_version    = packet[6];
96f9563b89SMatthias Ringwald     uint16_t hci_revision   = little_endian_read_16(packet, 7);
97f9563b89SMatthias Ringwald     uint16_t lmp_version    = packet[9];
98f9563b89SMatthias Ringwald     uint16_t manufacturer   = little_endian_read_16(packet, 10);
99f9563b89SMatthias Ringwald     uint16_t lmp_subversion = little_endian_read_16(packet, 12);
100f9563b89SMatthias Ringwald     printf("- HCI Version    0x%04x\n", hci_version);
101f9563b89SMatthias Ringwald     printf("- HCI Revision   0x%04x\n", hci_revision);
102f9563b89SMatthias Ringwald     printf("- LMP Version    0x%04x\n", lmp_version);
103f9563b89SMatthias Ringwald     printf("- LMP Subversion 0x%04x\n", lmp_subversion);
104f9563b89SMatthias Ringwald     printf("- Manufacturer 0x%04x\n", manufacturer);
105f9563b89SMatthias Ringwald     switch (manufacturer){
106f9563b89SMatthias Ringwald         case BLUETOOTH_COMPANY_ID_THE_LINUX_FOUNDATION:
107f4ab4581SMatthias Ringwald             printf("- Linux Foundation - assume Zephyr hci_usb firmware running on nRF52xx\n");
108f4ab4581SMatthias Ringwald             // setup Zephyr chipset support
109f9563b89SMatthias Ringwald             hci_set_chipset(btstack_chipset_zephyr_instance());
110f4ab4581SMatthias Ringwald             // sm required to setup static random Bluetooth address
111f4ab4581SMatthias Ringwald             sm_init();
112f9563b89SMatthias Ringwald             break;
113f9563b89SMatthias Ringwald         default:
114f9563b89SMatthias Ringwald             break;
115f9563b89SMatthias Ringwald     }
116f9563b89SMatthias Ringwald }
117f9563b89SMatthias Ringwald 
118d356a6daSMatthias Ringwald static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
1199ec2630cSMatthias Ringwald     UNUSED(channel);
1209ec2630cSMatthias Ringwald     UNUSED(size);
121*24a31dc7SMatthias Ringwald     uint8_t i;
122*24a31dc7SMatthias Ringwald     uint8_t usb_path_len;
123*24a31dc7SMatthias Ringwald     const uint8_t * usb_path;
124*24a31dc7SMatthias Ringwald 
125d356a6daSMatthias Ringwald     if (packet_type != HCI_EVENT_PACKET) return;
126*24a31dc7SMatthias Ringwald 
12759bdfe96SMatthias Ringwald     switch (hci_event_packet_get_type(packet)){
128*24a31dc7SMatthias Ringwald         case HCI_EVENT_TRANSPORT_USB_INFO:
129*24a31dc7SMatthias Ringwald             usb_path_len = hci_event_transport_usb_info_get_path_len(packet);
130*24a31dc7SMatthias Ringwald             usb_path = hci_event_transport_usb_info_get_path(packet);
131*24a31dc7SMatthias Ringwald             // print device path
132*24a31dc7SMatthias Ringwald             printf("USB device 0x%04x/0x%04x, path: ",
133*24a31dc7SMatthias Ringwald                    hci_event_transport_usb_info_get_vendor_id(packet),
134*24a31dc7SMatthias Ringwald                    hci_event_transport_usb_info_get_product_id(packet));
135*24a31dc7SMatthias Ringwald             for (i=0;i<usb_path_len;i++){
136*24a31dc7SMatthias Ringwald                 if (i) printf("-");
137*24a31dc7SMatthias Ringwald                 printf("%02x", usb_path[i]);
138*24a31dc7SMatthias Ringwald             }
139*24a31dc7SMatthias Ringwald             printf("\n");
140*24a31dc7SMatthias Ringwald             break;
14159bdfe96SMatthias Ringwald         case BTSTACK_EVENT_STATE:
142d7b77a0cSMatthias Ringwald             switch (btstack_event_state_get_state(packet)){
143d7b77a0cSMatthias Ringwald                 case HCI_STATE_WORKING:
14459bdfe96SMatthias Ringwald                     gap_local_bd_addr(local_addr);
145f9563b89SMatthias Ringwald                     if (using_static_address){
146f9563b89SMatthias Ringwald                         memcpy(local_addr, static_address, 6);
147f9563b89SMatthias Ringwald                     }
14859bdfe96SMatthias Ringwald                     printf("BTstack up and running on %s.\n", bd_addr_to_str(local_addr));
14959bdfe96SMatthias Ringwald                     strcpy(tlv_db_path, TLV_DB_PATH_PREFIX);
15015d21758SMatthias Ringwald                     strcat(tlv_db_path, bd_addr_to_str_with_delimiter(local_addr, '-'));
15159bdfe96SMatthias Ringwald                     strcat(tlv_db_path, TLV_DB_PATH_POSTFIX);
15259bdfe96SMatthias Ringwald                     tlv_impl = btstack_tlv_posix_init_instance(&tlv_context, tlv_db_path);
15359bdfe96SMatthias Ringwald                     btstack_tlv_set_instance(tlv_impl, &tlv_context);
15481862996SMatthias Ringwald #ifdef ENABLE_CLASSIC
15581862996SMatthias Ringwald                     hci_set_link_key_db(btstack_link_key_db_tlv_get_instance(tlv_impl, &tlv_context));
15681862996SMatthias Ringwald #endif
15781862996SMatthias Ringwald #ifdef ENABLE_BLE
15881862996SMatthias Ringwald                     le_device_db_tlv_configure(tlv_impl, &tlv_context);
15981862996SMatthias Ringwald #endif
16059bdfe96SMatthias Ringwald                     break;
161d7b77a0cSMatthias Ringwald                 case HCI_STATE_OFF:
162d7b77a0cSMatthias Ringwald                     btstack_tlv_posix_deinit(&tlv_context);
163f11fd9a9SMatthias Ringwald                     if (!shutdown_triggered) break;
164f11fd9a9SMatthias Ringwald                     // reset stdin
165f11fd9a9SMatthias Ringwald                     btstack_stdin_reset();
166f11fd9a9SMatthias Ringwald                     log_info("Good bye, see you.\n");
167f11fd9a9SMatthias Ringwald                     exit(0);
168d7b77a0cSMatthias Ringwald                     break;
169d7b77a0cSMatthias Ringwald                 default:
170d7b77a0cSMatthias Ringwald                     break;
171d7b77a0cSMatthias Ringwald             }
172d7b77a0cSMatthias Ringwald             break;
173f9563b89SMatthias Ringwald         case HCI_EVENT_COMMAND_COMPLETE:
174f9563b89SMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_version_information)){
175f9563b89SMatthias Ringwald                 local_version_information_handler(packet);
176f9563b89SMatthias Ringwald             }
177f9563b89SMatthias Ringwald             if (memcmp(packet, read_static_address_command_complete_prefix, sizeof(read_static_address_command_complete_prefix)) == 0){
178f9563b89SMatthias Ringwald                 reverse_48(&packet[7], static_address);
179f9563b89SMatthias Ringwald                 gap_random_address_set(static_address);
180f9563b89SMatthias Ringwald                 using_static_address = 1;
181f9563b89SMatthias Ringwald             }
182f9563b89SMatthias Ringwald             break;
18359bdfe96SMatthias Ringwald         default:
18459bdfe96SMatthias Ringwald             break;
18559bdfe96SMatthias Ringwald     }
186d356a6daSMatthias Ringwald }
187d356a6daSMatthias Ringwald 
188f11fd9a9SMatthias Ringwald static void trigger_shutdown(void){
189b96c8f44SMatthias Ringwald     printf("CTRL-C - SIGINT received, shutting down..\n");
190b96c8f44SMatthias Ringwald     log_info("sigint_handler: shutting down");
191f11fd9a9SMatthias Ringwald     shutdown_triggered = true;
1928caefee3SMatthias Ringwald     hci_power_control(HCI_POWER_OFF);
1938caefee3SMatthias Ringwald }
1948caefee3SMatthias Ringwald 
1958caefee3SMatthias Ringwald static int led_state = 0;
1968caefee3SMatthias Ringwald void hal_led_toggle(void){
1978caefee3SMatthias Ringwald     led_state = 1 - led_state;
1988caefee3SMatthias Ringwald     printf("LED State %u\n", led_state);
1998caefee3SMatthias Ringwald }
2008caefee3SMatthias Ringwald 
201e13e7f54SMatthias Ringwald #define USB_MAX_PATH_LEN 7
2028caefee3SMatthias Ringwald int main(int argc, const char * argv[]){
2038caefee3SMatthias Ringwald 
204e13e7f54SMatthias Ringwald     uint8_t usb_path[USB_MAX_PATH_LEN];
205e13e7f54SMatthias Ringwald     int usb_path_len = 0;
206fb34235aSMatthias Ringwald     const char * usb_path_string = NULL;
207e13e7f54SMatthias Ringwald     if (argc >= 3 && strcmp(argv[1], "-u") == 0){
208e13e7f54SMatthias Ringwald         // parse command line options for "-u 11:22:33"
209fb34235aSMatthias Ringwald         usb_path_string = argv[2];
210e13e7f54SMatthias Ringwald         printf("Specified USB Path: ");
211e13e7f54SMatthias Ringwald         while (1){
212e13e7f54SMatthias Ringwald             char * delimiter;
213fb34235aSMatthias Ringwald             int port = strtol(usb_path_string, &delimiter, 16);
214e13e7f54SMatthias Ringwald             usb_path[usb_path_len] = port;
215e13e7f54SMatthias Ringwald             usb_path_len++;
216e13e7f54SMatthias Ringwald             printf("%02x ", port);
217e13e7f54SMatthias Ringwald             if (!delimiter) break;
218a4c4a5d6SMatthias Ringwald             if (*delimiter != ':' && *delimiter != '-') break;
219fb34235aSMatthias Ringwald             usb_path_string = delimiter+1;
220e13e7f54SMatthias Ringwald         }
221e13e7f54SMatthias Ringwald         printf("\n");
2227c3351a5SMatthias Ringwald         argc -= 2;
223fb34235aSMatthias Ringwald         memmove(&argv[1], &argv[3], (argc-1) * sizeof(char *));
224e13e7f54SMatthias Ringwald     }
225e13e7f54SMatthias Ringwald 
2268caefee3SMatthias Ringwald 	/// GET STARTED with BTstack ///
2278caefee3SMatthias Ringwald 	btstack_memory_init();
228528a4a3bSMatthias Ringwald     btstack_run_loop_init(btstack_run_loop_posix_get_instance());
2298caefee3SMatthias Ringwald 
230e13e7f54SMatthias Ringwald     if (usb_path_len){
231e13e7f54SMatthias Ringwald         hci_transport_usb_set_path(usb_path_len, usb_path);
232e13e7f54SMatthias Ringwald     }
233e13e7f54SMatthias Ringwald 
2347435ec7bSMatthias Ringwald     // log into file using HCI_DUMP_PACKETLOGGER format
23502065453SMatthias Ringwald     char pklg_path[100];
23602065453SMatthias Ringwald     strcpy(pklg_path, "/tmp/hci_dump");
23702065453SMatthias Ringwald     if (usb_path_len){
23802065453SMatthias Ringwald         strcat(pklg_path, "_");
239fb34235aSMatthias Ringwald         strcat(pklg_path, usb_path_string);
24002065453SMatthias Ringwald     }
24102065453SMatthias Ringwald     strcat(pklg_path, ".pklg");
2427435ec7bSMatthias Ringwald     hci_dump_posix_fs_open(pklg_path, HCI_DUMP_PACKETLOGGER);
2437435ec7bSMatthias Ringwald     const hci_dump_t * hci_dump_impl = hci_dump_posix_fs_get_instance();
2447435ec7bSMatthias Ringwald     hci_dump_init(hci_dump_impl);
24502065453SMatthias Ringwald     printf("Packet Log: %s\n", pklg_path);
2468caefee3SMatthias Ringwald 
2478caefee3SMatthias Ringwald     // init HCI
2482d5e09d6SMatthias Ringwald 	hci_init(hci_transport_usb_instance(), NULL);
24935454696SMatthias Ringwald 
250e739af98SMatthias Ringwald #ifdef HAVE_PORTAUDIO
2513d3351f3SMatthias Ringwald     btstack_audio_sink_set_instance(btstack_audio_portaudio_sink_get_instance());
2523d3351f3SMatthias Ringwald     btstack_audio_source_set_instance(btstack_audio_portaudio_source_get_instance());
253e739af98SMatthias Ringwald #endif
254e739af98SMatthias Ringwald 
255d356a6daSMatthias Ringwald     // inform about BTstack state
256d356a6daSMatthias Ringwald     hci_event_callback_registration.callback = &packet_handler;
257d356a6daSMatthias Ringwald     hci_add_event_handler(&hci_event_callback_registration);
258d356a6daSMatthias Ringwald 
259f11fd9a9SMatthias Ringwald     // register callback for CTRL-c
260f11fd9a9SMatthias Ringwald     btstack_signal_register_callback(SIGINT, &trigger_shutdown);
2618caefee3SMatthias Ringwald 
2628caefee3SMatthias Ringwald     // setup app
2638caefee3SMatthias Ringwald     btstack_main(argc, argv);
2648caefee3SMatthias Ringwald 
2658caefee3SMatthias Ringwald     // go
266528a4a3bSMatthias Ringwald     btstack_run_loop_execute();
2678caefee3SMatthias Ringwald 
2688caefee3SMatthias Ringwald     return 0;
2698caefee3SMatthias Ringwald }
270