diff options
Diffstat (limited to 'src/common/Core/main.c')
| -rw-r--r-- | src/common/Core/main.c | 25 |
1 files changed, 20 insertions, 5 deletions
diff --git a/src/common/Core/main.c b/src/common/Core/main.c index bb072c8..f2aaf93 100644 --- a/src/common/Core/main.c +++ b/src/common/Core/main.c @@ -301,15 +301,30 @@ static void launcher_task(void __attribute__ ((unused))*pvParameters) } } else { - const int qrp_from_supply = analog_supply_too_low(); if (swr_error_flag) { pio_set_qrp(1); } - else if (qrp_from_supply != last_qrp_from_supply) { - usart_debug("QRP = %d\r\n", qrp_from_supply); - last_qrp_from_supply = qrp_from_supply; + else { + const uint32_t charge_qrp = batterycharge_too_low(); + + if (charge_qrp != -1) { + if (charge_qrp != last_qrp_from_supply) { + usart_debug("QRP CC = %d\r\n", charge_qrp); + last_qrp_from_supply = charge_qrp; + + pio_set_qrp(charge_qrp); + } + } + else { + /* Read the voltage when battery capacity is not available */ + const int qrp_from_supply = analog_supply_too_low(); + if (qrp_from_supply != last_qrp_from_supply) { + usart_debug("QRP U = %d\r\n", qrp_from_supply); + last_qrp_from_supply = qrp_from_supply; - pio_set_qrp(qrp_from_supply); + pio_set_qrp(qrp_from_supply); + } + } } } |