|
| 1 | +#include "HeltecTowerV2Board.h" |
| 2 | + |
| 3 | +#include <Arduino.h> |
| 4 | +#include <Wire.h> |
| 5 | + |
| 6 | +extern void variant_shutdown(); |
| 7 | + |
| 8 | +#ifdef NRF52_POWER_MANAGEMENT |
| 9 | +const PowerMgtConfig power_config = { |
| 10 | + .lpcomp_ain_channel = PWRMGT_LPCOMP_AIN, |
| 11 | + .lpcomp_refsel = PWRMGT_LPCOMP_REFSEL, |
| 12 | + .voltage_bootlock = PWRMGT_VOLTAGE_BOOTLOCK |
| 13 | +}; |
| 14 | + |
| 15 | +void HeltecTowerV2Board::initiateShutdown(uint8_t reason) { |
| 16 | + pinMode(PIN_GPS_EN, OUTPUT); |
| 17 | + digitalWrite(PIN_GPS_EN, !PIN_GPS_EN_ACTIVE); |
| 18 | + pinMode(PIN_GPS_STANDBY, OUTPUT); |
| 19 | + digitalWrite(PIN_GPS_STANDBY, LOW); |
| 20 | + pinMode(PIN_GPS_RESET, OUTPUT); |
| 21 | + digitalWrite(PIN_GPS_RESET, GPS_RESET_MODE); |
| 22 | + loRaFEMControl.setSleepModeEnable(); |
| 23 | + |
| 24 | + bool enable_lpcomp = (reason == SHUTDOWN_REASON_LOW_VOLTAGE || |
| 25 | + reason == SHUTDOWN_REASON_BOOT_PROTECT); |
| 26 | + pinMode(PIN_BAT_CTL, OUTPUT); |
| 27 | + digitalWrite(PIN_BAT_CTL, enable_lpcomp ? HIGH : LOW); |
| 28 | + |
| 29 | + if (enable_lpcomp) { |
| 30 | + configureVoltageWake(power_config.lpcomp_ain_channel, power_config.lpcomp_refsel); |
| 31 | + } |
| 32 | + |
| 33 | + variant_shutdown(); |
| 34 | + enterSystemOff(reason); |
| 35 | +} |
| 36 | +#endif |
| 37 | + |
| 38 | +void HeltecTowerV2Board::begin() { |
| 39 | + NRF52Board::begin(); |
| 40 | + |
| 41 | + pinMode(P_LORA_TX_LED, OUTPUT); |
| 42 | + digitalWrite(P_LORA_TX_LED, !LED_STATE_ON); |
| 43 | + |
| 44 | + pinMode(PIN_BAT_CTL, OUTPUT); |
| 45 | + digitalWrite(PIN_BAT_CTL, LOW); |
| 46 | + |
| 47 | +#ifdef NRF52_POWER_MANAGEMENT |
| 48 | + checkBootVoltage(&power_config); |
| 49 | +#endif |
| 50 | + |
| 51 | + Wire.setPins(PIN_BOARD_SDA, PIN_BOARD_SCL); |
| 52 | + Wire.begin(); |
| 53 | + |
| 54 | + pinMode(PIN_GPS_EN, OUTPUT); |
| 55 | + digitalWrite(PIN_GPS_EN, !PIN_GPS_EN_ACTIVE); |
| 56 | + pinMode(PIN_GPS_RESET, OUTPUT); |
| 57 | + digitalWrite(PIN_GPS_RESET, GPS_RESET_MODE); |
| 58 | + pinMode(PIN_GPS_STANDBY, OUTPUT); |
| 59 | + digitalWrite(PIN_GPS_STANDBY, HIGH); |
| 60 | + loRaFEMControl.init(); |
| 61 | +} |
| 62 | + |
| 63 | +void HeltecTowerV2Board::onBeforeTransmit() { |
| 64 | + digitalWrite(P_LORA_TX_LED, LED_STATE_ON); |
| 65 | + loRaFEMControl.setTxModeEnable(); |
| 66 | +} |
| 67 | + |
| 68 | +void HeltecTowerV2Board::onAfterTransmit() { |
| 69 | + digitalWrite(P_LORA_TX_LED, !LED_STATE_ON); |
| 70 | + loRaFEMControl.setRxModeEnable(); |
| 71 | +} |
| 72 | + |
| 73 | +uint16_t HeltecTowerV2Board::getBattMilliVolts() { |
| 74 | + analogReadResolution(12); |
| 75 | + analogReference(VBAT_AR_INTERNAL); |
| 76 | + pinMode(PIN_VBAT_READ, INPUT); |
| 77 | + pinMode(PIN_BAT_CTL, OUTPUT); |
| 78 | + digitalWrite(PIN_BAT_CTL, HIGH); |
| 79 | + |
| 80 | + delay(10); |
| 81 | + int adcvalue = analogRead(PIN_VBAT_READ); |
| 82 | + digitalWrite(PIN_BAT_CTL, LOW); |
| 83 | + |
| 84 | + return (uint16_t)((float)adcvalue * MV_LSB * ADC_MULTIPLIER); |
| 85 | +} |
| 86 | + |
| 87 | +const char* HeltecTowerV2Board::getManufacturerName() const { |
| 88 | + return "Heltec Tower V2"; |
| 89 | +} |
| 90 | + |
| 91 | +void HeltecTowerV2Board::powerOff() { |
| 92 | + pinMode(PIN_GPS_EN, OUTPUT); |
| 93 | + digitalWrite(PIN_GPS_EN, !PIN_GPS_EN_ACTIVE); |
| 94 | + pinMode(PIN_GPS_STANDBY, OUTPUT); |
| 95 | + digitalWrite(PIN_GPS_STANDBY, LOW); |
| 96 | + pinMode(PIN_GPS_RESET, OUTPUT); |
| 97 | + digitalWrite(PIN_GPS_RESET, GPS_RESET_MODE); |
| 98 | + loRaFEMControl.setSleepModeEnable(); |
| 99 | + pinMode(PIN_BAT_CTL, OUTPUT); |
| 100 | + digitalWrite(PIN_BAT_CTL, LOW); |
| 101 | + variant_shutdown(); |
| 102 | + sd_power_system_off(); |
| 103 | +} |
0 commit comments