1 /* 2 * Copyright (C) 2018 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 BLUEKITCHEN 24 * GMBH 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__ "csr_set_bd_addr.c" 39 40 // ***************************************************************************** 41 /* EXAMPLE_START(csr_set_bd_addr): Set BD ADDR on USB CSR modules 42 * 43 */ 44 // ***************************************************************************** 45 46 #include <stdint.h> 47 #include <stdio.h> 48 #include <stdlib.h> 49 #include <string.h> 50 51 #include "btstack.h" 52 53 static btstack_packet_callback_registration_t hci_event_callback_registration; 54 static bd_addr_t cmdline_addr; 55 static btstack_timer_source_t warm_boot_timer; 56 static int cmdline_addr_found; 57 static const char * prog_name; 58 59 static uint8_t csr_set_bd_addr[] = { 60 // 0x0001: Set Bluetooth address 61 0x00, 0xFC, 0x19, 0xc2, 0x02, 0x00, 0x0A, 0x00, 0x03, 0x00, 0x03, 0x70, 0x00, 0x00, 0x01, 0x00, 0x04, 0x00, 0x00, 0x00, 0xf3, 0x00, 0xf5, 0xf4, 0xf2, 0x00, 0xf2, 0xf1, 62 }; 63 64 static uint8_t csr_warm_start[] = { 65 // WarmReset 66 0x00, 0xFC, 0x13, 0xc2, 0x02, 0x00, 0x09, 0x00, 0x03, 0x0e, 0x02, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 67 }; 68 69 static void usage(void){ 70 fprintf(stderr, "\nUsage: %s aa:bb:cc:dd:ee:ff\n", prog_name); 71 exit(0); 72 } 73 /* @section Bluetooth Logic 74 * 75 * @text The Bluetooth logic is implemented as a state machine within the packet 76 * handler. In this example, the following states are passed sequentially: 77 * INIT, and ACTIVE. 78 */ 79 80 static void local_version_information_handler(uint8_t * packet){ 81 uint16_t hci_version = packet[6]; 82 uint16_t hci_revision = little_endian_read_16(packet, 7); 83 uint16_t lmp_version = packet[9]; 84 uint16_t manufacturer = little_endian_read_16(packet, 10); 85 uint16_t lmp_subversion = little_endian_read_16(packet, 12); 86 switch (manufacturer){ 87 case BLUETOOTH_COMPANY_ID_CAMBRIDGE_SILICON_RADIO: 88 printf("Cambridge Silicon Radio - CSR chipset.\n"); 89 break; 90 default: 91 printf("Local version information:\n"); 92 printf("- HCI Version 0x%04x\n", hci_version); 93 printf("- HCI Revision 0x%04x\n", hci_revision); 94 printf("- LMP Version 0x%04x\n", lmp_version); 95 printf("- LMP Subversion 0x%04x\n", lmp_subversion); 96 printf("- Manufacturer 0x%04x\n", manufacturer); 97 printf("Not a CSR chipset, exit\n"); 98 usage(); 99 break; 100 } 101 } 102 103 static int state = 0; 104 105 static void warm_boot_handler(struct btstack_timer_source *ts){ 106 UNUSED(ts); 107 108 if (state != 4) return; 109 printf("Done\n"); 110 exit(0); 111 } 112 113 static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 114 UNUSED(channel); 115 UNUSED(size); 116 117 if (packet_type != HCI_EVENT_PACKET) return; 118 119 switch(hci_event_packet_get_type(packet)){ 120 case BTSTACK_EVENT_STATE: 121 if (btstack_event_state_get_state(packet) == HCI_STATE_WORKING){ 122 if (!cmdline_addr_found){ 123 usage(); 124 break; 125 } 126 printf("Setting BD ADDR to %s\n", bd_addr_to_str(cmdline_addr)); 127 state = 1; 128 } 129 break; 130 if (hci_event_command_complete_get_command_opcode(packet) == HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION){ 131 local_version_information_handler(packet); 132 } 133 break; 134 case HCI_EVENT_VENDOR_SPECIFIC: 135 // Vendor event 136 state++; 137 break; 138 default: 139 break; 140 } 141 142 if (!hci_can_send_command_packet_now()) return; 143 switch (state){ 144 case 0: 145 case 2: 146 break; 147 case 1: 148 state++; 149 hci_send_cmd_packet(csr_set_bd_addr, sizeof(csr_set_bd_addr)); 150 break; 151 case 3: 152 state++; 153 hci_send_cmd_packet(csr_warm_start, sizeof(csr_warm_start)); 154 // set timer 155 warm_boot_timer.process = &warm_boot_handler; 156 btstack_run_loop_set_timer(&warm_boot_timer, 1000); 157 btstack_run_loop_add_timer(&warm_boot_timer); 158 break; 159 default: 160 break; 161 } 162 } 163 164 165 /* @section Main Application Setup 166 * 167 * @text Listing MainConfiguration shows main application code. 168 * It registers the HCI packet handler and starts the Bluetooth stack. 169 */ 170 171 /* LISTING_START(MainConfiguration): Setup packet handler for GAP inquiry */ 172 int btstack_main(int argc, const char * argv[]); 173 int btstack_main(int argc, const char * argv[]) { 174 175 prog_name = argv[0]; 176 if (argc > 1) { 177 cmdline_addr_found = sscanf_bd_addr(argv[1], cmdline_addr); 178 } 179 180 if (cmdline_addr_found){ 181 // prepare set bd addr command 182 csr_set_bd_addr[20] = cmdline_addr[3]; 183 csr_set_bd_addr[22] = cmdline_addr[5]; 184 csr_set_bd_addr[23] = cmdline_addr[4]; 185 csr_set_bd_addr[24] = cmdline_addr[2]; 186 csr_set_bd_addr[26] = cmdline_addr[1]; 187 csr_set_bd_addr[27] = cmdline_addr[0]; 188 } 189 190 hci_event_callback_registration.callback = &packet_handler; 191 hci_add_event_handler(&hci_event_callback_registration); 192 193 // turn on! 194 hci_power_control(HCI_POWER_ON); 195 return 0; 196 } 197 /* LISTING_END */ 198 /* EXAMPLE_END */ 199