TBeam1WBoard.cpp 4.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193
  1. #include "TBeam1WBoard.h"
  2. namespace {
  3. constexpr float kFanTempOnC = 48.0f;
  4. constexpr float kFanTempOffC = 42.0f;
  5. constexpr uint32_t kFanControlCheckMs = 5000;
  6. constexpr uint32_t kFanPostTxHoldMs = 30000;
  7. constexpr float kNtcSeriesResistorOhms = 10000.0f;
  8. constexpr float kNtcBeta = 3950.0f;
  9. constexpr float kNtcRoomTempKelvin = 298.15f;
  10. constexpr float kNtcRoomResistanceOhms = 10000.0f;
  11. constexpr float kNtcVrefVolts = 3.3f;
  12. constexpr uint32_t kMinFanPostTxHoldMs = 0;
  13. constexpr uint32_t kMaxFanPostTxHoldMs = 600000;
  14. }
  15. void TBeam1WBoard::begin() {
  16. ESP32Board::begin();
  17. // Power on radio module (must be done before radio init)
  18. pinMode(SX126X_POWER_EN, OUTPUT);
  19. digitalWrite(SX126X_POWER_EN, HIGH);
  20. radio_powered = true;
  21. delay(10); // Allow radio to power up
  22. // RF switch RXEN pin handled by RadioLib via setRfSwitchPins()
  23. // Initialize LED
  24. pinMode(LED_PIN, OUTPUT);
  25. digitalWrite(LED_PIN, LOW);
  26. // Initialize fan control (on by default - 1W PA can overheat)
  27. pinMode(FAN_CTRL_PIN, OUTPUT);
  28. setFanEnabled(true);
  29. fan_force_on_until = millis() + fan_post_tx_hold_ms;
  30. next_fan_control_check_at = millis() + kFanControlCheckMs;
  31. }
  32. void TBeam1WBoard::onBeforeTransmit() {
  33. // RF switching handled by RadioLib via SX126X_DIO2_AS_RF_SWITCH and setRfSwitchPins()
  34. digitalWrite(LED_PIN, HIGH); // TX LED on
  35. if (fan_mode == FanMode::Auto) {
  36. fan_force_on_until = millis() + fan_post_tx_hold_ms;
  37. setFanEnabled(true);
  38. }
  39. }
  40. void TBeam1WBoard::onAfterTransmit() {
  41. digitalWrite(LED_PIN, LOW); // TX LED off
  42. if (fan_mode == FanMode::Auto) {
  43. fan_force_on_until = millis() + fan_post_tx_hold_ms;
  44. }
  45. }
  46. uint16_t TBeam1WBoard::getBattMilliVolts() {
  47. // T-Beam 1W uses 7.4V battery with voltage divider
  48. // ADC reads through divider - adjust multiplier based on actual divider ratio
  49. analogReadResolution(12);
  50. uint32_t raw = 0;
  51. for (int i = 0; i < 8; i++) {
  52. raw += analogRead(BATTERY_PIN);
  53. }
  54. raw = raw / 8;
  55. // Assuming voltage divider ratio from ADC_MULTIPLIER
  56. // 3.3V reference, 12-bit ADC (4095 max)
  57. return static_cast<uint16_t>((raw * 3300 * ADC_MULTIPLIER) / 4095);
  58. }
  59. uint16_t TBeam1WBoard::getBatteryMinMilliVolts() const {
  60. return 6000;
  61. }
  62. uint16_t TBeam1WBoard::getBatteryMaxMilliVolts() const {
  63. return 8400;
  64. }
  65. const char* TBeam1WBoard::getManufacturerName() const {
  66. return "LilyGo T-Beam 1W";
  67. }
  68. void TBeam1WBoard::powerOff() {
  69. // Turn off radio LNA (CTRL pin must be LOW when not receiving)
  70. digitalWrite(SX126X_RXEN, LOW);
  71. // Turn off radio power
  72. digitalWrite(SX126X_POWER_EN, LOW);
  73. radio_powered = false;
  74. // Turn off LED and fan
  75. digitalWrite(LED_PIN, LOW);
  76. setFanEnabled(false);
  77. ESP32Board::powerOff();
  78. }
  79. void TBeam1WBoard::setFanEnabled(bool enabled) {
  80. fan_enabled = enabled;
  81. digitalWrite(FAN_CTRL_PIN, enabled ? HIGH : LOW);
  82. }
  83. bool TBeam1WBoard::isFanEnabled() const {
  84. return fan_enabled;
  85. }
  86. void TBeam1WBoard::setFanMode(FanMode mode) {
  87. fan_mode = mode;
  88. next_fan_control_check_at = 0;
  89. updateFanControl(true);
  90. }
  91. TBeam1WBoard::FanMode TBeam1WBoard::getFanMode() const {
  92. return fan_mode;
  93. }
  94. const char* TBeam1WBoard::getFanModeName() const {
  95. switch (fan_mode) {
  96. case FanMode::On:
  97. return "on";
  98. case FanMode::Off:
  99. return "off";
  100. case FanMode::Auto:
  101. default:
  102. return "auto";
  103. }
  104. }
  105. float TBeam1WBoard::getLastBoardTemperatureC() const {
  106. return last_board_temperature_c;
  107. }
  108. bool TBeam1WBoard::setFanPostTxHoldMs(uint32_t hold_ms) {
  109. if (hold_ms < kMinFanPostTxHoldMs || hold_ms > kMaxFanPostTxHoldMs) {
  110. return false;
  111. }
  112. fan_post_tx_hold_ms = hold_ms;
  113. return true;
  114. }
  115. uint32_t TBeam1WBoard::getFanPostTxHoldMs() const {
  116. return fan_post_tx_hold_ms;
  117. }
  118. float TBeam1WBoard::readBoardTemperatureC() const {
  119. const float millivolts = analogReadMilliVolts(NTC_PIN);
  120. if (millivolts <= 0.0f || millivolts >= (kNtcVrefVolts * 1000.0f)) {
  121. return NAN;
  122. }
  123. const float voltage = millivolts / 1000.0f;
  124. const float resistance = kNtcSeriesResistorOhms * ((kNtcVrefVolts / voltage) - 1.0f);
  125. if (!(resistance > 0.0f)) {
  126. return NAN;
  127. }
  128. const float kelvin = 1.0f / ((log(resistance / kNtcRoomResistanceOhms) / kNtcBeta) + (1.0f / kNtcRoomTempKelvin));
  129. return kelvin - 273.15f;
  130. }
  131. void TBeam1WBoard::updateFanControl(bool force) {
  132. const uint32_t now = millis();
  133. if (!force && now < next_fan_control_check_at) {
  134. return;
  135. }
  136. next_fan_control_check_at = now + kFanControlCheckMs;
  137. if (fan_mode == FanMode::On) {
  138. setFanEnabled(true);
  139. return;
  140. }
  141. if (fan_mode == FanMode::Off) {
  142. setFanEnabled(false);
  143. return;
  144. }
  145. if (now < fan_force_on_until) {
  146. setFanEnabled(true);
  147. return;
  148. }
  149. const float temperature = readBoardTemperatureC();
  150. last_board_temperature_c = temperature;
  151. if (isnan(temperature)) {
  152. // Keep the fan on if temperature sensing is unavailable.
  153. setFanEnabled(true);
  154. return;
  155. }
  156. if (temperature >= kFanTempOnC) {
  157. setFanEnabled(true);
  158. } else if (temperature <= kFanTempOffC) {
  159. setFanEnabled(false);
  160. }
  161. }