Marco Calzana
/
BLELedScanner2
Exercise 4 Calzana Iandiorio
source/main.cpp@2:59e9845ddbb6, 2018-11-30 (annotated)
- Committer:
- mcalzana
- Date:
- Fri Nov 30 16:29:55 2018 +0000
- Revision:
- 2:59e9845ddbb6
- Parent:
- 1:7b8b65fd1d74
Exercise 4
Who changed what in which revision?
User | Revision | Line number | New 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 | 2:59e9845ddbb6 | 23 | static DigitalOut led1(LED1); |
mcalzana | 2:59e9845ddbb6 | 24 | static DigitalOut led2(LED2); |
mcalzana | 2:59e9845ddbb6 | 25 | static DigitalOut led3(LED3); |
mcalzana | 2:59e9845ddbb6 | 26 | static bool blinkLed1 = false; |
mcalzana | 2:59e9845ddbb6 | 27 | static bool blinkLed2 = false; |
mcalzana | 2:59e9845ddbb6 | 28 | static bool blinkLed3 = false; |
mcalzana | 0:c544827b6b11 | 29 | static DiscoveredCharacteristic ledCharacteristic; |
mcalzana | 0:c544827b6b11 | 30 | static bool triggerLedCharacteristic; |
mcalzana | 0:c544827b6b11 | 31 | static const char PEER_NAME[] = "LED666"; |
mcalzana | 0:c544827b6b11 | 32 | static uint8_t toggledValue = 0x0; |
mcalzana | 0:c544827b6b11 | 33 | InterruptIn button(USER_BUTTON); |
mcalzana | 0:c544827b6b11 | 34 | |
mcalzana | 0:c544827b6b11 | 35 | static EventQueue eventQueue(/* event count */ 16 * EVENTS_EVENT_SIZE); |
mcalzana | 0:c544827b6b11 | 36 | |
mcalzana | 0:c544827b6b11 | 37 | void periodicCallback(void) { |
mcalzana | 2:59e9845ddbb6 | 38 | if(blinkLed1){ |
mcalzana | 2:59e9845ddbb6 | 39 | led1 = !led1; |
mcalzana | 2:59e9845ddbb6 | 40 | led2 = 0; |
mcalzana | 2:59e9845ddbb6 | 41 | led3 = 0; |
mcalzana | 2:59e9845ddbb6 | 42 | }else if(blinkLed2){ |
mcalzana | 2:59e9845ddbb6 | 43 | led1 = 0; |
mcalzana | 2:59e9845ddbb6 | 44 | led2 = !led2; |
mcalzana | 2:59e9845ddbb6 | 45 | led3 = 0; |
mcalzana | 2:59e9845ddbb6 | 46 | }else if(blinkLed3){ |
mcalzana | 2:59e9845ddbb6 | 47 | led1 = 0; |
mcalzana | 2:59e9845ddbb6 | 48 | led2 = 0; |
mcalzana | 2:59e9845ddbb6 | 49 | led3 = !led3; |
mcalzana | 1:7b8b65fd1d74 | 50 | } |
mcalzana | 0:c544827b6b11 | 51 | } |
mcalzana | 0:c544827b6b11 | 52 | |
mcalzana | 0:c544827b6b11 | 53 | void advertisementCallback(const Gap::AdvertisementCallbackParams_t *params) { |
mcalzana | 0:c544827b6b11 | 54 | // parse the advertising payload, looking for data type COMPLETE_LOCAL_NAME |
mcalzana | 0:c544827b6b11 | 55 | // The advertising payload is a collection of key/value records where |
mcalzana | 0:c544827b6b11 | 56 | // byte 0: length of the record excluding this byte |
mcalzana | 0:c544827b6b11 | 57 | // byte 1: The key, it is the type of the data |
mcalzana | 0:c544827b6b11 | 58 | // byte [2..N] The value. N is equal to byte0 - 1 |
mcalzana | 2:59e9845ddbb6 | 59 | |
mcalzana | 0:c544827b6b11 | 60 | for (uint8_t i = 0; i < params->advertisingDataLen; ++i) { |
mcalzana | 0:c544827b6b11 | 61 | |
mcalzana | 0:c544827b6b11 | 62 | const uint8_t record_length = params->advertisingData[i]; |
mcalzana | 0:c544827b6b11 | 63 | if (record_length == 0) { |
mcalzana | 0:c544827b6b11 | 64 | continue; |
mcalzana | 0:c544827b6b11 | 65 | } |
mcalzana | 0:c544827b6b11 | 66 | const uint8_t type = params->advertisingData[i + 1]; |
mcalzana | 0:c544827b6b11 | 67 | const uint8_t* value = params->advertisingData + i + 2; |
mcalzana | 0:c544827b6b11 | 68 | const uint8_t value_length = record_length - 1; |
mcalzana | 0:c544827b6b11 | 69 | if(type == GapAdvertisingData::COMPLETE_LOCAL_NAME) { |
mcalzana | 0:c544827b6b11 | 70 | if ((value_length == sizeof(PEER_NAME)) && (memcmp(value, PEER_NAME, value_length) == 0)) { |
mcalzana | 2:59e9845ddbb6 | 71 | printf("connected. %d \n", params->rssi); |
mcalzana | 2:59e9845ddbb6 | 72 | if(params->rssi > -60){ |
mcalzana | 1:7b8b65fd1d74 | 73 | printf("NEAR\n"); |
mcalzana | 2:59e9845ddbb6 | 74 | blinkLed1 = true; |
mcalzana | 2:59e9845ddbb6 | 75 | blinkLed2 = false; |
mcalzana | 2:59e9845ddbb6 | 76 | blinkLed3 = false; |
mcalzana | 2:59e9845ddbb6 | 77 | }else if(params->rssi > -80){ |
mcalzana | 1:7b8b65fd1d74 | 78 | printf("MEDIUM\n"); |
mcalzana | 2:59e9845ddbb6 | 79 | blinkLed1 = false; |
mcalzana | 2:59e9845ddbb6 | 80 | blinkLed2 = true; |
mcalzana | 2:59e9845ddbb6 | 81 | blinkLed3 = false; |
mcalzana | 1:7b8b65fd1d74 | 82 | }else{ |
mcalzana | 1:7b8b65fd1d74 | 83 | printf("FAR\n"); |
mcalzana | 2:59e9845ddbb6 | 84 | blinkLed1 = false; |
mcalzana | 2:59e9845ddbb6 | 85 | blinkLed2 = false; |
mcalzana | 2:59e9845ddbb6 | 86 | blinkLed3 = true; |
mcalzana | 1:7b8b65fd1d74 | 87 | } |
mcalzana | 0:c544827b6b11 | 88 | break; |
mcalzana | 0:c544827b6b11 | 89 | } |
mcalzana | 0:c544827b6b11 | 90 | } |
mcalzana | 0:c544827b6b11 | 91 | i += record_length; |
mcalzana | 0:c544827b6b11 | 92 | } |
mcalzana | 0:c544827b6b11 | 93 | } |
mcalzana | 0:c544827b6b11 | 94 | |
mcalzana | 0:c544827b6b11 | 95 | void serviceDiscoveryCallback(const DiscoveredService *service) { |
mcalzana | 0:c544827b6b11 | 96 | if (service->getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) { |
mcalzana | 0:c544827b6b11 | 97 | printf("S UUID-%x attrs[%u %u]\r\n", service->getUUID().getShortUUID(), service->getStartHandle(), service->getEndHandle()); |
mcalzana | 0:c544827b6b11 | 98 | } else { |
mcalzana | 0:c544827b6b11 | 99 | printf("S UUID-"); |
mcalzana | 0:c544827b6b11 | 100 | const uint8_t *longUUIDBytes = service->getUUID().getBaseUUID(); |
mcalzana | 0:c544827b6b11 | 101 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) { |
mcalzana | 0:c544827b6b11 | 102 | printf("%02x", longUUIDBytes[i]); |
mcalzana | 0:c544827b6b11 | 103 | } |
mcalzana | 0:c544827b6b11 | 104 | printf(" attrs[%u %u]\r\n", service->getStartHandle(), service->getEndHandle()); |
mcalzana | 0:c544827b6b11 | 105 | } |
mcalzana | 0:c544827b6b11 | 106 | } |
mcalzana | 0:c544827b6b11 | 107 | |
mcalzana | 0:c544827b6b11 | 108 | void updateLedCharacteristic(void) { |
mcalzana | 0:c544827b6b11 | 109 | if (!BLE::Instance().gattClient().isServiceDiscoveryActive()) { |
mcalzana | 0:c544827b6b11 | 110 | ledCharacteristic.read(); |
mcalzana | 0:c544827b6b11 | 111 | } |
mcalzana | 0:c544827b6b11 | 112 | } |
mcalzana | 0:c544827b6b11 | 113 | |
mcalzana | 0:c544827b6b11 | 114 | void characteristicDiscoveryCallback(const DiscoveredCharacteristic *characteristicP) { |
mcalzana | 0:c544827b6b11 | 115 | printf(" C UUID-%x valueAttr[%u] props[%x]\r\n", characteristicP->getUUID().getShortUUID(), characteristicP->getValueHandle(), (uint8_t)characteristicP->getProperties().broadcast()); |
mcalzana | 0:c544827b6b11 | 116 | if (characteristicP->getUUID().getShortUUID() == 0xa001) { /* !ALERT! Alter this filter to suit your device. */ |
mcalzana | 0:c544827b6b11 | 117 | ledCharacteristic = *characteristicP; |
mcalzana | 0:c544827b6b11 | 118 | triggerLedCharacteristic = true; |
mcalzana | 0:c544827b6b11 | 119 | } |
mcalzana | 0:c544827b6b11 | 120 | } |
mcalzana | 0:c544827b6b11 | 121 | |
mcalzana | 0:c544827b6b11 | 122 | void discoveryTerminationCallback(Gap::Handle_t connectionHandle) { |
mcalzana | 0:c544827b6b11 | 123 | printf("terminated SD for handle %u\r\n", connectionHandle); |
mcalzana | 0:c544827b6b11 | 124 | if (triggerLedCharacteristic) { |
mcalzana | 0:c544827b6b11 | 125 | triggerLedCharacteristic = false; |
mcalzana | 0:c544827b6b11 | 126 | eventQueue.call(updateLedCharacteristic); |
mcalzana | 0:c544827b6b11 | 127 | } |
mcalzana | 0:c544827b6b11 | 128 | } |
mcalzana | 0:c544827b6b11 | 129 | |
mcalzana | 0:c544827b6b11 | 130 | void connectionCallback(const Gap::ConnectionCallbackParams_t *params) { |
mcalzana | 0:c544827b6b11 | 131 | if (params->role == Gap::CENTRAL) { |
mcalzana | 0:c544827b6b11 | 132 | BLE &ble = BLE::Instance(); |
mcalzana | 0:c544827b6b11 | 133 | ble.gattClient().onServiceDiscoveryTermination(discoveryTerminationCallback); |
mcalzana | 0:c544827b6b11 | 134 | ble.gattClient().launchServiceDiscovery(params->handle, serviceDiscoveryCallback, characteristicDiscoveryCallback, 0xa000, 0xa001); |
mcalzana | 0:c544827b6b11 | 135 | } |
mcalzana | 0:c544827b6b11 | 136 | } |
mcalzana | 0:c544827b6b11 | 137 | |
mcalzana | 0:c544827b6b11 | 138 | void triggerToggledWrite(const GattReadCallbackParams *response) { |
mcalzana | 0:c544827b6b11 | 139 | if (response->handle == ledCharacteristic.getValueHandle()) { |
mcalzana | 0:c544827b6b11 | 140 | printf("triggerToggledWrite: handle %u, offset %u, len %u\r\n", response->handle, response->offset, response->len); |
mcalzana | 0:c544827b6b11 | 141 | for (unsigned index = 0; index < response->len; index++) { |
mcalzana | 0:c544827b6b11 | 142 | printf("%c[%02x]", response->data[index], response->data[index]); |
mcalzana | 0:c544827b6b11 | 143 | } |
mcalzana | 0:c544827b6b11 | 144 | printf("\r\n"); |
mcalzana | 0:c544827b6b11 | 145 | ledCharacteristic.write(1, &toggledValue); |
mcalzana | 0:c544827b6b11 | 146 | } |
mcalzana | 0:c544827b6b11 | 147 | } |
mcalzana | 0:c544827b6b11 | 148 | |
mcalzana | 0:c544827b6b11 | 149 | void triggerRead(const GattWriteCallbackParams *response) { |
mcalzana | 0:c544827b6b11 | 150 | if (response->handle == ledCharacteristic.getValueHandle()) { |
mcalzana | 0:c544827b6b11 | 151 | ledCharacteristic.read(); |
mcalzana | 0:c544827b6b11 | 152 | } |
mcalzana | 0:c544827b6b11 | 153 | } |
mcalzana | 0:c544827b6b11 | 154 | |
mcalzana | 0:c544827b6b11 | 155 | void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *) { |
mcalzana | 0:c544827b6b11 | 156 | printf("disconnected\r\n"); |
mcalzana | 0:c544827b6b11 | 157 | /* Start scanning and try to connect again */ |
mcalzana | 0:c544827b6b11 | 158 | BLE::Instance().gap().startScan(advertisementCallback); |
mcalzana | 0:c544827b6b11 | 159 | } |
mcalzana | 0:c544827b6b11 | 160 | |
mcalzana | 0:c544827b6b11 | 161 | void onBleInitError(BLE &ble, ble_error_t error) |
mcalzana | 0:c544827b6b11 | 162 | { |
mcalzana | 0:c544827b6b11 | 163 | /* Initialization error handling should go here */ |
mcalzana | 0:c544827b6b11 | 164 | } |
mcalzana | 0:c544827b6b11 | 165 | |
mcalzana | 0:c544827b6b11 | 166 | void printMacAddress() |
mcalzana | 0:c544827b6b11 | 167 | { |
mcalzana | 0:c544827b6b11 | 168 | /* Print out device MAC address to the console*/ |
mcalzana | 0:c544827b6b11 | 169 | Gap::AddressType_t addr_type; |
mcalzana | 0:c544827b6b11 | 170 | Gap::Address_t address; |
mcalzana | 0:c544827b6b11 | 171 | BLE::Instance().gap().getAddress(&addr_type, address); |
mcalzana | 0:c544827b6b11 | 172 | printf("DEVICE MAC ADDRESS: "); |
mcalzana | 0:c544827b6b11 | 173 | for (int i = 5; i >= 1; i--){ |
mcalzana | 0:c544827b6b11 | 174 | printf("%02x:", address[i]); |
mcalzana | 0:c544827b6b11 | 175 | } |
mcalzana | 0:c544827b6b11 | 176 | printf("%02x\r\n", address[0]); |
mcalzana | 0:c544827b6b11 | 177 | } |
mcalzana | 0:c544827b6b11 | 178 | |
mcalzana | 0:c544827b6b11 | 179 | void bleInitComplete(BLE::InitializationCompleteCallbackContext *params) |
mcalzana | 0:c544827b6b11 | 180 | { |
mcalzana | 0:c544827b6b11 | 181 | BLE& ble = params->ble; |
mcalzana | 0:c544827b6b11 | 182 | ble_error_t error = params->error; |
mcalzana | 0:c544827b6b11 | 183 | |
mcalzana | 0:c544827b6b11 | 184 | if (error != BLE_ERROR_NONE) { |
mcalzana | 0:c544827b6b11 | 185 | /* In case of error, forward the error handling to onBleInitError */ |
mcalzana | 0:c544827b6b11 | 186 | onBleInitError(ble, error); |
mcalzana | 0:c544827b6b11 | 187 | return; |
mcalzana | 0:c544827b6b11 | 188 | } |
mcalzana | 0:c544827b6b11 | 189 | |
mcalzana | 0:c544827b6b11 | 190 | /* Ensure that it is the default instance of BLE */ |
mcalzana | 0:c544827b6b11 | 191 | if (ble.getInstanceID() != BLE::DEFAULT_INSTANCE) { |
mcalzana | 0:c544827b6b11 | 192 | return; |
mcalzana | 0:c544827b6b11 | 193 | } |
mcalzana | 0:c544827b6b11 | 194 | |
mcalzana | 0:c544827b6b11 | 195 | ble.gap().onDisconnection(disconnectionCallback); |
mcalzana | 0:c544827b6b11 | 196 | ble.gap().onConnection(connectionCallback); |
mcalzana | 0:c544827b6b11 | 197 | |
mcalzana | 0:c544827b6b11 | 198 | ble.gattClient().onDataRead(triggerToggledWrite); |
mcalzana | 0:c544827b6b11 | 199 | ble.gattClient().onDataWrite(triggerRead); |
mcalzana | 0:c544827b6b11 | 200 | |
mcalzana | 0:c544827b6b11 | 201 | // scan interval: 400ms and scan window: 400ms. |
mcalzana | 0:c544827b6b11 | 202 | // Every 400ms the device will scan for 400ms |
mcalzana | 0:c544827b6b11 | 203 | // This means that the device will scan continuously. |
mcalzana | 0:c544827b6b11 | 204 | ble.gap().setScanParams(400, 400); |
mcalzana | 0:c544827b6b11 | 205 | ble.gap().startScan(advertisementCallback); |
mcalzana | 0:c544827b6b11 | 206 | |
mcalzana | 0:c544827b6b11 | 207 | printMacAddress(); |
mcalzana | 0:c544827b6b11 | 208 | } |
mcalzana | 0:c544827b6b11 | 209 | |
mcalzana | 0:c544827b6b11 | 210 | void scheduleBleEventsProcessing(BLE::OnEventsToProcessCallbackContext* context) { |
mcalzana | 0:c544827b6b11 | 211 | BLE &ble = BLE::Instance(); |
mcalzana | 0:c544827b6b11 | 212 | eventQueue.call(Callback<void()>(&ble, &BLE::processEvents)); |
mcalzana | 0:c544827b6b11 | 213 | } |
mcalzana | 0:c544827b6b11 | 214 | |
mcalzana | 0:c544827b6b11 | 215 | void rise_handler_iterrupt_context(void) { |
mcalzana | 0:c544827b6b11 | 216 | toggledValue = 0x0; |
mcalzana | 0:c544827b6b11 | 217 | } |
mcalzana | 0:c544827b6b11 | 218 | |
mcalzana | 0:c544827b6b11 | 219 | void fall_handler_iterrupt_context(void) { |
mcalzana | 0:c544827b6b11 | 220 | toggledValue = 0x1; |
mcalzana | 0:c544827b6b11 | 221 | } |
mcalzana | 0:c544827b6b11 | 222 | |
mcalzana | 0:c544827b6b11 | 223 | int main() |
mcalzana | 0:c544827b6b11 | 224 | { |
mcalzana | 0:c544827b6b11 | 225 | |
mcalzana | 0:c544827b6b11 | 226 | triggerLedCharacteristic = false; |
mcalzana | 0:c544827b6b11 | 227 | eventQueue.call_every(500, periodicCallback); |
mcalzana | 0:c544827b6b11 | 228 | |
mcalzana | 0:c544827b6b11 | 229 | BLE &ble = BLE::Instance(); |
mcalzana | 0:c544827b6b11 | 230 | ble.onEventsToProcess(scheduleBleEventsProcessing); |
mcalzana | 0:c544827b6b11 | 231 | ble.init(bleInitComplete); |
mcalzana | 0:c544827b6b11 | 232 | button.rise(rise_handler_iterrupt_context); |
mcalzana | 0:c544827b6b11 | 233 | button.fall(fall_handler_iterrupt_context); |
mcalzana | 0:c544827b6b11 | 234 | |
mcalzana | 0:c544827b6b11 | 235 | eventQueue.dispatch_forever(); |
mcalzana | 0:c544827b6b11 | 236 | |
mcalzana | 0:c544827b6b11 | 237 | return 0; |
mcalzana | 0:c544827b6b11 | 238 | } |