cycle speed and cadence service

Dependencies:   BLE_API mbed nRF51822

Fork of Bluetooth_Heart_Rate_Monitor_dummy by Icarus Sensors

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));
     }
 }