Ken Todotani / Mbed 2 deprecated BTstackLE

BLE demo for mbed Ported RunningElectronics's SBDBT firmware for BLE. It can communicate with iOS

Dependencies:   FatFileSystem mbed

Fork of BTstack by Norimasa Okamoto

BLE_demo.cpp@2:24b33d92e086, 2013-02-07 (annotated)

Committer:
todotani
Date:
Thu Feb 07 14:23:22 2013 +0000
Revision:
2:24b33d92e086
Parent:
1:6078e430af82
Child:
3:4bc438c6fc52
Add Copy Right notice

Who changed what in which revision?

UserRevisionLine numberNew contents of line
todotani 2:24b33d92e086 1 /*
todotani 2:24b33d92e086 2 * Copyright (C) 2011-2012 by Matthias Ringwald
todotani 2:24b33d92e086 3 *
todotani 2:24b33d92e086 4 * Redistribution and use in source and binary forms, with or without
todotani 2:24b33d92e086 5 * modification, are permitted provided that the following conditions
todotani 2:24b33d92e086 6 * are met:
todotani 2:24b33d92e086 7 *
todotani 2:24b33d92e086 8 * 1. Redistributions of source code must retain the above copyright
todotani 2:24b33d92e086 9 * notice, this list of conditions and the following disclaimer.
todotani 2:24b33d92e086 10 * 2. Redistributions in binary form must reproduce the above copyright
todotani 2:24b33d92e086 11 * notice, this list of conditions and the following disclaimer in the
todotani 2:24b33d92e086 12 * documentation and/or other materials provided with the distribution.
todotani 2:24b33d92e086 13 * 3. Neither the name of the copyright holders nor the names of
todotani 2:24b33d92e086 14 * contributors may be used to endorse or promote products derived
todotani 2:24b33d92e086 15 * from this software without specific prior written permission.
todotani 2:24b33d92e086 16 * 4. This software may not be used in a commercial product
todotani 2:24b33d92e086 17 * without an explicit license granted by the copyright holder.
todotani 2:24b33d92e086 18 *
todotani 2:24b33d92e086 19 * THIS SOFTWARE IS PROVIDED BY MATTHIAS RINGWALD AND CONTRIBUTORS
todotani 2:24b33d92e086 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
todotani 2:24b33d92e086 21 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
todotani 2:24b33d92e086 22 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
todotani 2:24b33d92e086 23 * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
todotani 2:24b33d92e086 24 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
todotani 2:24b33d92e086 25 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
todotani 2:24b33d92e086 26 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
todotani 2:24b33d92e086 27 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
todotani 2:24b33d92e086 28 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
todotani 2:24b33d92e086 29 * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
todotani 2:24b33d92e086 30 * SUCH DAMAGE.
todotani 2:24b33d92e086 31 *
todotani 2:24b33d92e086 32 */
todotani 2:24b33d92e086 33
todotani 2:24b33d92e086 34 //*****************************************************************************
todotani 2:24b33d92e086 35 //
todotani 2:24b33d92e086 36 // att device demo
todotani 2:24b33d92e086 37 //
todotani 2:24b33d92e086 38 //*****************************************************************************
todotani 2:24b33d92e086 39
todotani 2:24b33d92e086 40 // TODO: seperate BR/EDR from LE ACL buffers
todotani 2:24b33d92e086 41 // TODO: move LE init into HCI
todotani 2:24b33d92e086 42 // ..
todotani 2:24b33d92e086 43
todotani 2:24b33d92e086 44 // NOTE: Supports only a single connection
todotani 2:24b33d92e086 45
todotani 2:24b33d92e086 46
todotani 1:6078e430af82 47 /*
todotani 1:6078e430af82 48 * BLE_demo
todotani 1:6078e430af82 49 */
todotani 1:6078e430af82 50
todotani 1:6078e430af82 51 // mbed specific
todotani 1:6078e430af82 52 #include "mbed.h"
todotani 1:6078e430af82 53 Serial pc(USBTX, USBRX);
todotani 1:6078e430af82 54 DigitalOut led1(LED1), led2(LED2), led3(LED3);
todotani 1:6078e430af82 55
todotani 1:6078e430af82 56 #define HEARTBEAT_PERIOD_MS 500
todotani 1:6078e430af82 57
todotani 1:6078e430af82 58 // from btstack ble_server.c
todotani 1:6078e430af82 59 #include "global.h"
todotani 1:6078e430af82 60 #include "debug.h"
todotani 1:6078e430af82 61 #include "btstack/btstack.h"
todotani 1:6078e430af82 62 #include "btstack/hci_cmds.h"
todotani 1:6078e430af82 63 #include "btstack/run_loop.h"
todotani 1:6078e430af82 64
todotani 1:6078e430af82 65 #include "hci.h"
todotani 1:6078e430af82 66 #include "l2cap.h"
todotani 1:6078e430af82 67 #include "btstack_memory.h"
todotani 1:6078e430af82 68 #include "remote_device_db.h"
todotani 1:6078e430af82 69 #include "config.h"
todotani 1:6078e430af82 70
todotani 1:6078e430af82 71 #include "att.h"
todotani 1:6078e430af82 72
todotani 1:6078e430af82 73 unsigned timer_counter=0;
todotani 1:6078e430af82 74 uint8_t startup_state=0;
todotani 1:6078e430af82 75
todotani 1:6078e430af82 76
todotani 1:6078e430af82 77 hci_transport_t * hci_transport_picusb_instance();
todotani 1:6078e430af82 78
todotani 1:6078e430af82 79 static att_connection_t att_connection;
todotani 1:6078e430af82 80 static uint16_t att_response_handle = 0;
todotani 1:6078e430af82 81 static uint16_t att_response_size = 0;
todotani 1:6078e430af82 82 static uint8_t att_response_buffer[28];
todotani 1:6078e430af82 83
todotani 1:6078e430af82 84 uint8_t connection_status=0;
todotani 1:6078e430af82 85
todotani 1:6078e430af82 86 void hexdump2(void *data, int size){
todotani 1:6078e430af82 87 int i;
todotani 1:6078e430af82 88 for (i=0; i<size;i++){
todotani 1:6078e430af82 89 log_info("%02X ", ((uint8_t *)data)[i]);
todotani 1:6078e430af82 90 }
todotani 1:6078e430af82 91 log_info("\n");
todotani 1:6078e430af82 92 }
todotani 1:6078e430af82 93
todotani 1:6078e430af82 94 static void att_try_respond(void){
todotani 1:6078e430af82 95 if (!att_response_size) return;
todotani 1:6078e430af82 96 if (!att_response_handle) return;
todotani 1:6078e430af82 97 if (!hci_can_send_packet_now(HCI_ACL_DATA_PACKET)) return;
todotani 1:6078e430af82 98
todotani 1:6078e430af82 99 // update state before sending packet
todotani 1:6078e430af82 100 uint16_t size = att_response_size;
todotani 1:6078e430af82 101 att_response_size = 0;
todotani 1:6078e430af82 102 l2cap_send_connectionless(att_response_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, att_response_buffer, size);
todotani 1:6078e430af82 103 }
todotani 1:6078e430af82 104
todotani 1:6078e430af82 105
todotani 1:6078e430af82 106 static void att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){
todotani 1:6078e430af82 107 if (packet_type != ATT_DATA_PACKET) return;
todotani 1:6078e430af82 108
todotani 1:6078e430af82 109 att_response_handle = handle;
todotani 1:6078e430af82 110 att_response_size = att_handle_request(&att_connection, packet, size, att_response_buffer);
todotani 1:6078e430af82 111 att_try_respond();
todotani 1:6078e430af82 112 }
todotani 1:6078e430af82 113
todotani 1:6078e430af82 114
todotani 1:6078e430af82 115 // enable LE, setup ADV data
todotani 1:6078e430af82 116 static void packet_handler (void * connection, uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
todotani 1:6078e430af82 117 static bd_addr_t addr;
todotani 1:6078e430af82 118 // uint8_t adv_data[] = { 02, 01, 05, 03, 02, 0xf0, 0xff };
todotani 1:6078e430af82 119 const uint8_t adv_data[31]="\x02\x01\x05" "\x06\x09SBDBT";
todotani 1:6078e430af82 120 switch (packet_type) {
todotani 1:6078e430af82 121
todotani 1:6078e430af82 122 case HCI_EVENT_PACKET:
todotani 1:6078e430af82 123 switch (packet[0]) {
todotani 1:6078e430af82 124
todotani 1:6078e430af82 125 case BTSTACK_EVENT_STATE:
todotani 1:6078e430af82 126 // bt stack activated, get started - set local name
todotani 1:6078e430af82 127 if (packet[2] == HCI_STATE_WORKING) {
todotani 1:6078e430af82 128 log_info("Working!\n");
todotani 1:6078e430af82 129 hci_send_cmd(&hci_read_local_supported_features);
todotani 1:6078e430af82 130 }
todotani 1:6078e430af82 131 break;
todotani 1:6078e430af82 132
todotani 1:6078e430af82 133 case DAEMON_EVENT_HCI_PACKET_SENT:
todotani 1:6078e430af82 134 att_try_respond();
todotani 1:6078e430af82 135 break;
todotani 1:6078e430af82 136
todotani 1:6078e430af82 137 case HCI_EVENT_LE_META:
todotani 1:6078e430af82 138 switch (packet[2]) {
todotani 1:6078e430af82 139 case HCI_SUBEVENT_LE_CONNECTION_COMPLETE:
todotani 1:6078e430af82 140 // reset connection MTU
todotani 1:6078e430af82 141 att_connection.mtu = 23;
todotani 1:6078e430af82 142 break;
todotani 1:6078e430af82 143 default:
todotani 1:6078e430af82 144 break;
todotani 1:6078e430af82 145 }
todotani 1:6078e430af82 146 break;
todotani 1:6078e430af82 147
todotani 1:6078e430af82 148 case BTSTACK_EVENT_NR_CONNECTIONS_CHANGED:
todotani 1:6078e430af82 149 if (packet[2]) {
todotani 1:6078e430af82 150 connection_status=1;
todotani 1:6078e430af82 151 log_info("CONNECTED\n");
todotani 1:6078e430af82 152 } else {
todotani 1:6078e430af82 153 connection_status=0;
todotani 1:6078e430af82 154 log_info("NOT CONNECTED\n");
todotani 1:6078e430af82 155 }
todotani 1:6078e430af82 156 break;
todotani 1:6078e430af82 157
todotani 1:6078e430af82 158 case HCI_EVENT_DISCONNECTION_COMPLETE:
todotani 1:6078e430af82 159 att_response_handle =0;
todotani 1:6078e430af82 160 att_response_size = 0;
todotani 1:6078e430af82 161
todotani 1:6078e430af82 162 // restart advertising
todotani 1:6078e430af82 163 hci_send_cmd(&hci_le_set_advertise_enable, 1);
todotani 1:6078e430af82 164 break;
todotani 1:6078e430af82 165
todotani 1:6078e430af82 166 case HCI_EVENT_COMMAND_COMPLETE:
todotani 1:6078e430af82 167 if (COMMAND_COMPLETE_EVENT(packet, hci_read_bd_addr)){
todotani 1:6078e430af82 168 bt_flip_addr(addr, &packet[6]);
todotani 1:6078e430af82 169 log_info("BD ADDR: %s\n", bd_addr_to_str(addr));
todotani 1:6078e430af82 170 break;
todotani 1:6078e430af82 171 }
todotani 1:6078e430af82 172 if (COMMAND_COMPLETE_EVENT(packet, hci_read_local_supported_features)){
todotani 1:6078e430af82 173 log_info("Local supported features: %04lX%04lX\n", READ_BT_32(packet, 10), READ_BT_32(packet, 6));
todotani 1:6078e430af82 174 hci_send_cmd(&hci_set_event_mask, 0xffffffff, 0x20001fff);
todotani 1:6078e430af82 175 break;
todotani 1:6078e430af82 176 }
todotani 1:6078e430af82 177 if (COMMAND_COMPLETE_EVENT(packet, hci_set_event_mask)){
todotani 1:6078e430af82 178 hci_send_cmd(&hci_write_le_host_supported, 1, 1);
todotani 1:6078e430af82 179 break;
todotani 1:6078e430af82 180 }
todotani 1:6078e430af82 181 if (COMMAND_COMPLETE_EVENT(packet, hci_write_le_host_supported)){
todotani 1:6078e430af82 182 hci_send_cmd(&hci_le_set_event_mask, 0xffffffff, 0xffffffff);
todotani 1:6078e430af82 183 break;
todotani 1:6078e430af82 184 }
todotani 1:6078e430af82 185 if (COMMAND_COMPLETE_EVENT(packet, hci_le_set_event_mask)){
todotani 1:6078e430af82 186 hci_send_cmd(&hci_le_read_buffer_size);
todotani 1:6078e430af82 187 break;
todotani 1:6078e430af82 188 }
todotani 1:6078e430af82 189 if (COMMAND_COMPLETE_EVENT(packet, hci_le_read_buffer_size)){
todotani 1:6078e430af82 190 log_info("LE buffer size: %u, count %u\n", READ_BT_16(packet,6), packet[8]);
todotani 1:6078e430af82 191 hci_send_cmd(&hci_le_read_supported_states);
todotani 1:6078e430af82 192 break;
todotani 1:6078e430af82 193 }
todotani 1:6078e430af82 194 if (COMMAND_COMPLETE_EVENT(packet, hci_le_read_supported_states)){
todotani 1:6078e430af82 195 hci_send_cmd(&hci_le_set_advertising_parameters, 0x0400, 0x0800, 0, 0, 0, &addr, 0x07, 0);
todotani 1:6078e430af82 196 break;
todotani 1:6078e430af82 197 }
todotani 1:6078e430af82 198 if (COMMAND_COMPLETE_EVENT(packet, hci_le_set_advertising_parameters)){
todotani 1:6078e430af82 199 hci_send_cmd(&hci_le_set_advertising_data, sizeof(adv_data), adv_data);
todotani 1:6078e430af82 200 break;
todotani 1:6078e430af82 201 }
todotani 1:6078e430af82 202 if (COMMAND_COMPLETE_EVENT(packet, hci_le_set_advertising_data)){
todotani 1:6078e430af82 203 hci_send_cmd(&hci_le_set_scan_response_data, 10, adv_data);
todotani 1:6078e430af82 204 break;
todotani 1:6078e430af82 205 }
todotani 1:6078e430af82 206 if (COMMAND_COMPLETE_EVENT(packet, hci_le_set_scan_response_data)){
todotani 1:6078e430af82 207 hci_send_cmd(&hci_le_set_advertise_enable, 1);
todotani 1:6078e430af82 208 break;
todotani 1:6078e430af82 209 }
todotani 1:6078e430af82 210 if (COMMAND_COMPLETE_EVENT(packet, hci_le_set_advertise_enable)){
todotani 1:6078e430af82 211 hci_discoverable_control(1);
todotani 1:6078e430af82 212 log_info("startup_state=1\n");
todotani 1:6078e430af82 213 startup_state=1;
todotani 1:6078e430af82 214 led1 = 0;
todotani 1:6078e430af82 215 break;
todotani 1:6078e430af82 216 }
todotani 1:6078e430af82 217
todotani 1:6078e430af82 218 }
todotani 1:6078e430af82 219 }
todotani 1:6078e430af82 220 }
todotani 1:6078e430af82 221
todotani 1:6078e430af82 222 // test profile
todotani 1:6078e430af82 223 #include "profile.h"
todotani 1:6078e430af82 224
todotani 1:6078e430af82 225 static uint8_t strbuf[80];
todotani 1:6078e430af82 226 static uint8_t ledvalue;
todotani 1:6078e430af82 227
todotani 1:6078e430af82 228 // read requests
todotani 1:6078e430af82 229 static uint16_t att_read_callback(uint16_t handle, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){
todotani 1:6078e430af82 230 uint16_t ret=0,val;
todotani 1:6078e430af82 231
todotani 1:6078e430af82 232 if(buffer){
todotani 1:6078e430af82 233 log_info("READ Callback, handle %04x\n", handle);
todotani 1:6078e430af82 234 led1 = 1;
todotani 1:6078e430af82 235 }
todotani 1:6078e430af82 236 switch(handle){
todotani 1:6078e430af82 237 case 0x000b:
todotani 1:6078e430af82 238 ret=strlen((char*)strbuf);
todotani 1:6078e430af82 239 if(buffer && ret<=buffer_size){
todotani 1:6078e430af82 240 log_info("Read text: %s\n", strbuf);
todotani 1:6078e430af82 241 memcpy(buffer,strbuf,ret);
todotani 1:6078e430af82 242 }
todotani 1:6078e430af82 243 break;
todotani 1:6078e430af82 244 case 0x000d:
todotani 1:6078e430af82 245 if(buffer && buffer_size){
todotani 1:6078e430af82 246 log_info("Read value: %u\n", buffer[0]);
todotani 1:6078e430af82 247 buffer[0]=ledvalue;
todotani 1:6078e430af82 248 }
todotani 1:6078e430af82 249 ret=1;
todotani 1:6078e430af82 250 break;
todotani 1:6078e430af82 251 case 0x000f:
todotani 1:6078e430af82 252 if(buffer && buffer_size>=2){
todotani 1:6078e430af82 253 val=timer_counter;
todotani 1:6078e430af82 254 log_info("Read value: %u\n", val);
todotani 1:6078e430af82 255 buffer[0]=val&0xff;
todotani 1:6078e430af82 256 buffer[1]=val>>8;
todotani 1:6078e430af82 257 }
todotani 1:6078e430af82 258 ret=2;
todotani 1:6078e430af82 259 break;
todotani 1:6078e430af82 260 }
todotani 1:6078e430af82 261 return ret;
todotani 1:6078e430af82 262 }
todotani 1:6078e430af82 263
todotani 1:6078e430af82 264 // write requests
todotani 1:6078e430af82 265 static void att_write_callback(uint16_t handle, uint16_t transaction_mode, uint16_t offset, uint8_t *buffer, uint16_t buffer_size, signature_t * signature){
todotani 1:6078e430af82 266 log_info("WRITE Callback, handle %04x\n", handle);
todotani 1:6078e430af82 267 led1 = 1;
todotani 1:6078e430af82 268 switch(handle){
todotani 1:6078e430af82 269 case 0x000b:
todotani 1:6078e430af82 270 buffer[buffer_size]=0;
todotani 1:6078e430af82 271 if(sizeof(strbuf)>buffer_size){
todotani 1:6078e430af82 272 strcpy((char*)strbuf,(char*)buffer);
todotani 1:6078e430af82 273 }
todotani 1:6078e430af82 274 log_info("New text: %s\n", buffer);
todotani 1:6078e430af82 275 break;
todotani 1:6078e430af82 276 case 0x000d:
todotani 1:6078e430af82 277 log_info("New value: %u\n", buffer[0]);
todotani 1:6078e430af82 278 ledvalue=buffer[0];
todotani 1:6078e430af82 279 if (buffer[0]){
todotani 1:6078e430af82 280 led1 = 1;
todotani 1:6078e430af82 281 } else {
todotani 1:6078e430af82 282 led1 = 0;
todotani 1:6078e430af82 283 }
todotani 1:6078e430af82 284 break;
todotani 1:6078e430af82 285 }
todotani 1:6078e430af82 286 }
todotani 1:6078e430af82 287
todotani 1:6078e430af82 288
todotani 1:6078e430af82 289 static void heartbeat_handler(struct timer *ts){
todotani 1:6078e430af82 290 run_loop_set_timer(ts, HEARTBEAT_PERIOD_MS);
todotani 1:6078e430af82 291 run_loop_add_timer(ts);
todotani 1:6078e430af82 292 led2 = !led2;
todotani 1:6078e430af82 293 }
todotani 1:6078e430af82 294
todotani 1:6078e430af82 295
todotani 1:6078e430af82 296 // main
todotani 1:6078e430af82 297 int main(void)
todotani 1:6078e430af82 298 {
todotani 1:6078e430af82 299 pc.baud(115200);
todotani 1:6078e430af82 300 log_info("%s\n", __FILE__);
todotani 1:6078e430af82 301
todotani 1:6078e430af82 302 // init LEDs
todotani 1:6078e430af82 303 led1 = led2 = led3 = 1;
todotani 1:6078e430af82 304
todotani 1:6078e430af82 305 /// GET STARTED with BTstack ///
todotani 1:6078e430af82 306 btstack_memory_init();
todotani 1:6078e430af82 307 run_loop_init(RUN_LOOP_EMBEDDED);
todotani 1:6078e430af82 308
todotani 1:6078e430af82 309 // init HCI
todotani 1:6078e430af82 310 // use BlueUSB
todotani 1:6078e430af82 311 hci_transport_t* transport = hci_transport_usb_instance();
todotani 1:6078e430af82 312 bt_control_t * control = NULL;
todotani 1:6078e430af82 313 hci_uart_config_t * config = NULL;
todotani 1:6078e430af82 314 remote_device_db_t * remote_db = (remote_device_db_t *) &remote_device_db_memory;
todotani 1:6078e430af82 315 hci_init(transport, config, control, remote_db);
todotani 1:6078e430af82 316
todotani 1:6078e430af82 317 // use eHCILL
todotani 1:6078e430af82 318 // bt_control_cc256x_enable_ehcill(1);
todotani 1:6078e430af82 319
todotani 1:6078e430af82 320 // set up l2cap_le
todotani 1:6078e430af82 321 l2cap_init();
todotani 1:6078e430af82 322 l2cap_register_fixed_channel(att_packet_handler, L2CAP_CID_ATTRIBUTE_PROTOCOL);
todotani 1:6078e430af82 323 l2cap_register_packet_handler(packet_handler);
todotani 1:6078e430af82 324
todotani 1:6078e430af82 325 // set up ATT
todotani 1:6078e430af82 326 att_set_db(profile_data);
todotani 1:6078e430af82 327 att_set_write_callback(att_write_callback);
todotani 1:6078e430af82 328 att_set_read_callback(att_read_callback);
todotani 1:6078e430af82 329 att_dump_attributes();
todotani 1:6078e430af82 330 att_connection.mtu = 27;
todotani 1:6078e430af82 331
todotani 1:6078e430af82 332 // set one-shot timer
todotani 1:6078e430af82 333 timer_source_t heartbeat;
todotani 1:6078e430af82 334 heartbeat.process = &heartbeat_handler;
todotani 1:6078e430af82 335 run_loop_set_timer(&heartbeat, HEARTBEAT_PERIOD_MS);
todotani 1:6078e430af82 336 run_loop_add_timer(&heartbeat);
todotani 1:6078e430af82 337
todotani 1:6078e430af82 338 log_info("Run...\n\r");
todotani 1:6078e430af82 339
todotani 1:6078e430af82 340 // turn on!
todotani 1:6078e430af82 341 hci_power_control(HCI_POWER_ON);
todotani 1:6078e430af82 342
todotani 1:6078e430af82 343 // go!
todotani 1:6078e430af82 344 run_loop_execute();
todotani 1:6078e430af82 345
todotani 1:6078e430af82 346 // happy compiler!
todotani 1:6078e430af82 347 return 0;
todotani 1:6078e430af82 348 }