Marco Calzana / Mbed OS BLELedControlButton

Exercise 3 Calzana-Iandiorio

Dependents:   BLELedScanner

source/main.cpp@0:c544827b6b11, 2018-11-29 (annotated)

Committer:
mcalzana
Date:
Thu Nov 29 18:13:44 2018 +0000
Revision:
0:c544827b6b11
Exercise 3

Who changed what in which revision?

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