Implement get batter status msg and a rx fix

Author: cujomalainey

src/Profiles/HeartRate/DataPages/RX/ANTPLUS_HeartRateBatteryStatus.cpp

@@ -18,5 +18,5 @@ uint8_t HeartRateBatteryStatus::getCoarseBatteryVolage() {
 }
 
 uint8_t HeartRateBatteryStatus::getBatteryStatus() {
-    return (getData(ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_BYTE) & ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_MASK) << ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_SHIFT;
+    return (getData(ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_BYTE) & ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_MASK) >> ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_SHIFT;
 }

src/Profiles/HeartRate/DataPages/TX/ANTPLUS_HeartRateBatteryStatusMsg.cpp

@@ -6,33 +6,35 @@ HeartRateBatteryStatusMsg::HeartRateBatteryStatusMsg() : HeartRateBaseMainDataPa
 }
 
 uint8_t HeartRateBatteryStatusMsg::getBatteryLevel() {
-    // TODO
+    return _buffer[ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYLEVEL_BYTE];
 }
 
 uint8_t HeartRateBatteryStatusMsg::getFractionalBatteryVoltage() {
-    // TODO
+    return _buffer[ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_FRACTIONALBATTERYVOLTAGE_BYTE];
 }
 
 uint8_t HeartRateBatteryStatusMsg::getCoarseBatteryVolage() {
-    // TODO
+    return _buffer[ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_COARSEBATTERYVOLTAGE_BYTE] & ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_COARSEBATTERYVOLTAGE_MASK;
 }
 
 uint8_t HeartRateBatteryStatusMsg::getBatteryStatus() {
-    // TODO
+    return (_buffer[ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_BYTE] & ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_MASK) << ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_SHIFT;
 }
 
 void HeartRateBatteryStatusMsg::setBatteryLevel(uint8_t level) {
-    // TODO
+    _buffer[ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYLEVEL_BYTE] = level;
 }
 
 void HeartRateBatteryStatusMsg::setFractionalBatteryVoltage(uint8_t voltage) {
-    // TODO
+    _buffer[ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_FRACTIONALBATTERYVOLTAGE_BYTE] = voltage;
 }
 
 void HeartRateBatteryStatusMsg::setCoarseBatteryVolage(uint8_t voltage) {
-    // TODO
+    _buffer[ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_COARSEBATTERYVOLTAGE_BYTE] &= ~ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_COARSEBATTERYVOLTAGE_MASK;
+    _buffer[ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_COARSEBATTERYVOLTAGE_BYTE] |= (ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_COARSEBATTERYVOLTAGE_MASK & voltage);
 }
 
 void HeartRateBatteryStatusMsg::setBatteryStatus(uint8_t status) {
-    // TODO
+    _buffer[ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_BYTE] &= ~ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_MASK;
+    _buffer[ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_BYTE] |= ((status << ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_SHIFT) & ANTPLUS_HEARTRATE_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_MASK);
 }