Jelle Bakker / Mbed OS mbed-os-example-ble-LEDBlinker_2

working observer

Fork of mbed-os-example-ble-LEDBlinker by mbed-os-examples

source/main.cpp@50:a45dd75fbe11, 2017-12-12 (annotated)

Committer:
john111222333
Date:
Tue Dec 12 09:49:30 2017 +0000
Revision:
50:a45dd75fbe11
Parent:
45:9fe6d1e21b8a 
working observer

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Vincent Coubard 0:86bf1d2040b3 1 /* mbed Microcontroller Library
Vincent Coubard 0:86bf1d2040b3 2 * Copyright (c) 2006-2015 ARM Limited
Vincent Coubard 0:86bf1d2040b3 3 *
Vincent Coubard 0:86bf1d2040b3 4 * Licensed under the Apache License, Version 2.0 (the "License");
Vincent Coubard 0:86bf1d2040b3 5 * you may not use this file except in compliance with the License.
Vincent Coubard 0:86bf1d2040b3 6 * You may obtain a copy of the License at
Vincent Coubard 0:86bf1d2040b3 7 *
Vincent Coubard 0:86bf1d2040b3 8 * http://www.apache.org/licenses/LICENSE-2.0
Vincent Coubard 0:86bf1d2040b3 9 *
Vincent Coubard 0:86bf1d2040b3 10 * Unless required by applicable law or agreed to in writing, software
Vincent Coubard 0:86bf1d2040b3 11 * distributed under the License is distributed on an "AS IS" BASIS,
Vincent Coubard 0:86bf1d2040b3 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
Vincent Coubard 0:86bf1d2040b3 13 * See the License for the specific language governing permissions and
Vincent Coubard 0:86bf1d2040b3 14 * limitations under the License.
Vincent Coubard 0:86bf1d2040b3 15 */
Vincent Coubard 0:86bf1d2040b3 16
mbed_official 12:059c7b7fb18a 17 #include <events/mbed_events.h>
Vincent Coubard 0:86bf1d2040b3 18 #include <mbed.h>
Vincent Coubard 0:86bf1d2040b3 19 #include "ble/BLE.h"
Vincent Coubard 0:86bf1d2040b3 20 #include "ble/DiscoveredCharacteristic.h"
Vincent Coubard 0:86bf1d2040b3 21 #include "ble/DiscoveredService.h"
Vincent Coubard 0:86bf1d2040b3 22
Vincent Coubard 0:86bf1d2040b3 23 DigitalOut alivenessLED(LED1, 1);
Vincent Coubard 0:86bf1d2040b3 24 static DiscoveredCharacteristic ledCharacteristic;
Vincent Coubard 0:86bf1d2040b3 25 static bool triggerLedCharacteristic;
john111222333 50:a45dd75fbe11 26 static const char PEER_NAME[] = "Jelle";
Vincent Coubard 0:86bf1d2040b3 27
mbed_official 28:64621b6587e1 28 static EventQueue eventQueue(/* event count */ 16 * EVENTS_EVENT_SIZE);
Vincent Coubard 0:86bf1d2040b3 29
Vincent Coubard 0:86bf1d2040b3 30 void periodicCallback(void) {
Vincent Coubard 0:86bf1d2040b3 31 alivenessLED = !alivenessLED; /* Do blinky on LED1 while we're waiting for BLE events */
Vincent Coubard 0:86bf1d2040b3 32 }
Vincent Coubard 0:86bf1d2040b3 33
Vincent Coubard 0:86bf1d2040b3 34 void advertisementCallback(const Gap::AdvertisementCallbackParams_t *params) {
Vincent Coubard 0:86bf1d2040b3 35 // parse the advertising payload, looking for data type COMPLETE_LOCAL_NAME
Vincent Coubard 0:86bf1d2040b3 36 // The advertising payload is a collection of key/value records where
Vincent Coubard 0:86bf1d2040b3 37 // byte 0: length of the record excluding this byte
Vincent Coubard 0:86bf1d2040b3 38 // byte 1: The key, it is the type of the data
Vincent Coubard 0:86bf1d2040b3 39 // byte [2..N] The value. N is equal to byte0 - 1
john111222333 50:a45dd75fbe11 40 bool isTrustedDevice = false;
Vincent Coubard 0:86bf1d2040b3 41 for (uint8_t i = 0; i < params->advertisingDataLen; ++i) {
Vincent Coubard 0:86bf1d2040b3 42
Vincent Coubard 0:86bf1d2040b3 43 const uint8_t record_length = params->advertisingData[i];
Vincent Coubard 0:86bf1d2040b3 44 if (record_length == 0) {
Vincent Coubard 0:86bf1d2040b3 45 continue;
Vincent Coubard 0:86bf1d2040b3 46 }
Vincent Coubard 0:86bf1d2040b3 47 const uint8_t type = params->advertisingData[i + 1];
Vincent Coubard 0:86bf1d2040b3 48 const uint8_t* value = params->advertisingData + i + 2;
Vincent Coubard 0:86bf1d2040b3 49 const uint8_t value_length = record_length - 1;
Vincent Coubard 0:86bf1d2040b3 50
Vincent Coubard 0:86bf1d2040b3 51 if(type == GapAdvertisingData::COMPLETE_LOCAL_NAME) {
Vincent Coubard 0:86bf1d2040b3 52 if ((value_length == sizeof(PEER_NAME)) && (memcmp(value, PEER_NAME, value_length) == 0)) {
Vincent Coubard 0:86bf1d2040b3 53 printf(
Vincent Coubard 0:86bf1d2040b3 54 "adv peerAddr[%02x %02x %02x %02x %02x %02x] rssi %d, isScanResponse %u, AdvertisementType %u\r\n",
Vincent Coubard 0:86bf1d2040b3 55 params->peerAddr[5], params->peerAddr[4], params->peerAddr[3], params->peerAddr[2],
Vincent Coubard 0:86bf1d2040b3 56 params->peerAddr[1], params->peerAddr[0], params->rssi, params->isScanResponse, params->type
Vincent Coubard 0:86bf1d2040b3 57 );
john111222333 50:a45dd75fbe11 58 isTrustedDevice = true;
john111222333 50:a45dd75fbe11 59 printf("isTrustedDevice %s\n\r", isTrustedDevice);
john111222333 50:a45dd75fbe11 60 // BLE::Instance().gap().connect(params->peerAddr, Gap::ADDR_TYPE_RANDOM_STATIC, NULL, NULL);
Vincent Coubard 0:86bf1d2040b3 61 }
Vincent Coubard 0:86bf1d2040b3 62 }
john111222333 50:a45dd75fbe11 63
john111222333 50:a45dd75fbe11 64 if(type == GapAdvertisingData::SERVICE_DATA && isTrustedDevice) {
john111222333 50:a45dd75fbe11 65 printf("adv number = %d\n\r", *value);
john111222333 50:a45dd75fbe11 66 }
john111222333 50:a45dd75fbe11 67 if(type == GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA && isTrustedDevice) {
john111222333 50:a45dd75fbe11 68 printf("adv counter = %d\n\r",*value);
john111222333 50:a45dd75fbe11 69 }
john111222333 50:a45dd75fbe11 70
Vincent Coubard 0:86bf1d2040b3 71 i += record_length;
Vincent Coubard 0:86bf1d2040b3 72 }
Vincent Coubard 0:86bf1d2040b3 73 }
Vincent Coubard 0:86bf1d2040b3 74
Vincent Coubard 0:86bf1d2040b3 75 void serviceDiscoveryCallback(const DiscoveredService *service) {
Vincent Coubard 0:86bf1d2040b3 76 if (service->getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
Vincent Coubard 0:86bf1d2040b3 77 printf("S UUID-%x attrs[%u %u]\r\n", service->getUUID().getShortUUID(), service->getStartHandle(), service->getEndHandle());
Vincent Coubard 0:86bf1d2040b3 78 } else {
Vincent Coubard 0:86bf1d2040b3 79 printf("S UUID-");
Vincent Coubard 0:86bf1d2040b3 80 const uint8_t *longUUIDBytes = service->getUUID().getBaseUUID();
Vincent Coubard 0:86bf1d2040b3 81 for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) {
Vincent Coubard 0:86bf1d2040b3 82 printf("%02x", longUUIDBytes[i]);
Vincent Coubard 0:86bf1d2040b3 83 }
Vincent Coubard 0:86bf1d2040b3 84 printf(" attrs[%u %u]\r\n", service->getStartHandle(), service->getEndHandle());
Vincent Coubard 0:86bf1d2040b3 85 }
Vincent Coubard 0:86bf1d2040b3 86 }
Vincent Coubard 0:86bf1d2040b3 87
Vincent Coubard 0:86bf1d2040b3 88 void updateLedCharacteristic(void) {
Vincent Coubard 0:86bf1d2040b3 89 if (!BLE::Instance().gattClient().isServiceDiscoveryActive()) {
Vincent Coubard 0:86bf1d2040b3 90 ledCharacteristic.read();
Vincent Coubard 0:86bf1d2040b3 91 }
Vincent Coubard 0:86bf1d2040b3 92 }
Vincent Coubard 0:86bf1d2040b3 93
Vincent Coubard 0:86bf1d2040b3 94 void characteristicDiscoveryCallback(const DiscoveredCharacteristic *characteristicP) {
Vincent Coubard 0:86bf1d2040b3 95 printf(" C UUID-%x valueAttr[%u] props[%x]\r\n", characteristicP->getUUID().getShortUUID(), characteristicP->getValueHandle(), (uint8_t)characteristicP->getProperties().broadcast());
Vincent Coubard 0:86bf1d2040b3 96 if (characteristicP->getUUID().getShortUUID() == 0xa001) { /* !ALERT! Alter this filter to suit your device. */
Vincent Coubard 0:86bf1d2040b3 97 ledCharacteristic = *characteristicP;
Vincent Coubard 0:86bf1d2040b3 98 triggerLedCharacteristic = true;
Vincent Coubard 0:86bf1d2040b3 99 }
Vincent Coubard 0:86bf1d2040b3 100 }
Vincent Coubard 0:86bf1d2040b3 101
Vincent Coubard 0:86bf1d2040b3 102 void discoveryTerminationCallback(Gap::Handle_t connectionHandle) {
Vincent Coubard 0:86bf1d2040b3 103 printf("terminated SD for handle %u\r\n", connectionHandle);
Vincent Coubard 0:86bf1d2040b3 104 if (triggerLedCharacteristic) {
Vincent Coubard 0:86bf1d2040b3 105 triggerLedCharacteristic = false;
mbed_official 12:059c7b7fb18a 106 eventQueue.call(updateLedCharacteristic);
Vincent Coubard 0:86bf1d2040b3 107 }
Vincent Coubard 0:86bf1d2040b3 108 }
Vincent Coubard 0:86bf1d2040b3 109
Vincent Coubard 0:86bf1d2040b3 110 void connectionCallback(const Gap::ConnectionCallbackParams_t *params) {
Vincent Coubard 0:86bf1d2040b3 111 if (params->role == Gap::CENTRAL) {
Vincent Coubard 0:86bf1d2040b3 112 BLE &ble = BLE::Instance();
Vincent Coubard 0:86bf1d2040b3 113 ble.gattClient().onServiceDiscoveryTermination(discoveryTerminationCallback);
Vincent Coubard 0:86bf1d2040b3 114 ble.gattClient().launchServiceDiscovery(params->handle, serviceDiscoveryCallback, characteristicDiscoveryCallback, 0xa000, 0xa001);
Vincent Coubard 0:86bf1d2040b3 115 }
Vincent Coubard 0:86bf1d2040b3 116 }
Vincent Coubard 0:86bf1d2040b3 117
Vincent Coubard 0:86bf1d2040b3 118 void triggerToggledWrite(const GattReadCallbackParams *response) {
Vincent Coubard 0:86bf1d2040b3 119 if (response->handle == ledCharacteristic.getValueHandle()) {
Vincent Coubard 0:86bf1d2040b3 120 printf("triggerToggledWrite: handle %u, offset %u, len %u\r\n", response->handle, response->offset, response->len);
Vincent Coubard 0:86bf1d2040b3 121 for (unsigned index = 0; index < response->len; index++) {
john111222333 50:a45dd75fbe11 122 printf("test %d", index);
Vincent Coubard 0:86bf1d2040b3 123 printf("%c[%02x]", response->data[index], response->data[index]);
Vincent Coubard 0:86bf1d2040b3 124 }
Vincent Coubard 0:86bf1d2040b3 125 printf("\r\n");
Vincent Coubard 0:86bf1d2040b3 126
Vincent Coubard 0:86bf1d2040b3 127 uint8_t toggledValue = response->data[0] ^ 0x1;
Vincent Coubard 0:86bf1d2040b3 128 ledCharacteristic.write(1, &toggledValue);
Vincent Coubard 0:86bf1d2040b3 129 }
Vincent Coubard 0:86bf1d2040b3 130 }
Vincent Coubard 0:86bf1d2040b3 131
Vincent Coubard 0:86bf1d2040b3 132 void triggerRead(const GattWriteCallbackParams *response) {
Vincent Coubard 0:86bf1d2040b3 133 if (response->handle == ledCharacteristic.getValueHandle()) {
Vincent Coubard 0:86bf1d2040b3 134 ledCharacteristic.read();
Vincent Coubard 0:86bf1d2040b3 135 }
Vincent Coubard 0:86bf1d2040b3 136 }
Vincent Coubard 0:86bf1d2040b3 137
Vincent Coubard 0:86bf1d2040b3 138 void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *) {
Vincent Coubard 0:86bf1d2040b3 139 printf("disconnected\r\n");
Vincent Coubard 0:86bf1d2040b3 140 /* Start scanning and try to connect again */
Vincent Coubard 0:86bf1d2040b3 141 BLE::Instance().gap().startScan(advertisementCallback);
Vincent Coubard 0:86bf1d2040b3 142 }
Vincent Coubard 0:86bf1d2040b3 143
Vincent Coubard 0:86bf1d2040b3 144 void onBleInitError(BLE &ble, ble_error_t error)
Vincent Coubard 0:86bf1d2040b3 145 {
Vincent Coubard 0:86bf1d2040b3 146 /* Initialization error handling should go here */
Vincent Coubard 0:86bf1d2040b3 147 }
Vincent Coubard 0:86bf1d2040b3 148
mbed_official 45:9fe6d1e21b8a 149 void printMacAddress()
mbed_official 45:9fe6d1e21b8a 150 {
mbed_official 45:9fe6d1e21b8a 151 /* Print out device MAC address to the console*/
mbed_official 45:9fe6d1e21b8a 152 Gap::AddressType_t addr_type;
mbed_official 45:9fe6d1e21b8a 153 Gap::Address_t address;
mbed_official 45:9fe6d1e21b8a 154 BLE::Instance().gap().getAddress(&addr_type, address);
mbed_official 45:9fe6d1e21b8a 155 printf("DEVICE MAC ADDRESS: ");
mbed_official 45:9fe6d1e21b8a 156 for (int i = 5; i >= 1; i--){
mbed_official 45:9fe6d1e21b8a 157 printf("%02x:", address[i]);
mbed_official 45:9fe6d1e21b8a 158 }
mbed_official 45:9fe6d1e21b8a 159 printf("%02x\r\n", address[0]);
mbed_official 45:9fe6d1e21b8a 160 }
mbed_official 45:9fe6d1e21b8a 161
Vincent Coubard 0:86bf1d2040b3 162 void bleInitComplete(BLE::InitializationCompleteCallbackContext *params)
Vincent Coubard 0:86bf1d2040b3 163 {
Vincent Coubard 0:86bf1d2040b3 164 BLE& ble = params->ble;
Vincent Coubard 0:86bf1d2040b3 165 ble_error_t error = params->error;
Vincent Coubard 0:86bf1d2040b3 166
Vincent Coubard 0:86bf1d2040b3 167 if (error != BLE_ERROR_NONE) {
Vincent Coubard 0:86bf1d2040b3 168 /* In case of error, forward the error handling to onBleInitError */
Vincent Coubard 0:86bf1d2040b3 169 onBleInitError(ble, error);
Vincent Coubard 0:86bf1d2040b3 170 return;
Vincent Coubard 0:86bf1d2040b3 171 }
Vincent Coubard 0:86bf1d2040b3 172
Vincent Coubard 0:86bf1d2040b3 173 /* Ensure that it is the default instance of BLE */
Vincent Coubard 0:86bf1d2040b3 174 if (ble.getInstanceID() != BLE::DEFAULT_INSTANCE) {
Vincent Coubard 0:86bf1d2040b3 175 return;
Vincent Coubard 0:86bf1d2040b3 176 }
Vincent Coubard 0:86bf1d2040b3 177
Vincent Coubard 0:86bf1d2040b3 178 ble.gap().onDisconnection(disconnectionCallback);
Vincent Coubard 0:86bf1d2040b3 179 ble.gap().onConnection(connectionCallback);
Vincent Coubard 0:86bf1d2040b3 180
Vincent Coubard 0:86bf1d2040b3 181 ble.gattClient().onDataRead(triggerToggledWrite);
Vincent Coubard 0:86bf1d2040b3 182 ble.gattClient().onDataWrite(triggerRead);
Vincent Coubard 0:86bf1d2040b3 183
Vincent Coubard 0:86bf1d2040b3 184 // scan interval: 400ms and scan window: 400ms.
Vincent Coubard 0:86bf1d2040b3 185 // Every 400ms the device will scan for 400ms
Vincent Coubard 0:86bf1d2040b3 186 // This means that the device will scan continuously.
Vincent Coubard 0:86bf1d2040b3 187 ble.gap().setScanParams(400, 400);
Vincent Coubard 0:86bf1d2040b3 188 ble.gap().startScan(advertisementCallback);
mbed_official 45:9fe6d1e21b8a 189
mbed_official 45:9fe6d1e21b8a 190 printMacAddress();
Vincent Coubard 0:86bf1d2040b3 191 }
Vincent Coubard 0:86bf1d2040b3 192
Vincent Coubard 0:86bf1d2040b3 193 void scheduleBleEventsProcessing(BLE::OnEventsToProcessCallbackContext* context) {
Vincent Coubard 0:86bf1d2040b3 194 BLE &ble = BLE::Instance();
mbed_official 12:059c7b7fb18a 195 eventQueue.call(Callback<void()>(&ble, &BLE::processEvents));
Vincent Coubard 0:86bf1d2040b3 196 }
Vincent Coubard 0:86bf1d2040b3 197
Vincent Coubard 0:86bf1d2040b3 198 int main()
Vincent Coubard 0:86bf1d2040b3 199 {
Vincent Coubard 0:86bf1d2040b3 200 triggerLedCharacteristic = false;
mbed_official 12:059c7b7fb18a 201 eventQueue.call_every(500, periodicCallback);
Vincent Coubard 0:86bf1d2040b3 202
Vincent Coubard 0:86bf1d2040b3 203 BLE &ble = BLE::Instance();
Vincent Coubard 0:86bf1d2040b3 204 ble.onEventsToProcess(scheduleBleEventsProcessing);
Vincent Coubard 0:86bf1d2040b3 205 ble.init(bleInitComplete);
Vincent Coubard 0:86bf1d2040b3 206
mbed_official 12:059c7b7fb18a 207 eventQueue.dispatch_forever();
Vincent Coubard 0:86bf1d2040b3 208
Vincent Coubard 0:86bf1d2040b3 209 return 0;
Vincent Coubard 0:86bf1d2040b3 210 }