fixed target watt bug

doudar · Nov 12, 2024 · 5cfb9a3 · 5cfb9a3
1 parent 20d64c4
commit 5cfb9a3
Showing 1 changed file with 6 additions and 2 deletions.
diff --git a/src/BLE_Fitness_Machine_Service.cpp b/src/BLE_Fitness_Machine_Service.cpp
@@ -130,13 +130,13 @@ void BLE_Fitness_Machine_Service::processFTMSWrite() {
       switch ((uint8_t)rxValue[0]) {
         case FitnessMachineControlPointProcedure::RequestControl:
           returnValue[2] = FitnessMachineControlPointResultCode::Success;  // 0x01;
-          rtConfig->watts.setTarget(0);
-          rtConfig->setSimTargetWatts(false);
           logBufLength += snprintf(logBuf + logBufLength, kLogBufCapacity - logBufLength, "-> Control Request");
           ftmsTrainingStatus[1] = FitnessMachineTrainingStatus::Idle;  // 0x01;
           fitnessMachineTrainingStatus->setValue(ftmsTrainingStatus, 2);
           ftmsStatus = {FitnessMachineStatus::StartedOrResumedByUser};
           pCharacteristic->setValue(returnValue, 3);
+          rtConfig->watts.setTarget(0);
+          rtConfig->setSimTargetWatts(false);
           break;
 
         case FitnessMachineControlPointProcedure::Reset: {
@@ -147,6 +147,8 @@ void BLE_Fitness_Machine_Service::processFTMSWrite() {
           ftmsStatus            = {FitnessMachineStatus::Reset};
           fitnessMachineTrainingStatus->setValue(ftmsTrainingStatus, 2);
           pCharacteristic->setValue(returnValue, 3);
+          rtConfig->watts.setTarget(0);
+          rtConfig->setSimTargetWatts(false);
         } break;
 
         case FitnessMachineControlPointProcedure::SetTargetInclination: {
@@ -233,6 +235,8 @@ void BLE_Fitness_Machine_Service::processFTMSWrite() {
           ftmsStatus            = {FitnessMachineStatus::StoppedOrPausedByUser};
           ftmsTrainingStatus[1] = FitnessMachineTrainingStatus::Other;  // 0x00;
           fitnessMachineTrainingStatus->setValue(ftmsTrainingStatus, 2);
+          rtConfig->watts.setTarget(0);
+          rtConfig->setSimTargetWatts(false);
 
         } break;