init

Dependencies:   BLE_API mbed nRF51822

Committer:
jslater8
Date:
Mon Jul 27 13:30:01 2015 +0000
Revision:
2:2a2b4781cd8a
Parent:
1:30f1232e4c17
Child:
3:88f7aa6c2a75
fixed bugs with commandInterpreter

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 2:2a2b4781cd8a 26 BLE ble;
jslater8 2:2a2b4781cd8a 27 Gap::Address_t address;
jslater8 0:ef5229893eb9 28 Gap::AddressType_t *addressType;
jslater8 2:2a2b4781cd8a 29
jslater8 0:ef5229893eb9 30 DiscoveredCharacteristic HRMCharacteristic;
jslater8 2:2a2b4781cd8a 31 bool HRMFound = false;
jslater8 1:30f1232e4c17 32 DiscoveredCharacteristic LEDCharacteristic;
jslater8 2:2a2b4781cd8a 33 bool LEDFound = false;
jslater8 2:2a2b4781cd8a 34 Gap::Handle_t deviceAHandle;
jslater8 0:ef5229893eb9 35
jslater8 0:ef5229893eb9 36 void advertisementCallback(const Gap::AdvertisementCallbackParams_t *params) {
jslater8 0:ef5229893eb9 37 for (int i = 0; i < 5; i++){
jslater8 0:ef5229893eb9 38 if(address[i] != params->peerAddr[i]){
jslater8 0:ef5229893eb9 39 return;
jslater8 0:ef5229893eb9 40 }
jslater8 0:ef5229893eb9 41 }
jslater8 0:ef5229893eb9 42 }
jslater8 0:ef5229893eb9 43
jslater8 0:ef5229893eb9 44 void serviceDiscoveryCallback(const DiscoveredService *service) {
jslater8 0:ef5229893eb9 45 if (service->getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
jslater8 0:ef5229893eb9 46 printf("S UUID-%x attrs[%u %u]\r\n", service->getUUID().getShortUUID(), service->getStartHandle(), service->getEndHandle());
jslater8 0:ef5229893eb9 47 } else {
jslater8 0:ef5229893eb9 48 printf("S UUID-");
jslater8 0:ef5229893eb9 49 const uint8_t *longUUIDBytes = service->getUUID().getBaseUUID();
jslater8 0:ef5229893eb9 50 for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) {
jslater8 0:ef5229893eb9 51 printf("%02x", longUUIDBytes[i]);
jslater8 0:ef5229893eb9 52 }
jslater8 0:ef5229893eb9 53 printf("attrs[%u %u]\r\n", service->getStartHandle(), service->getEndHandle());
jslater8 0:ef5229893eb9 54 }
jslater8 0:ef5229893eb9 55 }
jslater8 0:ef5229893eb9 56
jslater8 0:ef5229893eb9 57 void characteristicDiscoveryCallback(const DiscoveredCharacteristic *characteristicP) {
jslater8 1:30f1232e4c17 58 if (characteristicP->getShortUUID() == 0x2a37) {
jslater8 0:ef5229893eb9 59 HRMCharacteristic = *characteristicP;
jslater8 1:30f1232e4c17 60 HRMFound = true;
jslater8 1:30f1232e4c17 61 }
jslater8 1:30f1232e4c17 62 if (characteristicP->getShortUUID() == 0xA001){
jslater8 1:30f1232e4c17 63 LEDCharacteristic = *characteristicP;
jslater8 1:30f1232e4c17 64 LEDFound = true;
jslater8 0:ef5229893eb9 65 }
jslater8 0:ef5229893eb9 66 }
jslater8 0:ef5229893eb9 67
jslater8 0:ef5229893eb9 68 void connectionCallback(const Gap::ConnectionCallbackParams_t *params){
jslater8 0:ef5229893eb9 69 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 70 if (params->role == Gap::CENTRAL) {
jslater8 0:ef5229893eb9 71 // ble.gattClient().onServiceDiscoveryTermination(discoveryTerminationCallback);
jslater8 2:2a2b4781cd8a 72 deviceAHandle = params->handle;
jslater8 1:30f1232e4c17 73 BLE_CHECK(ble.gattClient().launchServiceDiscovery(params->handle, serviceDiscoveryCallback, characteristicDiscoveryCallback));
jslater8 1:30f1232e4c17 74 //BLE_CHECK(ble.gattClient().launchServiceDiscovery(params->handle, serviceDiscoveryCallback, characteristicDiscoveryCallback, 0x180d, 0x2a37));
jslater8 1:30f1232e4c17 75 //BLE_CHECK(ble.gattClient().launchServiceDiscovery(params->handle, serviceDiscoveryCallback, characteristicDiscoveryCallback, 0xA000, 0xA001));
jslater8 0:ef5229893eb9 76 }
jslater8 0:ef5229893eb9 77 }
jslater8 0:ef5229893eb9 78
jslater8 0:ef5229893eb9 79 void triggerToggledWrite(const GattReadCallbackParams *response) {
jslater8 0:ef5229893eb9 80 if (response->handle == HRMCharacteristic.getValueHandle()) {
jslater8 1:30f1232e4c17 81 printf("HRMCounter: %d\n", response->data[1]);
jslater8 1:30f1232e4c17 82 }
jslater8 1:30f1232e4c17 83 if (response->handle == LEDCharacteristic.getValueHandle()) {
jslater8 1:30f1232e4c17 84 printf("LED: %d\n", response->data[0]);
jslater8 1:30f1232e4c17 85
jslater8 0:ef5229893eb9 86 }
jslater8 0:ef5229893eb9 87 }
jslater8 0:ef5229893eb9 88
jslater8 0:ef5229893eb9 89 void connectTest(){
jslater8 1:30f1232e4c17 90 if (!(ble.gap().getState().connected)){
jslater8 1:30f1232e4c17 91 BLE_CHECK(ble.gap().connect(address,Gap::ADDR_TYPE_RANDOM_STATIC,NULL,NULL));
jslater8 1:30f1232e4c17 92 }
jslater8 1:30f1232e4c17 93 else printf("Devices already connected\n");
jslater8 0:ef5229893eb9 94 }
jslater8 0:ef5229893eb9 95
jslater8 1:30f1232e4c17 96 void readTest(){
jslater8 2:2a2b4781cd8a 97 myled = 0;
jslater8 1:30f1232e4c17 98 if (!(ble.gap().getState().connected)){
jslater8 1:30f1232e4c17 99 printf("Devices must be connected before this test can be run\n");
jslater8 1:30f1232e4c17 100 return;
jslater8 1:30f1232e4c17 101 }
jslater8 1:30f1232e4c17 102 if (HRMFound){
jslater8 1:30f1232e4c17 103 BLE_CHECK(HRMCharacteristic.read());
jslater8 1:30f1232e4c17 104 }
jslater8 1:30f1232e4c17 105 }
jslater8 1:30f1232e4c17 106 void writeTest(){
jslater8 1:30f1232e4c17 107 if (!(ble.gap().getState().connected)){
jslater8 1:30f1232e4c17 108 printf("Devices must be connected before this test can be run\n");
jslater8 1:30f1232e4c17 109 return;
jslater8 1:30f1232e4c17 110 }
jslater8 1:30f1232e4c17 111 uint8_t write_value = 1;
jslater8 1:30f1232e4c17 112 if (LEDFound){
jslater8 1:30f1232e4c17 113 BLE_CHECK(LEDCharacteristic.write(sizeof(write_value),&write_value));
jslater8 1:30f1232e4c17 114 wait(0.5);
jslater8 1:30f1232e4c17 115 BLE_CHECK(LEDCharacteristic.read());
jslater8 1:30f1232e4c17 116 }
jslater8 1:30f1232e4c17 117 }
jslater8 1:30f1232e4c17 118
jslater8 1:30f1232e4c17 119 void disconnectTest(){
jslater8 1:30f1232e4c17 120 if ((ble.gap().getState().connected)){
jslater8 2:2a2b4781cd8a 121 BLE_CHECK(ble.gap().disconnect(deviceAHandle, Gap::REMOTE_USER_TERMINATED_CONNECTION));
jslater8 1:30f1232e4c17 122 }
jslater8 1:30f1232e4c17 123 else printf("Devices not connected\n");
jslater8 1:30f1232e4c17 124 }
jslater8 1:30f1232e4c17 125
jslater8 1:30f1232e4c17 126 void commandInterpreter(){
jslater8 1:30f1232e4c17 127 char command[50];
jslater8 1:30f1232e4c17 128 while(true){
jslater8 1:30f1232e4c17 129 scanf("%s", command);
jslater8 1:30f1232e4c17 130 if (!strcmp(command, "connect")) connectTest();
jslater8 1:30f1232e4c17 131 else if (!strcmp(command, "disconnect")) disconnectTest();
jslater8 2:2a2b4781cd8a 132 else if (!strcmp(command, "read")) readTest();
jslater8 2:2a2b4781cd8a 133 else if (!strcmp(command, "write")) writeTest();
jslater8 1:30f1232e4c17 134 }
jslater8 0:ef5229893eb9 135 }
jslater8 0:ef5229893eb9 136
jslater8 0:ef5229893eb9 137 int main(void)
jslater8 0:ef5229893eb9 138 {
jslater8 0:ef5229893eb9 139 myled = 1;
jslater8 0:ef5229893eb9 140 printf("{{success}}" "\n" "{{end}}" "\n");
jslater8 0:ef5229893eb9 141 ble.init();
jslater8 0:ef5229893eb9 142 scanf("%hhu",&address[0]);
jslater8 0:ef5229893eb9 143 scanf("%hhu",&address[1]);
jslater8 0:ef5229893eb9 144 scanf("%hhu",&address[2]);
jslater8 0:ef5229893eb9 145 scanf("%hhu",&address[3]);
jslater8 0:ef5229893eb9 146 scanf("%hhu",&address[4]);
jslater8 0:ef5229893eb9 147 scanf("%hhu",&address[5]);
jslater8 0:ef5229893eb9 148
jslater8 0:ef5229893eb9 149
jslater8 0:ef5229893eb9 150 BLE_CHECK(ble.gap().setScanParams(500 /* scan interval */, 200 /* scan window */));
jslater8 0:ef5229893eb9 151 BLE_CHECK(ble.gap().startScan(advertisementCallback));
jslater8 0:ef5229893eb9 152 ble.gap().onConnection(connectionCallback);
jslater8 0:ef5229893eb9 153 ble.gattClient().onDataRead(triggerToggledWrite);
jslater8 0:ef5229893eb9 154
jslater8 1:30f1232e4c17 155 commandInterpreter();
jslater8 0:ef5229893eb9 156 }