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