2004-04-16 21:59:51 +00:00
|
|
|
##
|
2004-10-17 17:41:05 +00:00
|
|
|
# Bendix/King KAP140 Autopilot System
|
2004-04-16 21:59:51 +00:00
|
|
|
##
|
|
|
|
|
|
|
|
Locks = "/autopilot/KAP140/locks";
|
|
|
|
Settings = "/autopilot/KAP140/settings";
|
|
|
|
Annunciators = "/autopilot/KAP140/annunciators";
|
|
|
|
Internal = "/autopilot/internal";
|
|
|
|
|
|
|
|
annunciator = "";
|
|
|
|
annunciator_state = "";
|
|
|
|
flash_interval = 0.0;
|
|
|
|
flash_count = 0.0;
|
|
|
|
flash_timer = -1.0;
|
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
# baro setting unit: 0=inHg, 1=hPa
|
|
|
|
baro_setting_unit = 0;
|
|
|
|
baro_setting = 29.92;
|
2004-11-01 09:34:16 +00:00
|
|
|
baro_setting_hpa = 1.013;
|
2004-10-17 17:41:05 +00:00
|
|
|
baro_setting_adjusting = 0;
|
|
|
|
baro_button_down = 0;
|
|
|
|
baro_timer_running = 0;
|
|
|
|
|
|
|
|
alt_preselect = 0;
|
|
|
|
alt_button_timer_running = 0;
|
|
|
|
alt_button_timer_ignore = 0;
|
|
|
|
alt_alert_on = 0;
|
|
|
|
alt_captured = 0;
|
|
|
|
|
|
|
|
old_alt_number_state = ["off", 0];
|
|
|
|
old_vs_number_state = ["off", 0];
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
|
|
|
|
flasher = func {
|
2004-10-17 17:41:05 +00:00
|
|
|
flash_timer = -1.0;
|
2004-04-16 21:59:51 +00:00
|
|
|
annunciator = arg[0];
|
|
|
|
flash_interval = arg[1];
|
|
|
|
flash_count = arg[2] + 1;
|
|
|
|
annunciator_state = arg[3];
|
|
|
|
|
|
|
|
flash_timer = 0.0;
|
|
|
|
|
|
|
|
flash_annunciator();
|
|
|
|
}
|
|
|
|
|
|
|
|
flash_annunciator = func {
|
2004-10-17 17:41:05 +00:00
|
|
|
##print(annunciator);
|
|
|
|
##print(flash_interval);
|
|
|
|
##print(flash_count);
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
##
|
|
|
|
# If flash_timer is set to -1 then flashing is aborted
|
|
|
|
if (flash_timer < -0.5)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
##print ("flash abort ", annunciator);
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Annunciators, annunciator, "off");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (flash_timer < flash_count)
|
|
|
|
{
|
|
|
|
#flash_timer = flash_timer + 1.0;
|
|
|
|
if (getprop(Annunciators, annunciator) == "on")
|
|
|
|
{
|
|
|
|
setprop(Annunciators, annunciator, "off");
|
|
|
|
settimer(flash_annunciator, flash_interval / 2.0);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
#elsif (getprop(Annunciators, annunciator) == "off")
|
|
|
|
{
|
|
|
|
flash_timer = flash_timer + 1.0;
|
|
|
|
setprop(Annunciators, annunciator, "on");
|
|
|
|
settimer(flash_annunciator, flash_interval);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
flash_timer = -1.0;
|
|
|
|
setprop(Annunciators, annunciator, annunciator_state);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
|
|
|
|
pt_check = func {
|
|
|
|
##print("pitch trim check");
|
|
|
|
|
|
|
|
if (getprop(Locks, "pitch-mode") == "off")
|
|
|
|
{
|
|
|
|
setprop(Annunciators, "pt-up", "off");
|
|
|
|
setprop(Annunciators, "pt-dn", "off");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
else
|
|
|
|
{
|
|
|
|
elevator_control = getprop("/controls/flight/elevator");
|
|
|
|
##print(elevator_control);
|
|
|
|
|
|
|
|
# Flash the pitch trim up annunciator
|
|
|
|
if (elevator_control < -0.01)
|
|
|
|
{
|
|
|
|
if (getprop(Annunciators, "pt-up") == "off")
|
|
|
|
{
|
|
|
|
setprop(Annunciators, "pt-up", "on");
|
|
|
|
}
|
|
|
|
elsif (getprop(Annunciators, "pt-up") == "on")
|
|
|
|
{
|
|
|
|
setprop(Annunciators, "pt-up", "off");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
# Flash the pitch trim down annunciator
|
|
|
|
elsif (elevator_control > 0.01)
|
|
|
|
{
|
|
|
|
if (getprop(Annunciators, "pt-dn") == "off")
|
|
|
|
{
|
|
|
|
setprop(Annunciators, "pt-dn", "on");
|
|
|
|
}
|
|
|
|
elsif (getprop(Annunciators, "pt-dn") == "on")
|
|
|
|
{
|
|
|
|
setprop(Annunciators, "pt-dn", "off");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
else
|
|
|
|
{
|
|
|
|
setprop(Annunciators, "pt-up", "off");
|
|
|
|
setprop(Annunciators, "pt-dn", "off");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
settimer(pt_check, 0.5);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
ap_init = func {
|
|
|
|
##print("ap init");
|
|
|
|
|
|
|
|
##
|
|
|
|
# Initialises the autopilot.
|
|
|
|
##
|
|
|
|
|
|
|
|
setprop(Locks, "alt-hold", "off");
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "hdg-hold", "off");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "rev-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "off");
|
|
|
|
setprop(Locks, "roll-mode", "off");
|
|
|
|
setprop(Locks, "pitch-axis", "off");
|
|
|
|
setprop(Locks, "pitch-mode", "off");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "off");
|
|
|
|
setprop(Locks, "pitch-arm", "off");
|
2004-10-17 17:41:05 +00:00
|
|
|
|
|
|
|
setprop(Settings, "target-alt-pressure", 0.0);
|
|
|
|
setprop(Settings, "target-intercept-angle", 0.0);
|
|
|
|
setprop(Settings, "target-pressure-rate", 0.0);
|
|
|
|
setprop(Settings, "target-turn-rate", 0.0);
|
|
|
|
|
|
|
|
setprop(Annunciators, "rol", "off");
|
|
|
|
setprop(Annunciators, "hdg", "off");
|
|
|
|
setprop(Annunciators, "nav", "off");
|
|
|
|
setprop(Annunciators, "nav-arm", "off");
|
|
|
|
setprop(Annunciators, "apr", "off");
|
|
|
|
setprop(Annunciators, "apr-arm", "off");
|
|
|
|
setprop(Annunciators, "rev", "off");
|
|
|
|
setprop(Annunciators, "rev-arm", "off");
|
|
|
|
setprop(Annunciators, "vs", "off");
|
|
|
|
setprop(Annunciators, "vs-number", "off");
|
|
|
|
setprop(Annunciators, "fpm", "off");
|
|
|
|
setprop(Annunciators, "alt", "off");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Annunciators, "alt-arm", "off");
|
2004-10-17 17:41:05 +00:00
|
|
|
setprop(Annunciators, "alt-number", "off");
|
|
|
|
setprop(Annunciators, "apr", "off");
|
|
|
|
setprop(Annunciators, "gs", "off");
|
|
|
|
setprop(Annunciators, "gs-arm", "off");
|
|
|
|
setprop(Annunciators, "pt-up", "off");
|
|
|
|
setprop(Annunciators, "pt-dn", "off");
|
|
|
|
setprop(Annunciators, "bs-hpa-number", "off");
|
|
|
|
setprop(Annunciators, "bs-inhg-number", "off");
|
|
|
|
setprop(Annunciators, "ap", "off");
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2004-04-16 21:59:51 +00:00
|
|
|
ap_button = func {
|
2004-10-17 17:41:05 +00:00
|
|
|
##print("ap_button");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
##
|
|
|
|
# Engages the autopilot in Wings level mode (ROL) and Vertical speed hold
|
|
|
|
# mode (VS).
|
|
|
|
##
|
|
|
|
if (getprop(Locks, "roll-mode") == "off" and
|
|
|
|
getprop(Locks, "pitch-mode") == "off")
|
|
|
|
{
|
|
|
|
flash_timer = -1.0;
|
|
|
|
|
|
|
|
setprop(Locks, "alt-hold", "off");
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "hdg-hold", "off");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Locks, "rev-hold", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "roll-axis", "trn");
|
|
|
|
setprop(Locks, "roll-mode", "rol");
|
|
|
|
setprop(Locks, "pitch-axis", "vs");
|
|
|
|
setprop(Locks, "pitch-mode", "vs");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "off");
|
|
|
|
setprop(Locks, "pitch-arm", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
setprop(Annunciators, "rol", "on");
|
|
|
|
setprop(Annunciators, "vs", "on");
|
|
|
|
setprop(Annunciators, "vs-number", "on");
|
|
|
|
|
|
|
|
setprop(Settings, "target-turn-rate", 0.0);
|
2004-11-01 09:34:16 +00:00
|
|
|
|
|
|
|
pt_check();
|
2004-10-17 17:41:05 +00:00
|
|
|
|
|
|
|
pressure_rate = getprop(Internal, "pressure-rate");
|
|
|
|
#print(pressure_rate);
|
|
|
|
fpm = -pressure_rate * 58000;
|
|
|
|
#print(fpm);
|
|
|
|
if (fpm > 0.0)
|
|
|
|
{
|
|
|
|
fpm = int(fpm/100 + 0.5) * 100;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
fpm = int(fpm/100 - 0.5) * 100;
|
|
|
|
}
|
|
|
|
#print(fpm);
|
|
|
|
|
|
|
|
setprop(Settings, "target-pressure-rate", -fpm / 58000);
|
|
|
|
|
|
|
|
if (alt_button_timer_running == 0)
|
|
|
|
{
|
|
|
|
settimer(alt_button_timer, 3.0);
|
|
|
|
alt_button_timer_running = 1;
|
|
|
|
alt_button_timer_ignore = 0;
|
|
|
|
setprop(Annunciators, "alt-number", "off");
|
|
|
|
}
|
2004-04-16 21:59:51 +00:00
|
|
|
}
|
|
|
|
##
|
|
|
|
# Disengages all modes.
|
|
|
|
##
|
|
|
|
elsif (getprop(Locks, "roll-mode") != "off" and
|
|
|
|
getprop(Locks, "pitch-mode") != "off")
|
|
|
|
{
|
|
|
|
flash_timer = -1.0;
|
|
|
|
|
|
|
|
setprop(Locks, "alt-hold", "off");
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "hdg-hold", "off");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Locks, "rev-hold", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "roll-axis", "off");
|
|
|
|
setprop(Locks, "roll-mode", "off");
|
|
|
|
setprop(Locks, "pitch-axis", "off");
|
|
|
|
setprop(Locks, "pitch-mode", "off");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "off");
|
|
|
|
setprop(Locks, "pitch-arm", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
setprop(Settings, "target-alt-pressure", 0.0);
|
|
|
|
setprop(Settings, "target-intercept-angle", 0.0);
|
|
|
|
setprop(Settings, "target-pressure-rate", 0.0);
|
|
|
|
setprop(Settings, "target-turn-rate", 0.0);
|
|
|
|
|
|
|
|
setprop(Annunciators, "rol", "off");
|
|
|
|
setprop(Annunciators, "hdg", "off");
|
|
|
|
setprop(Annunciators, "nav", "off");
|
|
|
|
setprop(Annunciators, "nav-arm", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Annunciators, "apr", "off");
|
|
|
|
setprop(Annunciators, "apr-arm", "off");
|
|
|
|
setprop(Annunciators, "rev", "off");
|
|
|
|
setprop(Annunciators, "rev-arm", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Annunciators, "vs", "off");
|
|
|
|
setprop(Annunciators, "vs-number", "off");
|
|
|
|
setprop(Annunciators, "alt", "off");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Annunciators, "alt-arm", "off");
|
2004-10-17 17:41:05 +00:00
|
|
|
setprop(Annunciators, "alt-number", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Annunciators, "apr", "off");
|
|
|
|
setprop(Annunciators, "gs", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Annunciators, "gs-arm", "off");
|
2004-10-17 17:41:05 +00:00
|
|
|
setprop(Annunciators, "pt-up", "off");
|
|
|
|
setprop(Annunciators, "pt-dn", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
flasher("ap", 1.0, 5, "off");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
hdg_button = func {
|
2004-10-17 17:41:05 +00:00
|
|
|
##print("hdg_button");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
##
|
|
|
|
# Engages the heading mode (HDG) and vertical speed hold mode (VS). The
|
|
|
|
# commanded vertical speed is set to the vertical speed present at button
|
|
|
|
# press.
|
|
|
|
##
|
|
|
|
if (getprop(Locks, "roll-mode") == "off" and
|
|
|
|
getprop(Locks, "pitch-mode") == "off")
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
flash_timer = -1.0;
|
|
|
|
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "alt-hold", "off");
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Locks, "rev-hold", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "hdg-hold", "hdg");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
|
|
|
setprop(Locks, "roll-mode", "hdg");
|
|
|
|
setprop(Locks, "pitch-axis", "vs");
|
|
|
|
setprop(Locks, "pitch-mode", "vs");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "off");
|
|
|
|
setprop(Locks, "pitch-arm", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
setprop(Annunciators, "hdg", "on");
|
|
|
|
setprop(Annunciators, "alt", "off");
|
|
|
|
setprop(Annunciators, "apr", "off");
|
|
|
|
setprop(Annunciators, "gs", "off");
|
|
|
|
setprop(Annunciators, "nav", "off");
|
|
|
|
setprop(Annunciators, "vs", "on");
|
|
|
|
setprop(Annunciators, "vs-number", "on");
|
2004-10-17 17:41:05 +00:00
|
|
|
|
|
|
|
setprop(Settings, "target-intercept-angle", 0.0);
|
2004-11-01 09:34:16 +00:00
|
|
|
|
|
|
|
pt_check();
|
2004-10-17 17:41:05 +00:00
|
|
|
|
|
|
|
pressure_rate = getprop(Internal, "pressure-rate");
|
|
|
|
fpm = -pressure_rate * 58000;
|
|
|
|
#print(fpm);
|
|
|
|
if (fpm > 0.0)
|
|
|
|
{
|
|
|
|
fpm = int(fpm/100 + 0.5) * 100;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
fpm = int(fpm/100 - 0.5) * 100;
|
|
|
|
}
|
|
|
|
#print(fpm);
|
|
|
|
|
|
|
|
setprop(Settings, "target-pressure-rate", -fpm / 58000);
|
|
|
|
|
|
|
|
if (alt_button_timer_running == 0)
|
|
|
|
{
|
|
|
|
settimer(alt_button_timer, 3.0);
|
|
|
|
alt_button_timer_running = 1;
|
|
|
|
alt_button_timer_ignore = 0;
|
|
|
|
setprop(Annunciators, "alt-number", "off");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
##
|
|
|
|
# Switch from ROL to HDG mode, but don't change pitch mode.
|
|
|
|
##
|
|
|
|
elsif (getprop(Locks, "roll-mode") == "rol")
|
|
|
|
{
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "rev-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "hdg-hold", "hdg");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
|
|
|
setprop(Locks, "roll-mode", "hdg");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "off");
|
2004-10-17 17:41:05 +00:00
|
|
|
|
|
|
|
setprop(Annunciators, "apr", "off");
|
|
|
|
setprop(Annunciators, "gs", "off");
|
|
|
|
setprop(Annunciators, "hdg", "on");
|
|
|
|
setprop(Annunciators, "nav", "off");
|
|
|
|
setprop(Annunciators, "rol", "off");
|
|
|
|
setprop(Annunciators, "rev", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
setprop(Settings, "target-intercept-angle", 0.0);
|
|
|
|
}
|
|
|
|
##
|
|
|
|
# Switch to HDG mode, but don't change pitch mode.
|
|
|
|
##
|
2004-10-17 17:41:05 +00:00
|
|
|
elsif ( (getprop(Locks, "roll-mode") == "nav" or
|
2004-11-01 09:34:16 +00:00
|
|
|
getprop(Locks, "roll-arm") == "nav-arm" or
|
2004-04-16 22:14:00 +00:00
|
|
|
getprop(Locks, "roll-mode") == "rev" or
|
2004-11-01 09:34:16 +00:00
|
|
|
getprop(Locks, "roll-arm") == "rev-arm") and
|
2004-10-17 17:41:05 +00:00
|
|
|
flash_timer < -0.5)
|
2004-04-16 21:59:51 +00:00
|
|
|
{
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Locks, "rev-hold", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "hdg-hold", "hdg");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
|
|
|
setprop(Locks, "roll-mode", "hdg");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
setprop(Annunciators, "apr", "off");
|
|
|
|
setprop(Annunciators, "gs", "off");
|
|
|
|
setprop(Annunciators, "hdg", "on");
|
|
|
|
setprop(Annunciators, "nav", "off");
|
|
|
|
setprop(Annunciators, "rol", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Annunciators, "rev", "off");
|
2004-10-17 17:41:05 +00:00
|
|
|
setprop(Annunciators, "nav-arm", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
setprop(Settings, "target-intercept-angle", 0.0);
|
|
|
|
}
|
|
|
|
##
|
|
|
|
# If we already are in HDG mode switch to ROL mode. Again don't touch pitch
|
|
|
|
# mode.
|
|
|
|
##
|
|
|
|
elsif (getprop(Locks, "roll-mode") == "hdg")
|
|
|
|
{
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "hdg-hold", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Locks, "rev-hold", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
|
|
|
setprop(Locks, "roll-mode", "rol");
|
|
|
|
|
|
|
|
setprop(Annunciators, "apr", "off");
|
|
|
|
setprop(Annunciators, "gs", "off");
|
|
|
|
setprop(Annunciators, "hdg", "off");
|
|
|
|
setprop(Annunciators, "nav", "off");
|
|
|
|
setprop(Annunciators, "rol", "on");
|
|
|
|
|
|
|
|
setprop(Settings, "target-turn-rate", 0.0);
|
|
|
|
}
|
|
|
|
##
|
|
|
|
# If we are in APR mode we also have to change pitch mode.
|
|
|
|
# TODO: Should we switch to VS or ALT mode? (currently VS)
|
|
|
|
##
|
2004-10-17 17:41:05 +00:00
|
|
|
elsif ( (getprop(Locks, "roll-mode") == "apr" or
|
2004-11-01 09:34:16 +00:00
|
|
|
getprop(Locks, "roll-arm") == "apr-arm" or
|
2004-04-16 22:14:00 +00:00
|
|
|
getprop(Locks, "pitch-mode") == "gs" or
|
2004-11-01 09:34:16 +00:00
|
|
|
getprop(Locks, "pitch-arm") == "gs-arm") and
|
2004-10-17 17:41:05 +00:00
|
|
|
flash_timer < -0.5)
|
2004-04-16 21:59:51 +00:00
|
|
|
{
|
|
|
|
setprop(Locks, "alt-hold", "off");
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "hdg-hold", "hdg");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
|
|
|
setprop(Locks, "roll-mode", "hdg");
|
|
|
|
setprop(Locks, "pitch-axis", "vs");
|
|
|
|
setprop(Locks, "pitch-mode", "vs");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "off");
|
|
|
|
setprop(Locks, "pitch-arm", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
setprop(Annunciators, "alt", "off");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Annunciators, "alt-arm", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Annunciators, "hdg", "on");
|
|
|
|
setprop(Annunciators, "nav", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Annunciators, "apr", "off");
|
|
|
|
setprop(Annunciators, "apr-arm", "off");
|
|
|
|
setprop(Annunciators, "gs", "off");
|
|
|
|
setprop(Annunciators, "gs-arm", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Annunciators, "vs", "on");
|
|
|
|
setprop(Annunciators, "vs-number", "on");
|
|
|
|
|
|
|
|
setprop(Settings, "target-intercept-angle", 0.0);
|
2004-11-01 09:34:16 +00:00
|
|
|
|
|
|
|
pressure_rate = getprop(Internal, "pressure-rate");
|
|
|
|
#print(pressure_rate);
|
|
|
|
fpm = -pressure_rate * 58000;
|
|
|
|
#print(fpm);
|
|
|
|
if (fpm > 0.0)
|
|
|
|
{
|
|
|
|
fpm = int(fpm/100 + 0.5) * 100;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
fpm = int(fpm/100 - 0.5) * 100;
|
|
|
|
}
|
|
|
|
#print(fpm);
|
|
|
|
|
|
|
|
setprop(Settings, "target-pressure-rate", -fpm / 58000);
|
|
|
|
|
|
|
|
if (alt_button_timer_running == 0)
|
|
|
|
{
|
|
|
|
settimer(alt_button_timer, 3.0);
|
|
|
|
alt_button_timer_running = 1;
|
|
|
|
alt_button_timer_ignore = 0;
|
|
|
|
setprop(Annunciators, "alt-number", "off");
|
|
|
|
}
|
2004-04-16 21:59:51 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
nav_button = func {
|
2004-10-17 17:41:05 +00:00
|
|
|
##print("nav_button");
|
2004-04-16 22:14:00 +00:00
|
|
|
|
|
|
|
##
|
|
|
|
# If we are in HDG mode we switch to the 45 degree angle intercept NAV mode
|
|
|
|
##
|
2004-04-16 21:59:51 +00:00
|
|
|
if (getprop(Locks, "roll-mode") == "hdg")
|
|
|
|
{
|
|
|
|
flasher("hdg", 0.5, 8, "off");
|
|
|
|
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Locks, "rev-hold", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "hdg-hold", "hdg");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "nav-arm");
|
2004-10-17 17:41:05 +00:00
|
|
|
setprop(Locks, "roll-mode", "nav");
|
|
|
|
|
|
|
|
setprop(Annunciators, "nav-arm", "on");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
nav_arm_from_hdg();
|
|
|
|
}
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# If we are in ROL mode we switch to the all angle intercept NAV mode.
|
|
|
|
##
|
2004-04-16 21:59:51 +00:00
|
|
|
elsif (getprop(Locks, "roll-mode") == "rol")
|
|
|
|
{
|
|
|
|
flasher("hdg", 0.5, 8, "off");
|
|
|
|
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Locks, "rev-hold", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "hdg-hold", "off");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "nav-arm");
|
2004-10-17 17:41:05 +00:00
|
|
|
setprop(Locks, "roll-mode", "nav");
|
|
|
|
|
|
|
|
setprop(Annunciators, "nav-arm", "on");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
nav_arm_from_rol();
|
|
|
|
}
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# TODO:
|
|
|
|
# NAV mode can only be armed if we are in HDG or ROL mode.
|
|
|
|
# Can anyone verify that this is correct?
|
|
|
|
##
|
2004-04-16 21:59:51 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
nav_arm_from_hdg = func
|
|
|
|
{
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
2004-10-17 17:41:05 +00:00
|
|
|
# Abort the NAV-ARM mode if something has changed the arm mode to something
|
2004-04-16 22:14:00 +00:00
|
|
|
# else than NAV-ARM.
|
|
|
|
##
|
2004-11-01 09:34:16 +00:00
|
|
|
if (getprop(Locks, "roll-arm") != "nav-arm")
|
2004-04-16 21:59:51 +00:00
|
|
|
{
|
|
|
|
setprop(Annunciators, "nav-arm", "off");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
#setprop(Annunciators, "nav-arm", "on");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# Wait for the HDG annunciator flashing to finish.
|
|
|
|
##
|
2004-04-16 21:59:51 +00:00
|
|
|
if (flash_timer > -0.5)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("flashing...");
|
2004-04-16 21:59:51 +00:00
|
|
|
settimer(nav_arm_from_hdg, 2.5);
|
|
|
|
return;
|
|
|
|
}
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# Activate the nav-hold controller and check the needle deviation.
|
|
|
|
##
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "nav-hold", "nav");
|
2004-12-04 20:37:04 +00:00
|
|
|
deviation = getprop("/instrumentation/nav/heading-needle-deflection");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# If the deflection is more than 3 degrees wait 5 seconds and check again.
|
|
|
|
##
|
2004-04-16 21:59:51 +00:00
|
|
|
if (abs(deviation) > 3.0)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("deviation");
|
2004-04-16 21:59:51 +00:00
|
|
|
settimer(nav_arm_from_hdg, 5);
|
|
|
|
return;
|
|
|
|
}
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# If the deviation is less than 3 degrees turn of the NAV-ARM annunciator
|
|
|
|
# and show the NAV annunciator. End of NAV-ARM sequence.
|
|
|
|
##
|
2004-04-16 21:59:51 +00:00
|
|
|
elsif (abs(deviation) < 3.1)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("capture");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Annunciators, "nav-arm", "off");
|
|
|
|
setprop(Annunciators, "nav", "on");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
nav_arm_from_rol = func
|
|
|
|
{
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
2004-10-17 17:41:05 +00:00
|
|
|
# Abort the NAV-ARM mode if something has changed the arm mode to something
|
2004-04-16 22:14:00 +00:00
|
|
|
# else than NAV-ARM.
|
|
|
|
##
|
2004-11-01 09:34:16 +00:00
|
|
|
if (getprop(Locks, "roll-arm") != "nav-arm")
|
2004-04-16 21:59:51 +00:00
|
|
|
{
|
|
|
|
setprop(Annunciators, "nav-arm", "off");
|
|
|
|
return;
|
|
|
|
}
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# Wait for the HDG annunciator flashing to finish.
|
|
|
|
##
|
2004-10-17 17:41:05 +00:00
|
|
|
#setprop(Annunciators, "nav-arm", "on");
|
2004-04-16 21:59:51 +00:00
|
|
|
if (flash_timer > -0.5)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("flashing...");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Annunciators, "rol", "off");
|
|
|
|
settimer(nav_arm_from_rol, 2.5);
|
|
|
|
return;
|
|
|
|
}
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# Turn the ROL annunciator back on and activate the ROL mode.
|
|
|
|
##
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Annunciators, "rol", "on");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
|
|
|
setprop(Settings, "target-turn-rate", 0.0);
|
2004-12-04 20:37:04 +00:00
|
|
|
deviation = getprop("/instrumentation/nav/heading-needle-deflection");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# If the deflection is more than 3 degrees wait 5 seconds and check again.
|
|
|
|
##
|
2004-04-16 21:59:51 +00:00
|
|
|
if (abs(deviation) > 3.0)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("deviation");
|
2004-04-16 21:59:51 +00:00
|
|
|
settimer(nav_arm_from_rol, 5);
|
|
|
|
return;
|
|
|
|
}
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# If the deviation is less than 3 degrees turn of the NAV-ARM annunciator
|
|
|
|
# and show the NAV annunciator. End of NAV-ARM sequence.
|
|
|
|
##
|
2004-04-16 21:59:51 +00:00
|
|
|
elsif (abs(deviation) < 3.1)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("capture");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Annunciators, "rol", "off");
|
|
|
|
setprop(Annunciators, "nav-arm", "off");
|
|
|
|
setprop(Annunciators, "nav", "on");
|
|
|
|
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Locks, "rev-hold", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "hdg-hold", "hdg");
|
|
|
|
setprop(Locks, "nav-hold", "nav");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
|
|
|
setprop(Locks, "roll-mode", "nav");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
apr_button = func {
|
2004-10-17 17:41:05 +00:00
|
|
|
##print("apr_button");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# If we are in HDG mode we switch to the 45 degree intercept angle APR mode
|
|
|
|
##
|
|
|
|
if (getprop(Locks, "roll-mode") == "hdg")
|
2004-04-16 21:59:51 +00:00
|
|
|
{
|
2004-04-16 22:14:00 +00:00
|
|
|
flasher("hdg", 0.5, 8, "off");
|
|
|
|
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "apr-hold", "apr");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "rev-hold", "off");
|
|
|
|
setprop(Locks, "hdg-hold", "hdg");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "apr-arm");
|
2004-10-17 17:41:05 +00:00
|
|
|
setprop(Locks, "roll-mode", "apr");
|
|
|
|
|
|
|
|
setprop(Annunciators, "apr-arm", "on");
|
2004-04-16 22:14:00 +00:00
|
|
|
|
|
|
|
apr_arm_from_hdg();
|
|
|
|
}
|
|
|
|
elsif (getprop(Locks, "roll-mode") == "rol")
|
|
|
|
{
|
|
|
|
flasher("hdg", 0.5, 8, "off");
|
|
|
|
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "rev-hold", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "hdg-hold", "off");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "apr-arm");
|
2004-10-17 17:41:05 +00:00
|
|
|
setprop(Locks, "roll-mode", "apr");
|
|
|
|
|
|
|
|
setprop(Annunciators, "apr-arm", "on");
|
2004-04-16 22:14:00 +00:00
|
|
|
|
|
|
|
apr_arm_from_rol();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
apr_arm_from_hdg = func
|
|
|
|
{
|
|
|
|
##
|
2004-10-17 17:41:05 +00:00
|
|
|
# Abort the APR-ARM mode if something has changed the arm mode to something
|
2004-04-16 22:14:00 +00:00
|
|
|
# else than APR-ARM.
|
|
|
|
##
|
2004-11-01 09:34:16 +00:00
|
|
|
if (getprop(Locks, "roll-arm") != "apr-arm")
|
2004-04-16 22:14:00 +00:00
|
|
|
{
|
|
|
|
setprop(Annunciators, "apr-arm", "off");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
#setprop(Annunciators, "apr-arm", "on");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# Wait for the HDG annunciator flashing to finish.
|
|
|
|
##
|
|
|
|
if (flash_timer > -0.5)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("flashing...");
|
2004-04-16 22:14:00 +00:00
|
|
|
settimer(apr_arm_from_hdg, 2.5);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
##
|
|
|
|
# Activate the apr-hold controller and check the needle deviation.
|
|
|
|
##
|
|
|
|
setprop(Locks, "apr-hold", "apr");
|
2004-12-04 20:37:04 +00:00
|
|
|
deviation = getprop("/instrumentation/nav/heading-needle-deflection");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# If the deflection is more than 3 degrees wait 5 seconds and check again.
|
|
|
|
##
|
|
|
|
if (abs(deviation) > 3.0)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("deviation");
|
2004-04-16 22:14:00 +00:00
|
|
|
settimer(apr_arm_from_hdg, 5);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
##
|
|
|
|
# If the deviation is less than 3 degrees turn of the APR-ARM annunciator
|
|
|
|
# and show the APR annunciator. End of APR-ARM sequence. Start the GS-ARM
|
|
|
|
# sequence.
|
|
|
|
##
|
|
|
|
elsif (abs(deviation) < 3.1)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("capture");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Annunciators, "apr-arm", "off");
|
|
|
|
setprop(Annunciators, "apr", "on");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "pitch-arm", "gs-arm");
|
2004-04-16 22:14:00 +00:00
|
|
|
|
|
|
|
gs_arm();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
apr_arm_from_rol = func
|
|
|
|
{
|
|
|
|
##
|
|
|
|
# Abort the APR-ARM mode if something has changed the roll mode to something
|
|
|
|
# else than APR-ARM.
|
|
|
|
##
|
2004-11-01 09:34:16 +00:00
|
|
|
if (getprop(Locks, "roll-arm") != "apr-arm")
|
2004-04-16 22:14:00 +00:00
|
|
|
{
|
|
|
|
setprop(Annunciators, "apr-arm", "off");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
#setprop(Annunciators, "apr-arm", "on");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# Wait for the HDG annunciator flashing to finish.
|
|
|
|
##
|
|
|
|
if (flash_timer > -0.5)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("flashing...");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Annunciators, "rol", "off");
|
|
|
|
settimer(apr_arm_from_rol, 2.5);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
##
|
|
|
|
# Turn the ROL annunciator back on and activate the ROL mode.
|
|
|
|
##
|
|
|
|
setprop(Annunciators, "rol", "on");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
|
|
|
setprop(Settings, "target-turn-rate", 0.0);
|
2004-12-04 20:37:04 +00:00
|
|
|
deviation = getprop("/instrumentation/nav/heading-needle-deflection");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# If the deflection is more than 3 degrees wait 5 seconds and check again.
|
|
|
|
##
|
|
|
|
if (abs(deviation) > 3.0)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("deviation");
|
2004-04-16 22:14:00 +00:00
|
|
|
settimer(apr_arm_from_rol, 5);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
##
|
|
|
|
# If the deviation is less than 3 degrees turn of the APR-ARM annunciator
|
|
|
|
# and show the APR annunciator. End of APR-ARM sequence. Start the GS-ARM
|
|
|
|
# sequence.
|
|
|
|
##
|
|
|
|
elsif (abs(deviation) < 3.1)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("capture");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Annunciators, "rol", "off");
|
|
|
|
setprop(Annunciators, "apr-arm", "off");
|
|
|
|
setprop(Annunciators, "apr", "on");
|
|
|
|
|
|
|
|
setprop(Locks, "apr-hold", "apr");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "rev-hold", "off");
|
|
|
|
setprop(Locks, "hdg-hold", "hdg");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "roll-mode", "apr");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "gs-arm");
|
2004-04-16 22:14:00 +00:00
|
|
|
|
|
|
|
gs_arm();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
gs_arm = func {
|
|
|
|
##
|
2004-10-17 17:41:05 +00:00
|
|
|
# Abort the GS-ARM mode if something has changed the arm mode to something
|
2004-04-16 22:14:00 +00:00
|
|
|
# else than GS-ARM.
|
|
|
|
##
|
2004-11-01 09:34:16 +00:00
|
|
|
if (getprop(Locks, "pitch-arm") != "gs-arm")
|
2004-04-16 22:14:00 +00:00
|
|
|
{
|
|
|
|
setprop(Annunciators, "gs-arm", "off");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
setprop(Annunciators, "gs-arm", "on");
|
|
|
|
|
2004-12-04 20:37:04 +00:00
|
|
|
deviation = getprop("/instrumentation/nav/gs-needle-deflection");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# If the deflection is more than 1 degrees wait 5 seconds and check again.
|
|
|
|
##
|
|
|
|
if (abs(deviation) > 1.0)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("deviation");
|
2004-04-16 22:14:00 +00:00
|
|
|
settimer(gs_arm, 5);
|
|
|
|
return;
|
2004-04-16 21:59:51 +00:00
|
|
|
}
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
2004-10-17 17:41:05 +00:00
|
|
|
# If the deviation is less than 1 degrees turn off the GS-ARM annunciator
|
2004-04-16 22:14:00 +00:00
|
|
|
# and show the GS annunciator. Activate the GS pitch mode.
|
|
|
|
##
|
|
|
|
elsif (abs(deviation) < 3.1)
|
2004-04-16 21:59:51 +00:00
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("capture");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Annunciators, "alt", "off");
|
|
|
|
setprop(Annunciators, "vs", "off");
|
|
|
|
setprop(Annunciators, "vs-number", "off");
|
|
|
|
setprop(Annunciators, "gs-arm", "off");
|
|
|
|
setprop(Annunciators, "gs", "on");
|
|
|
|
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "alt-hold", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Locks, "gs-hold", "gs");
|
|
|
|
setprop(Locks, "pitch-mode", "gs");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "pitch-arm", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
rev_button = func {
|
2004-10-17 17:41:05 +00:00
|
|
|
##print("rev_button");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# If we are in HDG mode we switch to the 45 degree intercept angle REV mode
|
|
|
|
##
|
|
|
|
if (getprop(Locks, "roll-mode") == "hdg")
|
|
|
|
{
|
|
|
|
flasher("hdg", 0.5, 8, "off");
|
|
|
|
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Locks, "rev-hold", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "hdg-hold", "hdg");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Locks, "nav-hold", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "roll-axis", "trn");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "rev-arm");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
2004-04-16 22:14:00 +00:00
|
|
|
rev_arm_from_hdg();
|
|
|
|
}
|
|
|
|
elsif (getprop(Locks, "roll-mode") == "rol")
|
|
|
|
{
|
|
|
|
flasher("hdg", 0.5, 8, "off");
|
|
|
|
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "rev-hold", "off");
|
|
|
|
setprop(Locks, "hdg-hold", "off");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "rev-arm");
|
2004-04-16 22:14:00 +00:00
|
|
|
|
|
|
|
rev_arm_from_rol();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
rev_arm_from_hdg = func
|
|
|
|
{
|
|
|
|
##
|
2004-10-17 17:41:05 +00:00
|
|
|
# Abort the REV-ARM mode if something has changed the arm mode to something
|
2004-04-16 22:14:00 +00:00
|
|
|
# else than REV-ARM.
|
|
|
|
##
|
2004-11-01 09:34:16 +00:00
|
|
|
if (getprop(Locks, "roll-arm") != "rev-arm")
|
2004-04-16 22:14:00 +00:00
|
|
|
{
|
|
|
|
setprop(Annunciators, "rev-arm", "off");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
#setprop(Annunciators, "rev-arm", "on");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# Wait for the HDG annunciator flashing to finish.
|
|
|
|
##
|
|
|
|
if (flash_timer > -0.5)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("flashing...");
|
2004-04-16 22:14:00 +00:00
|
|
|
settimer(rev_arm_from_hdg, 2.5);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
##
|
|
|
|
# Activate the rev-hold controller and check the needle deviation.
|
|
|
|
##
|
|
|
|
setprop(Locks, "rev-hold", "rev");
|
2004-12-04 20:37:04 +00:00
|
|
|
deviation = getprop("/instrumentation/nav/heading-needle-deflection");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# If the deflection is more than 3 degrees wait 5 seconds and check again.
|
|
|
|
##
|
|
|
|
if (abs(deviation) > 3.0)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("deviation");
|
2004-04-16 22:14:00 +00:00
|
|
|
settimer(rev_arm_from_hdg, 5);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
##
|
|
|
|
# If the deviation is less than 3 degrees turn of the REV-ARM annunciator
|
|
|
|
# and show the REV annunciator. End of REV-ARM sequence.
|
|
|
|
##
|
|
|
|
elsif (abs(deviation) < 3.1)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("capture");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Annunciators, "rev-arm", "off");
|
|
|
|
setprop(Annunciators, "rev", "on");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "off");
|
2004-04-16 22:14:00 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
rev_arm_from_rol = func
|
|
|
|
{
|
|
|
|
##
|
2004-10-17 17:41:05 +00:00
|
|
|
# Abort the REV-ARM mode if something has changed the arm mode to something
|
2004-04-16 22:14:00 +00:00
|
|
|
# else than REV-ARM.
|
|
|
|
##
|
2004-11-01 09:34:16 +00:00
|
|
|
if (getprop(Locks, "roll-arm") != "rev-arm")
|
2004-04-16 22:14:00 +00:00
|
|
|
{
|
|
|
|
setprop(Annunciators, "rev-arm", "off");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
#setprop(Annunciators, "rev-arm", "on");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# Wait for the HDG annunciator flashing to finish.
|
|
|
|
##
|
|
|
|
if (flash_timer > -0.5)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("flashing...");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Annunciators, "rol", "off");
|
|
|
|
settimer(rev_arm_from_rol, 2.5);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
##
|
|
|
|
# Turn the ROL annunciator back on and activate the ROL mode.
|
|
|
|
##
|
|
|
|
setprop(Annunciators, "rol", "on");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
|
|
|
setprop(Settings, "target-turn-rate", 0.0);
|
2004-12-04 20:37:04 +00:00
|
|
|
deviation = getprop("/instrumentation/nav/heading-needle-deflection");
|
2004-04-16 22:14:00 +00:00
|
|
|
##
|
|
|
|
# If the deflection is more than 3 degrees wait 5 seconds and check again.
|
|
|
|
##
|
|
|
|
if (abs(deviation) > 3.0)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("deviation");
|
2004-04-16 22:14:00 +00:00
|
|
|
settimer(rev_arm_from_rol, 5);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
##
|
|
|
|
# If the deviation is less than 3 degrees turn of the REV-ARM annunciator
|
|
|
|
# and show the REV annunciator. End of REV-ARM sequence.
|
|
|
|
##
|
|
|
|
elsif (abs(deviation) < 3.1)
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
#print("capture");
|
2004-04-16 22:14:00 +00:00
|
|
|
setprop(Annunciators, "rol", "off");
|
|
|
|
setprop(Annunciators, "rev-arm", "off");
|
|
|
|
setprop(Annunciators, "rev", "on");
|
|
|
|
|
|
|
|
setprop(Locks, "apr-hold", "off");
|
|
|
|
setprop(Locks, "gs-hold", "off");
|
|
|
|
setprop(Locks, "rev-hold", "rev");
|
|
|
|
setprop(Locks, "hdg-hold", "hdg");
|
|
|
|
setprop(Locks, "nav-hold", "off");
|
|
|
|
setprop(Locks, "roll-axis", "trn");
|
|
|
|
setprop(Locks, "roll-mode", "rev");
|
2004-11-01 09:34:16 +00:00
|
|
|
setprop(Locks, "roll-arm", "off");
|
2004-10-17 17:41:05 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
alt_button_timer = func {
|
|
|
|
#print("alt button timer");
|
|
|
|
#print(alt_button_timer_ignore);
|
|
|
|
|
|
|
|
if (alt_button_timer_ignore == 0)
|
|
|
|
{
|
|
|
|
setprop(Annunciators, "vs-number", "off");
|
|
|
|
setprop(Annunciators, "alt-number", "on");
|
|
|
|
|
|
|
|
alt_button_timer_running = 0;
|
|
|
|
}
|
|
|
|
elsif (alt_button_timer_ignore > 0)
|
|
|
|
{
|
|
|
|
alt_button_timer_ignore = alt_button_timer_ignore - 1;
|
2004-04-16 21:59:51 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
alt_button = func {
|
2004-10-17 17:41:05 +00:00
|
|
|
##print("alt_button");
|
|
|
|
|
2004-04-16 21:59:51 +00:00
|
|
|
if (getprop(Locks, "pitch-mode") == "alt")
|
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
if (alt_button_timer_running == 0)
|
|
|
|
{
|
|
|
|
settimer(alt_button_timer, 3.0);
|
|
|
|
alt_button_timer_running = 1;
|
|
|
|
alt_button_timer_ignore = 0;
|
|
|
|
}
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "alt-hold", "off");
|
2004-10-17 17:41:05 +00:00
|
|
|
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Locks, "pitch-axis", "vs");
|
|
|
|
setprop(Locks, "pitch-mode", "vs");
|
|
|
|
|
|
|
|
setprop(Annunciators, "alt", "off");
|
2004-10-17 17:41:05 +00:00
|
|
|
setprop(Annunciators, "alt-number", "off");
|
2004-04-16 21:59:51 +00:00
|
|
|
setprop(Annunciators, "vs", "on");
|
|
|
|
setprop(Annunciators, "vs-number", "on");
|
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
pressure_rate = getprop(Internal, "pressure-rate");
|
|
|
|
fpm = -pressure_rate * 58000;
|
|
|
|
#print(fpm);
|
|
|
|
if (fpm > 0.0)
|
|
|
|
{
|
|
|
|
fpm = int(fpm/100 + 0.5) * 100;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
fpm = int(fpm/100 - 0.5) * 100;
|
|
|
|
}
|
|
|
|
#print(fpm);
|
|
|
|
|
|
|
|
setprop(Settings, "target-pressure-rate", -fpm / 58000);
|
|
|
|
|
2004-04-16 21:59:51 +00:00
|
|
|
}
|
|
|
|
elsif (getprop(Locks, "pitch-mode") == "vs")
|
|
|
|
{
|
|
|
|
setprop(Locks, "alt-hold", "alt");
|
|
|
|
setprop(Locks, "pitch-axis", "vs");
|
|
|
|
setprop(Locks, "pitch-mode", "alt");
|
|
|
|
|
|
|
|
setprop(Annunciators, "alt", "on");
|
|
|
|
setprop(Annunciators, "vs", "off");
|
|
|
|
setprop(Annunciators, "vs-number", "off");
|
2004-10-17 17:41:05 +00:00
|
|
|
setprop(Annunciators, "alt-number", "on");
|
2004-04-16 21:59:51 +00:00
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
alt_pressure = getprop("/systems/static/pressure-inhg");
|
|
|
|
alt_ft = (baro_setting - alt_pressure) / 0.00103;
|
|
|
|
if (alt_ft > 0.0)
|
|
|
|
{
|
|
|
|
alt_ft = int(alt_ft/20 + 0.5) * 20;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
alt_ft = int(alt_ft/20 - 0.5) * 20;
|
|
|
|
}
|
|
|
|
#print(alt_ft);
|
|
|
|
|
|
|
|
alt_pressure = baro_setting - alt_ft * 0.00103;
|
|
|
|
setprop(Settings, "target-alt-pressure", alt_pressure);
|
2004-04-16 21:59:51 +00:00
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
dn_button = func {
|
2004-10-17 17:41:05 +00:00
|
|
|
##print("dn_button");
|
|
|
|
|
|
|
|
if (baro_timer_running == 0)
|
2004-04-16 21:59:51 +00:00
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
if (getprop(Locks, "pitch-mode") == "vs")
|
|
|
|
{
|
|
|
|
if (alt_button_timer_running == 0)
|
|
|
|
{
|
|
|
|
settimer(alt_button_timer, 3.0);
|
|
|
|
alt_button_timer_running = 1;
|
|
|
|
alt_button_timer_ignore = 0;
|
|
|
|
}
|
|
|
|
elsif (alt_button_timer_running == 1)
|
|
|
|
{
|
|
|
|
settimer(alt_button_timer, 3.0);
|
|
|
|
alt_button_timer_ignore = alt_button_timer_ignore + 1;
|
|
|
|
}
|
|
|
|
Target_VS = getprop(Settings, "target-pressure-rate");
|
|
|
|
setprop(Settings, "target-pressure-rate", Target_VS +
|
|
|
|
0.0017241379310345);
|
|
|
|
setprop(Annunciators, "alt-number", "off");
|
|
|
|
setprop(Annunciators, "vs-number", "on");
|
|
|
|
}
|
|
|
|
elsif (getprop(Locks, "pitch-mode") == "alt")
|
|
|
|
{
|
|
|
|
Target_Pressure = getprop(Settings, "target-alt-pressure");
|
|
|
|
setprop(Settings, "target-alt-pressure", Target_Pressure + 0.0206);
|
|
|
|
}
|
2004-04-16 21:59:51 +00:00
|
|
|
}
|
2004-10-17 17:41:05 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
up_button = func {
|
|
|
|
##print("up_button");
|
|
|
|
|
|
|
|
if (baro_timer_running == 0)
|
2004-04-16 21:59:51 +00:00
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
if (getprop(Locks, "pitch-mode") == "vs")
|
|
|
|
{
|
|
|
|
if (alt_button_timer_running == 0)
|
|
|
|
{
|
|
|
|
settimer(alt_button_timer, 3.0);
|
|
|
|
alt_button_timer_running = 1;
|
|
|
|
alt_button_timer_ignore = 0;
|
|
|
|
}
|
|
|
|
elsif (alt_button_timer_running == 1)
|
|
|
|
{
|
|
|
|
settimer(alt_button_timer, 3.0);
|
|
|
|
alt_button_timer_ignore = alt_button_timer_ignore + 1;
|
|
|
|
}
|
|
|
|
Target_VS = getprop(Settings, "target-pressure-rate");
|
|
|
|
setprop(Settings, "target-pressure-rate", Target_VS -
|
|
|
|
0.0017241379310345);
|
|
|
|
setprop(Annunciators, "alt-number", "off");
|
|
|
|
setprop(Annunciators, "vs-number", "on");
|
|
|
|
}
|
|
|
|
elsif (getprop(Locks, "pitch-mode") == "alt")
|
|
|
|
{
|
|
|
|
Target_Pressure = getprop(Settings, "target-alt-pressure");
|
|
|
|
setprop(Settings, "target-alt-pressure", Target_Pressure - 0.0206);
|
|
|
|
}
|
2004-04-16 21:59:51 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
arm_button = func {
|
|
|
|
#print("arm button");
|
2004-11-01 09:34:16 +00:00
|
|
|
|
|
|
|
pitch_arm = getprop(Locks, "pitch-arm");
|
|
|
|
|
|
|
|
if (pitch_arm == "off")
|
|
|
|
{
|
|
|
|
setprop(Locks, "pitch-arm", "alt-arm");
|
|
|
|
|
|
|
|
setprop(Annunciators, "alt-arm", "on");
|
|
|
|
}
|
|
|
|
elsif (pitch_arm == "alt-arm")
|
|
|
|
{
|
|
|
|
setprop(Locks, "pitch-arm", "off");
|
|
|
|
|
|
|
|
setprop(Annunciators, "alt-arm", "off");
|
|
|
|
}
|
2004-10-17 17:41:05 +00:00
|
|
|
}
|
2004-04-16 21:59:51 +00:00
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
|
|
|
|
baro_button_timer = func {
|
|
|
|
#print("baro button timer");
|
|
|
|
|
|
|
|
baro_timer_running = 0;
|
|
|
|
if (baro_button_down == 1)
|
|
|
|
{
|
|
|
|
baro_setting_unit = !baro_setting_unit;
|
|
|
|
baro_button_down = 0;
|
|
|
|
baro_button_press();
|
|
|
|
}
|
|
|
|
elsif (baro_button_down == 0 and
|
|
|
|
baro_setting_adjusting == 0)
|
2004-04-16 21:59:51 +00:00
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
setprop(Annunciators, "bs-hpa-number", "off");
|
|
|
|
setprop(Annunciators, "bs-inhg-number", "off");
|
|
|
|
setprop(Annunciators, "alt-number", "on");
|
2004-04-16 21:59:51 +00:00
|
|
|
}
|
2004-10-17 17:41:05 +00:00
|
|
|
elsif (baro_setting_adjusting == 1)
|
2004-04-16 21:59:51 +00:00
|
|
|
{
|
2004-10-17 17:41:05 +00:00
|
|
|
baro_timer_running = 1;
|
|
|
|
baro_setting_adjusting = 0;
|
|
|
|
settimer(baro_button_timer, 3.0);
|
2004-04-16 21:59:51 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
baro_button_press = func {
|
|
|
|
#print("baro putton press");
|
|
|
|
|
|
|
|
if (baro_button_down == 0 and
|
|
|
|
baro_timer_running == 0 and
|
|
|
|
alt_button_timer_running == 0)
|
|
|
|
{
|
|
|
|
baro_button_down = 1;
|
|
|
|
baro_timer_running = 1;
|
|
|
|
settimer(baro_button_timer, 3.0);
|
|
|
|
setprop(Annunciators, "alt-number", "off");
|
|
|
|
|
|
|
|
if (baro_setting_unit == 0)
|
|
|
|
{
|
|
|
|
setprop(Settings, "baro-setting-inhg", baro_setting);
|
|
|
|
|
|
|
|
setprop(Annunciators, "bs-inhg-number", "on");
|
|
|
|
setprop(Annunciators, "bs-hpa-number", "off");
|
|
|
|
}
|
|
|
|
elsif (baro_setting_unit == 1)
|
|
|
|
{
|
|
|
|
setprop(Settings, "baro-setting-hpa",
|
|
|
|
baro_setting * 0.03386389);
|
|
|
|
|
|
|
|
setprop(Annunciators, "bs-hpa-number", "on");
|
|
|
|
setprop(Annunciators, "bs-inhg-number", "off");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
baro_button_release = func {
|
|
|
|
#print("baro button release");
|
|
|
|
|
|
|
|
baro_button_down = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2004-11-01 09:34:16 +00:00
|
|
|
pow = func {
|
|
|
|
#print(arg[0],arg[1]);
|
|
|
|
return math.exp(arg[1]*math.ln(arg[0]));
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
pressureToHeight = func {
|
|
|
|
p0 = arg[1]; # [Pa]
|
|
|
|
p = arg[0]; # [Pa]
|
|
|
|
t0 = 288.15; # [K]
|
|
|
|
LR = -0.0065; # [K/m]
|
|
|
|
g = -9.80665; # [m/s²]
|
|
|
|
Rd = 287.05307; # [J/kg K]
|
|
|
|
|
|
|
|
z = -(t0/LR) * (1.0-pow((p/p0),((Rd*LR)/g)));
|
|
|
|
return z;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
heightToPressure = func {
|
|
|
|
p0 = arg[1]; # [Pa]
|
|
|
|
z = arg[0]; # [m]
|
|
|
|
t0 = 288.15; # [K]
|
|
|
|
LR = -0.0065; # [K/m]
|
|
|
|
g = -9.80665; # [m/s²]
|
|
|
|
Rd = 287.05307; # [J/kg K]
|
|
|
|
|
|
|
|
p = p0 * pow(((t0+LR*z)/t0),(g/(Rd*LR)));
|
|
|
|
return p;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
alt_alert = func {
|
|
|
|
#print("alt alert");
|
|
|
|
|
|
|
|
alt_pressure = getprop("/systems/static/pressure-inhg");
|
2004-11-01 09:34:16 +00:00
|
|
|
alt_m = pressureToHeight(alt_pressure*3386.389,
|
|
|
|
baro_setting*3386.389);
|
|
|
|
#print(alt_m);
|
|
|
|
|
|
|
|
alt_ft = alt_m / 0.3048006;
|
|
|
|
#print(alt_ft);
|
2004-10-17 17:41:05 +00:00
|
|
|
alt_difference = abs(alt_preselect - alt_ft);
|
|
|
|
#print(alt_difference);
|
|
|
|
|
|
|
|
if (alt_difference > 1000)
|
|
|
|
{
|
|
|
|
setprop(Annunciators, "alt-alert", "off");
|
|
|
|
}
|
|
|
|
elsif (alt_difference < 1000 and
|
|
|
|
alt_captured == 0)
|
|
|
|
{
|
|
|
|
if (flash_timer < -0.5) {
|
|
|
|
setprop(Annunciators, "alt-alert", "on"); }
|
|
|
|
if (alt_difference < 200)
|
|
|
|
{
|
|
|
|
if (flash_timer < -0.5) {
|
|
|
|
setprop(Annunciators, "alt-alert", "off"); }
|
|
|
|
if (alt_difference < 20)
|
|
|
|
{
|
|
|
|
#print("alt_capture()");
|
|
|
|
alt_captured = 1;
|
2004-11-01 09:34:16 +00:00
|
|
|
|
|
|
|
if (getprop(Locks, "pitch-arm") == "alt-arm")
|
|
|
|
{
|
|
|
|
setprop(Locks, "alt-hold", "alt");
|
|
|
|
setprop(Locks, "pitch-axis", "vs");
|
|
|
|
setprop(Locks, "pitch-mode", "alt");
|
|
|
|
setprop(Locks, "pitch-arm", "off");
|
|
|
|
|
|
|
|
setprop(Annunciators, "alt", "on");
|
|
|
|
setprop(Annunciators, "alt-arm", "off");
|
|
|
|
setprop(Annunciators, "vs", "off");
|
|
|
|
setprop(Annunciators, "vs-number", "off");
|
|
|
|
setprop(Annunciators, "alt-number", "on");
|
|
|
|
|
|
|
|
#alt_pressure = baro_setting - alt_preselect * 0.00103;
|
|
|
|
alt_pressure = heightToPressure(alt_preselect*0.3048006,
|
|
|
|
baro_setting*3386.389)/3386.389;
|
|
|
|
setprop(Settings, "target-alt-pressure", alt_pressure);
|
|
|
|
}
|
|
|
|
|
2004-10-17 17:41:05 +00:00
|
|
|
flasher("alt-alert", 1.0, 0, "off");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
elsif (alt_difference < 1000 and
|
|
|
|
alt_captured == 1)
|
|
|
|
{
|
|
|
|
if (alt_difference > 200)
|
|
|
|
{
|
|
|
|
flasher("alt-alert", 1.0, 5, "on");
|
|
|
|
alt_captured = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
settimer(alt_alert, 2.0);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
knob_s_up = func {
|
|
|
|
#print("knob small up");
|
|
|
|
|
|
|
|
if (baro_timer_running == 1)
|
|
|
|
{
|
|
|
|
baro_setting_adjusting = 1;
|
|
|
|
if (baro_setting_unit == 0)
|
|
|
|
{
|
|
|
|
baro_setting = baro_setting + 0.01;
|
2004-11-01 09:34:16 +00:00
|
|
|
baro_setting_hpa = baro_setting * 0.03386389;
|
2004-10-17 17:41:05 +00:00
|
|
|
|
|
|
|
setprop(Settings, "baro-setting-inhg", baro_setting);
|
|
|
|
}
|
|
|
|
elsif (baro_setting_unit == 1)
|
|
|
|
{
|
|
|
|
baro_setting_hpa = baro_setting * 0.03386389;
|
|
|
|
baro_setting_hpa = baro_setting_hpa + 0.001;
|
|
|
|
baro_setting = baro_setting_hpa / 0.03386389;
|
|
|
|
|
|
|
|
setprop(Settings, "baro-setting-hpa", baro_setting_hpa);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
elsif (baro_timer_running == 0 and
|
|
|
|
alt_button_timer_running == 0)
|
|
|
|
{
|
2004-11-01 09:34:16 +00:00
|
|
|
alt_captured = 0;
|
2004-10-17 17:41:05 +00:00
|
|
|
alt_preselect = alt_preselect + 20;
|
|
|
|
setprop(Settings, "target-alt-ft", alt_preselect);
|
|
|
|
|
|
|
|
if (getprop(Locks, "roll-mode") == "off" and
|
|
|
|
getprop(Locks, "pitch-mode") == "off")
|
|
|
|
{
|
|
|
|
setprop(Annunciators, "alt-number", "on");
|
|
|
|
if (alt_alert_on == 0)
|
|
|
|
{
|
|
|
|
alt_alert_on = 1;
|
|
|
|
}
|
|
|
|
}
|
2004-11-01 09:34:16 +00:00
|
|
|
elsif (getprop(Locks, "pitch-arm") == "off")
|
|
|
|
{
|
|
|
|
setprop(Locks, "pitch-arm", "alt-arm");
|
|
|
|
setprop(Annunciators, "alt-arm", "on");
|
|
|
|
}
|
2004-10-17 17:41:05 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
knob_l_up = func {
|
|
|
|
#print("knob large up");
|
|
|
|
|
|
|
|
if (baro_timer_running == 1)
|
|
|
|
{
|
|
|
|
baro_setting_adjusting = 1;
|
|
|
|
if (baro_setting_unit == 0)
|
|
|
|
{
|
|
|
|
baro_setting = baro_setting + 1.0;
|
2004-11-01 09:34:16 +00:00
|
|
|
baro_setting_hpa = baro_setting * 0.03386389;
|
2004-10-17 17:41:05 +00:00
|
|
|
|
|
|
|
setprop(Settings, "baro-setting-inhg", baro_setting);
|
|
|
|
}
|
|
|
|
elsif (baro_setting_unit == 1)
|
|
|
|
{
|
|
|
|
baro_setting_hpa = baro_setting * 0.03386389;
|
|
|
|
baro_setting_hpa = baro_setting_hpa + 0.1;
|
|
|
|
baro_setting = baro_setting_hpa / 0.03386389;
|
|
|
|
|
|
|
|
setprop(Settings, "baro-setting-hpa", baro_setting_hpa);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
elsif (baro_timer_running == 0 and
|
|
|
|
alt_button_timer_running == 0)
|
|
|
|
{
|
2004-11-01 09:34:16 +00:00
|
|
|
alt_captured = 0;
|
2004-10-17 17:41:05 +00:00
|
|
|
alt_preselect = alt_preselect + 100;
|
|
|
|
setprop(Settings, "target-alt-ft", alt_preselect);
|
|
|
|
|
|
|
|
if (getprop(Locks, "roll-mode") == "off" and
|
|
|
|
getprop(Locks, "pitch-mode") == "off")
|
|
|
|
{
|
|
|
|
setprop(Annunciators, "alt-number", "on");
|
|
|
|
if (alt_alert_on == 0)
|
|
|
|
{
|
|
|
|
alt_alert_on = 1;
|
|
|
|
}
|
|
|
|
}
|
2004-11-01 09:34:16 +00:00
|
|
|
elsif (getprop(Locks, "pitch-arm") == "off")
|
|
|
|
{
|
|
|
|
setprop(Locks, "pitch-arm", "alt-arm");
|
|
|
|
setprop(Annunciators, "alt-arm", "on");
|
|
|
|
}
|
2004-10-17 17:41:05 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
knob_s_dn = func {
|
|
|
|
#print("knob small down");
|
|
|
|
|
|
|
|
if (baro_timer_running == 1)
|
|
|
|
{
|
|
|
|
baro_setting_adjusting = 1;
|
|
|
|
if (baro_setting_unit == 0)
|
|
|
|
{
|
|
|
|
baro_setting = baro_setting - 0.01;
|
2004-11-01 09:34:16 +00:00
|
|
|
baro_setting_hpa = baro_setting * 0.03386389;
|
2004-10-17 17:41:05 +00:00
|
|
|
|
|
|
|
setprop(Settings, "baro-setting-inhg", baro_setting);
|
|
|
|
}
|
|
|
|
elsif (baro_setting_unit == 1)
|
|
|
|
{
|
|
|
|
baro_setting_hpa = baro_setting * 0.03386389;
|
|
|
|
baro_setting_hpa = baro_setting_hpa - 0.001;
|
|
|
|
baro_setting = baro_setting_hpa / 0.03386389;
|
|
|
|
|
|
|
|
setprop(Settings, "baro-setting-hpa", baro_setting_hpa);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
elsif (baro_timer_running == 0 and
|
|
|
|
alt_button_timer_running == 0)
|
|
|
|
{
|
2004-11-01 09:34:16 +00:00
|
|
|
alt_captured = 0;
|
2004-10-17 17:41:05 +00:00
|
|
|
alt_preselect = alt_preselect - 20;
|
|
|
|
setprop(Settings, "target-alt-ft", alt_preselect);
|
|
|
|
|
|
|
|
if (getprop(Locks, "roll-mode") == "off" and
|
|
|
|
getprop(Locks, "pitch-mode") == "off")
|
|
|
|
{
|
|
|
|
setprop(Annunciators, "alt-number", "on");
|
|
|
|
if (alt_alert_on == 0)
|
|
|
|
{
|
|
|
|
alt_alert_on = 1;
|
|
|
|
}
|
|
|
|
}
|
2004-11-01 09:34:16 +00:00
|
|
|
elsif (getprop(Locks, "pitch-arm") == "off")
|
|
|
|
{
|
|
|
|
setprop(Locks, "pitch-arm", "alt-arm");
|
|
|
|
setprop(Annunciators, "alt-arm", "on");
|
|
|
|
}
|
2004-10-17 17:41:05 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
knob_l_dn = func {
|
|
|
|
#print("knob large down");
|
|
|
|
|
|
|
|
if (baro_timer_running == 1)
|
|
|
|
{
|
|
|
|
baro_setting_adjusting = 1;
|
|
|
|
if (baro_setting_unit == 0)
|
|
|
|
{
|
|
|
|
baro_setting = baro_setting - 1.0;
|
2004-11-01 09:34:16 +00:00
|
|
|
baro_setting_hpa = baro_setting * 0.03386389;
|
2004-10-17 17:41:05 +00:00
|
|
|
|
|
|
|
setprop(Settings, "baro-setting-inhg", baro_setting);
|
|
|
|
}
|
|
|
|
elsif (baro_setting_unit == 1)
|
|
|
|
{
|
|
|
|
baro_setting_hpa = baro_setting * 0.03386389;
|
|
|
|
baro_setting_hpa = baro_setting_hpa - 0.1;
|
|
|
|
baro_setting = baro_setting_hpa / 0.03386389;
|
|
|
|
|
|
|
|
setprop(Settings, "baro-setting-hpa", baro_setting_hpa);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
elsif (baro_timer_running == 0 and
|
|
|
|
alt_button_timer_running == 0)
|
|
|
|
{
|
2004-11-01 09:34:16 +00:00
|
|
|
alt_captured = 0;
|
2004-10-17 17:41:05 +00:00
|
|
|
alt_preselect = alt_preselect - 100;
|
|
|
|
setprop(Settings, "target-alt-ft", alt_preselect);
|
|
|
|
|
|
|
|
if (getprop(Locks, "roll-mode") == "off" and
|
|
|
|
getprop(Locks, "pitch-mode") == "off")
|
|
|
|
{
|
|
|
|
setprop(Annunciators, "alt-number", "on");
|
|
|
|
if (alt_alert_on == 0)
|
|
|
|
{
|
|
|
|
alt_alert_on = 1;
|
|
|
|
}
|
|
|
|
}
|
2004-11-01 09:34:16 +00:00
|
|
|
elsif (getprop(Locks, "pitch-arm") == "off")
|
|
|
|
{
|
|
|
|
setprop(Locks, "pitch-arm", "alt-arm");
|
|
|
|
setprop(Annunciators, "alt-arm", "on");
|
|
|
|
}
|
2004-10-17 17:41:05 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
ap_init();
|
|
|
|
|
2004-11-01 09:34:16 +00:00
|
|
|
alt_alert();
|