Joshua Slater / Mbed 2 deprecated BHRM

init

Dependencies:   BLE_API mbed nRF51822

main.cpp@1:30f1232e4c17, 2015-07-27 (annotated)

Committer:
jslater8
Date:
Mon Jul 27 07:30:59 2015 +0000
Revision:
1:30f1232e4c17
Parent:
0:ef5229893eb9
Child:
2:2a2b4781cd8a
commandInterpreter uses input strings

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jslater8 0:ef5229893eb9 1 /* mbed Microcontroller Library
jslater8 0:ef5229893eb9 2 * Copyright (c) 2006-2015 ARM Limited
jslater8 0:ef5229893eb9 3 *
jslater8 0:ef5229893eb9 4 * Licensed under the Apache License, Version 2.0 (the "License");
jslater8 0:ef5229893eb9 5 * you may not use this file except in compliance with the License.
jslater8 0:ef5229893eb9 6 * You may obtain a copy of the License at
jslater8 0:ef5229893eb9 7 *
jslater8 0:ef5229893eb9 8 * http://www.apache.org/licenses/LICENSE-2.0
jslater8 0:ef5229893eb9 9 *
jslater8 0:ef5229893eb9 10 * Unless required by applicable law or agreed to in writing, software
jslater8 0:ef5229893eb9 11 * distributed under the License is distributed on an "AS IS" BASIS,
jslater8 0:ef5229893eb9 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
jslater8 0:ef5229893eb9 13 * See the License for the specific language governing permissions and
jslater8 0:ef5229893eb9 14 * limitations under the License.
jslater8 0:ef5229893eb9 15 */
jslater8 0:ef5229893eb9 16
jslater8 0:ef5229893eb9 17 #include "mbed.h"
jslater8 0:ef5229893eb9 18 #include "BLE.h"
jslater8 0:ef5229893eb9 19 #include "ble/DiscoveredCharacteristic.h"
jslater8 0:ef5229893eb9 20 #include "ble/DiscoveredService.h"
jslater8 0:ef5229893eb9 21 #define DUMP_ADV_DATA 0
jslater8 0:ef5229893eb9 22
jslater8 1:30f1232e4c17 23 #define BLE_CHECK(X) (X == BLE_ERROR_NONE) ? (printf("{{success}}\r\n")) : printf("{{failure}} %s at line %u ERROR CODE: %u\r\n", #X, __LINE__, (X));
jslater8 0:ef5229893eb9 24 #define BLE_EQUAL(X,Y) ((X)==(Y)) ? (printf("{{sucess}}\n")) : printf("{{failure}}\n");
jslater8 0:ef5229893eb9 25
jslater8 0:ef5229893eb9 26 BLE ble;
jslater8 0:ef5229893eb9 27 Gap::Address_t address;
jslater8 0:ef5229893eb9 28 Gap::AddressType_t *addressType;
jslater8 0:ef5229893eb9 29 DigitalOut myled(p21);
jslater8 0:ef5229893eb9 30 Ticker tick;
jslater8 0:ef5229893eb9 31 DiscoveredCharacteristic HRMCharacteristic;
jslater8 1:30f1232e4c17 32 bool HRMFound = false;
jslater8 1:30f1232e4c17 33 DiscoveredCharacteristic LEDCharacteristic;
jslater8 1:30f1232e4c17 34 bool LEDFound = false;
jslater8 1:30f1232e4c17 35 Gap::Handle_t aHandle;
jslater8 0:ef5229893eb9 36
jslater8 0:ef5229893eb9 37 void advertisementCallback(const Gap::AdvertisementCallbackParams_t *params) {
jslater8 0:ef5229893eb9 38 for (int i = 0; i < 5; i++){
jslater8 0:ef5229893eb9 39 if(address[i] != params->peerAddr[i]){
jslater8 0:ef5229893eb9 40 return;
jslater8 0:ef5229893eb9 41 }
jslater8 0:ef5229893eb9 42 }
jslater8 0:ef5229893eb9 43 //BLE_CHECK(ble.gap().connect(params->peerAddr,Gap::ADDR_TYPE_RANDOM_STATIC,NULL,NULL));
jslater8 0:ef5229893eb9 44 }
jslater8 0:ef5229893eb9 45
jslater8 0:ef5229893eb9 46 void serviceDiscoveryCallback(const DiscoveredService *service) {
jslater8 0:ef5229893eb9 47 if (service->getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
jslater8 0:ef5229893eb9 48 printf("S UUID-%x attrs[%u %u]\r\n", service->getUUID().getShortUUID(), service->getStartHandle(), service->getEndHandle());
jslater8 0:ef5229893eb9 49 } else {
jslater8 0:ef5229893eb9 50 printf("S UUID-");
jslater8 0:ef5229893eb9 51 const uint8_t *longUUIDBytes = service->getUUID().getBaseUUID();
jslater8 0:ef5229893eb9 52 for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) {
jslater8 0:ef5229893eb9 53 printf("%02x", longUUIDBytes[i]);
jslater8 0:ef5229893eb9 54 }
jslater8 0:ef5229893eb9 55 printf("attrs[%u %u]\r\n", service->getStartHandle(), service->getEndHandle());
jslater8 0:ef5229893eb9 56 }
jslater8 0:ef5229893eb9 57 }
jslater8 0:ef5229893eb9 58
jslater8 0:ef5229893eb9 59 void characteristicDiscoveryCallback(const DiscoveredCharacteristic *characteristicP) {
jslater8 1:30f1232e4c17 60 if (characteristicP->getShortUUID() == 0x2a37) {
jslater8 0:ef5229893eb9 61 HRMCharacteristic = *characteristicP;
jslater8 1:30f1232e4c17 62 HRMFound = true;
jslater8 1:30f1232e4c17 63 }
jslater8 1:30f1232e4c17 64 if (characteristicP->getShortUUID() == 0xA001){
jslater8 1:30f1232e4c17 65 LEDCharacteristic = *characteristicP;
jslater8 1:30f1232e4c17 66 LEDFound = true;
jslater8 0:ef5229893eb9 67 }
jslater8 0:ef5229893eb9 68 }
jslater8 0:ef5229893eb9 69
jslater8 0:ef5229893eb9 70 void connectionCallback(const Gap::ConnectionCallbackParams_t *params){
jslater8 0:ef5229893eb9 71 printf("Connected to: %d:%d:%d:%d:%d:%d\n", params->peerAddr[0], params->peerAddr[1], params->peerAddr[2], params->peerAddr[3], params->peerAddr[4], params->peerAddr[5]);
jslater8 0:ef5229893eb9 72 if (params->role == Gap::CENTRAL) {
jslater8 0:ef5229893eb9 73 // ble.gattClient().onServiceDiscoveryTermination(discoveryTerminationCallback);
jslater8 1:30f1232e4c17 74 aHandle = params->handle;
jslater8 1:30f1232e4c17 75 BLE_CHECK(ble.gattClient().launchServiceDiscovery(params->handle, serviceDiscoveryCallback, characteristicDiscoveryCallback));
jslater8 1:30f1232e4c17 76 //BLE_CHECK(ble.gattClient().launchServiceDiscovery(params->handle, serviceDiscoveryCallback, characteristicDiscoveryCallback, 0x180d, 0x2a37));
jslater8 1:30f1232e4c17 77 //BLE_CHECK(ble.gattClient().launchServiceDiscovery(params->handle, serviceDiscoveryCallback, characteristicDiscoveryCallback, 0xA000, 0xA001));
jslater8 0:ef5229893eb9 78 }
jslater8 0:ef5229893eb9 79 }
jslater8 0:ef5229893eb9 80
jslater8 0:ef5229893eb9 81 void triggerToggledWrite(const GattReadCallbackParams *response) {
jslater8 0:ef5229893eb9 82 if (response->handle == HRMCharacteristic.getValueHandle()) {
jslater8 1:30f1232e4c17 83 printf("HRMCounter: %d\n", response->data[1]);
jslater8 1:30f1232e4c17 84 }
jslater8 1:30f1232e4c17 85 if (response->handle == LEDCharacteristic.getValueHandle()) {
jslater8 1:30f1232e4c17 86 printf("LED: %d\n", response->data[0]);
jslater8 1:30f1232e4c17 87
jslater8 0:ef5229893eb9 88 }
jslater8 0:ef5229893eb9 89 }
jslater8 0:ef5229893eb9 90
jslater8 0:ef5229893eb9 91 void connectTest(){
jslater8 1:30f1232e4c17 92 if (!(ble.gap().getState().connected)){
jslater8 1:30f1232e4c17 93 BLE_CHECK(ble.gap().connect(address,Gap::ADDR_TYPE_RANDOM_STATIC,NULL,NULL));
jslater8 1:30f1232e4c17 94 }
jslater8 1:30f1232e4c17 95 else printf("Devices already connected\n");
jslater8 0:ef5229893eb9 96 }
jslater8 0:ef5229893eb9 97
jslater8 1:30f1232e4c17 98 void readTest(){
jslater8 1:30f1232e4c17 99 if (!(ble.gap().getState().connected)){
jslater8 1:30f1232e4c17 100 printf("Devices must be connected before this test can be run\n");
jslater8 1:30f1232e4c17 101 return;
jslater8 1:30f1232e4c17 102 }
jslater8 1:30f1232e4c17 103 if (HRMFound){
jslater8 1:30f1232e4c17 104 BLE_CHECK(HRMCharacteristic.read());
jslater8 1:30f1232e4c17 105 }
jslater8 1:30f1232e4c17 106 }
jslater8 1:30f1232e4c17 107 void writeTest(){
jslater8 1:30f1232e4c17 108 if (!(ble.gap().getState().connected)){
jslater8 1:30f1232e4c17 109 printf("Devices must be connected before this test can be run\n");
jslater8 1:30f1232e4c17 110 return;
jslater8 1:30f1232e4c17 111 }
jslater8 1:30f1232e4c17 112 uint8_t write_value = 1;
jslater8 1:30f1232e4c17 113 if (LEDFound){
jslater8 1:30f1232e4c17 114 BLE_CHECK(LEDCharacteristic.write(sizeof(write_value),&write_value));
jslater8 1:30f1232e4c17 115 wait(0.5);
jslater8 1:30f1232e4c17 116 BLE_CHECK(LEDCharacteristic.read());
jslater8 1:30f1232e4c17 117 }
jslater8 1:30f1232e4c17 118 }
jslater8 1:30f1232e4c17 119
jslater8 1:30f1232e4c17 120 void disconnectTest(){
jslater8 1:30f1232e4c17 121 if ((ble.gap().getState().connected)){
jslater8 1:30f1232e4c17 122 BLE_CHECK(ble.gap().disconnect(aHandle, Gap::REMOTE_USER_TERMINATED_CONNECTION));
jslater8 1:30f1232e4c17 123 }
jslater8 1:30f1232e4c17 124 else printf("Devices not connected\n");
jslater8 1:30f1232e4c17 125 }
jslater8 1:30f1232e4c17 126
jslater8 1:30f1232e4c17 127 void commandInterpreter(){
jslater8 1:30f1232e4c17 128 char command[50];
jslater8 1:30f1232e4c17 129 while(true){
jslater8 1:30f1232e4c17 130 scanf("%s", command);
jslater8 1:30f1232e4c17 131 if (!strcmp(command, "connect")) connectTest();
jslater8 1:30f1232e4c17 132 else if (!strcmp(command, "disconnect")) disconnectTest();
jslater8 1:30f1232e4c17 133 else if (!strcmp(command, "read characteristics")) readTest();
jslater8 1:30f1232e4c17 134 else if (!strcmp(command, "write characteristics")) writeTest();
jslater8 1:30f1232e4c17 135 }
jslater8 0:ef5229893eb9 136 }
jslater8 0:ef5229893eb9 137
jslater8 0:ef5229893eb9 138 int main(void)
jslater8 0:ef5229893eb9 139 {
jslater8 0:ef5229893eb9 140 myled = 1;
jslater8 0:ef5229893eb9 141 printf("{{success}}" "\n" "{{end}}" "\n");
jslater8 0:ef5229893eb9 142 ble.init();
jslater8 0:ef5229893eb9 143
jslater8 0:ef5229893eb9 144 scanf("%hhu",&address[0]);
jslater8 0:ef5229893eb9 145 scanf("%hhu",&address[1]);
jslater8 0:ef5229893eb9 146 scanf("%hhu",&address[2]);
jslater8 0:ef5229893eb9 147 scanf("%hhu",&address[3]);
jslater8 0:ef5229893eb9 148 scanf("%hhu",&address[4]);
jslater8 0:ef5229893eb9 149 scanf("%hhu",&address[5]);
jslater8 0:ef5229893eb9 150
jslater8 0:ef5229893eb9 151
jslater8 0:ef5229893eb9 152 BLE_CHECK(ble.gap().setScanParams(500 /* scan interval */, 200 /* scan window */));
jslater8 0:ef5229893eb9 153 BLE_CHECK(ble.gap().startScan(advertisementCallback));
jslater8 0:ef5229893eb9 154 ble.gap().onConnection(connectionCallback);
jslater8 0:ef5229893eb9 155 ble.gattClient().onDataRead(triggerToggledWrite);
jslater8 0:ef5229893eb9 156
jslater8 1:30f1232e4c17 157 commandInterpreter();
jslater8 0:ef5229893eb9 158 }