Changeset 28 for trunk/fw_g473rct/SES/src/outputs.c

Timestamp:

Sep 11, 2025, 4:17:09 PM (7 weeks ago)

Author:

f.jahn

Message:

 

File:

• trunk/fw_g473rct/SES/src/outputs.c (modified) (2 diffs)

trunk/fw_g473rct/SES/src/outputs.c

@@ -26 +26 @@
 //--- LOKALE FUNKTIONS PROTOTYPEN ---------------------------------------------- 
 /*
-* @brief
+* @brief Heizungssteuerung
 * @param        kein
 * @retval       kein
 */
+void AuxModeHeaterExec(void);
+
+
 //--- LOKALE FUNKTIONEN - bitte hier dokumentieren -----------------------------
 
@@ -226 +229 @@
         lastMode = sys_data.s.parameter.ovpMode;
 }
+
+
+
+#define   LVP_DETECTION_LEVEL           6000  //< 6 V
+#define   CHARGE_DETECT_HYSTERESE       10
+
+void AuxModeHeaterExec(void)
+{
+ static int outputState=0;
+
+ int offv = sys_data.s.parameter.auxOutputSetpointOn - CHARGE_DETECT_HYSTERESE;
+ int onv = sys_data.s.parameter.auxOutputSetpointOn + CHARGE_DETECT_HYSTERESE;
+
+        if ((sys_data.s.values.shuntVoltage > onv) && (sys_data.s.values.ovp_sense < LVP_DETECTION_LEVEL) && (outputState == 0))
+        {
+          printf("Heater on\r\n");
+          outputState = 1;
+          if (sys_data.s.parameter.auxOutputInverted == 0) 
+          {
+                HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_SET);
+          }
+          else
+          {
+                HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_RESET);
+          }
+
+        }
+
+        //Ausschalten
+        //Wenn Spannung am Shunt < setpoint (ladegeräteerkennung 14,8V?) und Entladung 
+        //Oder wenn OVP wieder da ist
+        //sys_data.s.values.batteryCurrent < sys_data.s.parameter.auxOutputSetpointOff
+
+        if ((sys_data.s.values.shuntVoltage < offv  ) || (sys_data.s.values.ovp_sense > LVP_DETECTION_LEVEL)) 
+        {
+          if (outputState == 1)
+          {
+          printf("Heater off\r\n");
+          outputState = 0;
+          if (sys_data.s.parameter.auxOutputInverted == 0) 
+          {
+                HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_RESET);
+          }
+          else
+          {
+                HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_SET);
+          }
+          }
+        }
+}
+
+void AuxModeSOCExec(void)
+{
+ static int outputState=0;
+
+
+        if ((sys_data.s.values.soc > (sys_data.s.parameter.auxOutputSetpointOn*1000)) &&  (outputState == 0))
+        {
+          printf("AUX on (SOC Mode)\r\n");
+          outputState = 1;
+          if (sys_data.s.parameter.auxOutputInverted == 0) 
+          {
+                HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_SET);
+          }
+          else
+          {
+                HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_RESET);
+          }
+
+        }
+
+
+        if ((sys_data.s.values.soc < (sys_data.s.parameter.auxOutputSetpointOff*1000)) &&  (outputState == 1))
+        {
+          printf("AUX off (SOC Mode)\r\n");
+          outputState = 0;
+          if (sys_data.s.parameter.auxOutputInverted == 0) 
+          {
+                HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_RESET);
+          }
+          else
+          {
+                HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_SET);
+          }
+        }
+
+        
+}
+
+
+        int16_t loadCurrentLimit;                                                                                                       // 30   maximaler Laststrom in A wenn der Strom grer ist als der eingestelle Wert dann wird die Laststrom Protection aktiv, darf nicht unsigned sein, da Entladestrom mit Minus angegeben [A] Default -500 A
+        int16_t chargeCurrentLimit;                                                                                                     // 31   maximaler Ladestrom in A wenn der Strom grer ist als der eingestelle Wert dann wird die Ladestrom Protection aktiv [A] Default:500A
+
+
+        int16_t chargeStopHighTemperatureStart;                                                                         // 32   Abschalttemperatur Ladung wegen zu hoher Temperatur [C * 100]
+        int16_t chargeStopHighTemperatureStop;                                                                          // 33   Wiedereinschalttemperatur [C * 100]
+
+        int16_t chargeStopLowTemperatureStart;                                                                          // 34   Abschalttemperatur Ladung wegen zu niedriger Temperatur [C * 100]
+        int16_t chargeStopLowTemperatureStop;                                                                           // 35   Wiedereinschalttemperatur [C * 100]
+
+        int16_t dischargeStopHighTemperatureStart;                                                                      // 36   Abschalttemperatur Entladung wegen zu hoher Temperatur [C * 100]
+        int16_t dischargeStopHighTemperatureStop;                                                                       // 37   Wiedereinschalttemperatur[C * 100]
+
+        int16_t dischargeStopLowTemperatureStart;                                                                       // 38   Abschalttemperatur EntLadung wegen zu niedriger Temperatur
+        int16_t dischargeStopLowTemperatureStop;                                                                        // 39   Wiedereinschalttemperatur
+
+
+
+void AuxModeAlarmExec(void)
+{
+  static int outputState=0;
+  
+
+  if (
+          (sys_data.s.values.shuntTemperature > (chargeStopHighTemperatureStart         - 500))         ||
+          (sys_data.s.values.chipTemperature > (chargeStopHighTemperatureStart          - 500))         ||
+          (sys_data.s.values.shuntTemperature < (chargeStopLowTemperatureStart          + 500))         ||
+          (sys_data.s.values.chipTemperature < (chargeStopLowTemperatureStart                   + 500))         ||
+          (sys_data.s.values.shuntTemperature > (dischargeStopHighTemperatureStart      - 500))         ||
+          (sys_data.s.values.chipTemperature > (dischargeStopHighTemperatureStart               - 500))         ||
+          (sys_data.s.values.shuntTemperature < (dischargeStopLowTemperatureStart               + 500))         ||
+          (sys_data.s.values.chipTemperature < (dischargeStopLowTemperatureStart                + 500))         ||
+          (sys_data.s.values.batteryCurrent > ((chargeCurrentLimit*1000LL)                      - 10000))       ||
+          (sys_data.s.values.batteryCurrent < ((loadCurrentLimit*1000LL)                                + 10000))
+  
+         )
+  {
+        if ( outputState == 0)
+        {
+          printf("AUX on (Alarm Mode)\r\n");
+          outputState = 1;
+          if (sys_data.s.parameter.auxOutputInverted == 0) 
+          {
+                HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_SET);
+          }
+          else
+          {
+                HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_RESET);
+          }
+        }
+  }
+  else // Alles OK
+  {  
+        if ( outputState == 0)
+        {
+          printf("AUX off (Alarm Mode)\r\n");
+          outputState = 0;
+          if (sys_data.s.parameter.auxOutputInverted == 0) 
+          {
+                HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_RESET);
+          }
+          else
+          {
+                HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_SET);
+          }
+        }
+  }
+}
+
+
+void OUTPUTS_CheckAUX(void)
+{
+  
+  switch (sys_data.s.parameter.auxOutputMode)
+  {
+        case AUX_MODE_OFF:
+          HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_RESET);
+        break;
+
+        case AUX_MODE_HEATER:
+          AuxModeHeaterExec();
+        break;
+
+        case AUX_MODE_SOC:
+          AuxModeSOCExec();
+        break;
+
+        case AUX_MODE_ALARM:
+          AuxModeAlarmExec();
+        break;
+
+
+        default:
+          HAL_GPIO_WritePin(AUX_EN_GPIO_Port, AUX_EN_Pin, GPIO_PIN_RESET);
+        break;
+        
+
+  }
+
+
+}
+
 /*************************** End of file ****************************/