src/lib/THERMAL/devThermal.cpp

   1 #include "devThermal.h"
   2
   3 #if defined(HAS_THERMAL) || defined(HAS_FAN)
   4
   5 #if defined(TARGET_RX)
   6     #error "devThermal not supported on RX"
   7 #endif
   8
   9 #include "config.h"
  10 extern TxConfig config;
  11
  12 #define THERMAL_DURATION 1000
  13
  14 #if defined(HAS_THERMAL)
  15 #include "common.h"
  16 #include "thermal.h"
  17 extern bool IsArmed();
  18
  19 Thermal thermal;
  20
  21 #if defined(HAS_SMART_FAN)
  22 bool is_smart_fan_control = false;
  23 bool is_smart_fan_working = false;
  24 #endif
  25
  26 #endif // HAS_THERMAL
  27
  28 #if defined(HAS_FAN)
  29 #include "POWERMGNT.h"
  30
  31 #if !defined(FAN_MIN_RUNTIME)
  32     #define FAN_MIN_RUNTIME 30U // seconds
  33 #endif
  34
  35 #endif // HAS_FAN
  36
  37 static void initialize()
  38 {
  39 #if defined(HAS_THERMAL)
  40     thermal.init();
  41 #endif
  42 #if defined(HAS_FAN)
  43     pinMode(GPIO_PIN_FAN_EN, OUTPUT);
  44 #endif
  45 }
  46
  47 static void timeoutThermal()
  48 {
  49 #if defined(HAS_THERMAL)
  50     if(!IsArmed() && connectionState != wifiUpdate)
  51     {
  52         thermal.handle();
  53  #ifdef HAS_SMART_FAN
  54         if(is_smart_fan_control & !is_smart_fan_working){
  55             is_smart_fan_working = true;
  56             thermal.update_threshold(USER_SMARTFAN_OFF);
  57         }
  58         if(!is_smart_fan_control & is_smart_fan_working){
  59             is_smart_fan_working = false;
  60 #endif
  61             thermal.update_threshold(config.GetFanMode());
  62 #ifdef HAS_SMART_FAN
  63         }
  64 #endif
  65     }
  66 #endif // HAS_THERMAL
  67 }
  68
  69 /***
  70  * Checks the PowerFanThreshold vs CurrPower and enables the fan if at or above the threshold
  71  * using a hysteresis. To turn on it must be at/above the threshold for a small time
  72  * and then to turn off it must be below the threshold for FAN_MIN_RUNTIME intervals
  73  ***/
  74 static void timeoutFan()
  75 {
  76 #if defined(HAS_FAN)
  77     static uint8_t fanStateDuration;
  78     static bool fanIsOn;
  79     bool fanShouldBeOn = POWERMGNT::currPower() >= (PowerLevels_e)config.GetPowerFanThreshold();
  80
  81     if (fanIsOn)
  82     {
  83         if (fanShouldBeOn)
  84         {
  85             fanStateDuration = 0; // reset the timeout
  86         }
  87         else if (fanStateDuration < FAN_MIN_RUNTIME)
  88         {
  89             ++fanStateDuration; // counting to turn off
  90         }
  91         else
  92         {
  93             // turn off expired
  94             digitalWrite(GPIO_PIN_FAN_EN, LOW);
  95             fanStateDuration = 0;
  96             fanIsOn = false;
  97         }
  98     }
  99     // vv else fan is off currently vv
 100     else if (fanShouldBeOn)
 101     {
 102         // Delay turning the fan on for 4 cycles to be sure it really should be on
 103         if (fanStateDuration < 3)
 104         {
 105             ++fanStateDuration; // counting to turn on
 106         }
 107         else
 108         {
 109             digitalWrite(GPIO_PIN_FAN_EN, HIGH);
 110             fanStateDuration = 0;
 111             fanIsOn = true;
 112         }
 113     }
 114 #endif // HAS_FAN
 115 }
 116
 117 static int event()
 118 {
 119 #if defined(HAS_THERMAL)
 120 #ifdef HAS_SMART_FAN
 121     if(!is_smart_fan_control)
 122     {
 123 #endif
 124         thermal.update_threshold(config.GetFanMode());
 125 #ifdef HAS_SMART_FAN
 126     }
 127 #endif
 128 #endif // HAS_THERMAL
 129
 130     return THERMAL_DURATION;
 131 }
 132
 133 static int timeout()
 134 {
 135     timeoutThermal();
 136     timeoutFan();
 137
 138     return THERMAL_DURATION;
 139 }
 140
 141 device_t Thermal_device = {
 142     .initialize = initialize,
 143     .start = NULL,
 144     .event = event,
 145     .timeout = timeout
 146 };
 147
 148 #endif // HAS_THERMAL || HAS_FAN