Changeset 7 for trunk/firmware/CubeMX/Src/main.c

Timestamp:

May 24, 2023, 1:47:09 PM (2 years ago)

Author:

f.jahn

Message:

12V variant is working good.

File:

• trunk/firmware/CubeMX/Src/main.c (modified) (10 diffs)

trunk/firmware/CubeMX/Src/main.c

@@ -193 +193 @@
 void ExternalRedLED2ShortOnThen2LongOnThenLongPauseBlinking(void);
 void RS485DisableButtonManagement(uint32_t new_time);
+static void BatteryLowVoltageProtection(/*uint32_t current_time*/);
 
 /* USER CODE END PFP */
@@ -278 +279 @@
   SEGGER_RTT_printf(0, "Free space for statistics in fake EEPROM: %u bytes\n", FEEPROM_StatFreeBytes());
   SEGGER_RTT_printf(0, "MAX_POSSIBLE_DIFF_TO_MEASURE: %u\n", MAX_POSSIBLE_DIFF_TO_MEASURE);
+  SEGGER_RTT_printf(0, "ADC_BAT_CRITICAL_VOLTAGE: %u\n", ADC_BAT_CRITICAL_VOLTAGE);
   SEGGER_RTT_printf(0, "CPU Freq: %u Hz\n", HAL_RCC_GetSysClockFreq());
 
@@ -374 +376 @@
   while (1)                                                                                                                                             // Main loop
   {
+          TP4_GPIO_Port->BSRR = TP4_Pin;
+
           ABVoltageDropCalculation();
+
+          BatteryLowVoltageProtection();
+
+          TP4_GPIO_Port->BRR = TP4_Pin;
 
           //TIM2->CNT = 0;
@@ -448 +456 @@
                   case SWITCH_AUTO:
                           // Checking whether temperature, current and battery voltage are within limits
-                          if ((temperature_shutdown_is_active == 1) || (low_bat_shutdown_is_active == 1))
+                          if (temperature_shutdown_is_active == 1)
+                          {
+                                  if (!restartAutoMode)
+                                  {
+                                          // If so, opening both MOSFETs (i.e. disconnecting load/charger from battery)
+                                          /*
+#ifdef DISABLE_SHORTCUT_DETECTION_DURING_SWITCH_OFF
+                                          DisableShortCutDetection();
+#endif
+                                          HAL_NVIC_DisableIRQ(ADC_DMA_IRQ);
+                                          MOSFETS_Management = &ADC_Open_Both_MOSFETs;
+                                          sys_data.s.relay_status = RELAY_IS_OPENED;
+                                          HAL_NVIC_EnableIRQ(ADC_DMA_IRQ);
+                                          ExternalRedLED_Management = &ExternalRedLED1ShortOnThenLongPauseBlinking;
+                                          */
+                                          restartAutoMode = 1;
+                                  }
+                          }
+                          else if (low_bat_shutdown_is_active == 1)
                           {
                                   if (!restartAutoMode)
@@ -457 +483 @@
 #endif
                                           HAL_NVIC_DisableIRQ(ADC_DMA_IRQ);
-                                          MOSFETS_Management = &ADC_Open_Both_MOSFETs;
+                                          MOSFETS_Management = &DoNothing;
+                                          OpenBothMOSFETSVeryFast();
                                           sys_data.s.relay_status = RELAY_IS_OPENED;
                                           HAL_NVIC_EnableIRQ(ADC_DMA_IRQ);
-                                          if (temperature_shutdown_is_active == 1) ExternalRedLED_Management = &ExternalRedLED1ShortOnThenLongPauseBlinking;
-                                          if (low_bat_shutdown_is_active == 1) ExternalRedLED_Management = &ExternalRedLED5ShortOnThenLongPauseBlinking;
+                                          ExternalRedLED_Management = &ExternalRedLED5ShortOnThenLongPauseBlinking;
                                           restartAutoMode = 1;
                                   }
@@ -722 +748 @@
   sys_data.s.command = 0;
   sys_data.s.device_status = 0;
+  sys_data.s.ubsenseb_voltage = 1;
 }
 
@@ -2180 +2207 @@
 static inline __attribute__((always_inline)) void CalculatingAndAveragingVoltageOnContactB(void)
 {
-        static int32_t ubsenseb_voltage_accum = U_BAT_RECOVERY_VOLTAGE * 32;            // << ubsenseb_voltage_accum_avg;
+        const uint32_t AVG_VALUE = 64U;
+        static int32_t ubsenseb_voltage_accum = U_BAT_RECOVERY_VOLTAGE_mV * AVG_VALUE;          // << ubsenseb_voltage_accum_avg;
+
+        // Special case for Battery undervoltage condition. During normal operation ubsenseb_voltage will never be zero
+        //if (sys_data.s.ubsenseb_voltage == 0) ubsenseb_voltage_accum = 0;
 
         // Calculating and averaging battery side voltage
-        int32_t temp = ADC_values[U_BAT_CHANNEL];                                                                       // Converting ADC value into int32_t type
+        int32_t temp = ADC_values[U_BAT_CHANNEL];                                                                       
         temp = (temp*ADC_VREF)>>ADC_RESOLUTION;                                                                         // Getting voltage value on ADC input [0:3000]mV
 #ifdef VARIANT_24V
@@ -2193 +2224 @@
         if (ubsenseb_voltage_accum < 0) ubsenseb_voltage_accum = 0;
         ubsenseb_voltage_accum += temp;
-        sys_data.s.ubsenseb_voltage = ubsenseb_voltage_accum / 32;                                      //>> ubsenseb_voltage_accum_avg;
-}
-
-//------------------------------------------------------------------------------
-
-inline __attribute__((always_inline)) void TestingForLowVoltageShutdown(void)
-{
+        sys_data.s.ubsenseb_voltage = ubsenseb_voltage_accum / AVG_VALUE;                       //>> ubsenseb_voltage_accum_avg;
+}
+
+//------------------------------------------------------------------------------
+
+static inline __attribute__((always_inline)) void TestingForLowVoltageShutdown(void)
+{
+        const uint32_t REACTIVATION_DELAY_ms = 10000;
+        static uint32_t low_bat_event_last_time; 
+
         // If voltage on contact B is lower than critical one, then we must initiate "low voltage shutdown"
-        if (sys_data.s.ubsenseb_voltage < U_BAT_CRITICAL_VOLTAGE)
+        if (sys_data.s.ubsenseb_voltage < U_BAT_CRITICAL_VOLTAGE_mV)
         {
                 if (low_bat_shutdown_is_active == 0)
                 {
+#ifdef DISABLE_SHORTCUT_DETECTION_DURING_SWITCH_OFF
+                        DisableShortCutDetection();
+#endif
+                        HAL_NVIC_DisableIRQ(ADC_DMA_IRQ);
+                        MOSFETS_Management = &DoNothing;
+                        OpenBothMOSFETSVeryFast();
+                        sys_data.s.relay_status = RELAY_IS_OPENED;
+                        HAL_NVIC_EnableIRQ(ADC_DMA_IRQ);
+                        ExternalRedLED_Management = &ExternalRedLED5ShortOnThenLongPauseBlinking;
+
                         low_bat_shutdown_is_active = 1;
                         sys_data.s.device_status |= (1 << LOWBAT_ERROR);
                         sys_data.s.lowbat_error_cnt++;
                         statDataChanged = 1;
-                }
-        }
-        else if (sys_data.s.ubsenseb_voltage > U_BAT_RECOVERY_VOLTAGE)
+
+                        low_bat_event_last_time = HAL_GetTick();
+                }
+        }
+        else if (sys_data.s.ubsenseb_voltage > U_BAT_RECOVERY_VOLTAGE_mV)
+        {
+                if (low_bat_event_last_time + REACTIVATION_DELAY_ms < HAL_GetTick())
+                {
+                        low_bat_shutdown_is_active = 0;
+                        sys_data.s.device_status &= ~(1 << LOWBAT_ERROR);
+                }
+        }
+
+        /*if (low_bat_shutdown_is_active == 1)
+        {
+                
+        }
+
+        if (sys_data.s.ubsenseb_voltage > U_BAT_RECOVERY_VOLTAGE_mV)
         {
                 low_bat_shutdown_is_active = 0;
                 sys_data.s.device_status &= ~(1 << LOWBAT_ERROR);
-        }
+        }*/
 }
 
@@ -2309 +2369 @@
 //------------------------------------------------------------------------------
 
+static inline __attribute__((always_inline)) void BatteryLowVoltageProtection(/*uint32_t current_time*/)
+{
+        //static uint32_t last_time = 0;
+
+        // During first start, somtimes we read 0s from ADC, so we need to wait for a while before calculating Min & Max values, especially Min values
+        //if (current_time - last_time >= 0U)
+        {
+                //last_time = current_time;
+
+                CalculatingAndAveragingVoltageOnContactB();
+
+                TestingForLowVoltageShutdown();
+        }
+}
+
+//------------------------------------------------------------------------------
+
 void HeavyCalculations(uint32_t current_time)
 {
@@ -2332 +2409 @@
                 CalculatingMinMaxVoltagesForContactA();
 
-                CalculatingAndAveragingVoltageOnContactB();
-
-                TestingForLowVoltageShutdown();
+                //CalculatingAndAveragingVoltageOnContactB();
+
+                //TestingForLowVoltageShutdown();
 
                 CalculatingMinMaxVoltagesForContactB();