diff --git a/afsk/main.c b/afsk/main.c index bae2f054..5f33428d 100644 --- a/afsk/main.c +++ b/afsk/main.c @@ -1128,12 +1128,16 @@ if (firstTime != ON) // printf("\n"); + batteryVoltage = voltage[map[BAT]]; if (batteryVoltage < 3.5) { NormalModeFailure = 1; printf("Safe Mode!\n"); - } + } + else + NormalModeFailure = 0; + FILE *cpuTempSensor = fopen("/sys/class/thermal/thermal_zone0/temp", "r"); if (cpuTempSensor) { double cpuTemp; @@ -1212,6 +1216,9 @@ if (sim_mode) NormalModeFailure = 1; printf("Safe Mode!\n"); } + else + NormalModeFailure = 0; + if (batt > 4.5) batt = 4.5;