fly/fgdata
1
0
Fork 0
Code Activity

FLARM: Improve Startup logic to better handle power outage during startup

Browse source
This commit is contained in:
Delta Echo 2021-08-07 18:24:20 +02:00
parent 94b89d9971
commit 704ded6d7f
1 changed files with 62 additions and 16 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

78
Aircraft/Instruments-3d/glider/flarm/flarm.nas
View file

@ -1,5 +1,5 @@
## FLARM ## FLARM
## Version 05/2020 ## Version 08/2021
## by Benedikt Wolf (D-ECHO) ## by Benedikt Wolf (D-ECHO)
## References: ## References:
@ -145,6 +145,7 @@ setlistener("/sim/signals/fdm-initialized", func{
phase1_timer = maketimer( 0.2, flarm_start_phase2 ); phase1_timer = maketimer( 0.2, flarm_start_phase2 );
phase2_timer = maketimer( 5, flarm_start_phase3 ); phase2_timer = maketimer( 5, flarm_start_phase3 );
phase3_timer = maketimer( 2, flarm_start_phase4 ); phase3_timer = maketimer( 2, flarm_start_phase4 );
startup_loop_timer = maketimer( 0, startup_loop );
phase1_timer.singleShot = 1; phase1_timer.singleShot = 1;
phase2_timer.singleShot = 1; phase2_timer.singleShot = 1;
@ -296,47 +297,92 @@ var flarm_update = maketimer( 1, func() { update_FLARM(); } );
var phase1_timer = nil; var phase1_timer = nil;
var phase2_timer = nil; var phase2_timer = nil;
var phase3_timer = nil; var phase3_timer = nil;
var startup_loop_timer = nil;
var starting = 0;
var leds_startup = {
green: [ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0],
red: [ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0],
};
var startup_loop = func {
if( !starting ){
startup_loop_timer.stop();
}
if( volts.getDoubleValue() > 9 ){
forindex( var key; leds_startup.green ){
leds_green[key].setBoolValue( leds_startup.green[ key ] );
leds_red[key].setBoolValue( leds_startup.red[ key ] );
}
} else {
foreach( var el; leds_startup.green ){
el = 0;
}
foreach( var el; leds_startup.red ){
el = 0;
}
forindex(var key; leds_green){
leds_green[key].setBoolValue(0);
leds_red[key].setBoolValue(0);
}
starting = 0;
}
}
flarm_start_phase1 = func () { flarm_start_phase1 = func () {
if( volts.getDoubleValue() <= 9 ){
return;
}
# 1. Short beep, all LEDs light up # 1. Short beep, all LEDs light up
forindex(var key; leds_green){ forindex(var key; leds_startup.green ){
leds_green[key].setBoolValue(1); leds_startup.green[ key ] = 1;
leds_red[key].setBoolValue(1); leds_startup.red[ key ] = 1;
} }
play_warn.setIntValue(1); play_warn.setIntValue(1);
phase1_timer.restart(0.2); phase1_timer.restart(0.2);
} }
flarm_start_phase2 = func () { flarm_start_phase2 = func () {
if( volts.getDoubleValue() <= 9 ){
return;
}
# beep and LEDs off except to show hardware version (here: show green LEDs 0 and 1) # beep and LEDs off except to show hardware version (here: show green LEDs 0 and 1)
play_warn.setIntValue(0); play_warn.setIntValue(0);
forindex(var key; leds_green){ forindex(var key; leds_startup.green){
if( key > 1 ){ if( key > 1 ){
leds_green[key].setBoolValue(0); leds_startup.green[key] = 0;
} }
leds_red[key].setBoolValue(0); leds_startup.red[key] = 0;
} }
phase2_timer.restart(5); phase2_timer.restart(5);
} }
flarm_start_phase3 = func () { flarm_start_phase3 = func () {
if( volts.getDoubleValue() <= 9 ){
return;
}
# Show firmware version ( emit green LEDs 7 and 8 as well as 2 and 3 ) # Show firmware version ( emit green LEDs 7 and 8 as well as 2 and 3 )
leds_green[0].setBoolValue(0); leds_startup.green[0]= 0;
leds_green[1].setBoolValue(0); leds_startup.green[1]= 0;
leds_green[2].setBoolValue(1); leds_startup.green[2]= 1;
leds_green[3].setBoolValue(1); leds_startup.green[3]= 1;
leds_green[7].setBoolValue(1); leds_startup.green[7]= 1;
leds_green[8].setBoolValue(1); leds_startup.green[8]= 1;
phase3_timer.restart(2); phase3_timer.restart(2);
} }
flarm_start_phase4 = func () { flarm_start_phase4 = func () {
if( volts.getDoubleValue() <= 9 ){
return;
}
# Go to normal operation # Go to normal operation
starting = 0;
running = 1;
flarm_update.restart(1); flarm_update.restart(1);
} }
setlistener(volts, func{ setlistener(volts, func{
if( running == 0 and volts.getDoubleValue() > 9) { if( running == 0 and starting == 0 and volts.getDoubleValue() > 9) {
running = 1; starting = 1;
flarm_start_phase1(); flarm_start_phase1();
startup_loop_timer.restart( 0 );
} }
}); });