xref: /btstack/test/mesh/main.c (revision 293fd5fb21e86fbb29e9789cc0a2c06dafbbf1b3)
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 "btstack_debug.h"
55 #include "btstack_event.h"
56 #include "btstack_link_key_db_fs.h"
57 #include "btstack_memory.h"
58 #include "btstack_run_loop.h"
59 #include "btstack_run_loop_posix.h"
60 #include "bluetooth_company_id.h"
61 #include "hci.h"
62 #include "hci_dump.h"
63 #include "btstack_stdin.h"
64 #include "btstack_tlv.h"
65 #include "btstack_tlv_posix.h"
66 
67 int is_bcm;
68 
69 #define TLV_DB_PATH_PREFIX "/tmp/btstack_"
70 #define TLV_DB_PATH_POSTFIX ".tlv"
71 static char tlv_db_path[100];
72 static const btstack_tlv_t * tlv_impl;
73 static btstack_tlv_posix_t   tlv_context;
74 static bd_addr_t             local_addr;
75 
76 int btstack_main(int argc, const char * argv[]);
77 static void local_version_information_handler(uint8_t * packet);
78 
79 static hci_transport_config_uart_t config = {
80     HCI_TRANSPORT_CONFIG_UART,
81     115200,
82     0,  // main baudrate
83     0,  // flow control
84     NULL,
85 };
86 
87 static btstack_packet_callback_registration_t hci_event_callback_registration;
88 
89 static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
90     if (packet_type != HCI_EVENT_PACKET) return;
91     switch (hci_event_packet_get_type(packet)){
92         case BTSTACK_EVENT_STATE:
93             if (btstack_event_state_get_state(packet) != HCI_STATE_WORKING) break;
94             gap_local_bd_addr(local_addr);
95             printf("BTstack up and running on %s.\n", bd_addr_to_str(local_addr));
96             strcpy(tlv_db_path, TLV_DB_PATH_PREFIX);
97             strcat(tlv_db_path, bd_addr_to_str(local_addr));
98             strcat(tlv_db_path, TLV_DB_PATH_POSTFIX);
99             tlv_impl = btstack_tlv_posix_init_instance(&tlv_context, tlv_db_path);
100             btstack_tlv_set_instance(tlv_impl, &tlv_context);
101             break;
102         case HCI_EVENT_COMMAND_COMPLETE:
103             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_version_information)){
104                 local_version_information_handler(packet);
105             }
106             break;
107         default:
108             break;
109     }
110 }
111 
112 static void sigint_handler(int param){
113     UNUSED(param);
114 
115     printf("CTRL-C - SIGINT received, shutting down..\n");
116     log_info("sigint_handler: shutting down");
117 
118     // reset anyway
119     btstack_stdin_reset();
120 
121     // power down
122     hci_power_control(HCI_POWER_OFF);
123     hci_close();
124     log_info("Good bye, see you.\n");
125     exit(0);
126 }
127 
128 static int led_state = 0;
129 void hal_led_toggle(void){
130     led_state = 1 - led_state;
131     printf("LED State %u\n", led_state);
132 }
133 
134 static void local_version_information_handler(uint8_t * packet){
135     printf("Local version information:\n");
136     uint16_t hci_version    = packet[6];
137     uint16_t hci_revision   = little_endian_read_16(packet, 7);
138     uint16_t lmp_version    = packet[9];
139     uint16_t manufacturer   = little_endian_read_16(packet, 10);
140     uint16_t lmp_subversion = little_endian_read_16(packet, 12);
141     printf("- HCI Version    0x%04x\n", hci_version);
142     printf("- HCI Revision   0x%04x\n", hci_revision);
143     printf("- LMP Version    0x%04x\n", lmp_version);
144     printf("- LMP Subversion 0x%04x\n", lmp_subversion);
145     printf("- Manufacturer 0x%04x\n", manufacturer);
146 }
147 
148 #define USB_MAX_PATH_LEN 7
149 int main(int argc, const char * argv[]){
150 
151 	/// GET STARTED with BTstack ///
152 	btstack_memory_init();
153     btstack_run_loop_init(btstack_run_loop_posix_get_instance());
154 
155     char log_path[100];
156     strcpy(log_path, "/tmp/hci_dump");
157 
158     // check for -d pty path
159     if (argc >= 3 && strcmp(argv[1], "-d") == 0){
160         config.device_name = argv[2];
161         argc -= 2;
162         memmove(&argv[0], &argv[2], argc * sizeof(char *));
163 
164         printf("Specified PTY: %s\n", config.device_name);
165 
166         // base logger output file on device_name
167         const char * src = config.device_name;
168         char *       dst = &log_path[strlen(log_path)];
169         while (*src){
170             if (*src == '/'){
171                 *dst++ = '_';
172             } else {
173                 *dst++ = *src;
174             }
175             src++;
176         }
177         *dst = 0;
178     }
179 
180     // check for -u usb path
181     uint8_t usb_path[USB_MAX_PATH_LEN];
182     int usb_path_len = 0;
183     if (argc >= 3 && strcmp(argv[1], "-u") == 0){
184         // parse command line options for "-u 11:22:33"
185         const char * port_str = argv[2];
186         printf("Specified USB Path: ");
187         while (1){
188             char * delimiter;
189             int port = strtol(port_str, &delimiter, 16);
190             usb_path[usb_path_len] = port;
191             usb_path_len++;
192             printf("%02x ", port);
193             if (!delimiter) break;
194             if (*delimiter != ':' && *delimiter != '-') break;
195             port_str = delimiter+1;
196         }
197         printf("\n");
198         argc -= 2;
199         memmove(&argv[0], &argv[2], argc * sizeof(char *));
200 
201         // base logger output file on usb path
202         if (usb_path_len){
203             strcat(log_path, "_");
204             strcat(log_path, argv[2]);
205         }
206     }
207 
208     // use logger: format HCI_DUMP_PACKETLOGGER, HCI_DUMP_BLUEZ or HCI_DUMP_STDOUT
209     strcat(log_path, ".pklg");
210     printf("Packet Log: %s\n", log_path);
211     hci_dump_open(log_path, HCI_DUMP_PACKETLOGGER);
212 
213     // init HCI
214     const hci_transport_t * transport;
215     if (config.device_name){
216         // PTY
217         const btstack_uart_block_t * uart_driver = btstack_uart_block_posix_instance();
218         transport = hci_transport_h4_instance(uart_driver);
219     } else {
220         // libusb
221         if (usb_path_len){
222             hci_transport_usb_set_path(usb_path_len, usb_path);
223         }
224         transport = hci_transport_usb_instance();
225     }
226 	hci_init(transport, (void*) &config);
227 
228     // inform about BTstack state
229     hci_event_callback_registration.callback = &packet_handler;
230     hci_add_event_handler(&hci_event_callback_registration);
231 
232     // handle CTRL-c
233     signal(SIGINT, sigint_handler);
234 
235     // setup app
236     btstack_main(argc, argv);
237 
238     // go
239     btstack_run_loop_execute();
240 
241     return 0;
242 }
243