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@3:4bc438c6fc52, 2013-02-10 (annotated)

Committer:
todotani
Date:
Sun Feb 10 07:53:46 2013 +0000
Revision:
3:4bc438c6fc52
Parent:
2:24b33d92e086
Child:
4:3e8cd77ee303
tick handler changed

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 1:6078e430af82 46 // mbed specific
todotani 1:6078e430af82 47 #include "mbed.h"
todotani 1:6078e430af82 48 Serial pc(USBTX, USBRX);
todotani 1:6078e430af82 49 DigitalOut led1(LED1), led2(LED2), led3(LED3);
todotani 1:6078e430af82 50
todotani 1:6078e430af82 51 #define HEARTBEAT_PERIOD_MS 500
todotani 1:6078e430af82 52
todotani 1:6078e430af82 53 // from btstack ble_server.c
todotani 1:6078e430af82 54 #include "global.h"
todotani 1:6078e430af82 55 #include "debug.h"
todotani 1:6078e430af82 56 #include "btstack/btstack.h"
todotani 1:6078e430af82 57 #include "btstack/hci_cmds.h"
todotani 1:6078e430af82 58 #include "btstack/run_loop.h"
todotani 3:4bc438c6fc52 59 #include "btstack/hal_tick.h"
todotani 1:6078e430af82 60
todotani 1:6078e430af82 61 #include "hci.h"
todotani 1:6078e430af82 62 #include "l2cap.h"
todotani 1:6078e430af82 63 #include "btstack_memory.h"
todotani 1:6078e430af82 64 #include "remote_device_db.h"
todotani 1:6078e430af82 65 #include "config.h"
todotani 1:6078e430af82 66
todotani 1:6078e430af82 67 #include "att.h"
todotani 1:6078e430af82 68
todotani 1:6078e430af82 69 hci_transport_t * hci_transport_picusb_instance();
todotani 1:6078e430af82 70
todotani 1:6078e430af82 71 static att_connection_t att_connection;
todotani 1:6078e430af82 72 static uint16_t att_response_handle = 0;
todotani 1:6078e430af82 73 static uint16_t att_response_size = 0;
todotani 1:6078e430af82 74 static uint8_t att_response_buffer[28];
todotani 1:6078e430af82 75
todotani 1:6078e430af82 76 void hexdump2(void *data, int size){
todotani 1:6078e430af82 77 int i;
todotani 1:6078e430af82 78 for (i=0; i<size;i++){
todotani 1:6078e430af82 79 log_info("%02X ", ((uint8_t *)data)[i]);
todotani 1:6078e430af82 80 }
todotani 1:6078e430af82 81 log_info("\n");
todotani 1:6078e430af82 82 }
todotani 1:6078e430af82 83
todotani 1:6078e430af82 84 static void att_try_respond(void){
todotani 1:6078e430af82 85 if (!att_response_size) return;
todotani 1:6078e430af82 86 if (!att_response_handle) return;
todotani 1:6078e430af82 87 if (!hci_can_send_packet_now(HCI_ACL_DATA_PACKET)) return;
todotani 1:6078e430af82 88
todotani 1:6078e430af82 89 // update state before sending packet
todotani 1:6078e430af82 90 uint16_t size = att_response_size;
todotani 1:6078e430af82 91 att_response_size = 0;
todotani 1:6078e430af82 92 l2cap_send_connectionless(att_response_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL, att_response_buffer, size);
todotani 1:6078e430af82 93 }
todotani 1:6078e430af82 94
todotani 1:6078e430af82 95
todotani 1:6078e430af82 96 static void att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){
todotani 1:6078e430af82 97 if (packet_type != ATT_DATA_PACKET) return;
todotani 1:6078e430af82 98
todotani 1:6078e430af82 99 att_response_handle = handle;
todotani 1:6078e430af82 100 att_response_size = att_handle_request(&att_connection, packet, size, att_response_buffer);
todotani 1:6078e430af82 101 att_try_respond();
todotani 1:6078e430af82 102 }
todotani 1:6078e430af82 103
todotani 1:6078e430af82 104
todotani 1:6078e430af82 105 // enable LE, setup ADV data
todotani 1:6078e430af82 106 static void packet_handler (void * connection, uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
todotani 1:6078e430af82 107 static bd_addr_t addr;
todotani 3:4bc438c6fc52 108 //uint8_t adv_data[] = { 02, 01, 05, 03, 02, 0xf0, 0xff };
todotani 3:4bc438c6fc52 109 // Data for advertisement and scan response
todotani 3:4bc438c6fc52 110 const uint8_t adv_data[31]="\x02\x01\x05" "\x06\x09SBDBT" "\x03\x02\xf0\xff";
todotani 1:6078e430af82 111 switch (packet_type) {
todotani 1:6078e430af82 112
todotani 1:6078e430af82 113 case HCI_EVENT_PACKET:
todotani 1:6078e430af82 114 switch (packet[0]) {
todotani 1:6078e430af82 115
todotani 1:6078e430af82 116 case BTSTACK_EVENT_STATE:
todotani 1:6078e430af82 117 // bt stack activated, get started - set local name
todotani 1:6078e430af82 118 if (packet[2] == HCI_STATE_WORKING) {
todotani 1:6078e430af82 119 log_info("Working!\n");
todotani 1:6078e430af82 120 hci_send_cmd(&hci_read_local_supported_features);
todotani 1:6078e430af82 121 }
todotani 1:6078e430af82 122 break;
todotani 1:6078e430af82 123
todotani 1:6078e430af82 124 case DAEMON_EVENT_HCI_PACKET_SENT:
todotani 1:6078e430af82 125 att_try_respond();
todotani 1:6078e430af82 126 break;
todotani 1:6078e430af82 127
todotani 1:6078e430af82 128 case HCI_EVENT_LE_META:
todotani 1:6078e430af82 129 switch (packet[2]) {
todotani 1:6078e430af82 130 case HCI_SUBEVENT_LE_CONNECTION_COMPLETE:
todotani 1:6078e430af82 131 // reset connection MTU
todotani 1:6078e430af82 132 att_connection.mtu = 23;
todotani 1:6078e430af82 133 break;
todotani 1:6078e430af82 134 default:
todotani 1:6078e430af82 135 break;
todotani 1:6078e430af82 136 }
todotani 1:6078e430af82 137 break;
todotani 1:6078e430af82 138
todotani 1:6078e430af82 139 case BTSTACK_EVENT_NR_CONNECTIONS_CHANGED:
todotani 1:6078e430af82 140 if (packet[2]) {
todotani 1:6078e430af82 141 connection_status=1;
todotani 1:6078e430af82 142 log_info("CONNECTED\n");
todotani 1:6078e430af82 143 } else {
todotani 1:6078e430af82 144 connection_status=0;
todotani 1:6078e430af82 145 log_info("NOT CONNECTED\n");
todotani 1:6078e430af82 146 }
todotani 1:6078e430af82 147 break;
todotani 1:6078e430af82 148
todotani 1:6078e430af82 149 case HCI_EVENT_DISCONNECTION_COMPLETE:
todotani 1:6078e430af82 150 att_response_handle =0;
todotani 1:6078e430af82 151 att_response_size = 0;
todotani 1:6078e430af82 152
todotani 1:6078e430af82 153 // restart advertising
todotani 1:6078e430af82 154 hci_send_cmd(&hci_le_set_advertise_enable, 1);
todotani 1:6078e430af82 155 break;
todotani 1:6078e430af82 156
todotani 1:6078e430af82 157 case HCI_EVENT_COMMAND_COMPLETE:
todotani 1:6078e430af82 158 if (COMMAND_COMPLETE_EVENT(packet, hci_read_bd_addr)){
todotani 1:6078e430af82 159 bt_flip_addr(addr, &packet[6]);
todotani 1:6078e430af82 160 log_info("BD ADDR: %s\n", bd_addr_to_str(addr));
todotani 1:6078e430af82 161 break;
todotani 1:6078e430af82 162 }
todotani 1:6078e430af82 163 if (COMMAND_COMPLETE_EVENT(packet, hci_read_local_supported_features)){
todotani 1:6078e430af82 164 log_info("Local supported features: %04lX%04lX\n", READ_BT_32(packet, 10), READ_BT_32(packet, 6));
todotani 1:6078e430af82 165 hci_send_cmd(&hci_set_event_mask, 0xffffffff, 0x20001fff);
todotani 1:6078e430af82 166 break;
todotani 1:6078e430af82 167 }
todotani 1:6078e430af82 168 if (COMMAND_COMPLETE_EVENT(packet, hci_set_event_mask)){
todotani 1:6078e430af82 169 hci_send_cmd(&hci_write_le_host_supported, 1, 1);
todotani 1:6078e430af82 170 break;
todotani 1:6078e430af82 171 }
todotani 1:6078e430af82 172 if (COMMAND_COMPLETE_EVENT(packet, hci_write_le_host_supported)){
todotani 1:6078e430af82 173 hci_send_cmd(&hci_le_set_event_mask, 0xffffffff, 0xffffffff);
todotani 1:6078e430af82 174 break;
todotani 1:6078e430af82 175 }
todotani 1:6078e430af82 176 if (COMMAND_COMPLETE_EVENT(packet, hci_le_set_event_mask)){
todotani 1:6078e430af82 177 hci_send_cmd(&hci_le_read_buffer_size);
todotani 1:6078e430af82 178 break;
todotani 1:6078e430af82 179 }
todotani 1:6078e430af82 180 if (COMMAND_COMPLETE_EVENT(packet, hci_le_read_buffer_size)){
todotani 1:6078e430af82 181 log_info("LE buffer size: %u, count %u\n", READ_BT_16(packet,6), packet[8]);
todotani 1:6078e430af82 182 hci_send_cmd(&hci_le_read_supported_states);
todotani 1:6078e430af82 183 break;
todotani 1:6078e430af82 184 }
todotani 1:6078e430af82 185 if (COMMAND_COMPLETE_EVENT(packet, hci_le_read_supported_states)){
todotani 1:6078e430af82 186 hci_send_cmd(&hci_le_set_advertising_parameters, 0x0400, 0x0800, 0, 0, 0, &addr, 0x07, 0);
todotani 1:6078e430af82 187 break;
todotani 1:6078e430af82 188 }
todotani 1:6078e430af82 189 if (COMMAND_COMPLETE_EVENT(packet, hci_le_set_advertising_parameters)){
todotani 1:6078e430af82 190 hci_send_cmd(&hci_le_set_advertising_data, sizeof(adv_data), adv_data);
todotani 1:6078e430af82 191 break;
todotani 1:6078e430af82 192 }
todotani 1:6078e430af82 193 if (COMMAND_COMPLETE_EVENT(packet, hci_le_set_advertising_data)){
todotani 1:6078e430af82 194 hci_send_cmd(&hci_le_set_scan_response_data, 10, adv_data);
todotani 1:6078e430af82 195 break;
todotani 1:6078e430af82 196 }
todotani 1:6078e430af82 197 if (COMMAND_COMPLETE_EVENT(packet, hci_le_set_scan_response_data)){
todotani 1:6078e430af82 198 hci_send_cmd(&hci_le_set_advertise_enable, 1);
todotani 1:6078e430af82 199 break;
todotani 1:6078e430af82 200 }
todotani 1:6078e430af82 201 if (COMMAND_COMPLETE_EVENT(packet, hci_le_set_advertise_enable)){
todotani 1:6078e430af82 202 hci_discoverable_control(1);
todotani 1:6078e430af82 203 log_info("startup_state=1\n");
todotani 1:6078e430af82 204 startup_state=1;
todotani 1:6078e430af82 205 led1 = 0;
todotani 1:6078e430af82 206 break;
todotani 1:6078e430af82 207 }
todotani 1:6078e430af82 208
todotani 1:6078e430af82 209 }
todotani 1:6078e430af82 210 }
todotani 1:6078e430af82 211 }
todotani 1:6078e430af82 212
todotani 1:6078e430af82 213 // test profile
todotani 1:6078e430af82 214 #include "profile.h"
todotani 1:6078e430af82 215
todotani 1:6078e430af82 216 static uint8_t strbuf[80];
todotani 1:6078e430af82 217 static uint8_t ledvalue;
todotani 1:6078e430af82 218
todotani 1:6078e430af82 219 // read requests
todotani 1:6078e430af82 220 static uint16_t att_read_callback(uint16_t handle, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){
todotani 1:6078e430af82 221 uint16_t ret=0,val;
todotani 1:6078e430af82 222
todotani 1:6078e430af82 223 if(buffer){
todotani 1:6078e430af82 224 log_info("READ Callback, handle %04x\n", handle);
todotani 3:4bc438c6fc52 225 led2 = 1;
todotani 1:6078e430af82 226 }
todotani 1:6078e430af82 227 switch(handle){
todotani 3:4bc438c6fc52 228 // Correspond to Characteristics 0xFFF1
todotani 1:6078e430af82 229 case 0x000b:
todotani 1:6078e430af82 230 ret=strlen((char*)strbuf);
todotani 1:6078e430af82 231 if(buffer && ret<=buffer_size){
todotani 1:6078e430af82 232 log_info("Read text: %s\n", strbuf);
todotani 1:6078e430af82 233 memcpy(buffer,strbuf,ret);
todotani 1:6078e430af82 234 }
todotani 1:6078e430af82 235 break;
todotani 3:4bc438c6fc52 236
todotani 3:4bc438c6fc52 237 // Correspond to Characteristics 0xFFF2
todotani 1:6078e430af82 238 case 0x000d:
todotani 1:6078e430af82 239 if(buffer && buffer_size){
todotani 1:6078e430af82 240 log_info("Read value: %u\n", buffer[0]);
todotani 1:6078e430af82 241 buffer[0]=ledvalue;
todotani 1:6078e430af82 242 }
todotani 1:6078e430af82 243 ret=1;
todotani 1:6078e430af82 244 break;
todotani 3:4bc438c6fc52 245
todotani 3:4bc438c6fc52 246 // Correspond to Characteristics 0x00001234-0000-1000-8000-00805F9B34FB
todotani 1:6078e430af82 247 case 0x000f:
todotani 1:6078e430af82 248 if(buffer && buffer_size>=2){
todotani 1:6078e430af82 249 val=timer_counter;
todotani 1:6078e430af82 250 log_info("Read value: %u\n", val);
todotani 1:6078e430af82 251 buffer[0]=val&0xff;
todotani 1:6078e430af82 252 buffer[1]=val>>8;
todotani 1:6078e430af82 253 }
todotani 1:6078e430af82 254 ret=2;
todotani 1:6078e430af82 255 break;
todotani 1:6078e430af82 256 }
todotani 1:6078e430af82 257 return ret;
todotani 1:6078e430af82 258 }
todotani 1:6078e430af82 259
todotani 1:6078e430af82 260 // write requests
todotani 1:6078e430af82 261 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 262 log_info("WRITE Callback, handle %04x\n", handle);
todotani 3:4bc438c6fc52 263 led2 = 0;
todotani 1:6078e430af82 264 switch(handle){
todotani 3:4bc438c6fc52 265 // Correspond to Characteristics 0xFFF1
todotani 1:6078e430af82 266 case 0x000b:
todotani 1:6078e430af82 267 buffer[buffer_size]=0;
todotani 1:6078e430af82 268 if(sizeof(strbuf)>buffer_size){
todotani 1:6078e430af82 269 strcpy((char*)strbuf,(char*)buffer);
todotani 1:6078e430af82 270 }
todotani 1:6078e430af82 271 log_info("New text: %s\n", buffer);
todotani 1:6078e430af82 272 break;
todotani 3:4bc438c6fc52 273
todotani 3:4bc438c6fc52 274 // Correspond to Characteristics 0xFFF2
todotani 1:6078e430af82 275 case 0x000d:
todotani 1:6078e430af82 276 log_info("New value: %u\n", buffer[0]);
todotani 1:6078e430af82 277 ledvalue=buffer[0];
todotani 1:6078e430af82 278 if (buffer[0]){
todotani 1:6078e430af82 279 led1 = 1;
todotani 1:6078e430af82 280 } else {
todotani 1:6078e430af82 281 led1 = 0;
todotani 1:6078e430af82 282 }
todotani 1:6078e430af82 283 break;
todotani 1:6078e430af82 284 }
todotani 1:6078e430af82 285 }
todotani 1:6078e430af82 286
todotani 1:6078e430af82 287
todotani 3:4bc438c6fc52 288 void hal_tick_event(void)
todotani 3:4bc438c6fc52 289 {
todotani 3:4bc438c6fc52 290 timer_counter++;
todotani 1:6078e430af82 291
todotani 3:4bc438c6fc52 292 if(connection_status){
todotani 3:4bc438c6fc52 293 led3 = !led3;
todotani 3:4bc438c6fc52 294 }else{
todotani 3:4bc438c6fc52 295 led3 = 1;
todotani 3:4bc438c6fc52 296 }
todotani 3:4bc438c6fc52 297 }
todotani 1:6078e430af82 298
todotani 1:6078e430af82 299 // main
todotani 1:6078e430af82 300 int main(void)
todotani 1:6078e430af82 301 {
todotani 1:6078e430af82 302 pc.baud(115200);
todotani 1:6078e430af82 303 log_info("%s\n", __FILE__);
todotani 1:6078e430af82 304
todotani 1:6078e430af82 305 // init LEDs
todotani 1:6078e430af82 306 led1 = led2 = led3 = 1;
todotani 1:6078e430af82 307
todotani 1:6078e430af82 308 /// GET STARTED with BTstack ///
todotani 1:6078e430af82 309 btstack_memory_init();
todotani 1:6078e430af82 310 run_loop_init(RUN_LOOP_EMBEDDED);
todotani 3:4bc438c6fc52 311 hal_tick_set_handler(&hal_tick_event);
todotani 1:6078e430af82 312
todotani 1:6078e430af82 313 // init HCI
todotani 1:6078e430af82 314 // use BlueUSB
todotani 1:6078e430af82 315 hci_transport_t* transport = hci_transport_usb_instance();
todotani 1:6078e430af82 316 bt_control_t * control = NULL;
todotani 1:6078e430af82 317 hci_uart_config_t * config = NULL;
todotani 1:6078e430af82 318 remote_device_db_t * remote_db = (remote_device_db_t *) &remote_device_db_memory;
todotani 1:6078e430af82 319 hci_init(transport, config, control, remote_db);
todotani 1:6078e430af82 320
todotani 1:6078e430af82 321 // use eHCILL
todotani 1:6078e430af82 322 // bt_control_cc256x_enable_ehcill(1);
todotani 1:6078e430af82 323
todotani 1:6078e430af82 324 // set up l2cap_le
todotani 1:6078e430af82 325 l2cap_init();
todotani 1:6078e430af82 326 l2cap_register_fixed_channel(att_packet_handler, L2CAP_CID_ATTRIBUTE_PROTOCOL);
todotani 1:6078e430af82 327 l2cap_register_packet_handler(packet_handler);
todotani 1:6078e430af82 328
todotani 1:6078e430af82 329 // set up ATT
todotani 1:6078e430af82 330 att_set_db(profile_data);
todotani 1:6078e430af82 331 att_set_write_callback(att_write_callback);
todotani 1:6078e430af82 332 att_set_read_callback(att_read_callback);
todotani 1:6078e430af82 333 att_dump_attributes();
todotani 1:6078e430af82 334 att_connection.mtu = 27;
todotani 1:6078e430af82 335
todotani 1:6078e430af82 336 log_info("Run...\n\r");
todotani 1:6078e430af82 337
todotani 1:6078e430af82 338 // turn on!
todotani 1:6078e430af82 339 hci_power_control(HCI_POWER_ON);
todotani 1:6078e430af82 340
todotani 1:6078e430af82 341 // go!
todotani 1:6078e430af82 342 run_loop_execute();
todotani 1:6078e430af82 343
todotani 1:6078e430af82 344 // happy compiler!
todotani 1:6078e430af82 345 return 0;
todotani 1:6078e430af82 346 }