xref: /btstack/test/security_manager_sc/main.c (revision b29e92f97ffd81bc8a1057634c8d1552fc963a6a)
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 MATTHIAS
24  * RINGWALD 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 "bluetooth_company_id.h"
55 #include "btstack_debug.h"
56 #include "btstack_event.h"
57 #include "ble/le_device_db_tlv.h"
58 #include "classic/btstack_link_key_db_tlv.h"
59 #include "btstack_memory.h"
60 #include "btstack_run_loop.h"
61 #include "btstack_run_loop_posix.h"
62 #include "hal_led.h"
63 #include "hci.h"
64 #include "hci_transport.h"
65 #include "hci_transport_usb.h"
66 #include "hci_dump.h"
67 #include "hci_dump_posix_fs.h"
68 #include "btstack_stdin.h"
69 #include "btstack_audio.h"
70 #include "btstack_tlv_posix.h"
71 #include "btstack_chipset_zephyr.h"
72 
73 #define TLV_DB_PATH_PREFIX "/tmp/btstack_"
74 #define TLV_DB_PATH_POSTFIX ".tlv"
75 static char tlv_db_path[100];
76 static const btstack_tlv_t * tlv_impl;
77 static btstack_tlv_posix_t   tlv_context;
78 static bd_addr_t             local_addr;
79 
80 int btstack_main(int argc, const char * argv[]);
81 
82 static const uint8_t read_static_address_command_complete_prefix[] = { 0x0e, 0x1b, 0x01, 0x09, 0xfc };
83 
84 static bd_addr_t static_address;
85 static int using_static_address;
86 
87 static btstack_packet_callback_registration_t hci_event_callback_registration;
88 
89 static void local_version_information_handler(uint8_t * packet){
90     printf("Local version information:\n");
91     uint16_t hci_version    = packet[6];
92     uint16_t hci_revision   = little_endian_read_16(packet, 7);
93     uint16_t lmp_version    = packet[9];
94     uint16_t manufacturer   = little_endian_read_16(packet, 10);
95     uint16_t lmp_subversion = little_endian_read_16(packet, 12);
96     printf("- HCI Version    0x%04x\n", hci_version);
97     printf("- HCI Revision   0x%04x\n", hci_revision);
98     printf("- LMP Version    0x%04x\n", lmp_version);
99     printf("- LMP Subversion 0x%04x\n", lmp_subversion);
100     printf("- Manufacturer 0x%04x\n", manufacturer);
101     switch (manufacturer){
102         case BLUETOOTH_COMPANY_ID_THE_LINUX_FOUNDATION:
103             printf("Linux Foundation - assume Zephyr hci_usb example running on nRF52xx\n");
104             hci_set_chipset(btstack_chipset_zephyr_instance());
105             break;
106         default:
107             break;
108     }
109 }
110 
111 static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
112     UNUSED(channel);
113     UNUSED(size);
114     if (packet_type != HCI_EVENT_PACKET) return;
115     switch (hci_event_packet_get_type(packet)){
116         case BTSTACK_EVENT_STATE:
117             switch (btstack_event_state_get_state(packet)){
118                 case HCI_STATE_WORKING:
119                     gap_local_bd_addr(local_addr);
120                     if (using_static_address){
121                         memcpy(local_addr, static_address, 6);
122                     }
123                     printf("BTstack up and running on %s.\n", bd_addr_to_str(local_addr));
124                     btstack_strcpy(tlv_db_path, sizeof(tlv_db_path), TLV_DB_PATH_PREFIX);
125                     btstack_strcat(tlv_db_path, sizeof(tlv_db_path), bd_addr_to_str(local_addr));
126                     btstack_strcat(tlv_db_path, sizeof(tlv_db_path), TLV_DB_PATH_POSTFIX);
127                     tlv_impl = btstack_tlv_posix_init_instance(&tlv_context, tlv_db_path);
128                     btstack_tlv_set_instance(tlv_impl, &tlv_context);
129 #ifdef ENABLE_CLASSIC
130                     hci_set_link_key_db(btstack_link_key_db_tlv_get_instance(tlv_impl, &tlv_context));
131 #endif
132 #ifdef ENABLE_BLE
133                     le_device_db_tlv_configure(tlv_impl, &tlv_context);
134 #endif
135                     break;
136                 case HCI_STATE_OFF:
137                     btstack_tlv_posix_deinit(&tlv_context);
138                     break;
139                 default:
140                     break;
141             }
142             if (btstack_event_state_get_state(packet) != HCI_STATE_WORKING) return;
143             break;
144         case HCI_EVENT_COMMAND_COMPLETE:
145             if (hci_event_command_complete_get_command_opcode(packet) == HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION){
146                 local_version_information_handler(packet);
147             }
148             if (memcmp(packet, read_static_address_command_complete_prefix, sizeof(read_static_address_command_complete_prefix)) == 0){
149                 reverse_48(&packet[7], static_address);
150                 gap_random_address_set(static_address);
151                 using_static_address = 1;
152             }
153             break;
154         default:
155             break;
156     }
157 }
158 
159 static void sigint_handler(int param){
160     UNUSED(param);
161 
162     printf("CTRL-C - SIGINT received, shutting down..\n");
163     log_info("sigint_handler: shutting down");
164 
165     // reset anyway
166     btstack_stdin_reset();
167 
168     // power down
169     hci_power_control(HCI_POWER_OFF);
170     hci_close();
171     log_info("Good bye, see you.\n");
172     exit(0);
173 }
174 
175 static int led_state = 0;
176 void hal_led_toggle(void){
177     led_state = 1 - led_state;
178     printf("LED State %u\n", led_state);
179 }
180 
181 #define USB_MAX_PATH_LEN 7
182 int main(int argc, const char * argv[]){
183 
184     uint8_t usb_path[USB_MAX_PATH_LEN];
185     int usb_path_len = 0;
186     const char * usb_path_string = NULL;
187     if (argc >= 3 && strcmp(argv[1], "-u") == 0){
188         // parse command line options for "-u 11:22:33"
189         usb_path_string = argv[2];
190         printf("Specified USB Path: ");
191         while (1){
192             char * delimiter;
193             int port = strtol(usb_path_string, &delimiter, 16);
194             usb_path[usb_path_len] = port;
195             usb_path_len++;
196             printf("%02x ", port);
197             if (!delimiter) break;
198             if (*delimiter != ':' && *delimiter != '-') break;
199             usb_path_string = delimiter+1;
200         }
201         printf("\n");
202         argc -= 2;
203         memmove((void *) &argv[1], &argv[3], (argc-1) * sizeof(char *));
204     }
205 
206 	/// GET STARTED with BTstack ///
207 	btstack_memory_init();
208     btstack_run_loop_init(btstack_run_loop_posix_get_instance());
209 
210     if (usb_path_len){
211         hci_transport_usb_set_path(usb_path_len, usb_path);
212     }
213 
214     // use logger: format HCI_DUMP_PACKETLOGGER, HCI_DUMP_BLUEZ or HCI_DUMP_STDOUT
215 
216     char pklg_path[100];
217     btstack_strcpy(pklg_path, sizeof(pklg_path),  "/tmp/hci_dump");
218     if (usb_path_len){
219         btstack_strcat(pklg_path, sizeof(pklg_path), "_");
220         btstack_strcat(pklg_path, sizeof(pklg_path), usb_path_string);
221     }
222     btstack_strcat(pklg_path, sizeof(pklg_path), ".pklg");
223 
224     // log into file using HCI_DUMP_PACKETLOGGER format
225     hci_dump_posix_fs_open(pklg_path, HCI_DUMP_PACKETLOGGER);
226     hci_dump_init(hci_dump_posix_fs_get_instance());
227     printf("Packet Log: %s\n", pklg_path);
228 
229     // init HCI
230 	hci_init(hci_transport_usb_instance(), NULL);
231 
232 #ifdef HAVE_PORTAUDIO
233     btstack_audio_sink_set_instance(btstack_audio_portaudio_sink_get_instance());
234     btstack_audio_source_set_instance(btstack_audio_portaudio_source_get_instance());
235 #endif
236 
237     // inform about BTstack state
238     hci_event_callback_registration.callback = &packet_handler;
239     hci_add_event_handler(&hci_event_callback_registration);
240 
241     // handle CTRL-c
242     signal(SIGINT, sigint_handler);
243 
244     // setup app
245     btstack_main(argc, argv);
246 
247     // go
248     btstack_run_loop_execute();
249 
250     return 0;
251 }
252