Joshua Slater / Mbed 2 deprecated AHRM

init

Dependencies:   BLE_API mbed nRF51822

main.cpp@1:4bdebb81dcd5, 2015-07-27 (annotated)

Committer:
jslater8
Date:
Mon Jul 27 07:30:47 2015 +0000
Revision:
1:4bdebb81dcd5
Parent:
0:84779d0d1ff5
Child:
2:95c770f35636
commandInterpreter uses input strings

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jslater8 0:84779d0d1ff5 1 /* mbed Microcontroller Library
jslater8 0:84779d0d1ff5 2 * Copyright (c) 2006-2015 ARM Limited
jslater8 0:84779d0d1ff5 3 *
jslater8 0:84779d0d1ff5 4 * Licensed under the Apache License, Version 2.0 (the "License");
jslater8 0:84779d0d1ff5 5 * you may not use this file except in compliance with the License.
jslater8 0:84779d0d1ff5 6 * You may obtain a copy of the License at
jslater8 0:84779d0d1ff5 7 *
jslater8 0:84779d0d1ff5 8 * http://www.apache.org/licenses/LICENSE-2.0
jslater8 0:84779d0d1ff5 9 *
jslater8 0:84779d0d1ff5 10 * Unless required by applicable law or agreed to in writing, software
jslater8 0:84779d0d1ff5 11 * distributed under the License is distributed on an "AS IS" BASIS,
jslater8 0:84779d0d1ff5 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
jslater8 0:84779d0d1ff5 13 * See the License for the specific language governing permissions and
jslater8 0:84779d0d1ff5 14 * limitations under the License.
jslater8 0:84779d0d1ff5 15 */
jslater8 0:84779d0d1ff5 16
jslater8 0:84779d0d1ff5 17 #include "mbed.h"
jslater8 0:84779d0d1ff5 18 #include "ble/BLE.h"
jslater8 0:84779d0d1ff5 19 #include "ble/services/HeartRateService.h"
jslater8 0:84779d0d1ff5 20 #include "ble/services/BatteryService.h"
jslater8 0:84779d0d1ff5 21 #include "ble/services/DeviceInformationService.h"
jslater8 0:84779d0d1ff5 22 #include "LEDService.h"
jslater8 0:84779d0d1ff5 23
jslater8 0:84779d0d1ff5 24 #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:84779d0d1ff5 25 #define BLE_EQUAL(X,Y) ((X)==(Y)) ? (printf("{{sucess}}\n")) : printf("{{failure}}\n");
jslater8 0:84779d0d1ff5 26
jslater8 0:84779d0d1ff5 27 BLE ble;
jslater8 0:84779d0d1ff5 28 DigitalOut led1(LED1);
jslater8 0:84779d0d1ff5 29 Gap::Address_t address;
jslater8 0:84779d0d1ff5 30 Gap::AddressType_t *addressType;
jslater8 0:84779d0d1ff5 31
jslater8 0:84779d0d1ff5 32 const static char DEVICE_NAME[] = "HRMTEST";
jslater8 0:84779d0d1ff5 33 static const uint16_t uuid16_list[] = {GattService::UUID_HEART_RATE_SERVICE,
jslater8 1:4bdebb81dcd5 34 GattService::UUID_DEVICE_INFORMATION_SERVICE,
jslater8 1:4bdebb81dcd5 35 LEDService::LED_SERVICE_UUID};
jslater8 0:84779d0d1ff5 36 static volatile bool triggerSensorPolling = false;
jslater8 0:84779d0d1ff5 37
jslater8 0:84779d0d1ff5 38 void disconnectionCallback(Gap::Handle_t handle, Gap::DisconnectionReason_t reason)
jslater8 0:84779d0d1ff5 39 {
jslater8 0:84779d0d1ff5 40 ble.gap().startAdvertising(); // restart advertising
jslater8 0:84779d0d1ff5 41 }
jslater8 0:84779d0d1ff5 42
jslater8 0:84779d0d1ff5 43 void periodicCallback(void)
jslater8 0:84779d0d1ff5 44 {
jslater8 0:84779d0d1ff5 45 led1 = !led1; /* Do blinky on LED1 while we're waiting for BLE events */
jslater8 0:84779d0d1ff5 46
jslater8 0:84779d0d1ff5 47 /* Note that the periodicCallback() executes in interrupt context, so it is safer to do
jslater8 0:84779d0d1ff5 48 * heavy-weight sensor polling from the main thread. */
jslater8 0:84779d0d1ff5 49 }
jslater8 0:84779d0d1ff5 50
jslater8 0:84779d0d1ff5 51 void connectionCallback(const Gap::ConnectionCallbackParams_t *params){
jslater8 0:84779d0d1ff5 52 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:84779d0d1ff5 53
jslater8 0:84779d0d1ff5 54 }
jslater8 0:84779d0d1ff5 55
jslater8 0:84779d0d1ff5 56 void dataReadCallback(const GattReadCallbackParams *params){
jslater8 0:84779d0d1ff5 57 printf("%d\n", params->data[1]);
jslater8 0:84779d0d1ff5 58 }
jslater8 0:84779d0d1ff5 59
jslater8 0:84779d0d1ff5 60 void testDeviceName(){
jslater8 1:4bdebb81dcd5 61 if (ble.gap().getState().connected){
jslater8 1:4bdebb81dcd5 62 printf("Device must be disconnected\n");
jslater8 1:4bdebb81dcd5 63 return;
jslater8 1:4bdebb81dcd5 64 }
jslater8 0:84779d0d1ff5 65 uint8_t deviceName[10];
jslater8 0:84779d0d1ff5 66 uint8_t deviceNameIn[] = {0x4A, 0x4F, 0x53, 0x48, 0x54, 0x45, 0x53, 0x54, 0x00};
jslater8 0:84779d0d1ff5 67 unsigned length = 10;
jslater8 0:84779d0d1ff5 68 BLE_CHECK(ble.gap().setDeviceName(deviceNameIn));
jslater8 1:4bdebb81dcd5 69 wait(0.5);
jslater8 0:84779d0d1ff5 70 BLE_CHECK(ble.gap().getDeviceName(deviceName, &length));
jslater8 1:4bdebb81dcd5 71 wait(0.5);
jslater8 0:84779d0d1ff5 72 for (int i = 0; i < length; i++){
jslater8 0:84779d0d1ff5 73 printf("%02x ", deviceName[i]);
jslater8 0:84779d0d1ff5 74 }
jslater8 0:84779d0d1ff5 75 printf("\r\n");
jslater8 0:84779d0d1ff5 76 for (int i = 0; i < 8; i++){
jslater8 0:84779d0d1ff5 77 printf("%02x ", deviceNameIn[i]);
jslater8 0:84779d0d1ff5 78 }
jslater8 0:84779d0d1ff5 79 printf("\r\n");
jslater8 0:84779d0d1ff5 80 }
jslater8 0:84779d0d1ff5 81
jslater8 0:84779d0d1ff5 82 void testAppearance(){
jslater8 1:4bdebb81dcd5 83 if ((ble.gap().getState().connected)){
jslater8 1:4bdebb81dcd5 84 printf("Device must be disconnected\n");
jslater8 1:4bdebb81dcd5 85 return;
jslater8 1:4bdebb81dcd5 86 }
jslater8 0:84779d0d1ff5 87 GapAdvertisingData::Appearance appearance;
jslater8 0:84779d0d1ff5 88 BLE_CHECK(ble.gap().setAppearance(GapAdvertisingData::GENERIC_PHONE));
jslater8 1:4bdebb81dcd5 89 wait(0.5);
jslater8 0:84779d0d1ff5 90 BLE_CHECK(ble.gap().getAppearance(&appearance));
jslater8 1:4bdebb81dcd5 91 wait(0.5);
jslater8 0:84779d0d1ff5 92 printf("%d\r\n",appearance);
jslater8 0:84779d0d1ff5 93 }
jslater8 0:84779d0d1ff5 94
jslater8 0:84779d0d1ff5 95 void connParams(){
jslater8 1:4bdebb81dcd5 96 if ((ble.gap().getState().connected)){
jslater8 1:4bdebb81dcd5 97 printf("Device must be disconnected\n");
jslater8 1:4bdebb81dcd5 98 return;
jslater8 1:4bdebb81dcd5 99 }
jslater8 0:84779d0d1ff5 100 Gap::ConnectionParams_t params;
jslater8 0:84779d0d1ff5 101 Gap::ConnectionParams_t paramsOut = {50,500,0,500};
jslater8 0:84779d0d1ff5 102 Gap::ConnectionParams_t temp;
jslater8 0:84779d0d1ff5 103 BLE_CHECK(ble.gap().getPreferredConnectionParams(&temp));
jslater8 0:84779d0d1ff5 104 BLE_CHECK(ble.gap().setPreferredConnectionParams(&paramsOut));
jslater8 0:84779d0d1ff5 105 ble.gap().getPreferredConnectionParams(&params);
jslater8 0:84779d0d1ff5 106 printf("%d\n", params.minConnectionInterval);
jslater8 0:84779d0d1ff5 107 printf("%d\n", params.maxConnectionInterval);
jslater8 0:84779d0d1ff5 108 printf("%d\n", params.slaveLatency);
jslater8 0:84779d0d1ff5 109 printf("%d\n", params.connectionSupervisionTimeout);
jslater8 0:84779d0d1ff5 110 ble.gap().setPreferredConnectionParams(&temp);
jslater8 0:84779d0d1ff5 111
jslater8 0:84779d0d1ff5 112 }
jslater8 0:84779d0d1ff5 113
jslater8 1:4bdebb81dcd5 114 void commandInterpreter(void){
jslater8 1:4bdebb81dcd5 115 char command[50];
jslater8 0:84779d0d1ff5 116 while(1){
jslater8 1:4bdebb81dcd5 117 scanf("%s", command);
jslater8 1:4bdebb81dcd5 118 if (!strcmp(command, "setDeviceName")) testDeviceName();
jslater8 1:4bdebb81dcd5 119 else if (!strcmp(command, "setAppearance")) testAppearance();
jslater8 1:4bdebb81dcd5 120 else if (!strcmp(command, "testConnectionParams")) connParams();
jslater8 0:84779d0d1ff5 121 }
jslater8 0:84779d0d1ff5 122 }
jslater8 0:84779d0d1ff5 123
jslater8 0:84779d0d1ff5 124 int main(void)
jslater8 0:84779d0d1ff5 125 {
jslater8 0:84779d0d1ff5 126 led1 = 1;
jslater8 0:84779d0d1ff5 127 Ticker ticker;
jslater8 0:84779d0d1ff5 128 ticker.attach(periodicCallback, 1); // blink LED every second
jslater8 0:84779d0d1ff5 129
jslater8 0:84779d0d1ff5 130 BLE_CHECK(ble.init());
jslater8 0:84779d0d1ff5 131 ble.gap().onDisconnection(disconnectionCallback);
jslater8 0:84779d0d1ff5 132 ble.gap().onConnection(connectionCallback);
jslater8 0:84779d0d1ff5 133 /* Setup primary service. */
jslater8 0:84779d0d1ff5 134 uint8_t hrmCounter = 100; // init HRM to 100bps
jslater8 0:84779d0d1ff5 135 HeartRateService hrService(ble, hrmCounter, HeartRateService::LOCATION_FINGER);
jslater8 1:4bdebb81dcd5 136
jslater8 1:4bdebb81dcd5 137 bool initialValueForLEDCharacteristic = false;
jslater8 1:4bdebb81dcd5 138 LEDService ledService(ble, initialValueForLEDCharacteristic);
jslater8 0:84779d0d1ff5 139
jslater8 0:84779d0d1ff5 140 /* Setup auxiliary service. */
jslater8 0:84779d0d1ff5 141 DeviceInformationService deviceInfo(ble, "ARM", "Model1", "SN1", "hw-rev1", "fw-rev1", "soft-rev1");
jslater8 0:84779d0d1ff5 142
jslater8 0:84779d0d1ff5 143 /* Setup advertising. */
jslater8 0:84779d0d1ff5 144 BLE_CHECK(ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE));
jslater8 0:84779d0d1ff5 145 BLE_CHECK(ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list)));
jslater8 0:84779d0d1ff5 146 BLE_CHECK(ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_HEART_RATE_SENSOR));
jslater8 0:84779d0d1ff5 147 BLE_CHECK(ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME)));
jslater8 0:84779d0d1ff5 148 ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
jslater8 0:84779d0d1ff5 149 ble.gap().setAdvertisingInterval(1000); /* 1000ms */
jslater8 0:84779d0d1ff5 150
jslater8 0:84779d0d1ff5 151 BLE_CHECK(ble.gap().startAdvertising());
jslater8 0:84779d0d1ff5 152 BLE_CHECK(ble.gap().getAddress(addressType, address));
jslater8 0:84779d0d1ff5 153 printf("{{success}}" "\n" "{{end}}" "\n");
jslater8 0:84779d0d1ff5 154 int x;
jslater8 0:84779d0d1ff5 155 scanf("%d" , &x);
jslater8 0:84779d0d1ff5 156 printf("%d:%d:%d:%d:%d:%d\n", address[0], address[1], address[2], address[3], address[4], address[5]);
jslater8 1:4bdebb81dcd5 157 commandInterpreter();
jslater8 1:4bdebb81dcd5 158 /*
jslater8 0:84779d0d1ff5 159 scanf("%d", &x);
jslater8 0:84779d0d1ff5 160 testDeviceName();
jslater8 0:84779d0d1ff5 161 //printf("%d\n",ble.gattServer().onDataRead(dataReadCallback));
jslater8 0:84779d0d1ff5 162 scanf("%d", &x);
jslater8 0:84779d0d1ff5 163 testAppearance();
jslater8 0:84779d0d1ff5 164 scanf("%d", &x);
jslater8 0:84779d0d1ff5 165 connParams();
jslater8 0:84779d0d1ff5 166 // infinite loop
jslater8 0:84779d0d1ff5 167 while (1) {
jslater8 0:84779d0d1ff5 168 // check for trigger from periodicCallback()
jslater8 0:84779d0d1ff5 169 if (triggerSensorPolling && ble.getGapState().connected) {
jslater8 0:84779d0d1ff5 170 triggerSensorPolling = false;
jslater8 0:84779d0d1ff5 171
jslater8 0:84779d0d1ff5 172 // Do blocking calls or whatever is necessary for sensor polling.
jslater8 0:84779d0d1ff5 173 // In our case, we simply update the HRM measurement.
jslater8 0:84779d0d1ff5 174 hrmCounter++;
jslater8 0:84779d0d1ff5 175 // 100 <= HRM bps <=175
jslater8 0:84779d0d1ff5 176 if (hrmCounter == 175) {
jslater8 0:84779d0d1ff5 177 hrmCounter = 100;
jslater8 0:84779d0d1ff5 178 }
jslater8 0:84779d0d1ff5 179 // update bps
jslater8 0:84779d0d1ff5 180 hrService.updateHeartRate(hrmCounter);
jslater8 0:84779d0d1ff5 181 } else {
jslater8 0:84779d0d1ff5 182 ble.waitForEvent(); // low power wait for event
jslater8 0:84779d0d1ff5 183 }
jslater8 0:84779d0d1ff5 184 }
jslater8 1:4bdebb81dcd5 185 */
jslater8 0:84779d0d1ff5 186 }