11fbe4564SMatthias Ringwald /*
21fbe4564SMatthias Ringwald * Copyright (C) 2014 BlueKitchen GmbH
31fbe4564SMatthias Ringwald *
41fbe4564SMatthias Ringwald * Redistribution and use in source and binary forms, with or without
51fbe4564SMatthias Ringwald * modification, are permitted provided that the following conditions
61fbe4564SMatthias Ringwald * are met:
71fbe4564SMatthias Ringwald *
81fbe4564SMatthias Ringwald * 1. Redistributions of source code must retain the above copyright
91fbe4564SMatthias Ringwald * notice, this list of conditions and the following disclaimer.
101fbe4564SMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright
111fbe4564SMatthias Ringwald * notice, this list of conditions and the following disclaimer in the
121fbe4564SMatthias Ringwald * documentation and/or other materials provided with the distribution.
131fbe4564SMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of
141fbe4564SMatthias Ringwald * contributors may be used to endorse or promote products derived
151fbe4564SMatthias Ringwald * from this software without specific prior written permission.
161fbe4564SMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for
171fbe4564SMatthias Ringwald * personal benefit and not for any commercial purpose or for
181fbe4564SMatthias Ringwald * monetary gain.
191fbe4564SMatthias Ringwald *
201fbe4564SMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
211fbe4564SMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
221fbe4564SMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
231fbe4564SMatthias Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
241fbe4564SMatthias Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
251fbe4564SMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
261fbe4564SMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
271fbe4564SMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
281fbe4564SMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
291fbe4564SMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
301fbe4564SMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
311fbe4564SMatthias Ringwald * SUCH DAMAGE.
321fbe4564SMatthias Ringwald *
331fbe4564SMatthias Ringwald * Please inquire about commercial licensing options at
341fbe4564SMatthias Ringwald * [email protected]
351fbe4564SMatthias Ringwald *
361fbe4564SMatthias Ringwald */
371fbe4564SMatthias Ringwald
38*bc6a318fSMatthias Ringwald #define BTSTACK_FILE__ "main.c"
391fbe4564SMatthias Ringwald
401fbe4564SMatthias Ringwald // *****************************************************************************
411fbe4564SMatthias Ringwald //
421fbe4564SMatthias Ringwald // minimal setup for HCI code
431fbe4564SMatthias Ringwald //
441fbe4564SMatthias Ringwald // *****************************************************************************
451fbe4564SMatthias Ringwald
461fbe4564SMatthias Ringwald #include <stdint.h>
471fbe4564SMatthias Ringwald #include <stdio.h>
481fbe4564SMatthias Ringwald #include <stdlib.h>
491fbe4564SMatthias Ringwald #include <string.h>
501fbe4564SMatthias Ringwald #include <signal.h>
511fbe4564SMatthias Ringwald
521fbe4564SMatthias Ringwald #include "btstack_config.h"
531fbe4564SMatthias Ringwald
541fbe4564SMatthias Ringwald #include "btstack_debug.h"
551fbe4564SMatthias Ringwald #include "btstack_event.h"
561fbe4564SMatthias Ringwald #include "btstack_link_key_db_fs.h"
571fbe4564SMatthias Ringwald #include "btstack_memory.h"
581fbe4564SMatthias Ringwald #include "btstack_run_loop.h"
591fbe4564SMatthias Ringwald #include "btstack_run_loop_posix.h"
601fbe4564SMatthias Ringwald #include "bluetooth_company_id.h"
611fbe4564SMatthias Ringwald #include "hci.h"
62bdf6d26aSMatthias Ringwald #include "hci_transport_h4.h"
63bdf6d26aSMatthias Ringwald #include "hci_transport_usb.h"
641fbe4564SMatthias Ringwald #include "hci_dump.h"
6531437b52SMatthias Ringwald #include "hci_dump_posix_fs.h"
661fbe4564SMatthias Ringwald #include "btstack_stdin.h"
671fbe4564SMatthias Ringwald #include "btstack_tlv.h"
681fbe4564SMatthias Ringwald #include "btstack_tlv_posix.h"
69bdf6d26aSMatthias Ringwald #include "btstack_uart.h"
701fbe4564SMatthias Ringwald
711fbe4564SMatthias Ringwald int is_bcm;
721fbe4564SMatthias Ringwald
731fbe4564SMatthias Ringwald #define TLV_DB_PATH_PREFIX "/tmp/btstack_"
741fbe4564SMatthias Ringwald #define TLV_DB_PATH_POSTFIX ".tlv"
751fbe4564SMatthias Ringwald static char tlv_db_path[100];
761fbe4564SMatthias Ringwald static const btstack_tlv_t * tlv_impl;
771fbe4564SMatthias Ringwald static btstack_tlv_posix_t tlv_context;
781fbe4564SMatthias Ringwald static bd_addr_t local_addr;
791fbe4564SMatthias Ringwald
801fbe4564SMatthias Ringwald int btstack_main(int argc, const char * argv[]);
811fbe4564SMatthias Ringwald static void local_version_information_handler(uint8_t * packet);
821fbe4564SMatthias Ringwald
831fbe4564SMatthias Ringwald static hci_transport_config_uart_t config = {
841fbe4564SMatthias Ringwald HCI_TRANSPORT_CONFIG_UART,
851fbe4564SMatthias Ringwald 115200,
861fbe4564SMatthias Ringwald 0, // main baudrate
871fbe4564SMatthias Ringwald 0, // flow control
881fbe4564SMatthias Ringwald NULL,
891fbe4564SMatthias Ringwald };
901fbe4564SMatthias Ringwald
911fbe4564SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration;
921fbe4564SMatthias Ringwald
packet_handler(uint8_t packet_type,uint16_t channel,uint8_t * packet,uint16_t size)931fbe4564SMatthias Ringwald static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
94df71a9a4SMatthias Ringwald UNUSED(channel);
95df71a9a4SMatthias Ringwald UNUSED(size);
96df71a9a4SMatthias Ringwald
971fbe4564SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return;
98df71a9a4SMatthias Ringwald
991fbe4564SMatthias Ringwald switch (hci_event_packet_get_type(packet)){
1001fbe4564SMatthias Ringwald case BTSTACK_EVENT_STATE:
1011fbe4564SMatthias Ringwald if (btstack_event_state_get_state(packet) != HCI_STATE_WORKING) break;
1021fbe4564SMatthias Ringwald gap_local_bd_addr(local_addr);
1031fbe4564SMatthias Ringwald printf("BTstack up and running on %s.\n", bd_addr_to_str(local_addr));
10454736c11SMatthias Ringwald btstack_strcpy(tlv_db_path, sizeof(tlv_db_path), TLV_DB_PATH_PREFIX);
10554736c11SMatthias Ringwald btstack_strcat(tlv_db_path, sizeof(tlv_db_path), bd_addr_to_str(local_addr));
10654736c11SMatthias Ringwald btstack_strcat(tlv_db_path, sizeof(tlv_db_path), TLV_DB_PATH_POSTFIX);
1071fbe4564SMatthias Ringwald tlv_impl = btstack_tlv_posix_init_instance(&tlv_context, tlv_db_path);
1081fbe4564SMatthias Ringwald btstack_tlv_set_instance(tlv_impl, &tlv_context);
1091fbe4564SMatthias Ringwald break;
1101fbe4564SMatthias Ringwald case HCI_EVENT_COMMAND_COMPLETE:
111a9ec7ee0SMatthias Ringwald if (hci_event_command_complete_get_command_opcode(packet) == HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION){
1121fbe4564SMatthias Ringwald local_version_information_handler(packet);
1131fbe4564SMatthias Ringwald }
1141fbe4564SMatthias Ringwald break;
1151fbe4564SMatthias Ringwald default:
1161fbe4564SMatthias Ringwald break;
1171fbe4564SMatthias Ringwald }
1181fbe4564SMatthias Ringwald }
1191fbe4564SMatthias Ringwald
sigint_handler(int param)1201fbe4564SMatthias Ringwald static void sigint_handler(int param){
1211fbe4564SMatthias Ringwald UNUSED(param);
1221fbe4564SMatthias Ringwald
1231fbe4564SMatthias Ringwald printf("CTRL-C - SIGINT received, shutting down..\n");
1241fbe4564SMatthias Ringwald log_info("sigint_handler: shutting down");
1251fbe4564SMatthias Ringwald
1261fbe4564SMatthias Ringwald // reset anyway
1271fbe4564SMatthias Ringwald btstack_stdin_reset();
1281fbe4564SMatthias Ringwald
1291fbe4564SMatthias Ringwald // power down
1301fbe4564SMatthias Ringwald hci_power_control(HCI_POWER_OFF);
1311fbe4564SMatthias Ringwald hci_close();
1321fbe4564SMatthias Ringwald log_info("Good bye, see you.\n");
1331fbe4564SMatthias Ringwald exit(0);
1341fbe4564SMatthias Ringwald }
1351fbe4564SMatthias Ringwald
local_version_information_handler(uint8_t * packet)1361fbe4564SMatthias Ringwald static void local_version_information_handler(uint8_t * packet){
1371fbe4564SMatthias Ringwald printf("Local version information:\n");
1381fbe4564SMatthias Ringwald uint16_t hci_version = packet[6];
1391fbe4564SMatthias Ringwald uint16_t hci_revision = little_endian_read_16(packet, 7);
1401fbe4564SMatthias Ringwald uint16_t lmp_version = packet[9];
1411fbe4564SMatthias Ringwald uint16_t manufacturer = little_endian_read_16(packet, 10);
1421fbe4564SMatthias Ringwald uint16_t lmp_subversion = little_endian_read_16(packet, 12);
1431fbe4564SMatthias Ringwald printf("- HCI Version 0x%04x\n", hci_version);
1441fbe4564SMatthias Ringwald printf("- HCI Revision 0x%04x\n", hci_revision);
1451fbe4564SMatthias Ringwald printf("- LMP Version 0x%04x\n", lmp_version);
1461fbe4564SMatthias Ringwald printf("- LMP Subversion 0x%04x\n", lmp_subversion);
1471fbe4564SMatthias Ringwald printf("- Manufacturer 0x%04x\n", manufacturer);
1481fbe4564SMatthias Ringwald }
1491fbe4564SMatthias Ringwald
1501fbe4564SMatthias Ringwald #define USB_MAX_PATH_LEN 7
main(int argc,const char * argv[])1511fbe4564SMatthias Ringwald int main(int argc, const char * argv[]){
1521fbe4564SMatthias Ringwald
1531fbe4564SMatthias Ringwald /// GET STARTED with BTstack ///
1541fbe4564SMatthias Ringwald btstack_memory_init();
1551fbe4564SMatthias Ringwald btstack_run_loop_init(btstack_run_loop_posix_get_instance());
1561fbe4564SMatthias Ringwald
1571fbe4564SMatthias Ringwald char log_path[100];
1581fbe4564SMatthias Ringwald strcpy(log_path, "/tmp/hci_dump");
1591fbe4564SMatthias Ringwald
1601fbe4564SMatthias Ringwald // check for -d pty path
1611fbe4564SMatthias Ringwald if (argc >= 3 && strcmp(argv[1], "-d") == 0){
1621fbe4564SMatthias Ringwald config.device_name = argv[2];
1631fbe4564SMatthias Ringwald argc -= 2;
1641fbe4564SMatthias Ringwald memmove(&argv[0], &argv[2], argc * sizeof(char *));
1651fbe4564SMatthias Ringwald
1661fbe4564SMatthias Ringwald printf("Specified PTY: %s\n", config.device_name);
1671fbe4564SMatthias Ringwald
1681fbe4564SMatthias Ringwald // base logger output file on device_name
1691fbe4564SMatthias Ringwald const char * src = config.device_name;
1701fbe4564SMatthias Ringwald char * dst = &log_path[strlen(log_path)];
1711fbe4564SMatthias Ringwald while (*src){
1721fbe4564SMatthias Ringwald if (*src == '/'){
1731fbe4564SMatthias Ringwald *dst++ = '_';
1741fbe4564SMatthias Ringwald } else {
1751fbe4564SMatthias Ringwald *dst++ = *src;
1761fbe4564SMatthias Ringwald }
1771fbe4564SMatthias Ringwald src++;
1781fbe4564SMatthias Ringwald }
1791fbe4564SMatthias Ringwald *dst = 0;
1801fbe4564SMatthias Ringwald }
1811fbe4564SMatthias Ringwald
1821fbe4564SMatthias Ringwald // check for -u usb path
1831fbe4564SMatthias Ringwald uint8_t usb_path[USB_MAX_PATH_LEN];
1841fbe4564SMatthias Ringwald int usb_path_len = 0;
1851fbe4564SMatthias Ringwald if (argc >= 3 && strcmp(argv[1], "-u") == 0){
1861fbe4564SMatthias Ringwald // parse command line options for "-u 11:22:33"
1871fbe4564SMatthias Ringwald const char * port_str = argv[2];
1881fbe4564SMatthias Ringwald printf("Specified USB Path: ");
1891fbe4564SMatthias Ringwald while (1){
1901fbe4564SMatthias Ringwald char * delimiter;
1911fbe4564SMatthias Ringwald int port = strtol(port_str, &delimiter, 16);
1921fbe4564SMatthias Ringwald usb_path[usb_path_len] = port;
1931fbe4564SMatthias Ringwald usb_path_len++;
1941fbe4564SMatthias Ringwald printf("%02x ", port);
1951fbe4564SMatthias Ringwald if (!delimiter) break;
1961fbe4564SMatthias Ringwald if (*delimiter != ':' && *delimiter != '-') break;
1971fbe4564SMatthias Ringwald port_str = delimiter+1;
1981fbe4564SMatthias Ringwald }
1991fbe4564SMatthias Ringwald printf("\n");
2001fbe4564SMatthias Ringwald argc -= 2;
2011fbe4564SMatthias Ringwald memmove(&argv[0], &argv[2], argc * sizeof(char *));
2021fbe4564SMatthias Ringwald
2031fbe4564SMatthias Ringwald // base logger output file on usb path
2041fbe4564SMatthias Ringwald if (usb_path_len){
2051fbe4564SMatthias Ringwald strcat(log_path, "_");
2061fbe4564SMatthias Ringwald strcat(log_path, argv[2]);
2071fbe4564SMatthias Ringwald }
2081fbe4564SMatthias Ringwald }
2091fbe4564SMatthias Ringwald
2101fbe4564SMatthias Ringwald // use logger: format HCI_DUMP_PACKETLOGGER, HCI_DUMP_BLUEZ or HCI_DUMP_STDOUT
2111fbe4564SMatthias Ringwald strcat(log_path, ".pklg");
21231437b52SMatthias Ringwald // log into file using HCI_DUMP_PACKETLOGGER format
21331437b52SMatthias Ringwald hci_dump_posix_fs_open(log_path, HCI_DUMP_PACKETLOGGER);
21431437b52SMatthias Ringwald hci_dump_init(hci_dump_posix_fs_get_instance());
2151fbe4564SMatthias Ringwald printf("Packet Log: %s\n", log_path);
2161fbe4564SMatthias Ringwald
2171fbe4564SMatthias Ringwald // init HCI
2181fbe4564SMatthias Ringwald const hci_transport_t * transport;
2191fbe4564SMatthias Ringwald if (config.device_name){
2201fbe4564SMatthias Ringwald // PTY
221f8da99a8SMatthias Ringwald const btstack_uart_t * uart_driver = btstack_uart_posix_instance();
222f8da99a8SMatthias Ringwald transport = hci_transport_h4_instance_for_uart(uart_driver);
2231fbe4564SMatthias Ringwald } else {
2241fbe4564SMatthias Ringwald // libusb
2251fbe4564SMatthias Ringwald if (usb_path_len){
2261fbe4564SMatthias Ringwald hci_transport_usb_set_path(usb_path_len, usb_path);
2271fbe4564SMatthias Ringwald }
2281fbe4564SMatthias Ringwald transport = hci_transport_usb_instance();
2291fbe4564SMatthias Ringwald }
2301fbe4564SMatthias Ringwald hci_init(transport, (void*) &config);
2311fbe4564SMatthias Ringwald
2321fbe4564SMatthias Ringwald // inform about BTstack state
2331fbe4564SMatthias Ringwald hci_event_callback_registration.callback = &packet_handler;
2341fbe4564SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration);
2351fbe4564SMatthias Ringwald
2361fbe4564SMatthias Ringwald // handle CTRL-c
2371fbe4564SMatthias Ringwald signal(SIGINT, sigint_handler);
2381fbe4564SMatthias Ringwald
2391fbe4564SMatthias Ringwald // setup app
2401fbe4564SMatthias Ringwald btstack_main(argc, argv);
2411fbe4564SMatthias Ringwald
2421fbe4564SMatthias Ringwald // go
2431fbe4564SMatthias Ringwald btstack_run_loop_execute();
2441fbe4564SMatthias Ringwald
2451fbe4564SMatthias Ringwald return 0;
2461fbe4564SMatthias Ringwald }
247