Merge pull request #156 from damienmaguire/revert-151-Tom-evnut-patch-2

Revert "Update stm32_vcu.cpp"
damienmaguire · Feb 3, 2025 · a8779cb · a8779cb
2 parents 4fb4a24 + f836a5b
commit a8779cb
Showing 1 changed file with 6 additions and 6 deletions.
diff --git a/src/stm32_vcu.cpp b/src/stm32_vcu.cpp
@@ -584,8 +584,6 @@ static void Ms10Task(void)
     }
     if(opmode==MOD_RUN) Param::SetInt(Param::canctr, (Param::GetInt(Param::canctr) + 1) & 0xF);//Update the OI can counter in RUN mode only
 
-    ControlCabHeater(opmode);
-
     //////////////////////////////////////////////////
     //            MODE CONTROL SECTION              //
     //////////////////////////////////////////////////
@@ -673,6 +671,7 @@ static void Ms10Task(void)
             ErrorMessage::Post(ERR_PRECHARGE);
             opmode = MOD_PCHFAIL;
         }
+        Param::SetInt(Param::opmode, opmode);
         break;
 
     case MOD_PCHFAIL:
@@ -688,15 +687,14 @@ static void Ms10Task(void)
         if(rlyDly==0)
         {
             DigIo::dcsw_out.Set();
-            Param::SetInt(Param::opmode, opmode);//Only set opmode to charge once Main Contactor is shut.
         }
         ErrorMessage::UnpostAll();
         if(!chargeMode)
         {
             opmode = MOD_OFF;
             rlyDly=250;//Recharge sequence timer for delayed shutdown
-            Param::SetInt(Param::opmode, opmode); //set opmode to OFF when leaving charge state
         }
+        Param::SetInt(Param::opmode, opmode);
         break;
 
     case MOD_RUN:
@@ -705,21 +703,23 @@ static void Ms10Task(void)
         {
             DigIo::dcsw_out.Set();
             DigIo::inv_out.Set();//inverter power on
-            Param::SetInt(Param::opmode, MOD_RUN); //Only set opmode to Run once main contactor is shut
         }
+        Param::SetInt(Param::opmode, MOD_RUN);
         ErrorMessage::UnpostAll();
         if(!selectedVehicle->Ready())
         {
             opmode = MOD_OFF;
             rlyDly=250;//Recharge sequence timer for delayed shutdown
-            Param::SetInt(Param::opmode, opmode); //set opmode to OFF when leaving charge state
         }
+        Param::SetInt(Param::opmode, opmode);
         break;
     }
 
+    ControlCabHeater(opmode);
     if (Param::GetInt(Param::ShuntType) == 2)  SBOX::ControlContactors(opmode,canInterface[Param::GetInt(Param::ShuntCan)]);//BMW contactor box
     if (Param::GetInt(Param::ShuntType) == 3)  VWBOX::ControlContactors(opmode,canInterface[Param::GetInt(Param::ShuntCan)]);//VW contactor box
 
+
 }
 
 static void Ms1Task(void)