Icarus Sensors
cycle speed and cadence service
Dependencies: BLE_API mbed nRF51822
Fork of
Bluetooth_Heart_Rate_Monitor_dummy
by 
Icarus Sensors
Diff: main.cpp
- Revision:
- 3:24e2b056d229
- Parent:
- 0:87a7fc231fae
- Child:
- 4:12890f3c62eb
--- a/main.cpp Thu Apr 03 01:09:02 2014 +0000
+++ b/main.cpp Wed May 21 14:39:35 2014 +0100
@@ -17,43 +17,56 @@
#include "mbed.h"
#include "nRF51822n.h"
-nRF51822n nrf; /* BLE radio driver */
+nRF51822n nrf; /* BLE radio driver */
-DigitalOut led1(LED1);
-DigitalOut led2(LED2);
-Ticker flipper;
-Serial pc(USBTX,USBRX);
+DigitalOut led1(LED1);
+DigitalOut led2(LED2);
+Ticker flipper;
+Serial pc(USBTX, USBRX);
/* Battery Level Service */
-uint8_t batt = 72; /* Battery level */
+uint8_t batt = 72; /* Battery level */
uint8_t read_batt = 0; /* Variable to hold battery level reads */
-GattService battService ( GattService::UUID_BATTERY_SERVICE );
-GattCharacteristic battLevel ( GattCharacteristic::UUID_BATTERY_LEVEL_CHAR, 1, 1,
- GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY |
- GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ);
+GattService battService (GattService::UUID_BATTERY_SERVICE);
+GattCharacteristic battLevel (GattCharacteristic::UUID_BATTERY_LEVEL_CHAR,
+ 1,
+ 1,
+ GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY |
+ GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ);
/* Heart Rate Service */
/* Service: https://developer.bluetooth.org/gatt/services/Pages/ServiceViewer.aspx?u=org.bluetooth.service.heart_rate.xml */
/* HRM Char: https://developer.bluetooth.org/gatt/characteristics/Pages/CharacteristicViewer.aspx?u=org.bluetooth.characteristic.heart_rate_measurement.xml */
/* Location: https://developer.bluetooth.org/gatt/characteristics/Pages/CharacteristicViewer.aspx?u=org.bluetooth.characteristic.body_sensor_location.xml */
-GattService hrmService ( GattService::UUID_HEART_RATE_SERVICE );
-GattCharacteristic hrmRate ( GattCharacteristic::UUID_HEART_RATE_MEASUREMENT_CHAR, 2, 3, GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY );
-GattCharacteristic hrmLocation ( GattCharacteristic::UUID_BODY_SENSOR_LOCATION_CHAR, 1, 1, GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ );
+GattService hrmService (GattService::UUID_HEART_RATE_SERVICE);
+GattCharacteristic hrmRate (
+ GattCharacteristic::UUID_HEART_RATE_MEASUREMENT_CHAR,
+ 2,
+ 3,
+ GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY);
+GattCharacteristic hrmLocation (
+ GattCharacteristic::UUID_BODY_SENSOR_LOCATION_CHAR,
+ 1,
+ 1,
+ GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ);
/* Device Information service */
-uint8_t deviceName[4] = { 'm', 'b', 'e', 'd' };
-GattService deviceInformationService ( GattService::UUID_DEVICE_INFORMATION_SERVICE );
-GattCharacteristic deviceManufacturer ( GattCharacteristic::UUID_MANUFACTURER_NAME_STRING_CHAR,
- sizeof(deviceName), sizeof(deviceName),
- GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ);
+uint8_t deviceName[4] = {'m', 'b', 'e', 'd'};
+GattService deviceInformationService (
+ GattService::UUID_DEVICE_INFORMATION_SERVICE);
+GattCharacteristic deviceManufacturer (
+ GattCharacteristic::UUID_MANUFACTURER_NAME_STRING_CHAR,
+ sizeof(deviceName),
+ sizeof(deviceName),
+ GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ);
/* Advertising data and parameters */
-GapAdvertisingData advData;
-GapAdvertisingData scanResponse;
-GapAdvertisingParams advParams ( GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED );
-uint16_t uuid16_list[] = { GattService::UUID_BATTERY_SERVICE,
- GattService::UUID_DEVICE_INFORMATION_SERVICE,
- GattService::UUID_HEART_RATE_SERVICE };
+GapAdvertisingData advData;
+GapAdvertisingData scanResponse;
+GapAdvertisingParams advParams (GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
+uint16_t uuid16_list[] = {GattService::UUID_BATTERY_SERVICE,
+ GattService::UUID_DEVICE_INFORMATION_SERVICE,
+ GattService::UUID_HEART_RATE_SERVICE};
void tickerCallback(void);
@@ -65,12 +78,12 @@
/**************************************************************************/
class GapEventHandler : public GapEvents
{
- virtual void onTimeout(void)
+ virtual void onTimeout(void)
{
pc.printf("Advertising Timeout!\n\r");
// Restart the advertising process with a much slower interval,
// only start advertising again after a button press, etc.
- }
+ }
virtual void onConnected(void)
{
@@ -95,21 +108,19 @@
{
//virtual void onDataSent(uint16_t charHandle) {}
//virtual void onDataWritten(uint16_t charHandle) {}
-
+
virtual void onUpdatesEnabled(uint16_t charHandle)
{
- if (charHandle == hrmRate.handle)
- {
- pc.printf("Heart rate notify enabled\n\r");
- }
+ if (charHandle == hrmRate.handle) {
+ pc.printf("Heart rate notify enabled\n\r");
+ }
}
virtual void onUpdatesDisabled(uint16_t charHandle)
{
- if (charHandle == hrmRate.handle)
- {
- pc.printf("Heart rate notify disabled\n\r");
- }
+ if (charHandle == hrmRate.handle) {
+ pc.printf("Heart rate notify disabled\n\r");
+ }
}
//virtual void onConfirmationReceived(uint16_t charHandle) {}
@@ -124,10 +135,10 @@
{
*(uint32_t *)0x40000504 = 0xC007FFDF;
*(uint32_t *)0x40006C18 = 0x00008000;
-
+
/* Setup blinky: led1 is toggled in main, led2 is toggled via Ticker */
- led1=1;
- led2=1;
+ led1 = 1;
+ led2 = 1;
flipper.attach(&tickerCallback, 1.0);
/* Setup the local GAP/GATT event handlers */
@@ -143,8 +154,8 @@
/* Add BLE-Only flag and complete service list to the advertising data */
advData.addFlags(GapAdvertisingData::BREDR_NOT_SUPPORTED);
- advData.addData(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS,
- (uint8_t*)uuid16_list, sizeof(uuid16_list));
+ advData.addData(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS,
+ (uint8_t *)uuid16_list, sizeof(uuid16_list));
advData.addAppearance(GapAdvertisingData::HEART_RATE_SENSOR_HEART_RATE_BELT);
nrf.getGap().setAdvertisingData(advData, scanResponse);
@@ -155,51 +166,61 @@
/* Add the Device Information service */
deviceInformationService.addCharacteristic(deviceManufacturer);
nrf.getGattServer().addService(deviceInformationService);
-
+
/* Add the Heart Rate service */
hrmService.addCharacteristic(hrmRate);
hrmService.addCharacteristic(hrmLocation);
nrf.getGattServer().addService(hrmService);
-
+
/* Start advertising (make sure you've added all your data first) */
nrf.getGap().startAdvertising(advParams);
-
- /* Wait until we are connected to a central device before updating anything */
+
+ /* Wait until we are connected to a central device before updating
+ * anything */
pc.printf("Waiting for a connection ...");
- while(!nrf.getGap().state.connected)
- {
+ while (!nrf.getGap().state.connected) {
}
pc.printf("Connected!\n\r");
-
+
/* Now that we're live, update the battery level characteristic, and */
/* change the device manufacturer characteristic to 'mbed' */
- nrf.getGattServer().updateValue(battLevel.handle, (uint8_t*)&batt, sizeof(batt));
- nrf.getGattServer().updateValue(deviceManufacturer.handle, deviceName, sizeof(deviceName));
+ nrf.getGattServer().updateValue(battLevel.handle, (uint8_t *)&batt,
+ sizeof(batt));
+ nrf.getGattServer().updateValue(deviceManufacturer.handle,
+ deviceName,
+ sizeof(deviceName));
/* Set the heart rate monitor location (one time only) */
/* See --> https://developer.bluetooth.org/gatt/characteristics/Pages/CharacteristicViewer.aspx?u=org.bluetooth.characteristic.body_sensor_location.xml */
uint8_t location = 0x03; /* Finger */
uint8_t hrmCounter = 100;
- nrf.getGattServer().updateValue(hrmLocation.handle, (uint8_t*)&location, sizeof(location));
+ nrf.getGattServer().updateValue(hrmLocation.handle,
+ (uint8_t *)&location,
+ sizeof(location));
/* Do blinky on LED1 while we're waiting for BLE events */
- for (;;)
- {
- led1 = !led1;
- wait(1);
-
- /* Update battery level */
- batt++;
- if (batt > 100) batt = 72;
- nrf.getGattServer().updateValue(battLevel.handle, (uint8_t*)&batt, sizeof(batt));
+ for (;; ) {
+ led1 = !led1;
+ wait(1);
+
+ /* Update battery level */
+ batt++;
+ if (batt > 100) {
+ batt = 72;
+ }
+ nrf.getGattServer().updateValue(battLevel.handle,
+ (uint8_t *)&batt,
+ sizeof(batt));
/* Update the HRM measurement */
/* First byte = 8-bit values, no extra info, Second byte = uint8_t HRM value */
/* See --> https://developer.bluetooth.org/gatt/characteristics/Pages/CharacteristicViewer.aspx?u=org.bluetooth.characteristic.heart_rate_measurement.xml */
- hrmCounter++;
- if (hrmCounter == 175) hrmCounter = 100;
- uint8_t bpm[2] = { 0x00, hrmCounter };
- nrf.getGattServer().updateValue(hrmRate.handle, bpm, sizeof(bpm));
+ hrmCounter++;
+ if (hrmCounter == 175) {
+ hrmCounter = 100;
+ }
+ uint8_t bpm[2] = {0x00, hrmCounter};
+ nrf.getGattServer().updateValue(hrmRate.handle, bpm, sizeof(bpm));
}
}