Start HRSensor implementation

Author: cujomalainey

src/Profiles/HeartRate/Sensor/ANTPLUS_ProfileHeartRateSensor.cpp

@@ -1,16 +1,51 @@
-// TODO
-/*
-Code accidentally implemented in monitor, storing here for later
+#include <Profiles/HeartRate/Sensor/ANTPLUS_ProfileHeartRateSensor.h>
+#include <Profiles/HeartRate/ANTPLUS_HeartRatePrivateDefines.h>
+#include <CommonDataPages/ANTPLUS_CommonDataPageDefines.h>
+
+void ProfileHeartRateSensor::onBroadcastData(BroadcastData& msg) {
+    HeartRateBaseMainDataPage dp = HeartRateBaseMainDataPage(msg);
+    uint8_t dataPage = dp.getDataPageNumber();
+    bool called = false;
+
+    BaseProfile::onBroadcastData(msg);
+
+    switch (dataPage) {
 
     case ANTPLUS_HEARTRATE_DATAPAGE_CAPABILITIES_NUMBER:
         called = handleCapabilities(dp);
         break;
+    }
+
+    if (!called) {
+        callOnOtherDataPage(msg);
+    }
+}
+
+void ProfileHeartRateSensor::onAcknowledgedData(AcknowledgedData& msg) {
+    HeartRateBaseMainDataPage dp = HeartRateBaseMainDataPage(msg);
+    uint8_t dataPage = dp.getDataPageNumber();
+    bool called = false;
+
+    BaseProfile::onAcknowledgedData(msg);
+
+    switch (dataPage) {
+
+    case ANTPLUS_COMMON_DATAPAGE_REQUESTDATAPAGE_NUMBER:
+        called = handleRequestDataPage(dp);
+        break;
+    }
+
+    if (!called) {
+        callOnOtherDataPage(msg);
+    }
+}
 
-bool ProfileHeartRateMonitor::handleCapabilities(HeartRateBaseMainDataPage& dataPage) {
-    // TODO
+bool ProfileHeartRateSensor::handleCapabilities(HeartRateBaseMainDataPage& dataPage) {
+    HeartRateCapabilities dp = HeartRateCapabilities(dataPage);
+    return _onHeartRateCapabilities.call(dp);
 }
 
-bool ProfileHeartRateMonitor::handleRequestDataPage(HeartRateBaseMainDataPage& dataPage) {
-    // TODO
+bool ProfileHeartRateSensor::handleRequestDataPage(HeartRateBaseMainDataPage& dataPage) {
+    RequestDataPage dp = RequestDataPage(dataPage);
+    return _onRequestDataPage.call(dp);
 }
-*/

src/Profiles/HeartRate/Sensor/ANTPLUS_ProfileHeartRateSensor.h

@@ -2,13 +2,20 @@
 #define ANTPLUS_PROFILEHEARTRATESENSOR_h
 
 #include <BaseClasses/ANTPLUS_BaseMasterProfile.h>
+#include <Profiles/HeartRate/DataPages/ANTPLUS_ProfileHeartRateDataPages.h>
+#include <CommonDataPages/ANTPLUS_CommonDataPages.h>
 
 class ProfileHeartRateSensor : BaseMasterProfile {
 public:
     void onHeartRateCapabilities(void (*func)(HeartRateCapabilities&, uintptr_t), uintptr_t data = 0) { _onHeartRateCapabilities.set(func, data); }
     void onRequestDataPage(void (*func)(RequestDataPage&, uintptr_t), uintptr_t data = 0) { _onRequestDataPage.set(func, data); }
     void begin();
     void stop();
+    /******************************************
+     *LIBRARY INTERNAL ONLY FUNCTIONS BELOW
+     ******************************************/
+    void onAcknowledgedData(AcknowledgedData& msg);
+    void onBroadcastData(BroadcastData& msg);
 protected:
     void transmitNextDataPage();
 private: