Correct Stopped state handling

Author: mark9064

src/heartratetask/HeartRateTask.cpp

@@ -153,7 +153,6 @@ void HeartRateTask::Work() {
           break;
         case Messages::Disable:
           newState = States::Disabled;
-          SendHeartRate(ControllerStates::Disabled, 0);
           break;
       }
     }
@@ -170,6 +169,10 @@ void HeartRateTask::Work() {
     } else if ((newState == States::Waiting || newState == States::Disabled) &&
                (state == States::ForegroundMeasuring || state == States::BackgroundMeasuring)) {
       StopMeasurement();
+      controller.UpdateState(ControllerStates::Stopped);
+    }
+    if (newState == States::Disabled) {
+      SendHeartRate(ControllerStates::Disabled, 0);
     }
     state = newState;
 
@@ -196,7 +199,6 @@ void HeartRateTask::StartMeasurement() {
 void HeartRateTask::StopMeasurement() {
   heartRateSensor.Disable();
   ppg.Reset();
-  controller.UpdateState(ControllerStates::Stopped);
 }
 
 void HeartRateTask::HandleSensorData() {