1096 lines
37 KiB
Text
1096 lines
37 KiB
Text
|
# A3XX FMGC/Autoflight
|
||
|
|
# Joshua Davidson (it0uchpods) and Jonathan Redpath (legoboyvdlp)
|
||
|
|
|
||
|
|
#################################
|
||
|
|
# IT-AUTOFLIGHT Based Autopilot #
|
||
|
|
#################################
|
||
|
|
|
||
|
|
var APinit = func {
|
||
|
|
setprop("/it-autoflight/custom/trk-fpa", 0);
|
||
|
|
setprop("/it-autoflight/input/kts-mach", 0);
|
||
|
|
setprop("/it-autoflight/input/ap1", 0);
|
||
|
|
setprop("/it-autoflight/input/ap2", 0);
|
||
|
|
setprop("/it-autoflight/input/athr", 0);
|
||
|
|
setprop("/it-autoflight/input/fd1", 0);
|
||
|
|
setprop("/it-autoflight/input/fd2", 0);
|
||
|
|
setprop("/it-autoflight/input/hdg", 360);
|
||
|
|
setprop("/it-autoflight/input/alt", 10000);
|
||
|
|
setprop("/it-autoflight/input/vs", 0);
|
||
|
|
setprop("/it-autoflight/input/fpa", 0);
|
||
|
|
setprop("/it-autoflight/input/lat", 5);
|
||
|
|
setprop("/it-autoflight/input/lat-arm", 0);
|
||
|
|
setprop("/it-autoflight/input/vert", 7);
|
||
|
|
setprop("/it-autoflight/input/bank-limit", 25);
|
||
|
|
setprop("/it-autoflight/input/trk", 0);
|
||
|
|
setprop("/it-autoflight/input/toga", 0);
|
||
|
|
setprop("/it-autoflight/input/spd-managed", 0);
|
||
|
|
setprop("/it-autoflight/output/ap1", 0);
|
||
|
|
setprop("/it-autoflight/output/ap2", 0);
|
||
|
|
setprop("/it-autoflight/output/athr", 0);
|
||
|
|
setprop("/it-autoflight/output/fd1", 0);
|
||
|
|
setprop("/it-autoflight/output/fd2", 0);
|
||
|
|
setprop("/it-autoflight/output/loc-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 2);
|
||
|
|
setprop("/it-autoflight/output/lat", 5);
|
||
|
|
setprop("/it-autoflight/output/vert", 7);
|
||
|
|
setprop("/it-autoflight/output/vert-mng", 4);
|
||
|
|
setprop("/it-autoflight/output/fma-pwr", 0);
|
||
|
|
setprop("/it-autoflight/settings/use-backcourse", 0);
|
||
|
|
setprop("/it-autoflight/internal/min-vs", -500);
|
||
|
|
setprop("/it-autoflight/internal/max-vs", 500);
|
||
|
|
setprop("/it-autoflight/internal/alt", 10000);
|
||
|
|
setprop("/it-autoflight/internal/alt", 10000);
|
||
|
|
setprop("/it-autoflight/internal/fpa", 0);
|
||
|
|
setprop("/it-autoflight/internal/top-of-des-nm", 0);
|
||
|
|
setprop("/it-autoflight/internal/alt-const", 10000);
|
||
|
|
setprop("/it-autoflight/internal/mng-alt", 10000);
|
||
|
|
setprop("/it-autoflight/internal/prof-mode", "XX");
|
||
|
|
setprop("/it-autoflight/internal/prof-fpm", 0);
|
||
|
|
setprop("/it-autoflight/internal/top-of-des-nm", 0);
|
||
|
|
setprop("/it-autoflight/mode/thr", "PITCH");
|
||
|
|
setprop("/it-autoflight/mode/arm", "HDG");
|
||
|
|
setprop("/it-autoflight/mode/lat", "T/O");
|
||
|
|
setprop("/it-autoflight/mode/vert", "T/O CLB");
|
||
|
|
setprop("/it-autoflight/input/spd-kts", 100);
|
||
|
|
setprop("/it-autoflight/input/spd-mach", 0.50);
|
||
|
|
update_armst.start();
|
||
|
|
thrustmode();
|
||
|
|
}
|
||
|
|
|
||
|
|
# AP 1 Master System
|
||
|
|
setlistener("/it-autoflight/input/ap1", func {
|
||
|
|
var apmas = getprop("/it-autoflight/input/ap1");
|
||
|
|
var ac_ess = getprop("/systems/electrical/bus/ac-ess");
|
||
|
|
if (apmas == 0) {
|
||
|
|
fmabox();
|
||
|
|
setprop("/it-autoflight/output/ap1", 0);
|
||
|
|
if (getprop("/it-autoflight/sound/enableapoffsound") == 1) {
|
||
|
|
setprop("/it-autoflight/sound/apoffsound", 1);
|
||
|
|
setprop("/it-autoflight/sound/enableapoffsound", 0);
|
||
|
|
}
|
||
|
|
} else if (apmas == 1 and ac_ess >= 110) {
|
||
|
|
if ((getprop("/gear/gear[1]/wow") == 0) and (getprop("/gear/gear[2]/wow") == 0)) {
|
||
|
|
fmabox();
|
||
|
|
setprop("/it-autoflight/output/ap1", 1);
|
||
|
|
setprop("/it-autoflight/sound/enableapoffsound", 1);
|
||
|
|
setprop("/it-autoflight/sound/apoffsound", 0);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
# AP 2 Master System
|
||
|
|
setlistener("/it-autoflight/input/ap2", func {
|
||
|
|
var apmas = getprop("/it-autoflight/input/ap2");
|
||
|
|
var ac_ess = getprop("/systems/electrical/bus/ac-ess");
|
||
|
|
if (apmas == 0) {
|
||
|
|
fmabox();
|
||
|
|
setprop("/it-autoflight/output/ap2", 0);
|
||
|
|
if (getprop("/it-autoflight/sound/enableapoffsound2") == 1) {
|
||
|
|
setprop("/it-autoflight/sound/apoffsound2", 1);
|
||
|
|
setprop("/it-autoflight/sound/enableapoffsound2", 0);
|
||
|
|
}
|
||
|
|
} else if (apmas == 1 and ac_ess >= 110) {
|
||
|
|
if ((getprop("/gear/gear[1]/wow") == 0) and (getprop("/gear/gear[2]/wow") == 0)) {
|
||
|
|
fmabox();
|
||
|
|
setprop("/it-autoflight/output/ap2", 1);
|
||
|
|
setprop("/it-autoflight/sound/enableapoffsound2", 1);
|
||
|
|
setprop("/it-autoflight/sound/apoffsound2", 0);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
# AT Master System
|
||
|
|
setlistener("/it-autoflight/input/athr", func {
|
||
|
|
var atmas = getprop("/it-autoflight/input/athr");
|
||
|
|
if (atmas == 0) {
|
||
|
|
setprop("/it-autoflight/output/athr", 0);
|
||
|
|
} else if (atmas == 1) {
|
||
|
|
thrustmode();
|
||
|
|
setprop("/it-autoflight/output/athr", 1);
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
# Flight Director 1 Master System
|
||
|
|
setlistener("/it-autoflight/input/fd1", func {
|
||
|
|
var fdmas = getprop("/it-autoflight/input/fd1");
|
||
|
|
if (fdmas == 0) {
|
||
|
|
fmabox();
|
||
|
|
setprop("/it-autoflight/output/fd1", 0);
|
||
|
|
} else if (fdmas == 1) {
|
||
|
|
fmabox();
|
||
|
|
setprop("/it-autoflight/output/fd1", 1);
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
# Flight Director 2 Master System
|
||
|
|
setlistener("/it-autoflight/input/fd2", func {
|
||
|
|
var fdmas = getprop("/it-autoflight/input/fd2");
|
||
|
|
if (fdmas == 0) {
|
||
|
|
fmabox();
|
||
|
|
setprop("/it-autoflight/output/fd2", 0);
|
||
|
|
} else if (fdmas == 1) {
|
||
|
|
fmabox();
|
||
|
|
setprop("/it-autoflight/output/fd2", 1);
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
# FMA Boxes and Mode
|
||
|
|
var fmabox = func {
|
||
|
|
var ap1 = getprop("/it-autoflight/output/ap1");
|
||
|
|
var ap2 = getprop("/it-autoflight/output/ap2");
|
||
|
|
var fd1 = getprop("/it-autoflight/output/fd1");
|
||
|
|
var fd2 = getprop("/it-autoflight/output/fd2");
|
||
|
|
if (!ap1 and !ap2 and !fd1 and !fd2) {
|
||
|
|
setprop("/it-autoflight/input/trk", 0);
|
||
|
|
setprop("/it-autoflight/input/lat", 3);
|
||
|
|
setprop("/it-autoflight/input/vert", 1);
|
||
|
|
setprop("/it-autoflight/input/vs", 0);
|
||
|
|
setprop("/it-autoflight/output/fma-pwr", 0);
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/input/trk", 0);
|
||
|
|
setprop("/it-autoflight/input/vs", 0);
|
||
|
|
setprop("/it-autoflight/output/fma-pwr", 1);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# Master Lateral
|
||
|
|
setlistener("/it-autoflight/input/lat", func {
|
||
|
|
if ((getprop("/gear/gear[1]/wow") == 0) and (getprop("/gear/gear[2]/wow") == 0)) {
|
||
|
|
lateral();
|
||
|
|
} else {
|
||
|
|
lat_arm();
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
var lateral = func {
|
||
|
|
var latset = getprop("/it-autoflight/input/lat");
|
||
|
|
if (latset == 0) {
|
||
|
|
alandt.stop();
|
||
|
|
alandt1.stop();
|
||
|
|
lnavwptt.stop();
|
||
|
|
setprop("/it-autoflight/output/loc-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/lat", 0);
|
||
|
|
setprop("/it-autoflight/mode/lat", "HDG");
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
} else if (latset == 1) {
|
||
|
|
if (getprop("/autopilot/route-manager/route/num") > 0 and getprop("/autopilot/route-manager/active") == 1) {
|
||
|
|
alandt.stop();
|
||
|
|
alandt1.stop();
|
||
|
|
lnavwptt.start();
|
||
|
|
setprop("/it-autoflight/output/loc-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/lat", 1);
|
||
|
|
setprop("/it-autoflight/mode/lat", "LNAV");
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
} else {
|
||
|
|
gui.popupTip("Please make sure you have a route set, and that it is Activated!");
|
||
|
|
}
|
||
|
|
} else if (latset == 2) {
|
||
|
|
if (getprop("/it-autoflight/output/lat") == 2) {
|
||
|
|
# Do nothing because VOR/LOC is active
|
||
|
|
} else {
|
||
|
|
setprop("/instrumentation/nav[0]/signal-quality-norm", 0);
|
||
|
|
setprop("/instrumentation/nav[1]/signal-quality-norm", 0);
|
||
|
|
setprop("/it-autoflight/output/loc-armed", 1);
|
||
|
|
setprop("/it-autoflight/mode/arm", "LOC");
|
||
|
|
}
|
||
|
|
} else if (latset == 3) {
|
||
|
|
alandt.stop();
|
||
|
|
alandt1.stop();
|
||
|
|
lnavwptt.stop();
|
||
|
|
setprop("/it-autoflight/output/loc-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
var hdg5sec = int(getprop("/it-autoflight/internal/heading-5-sec-ahead")+0.5);
|
||
|
|
setprop("/it-autoflight/input/hdg", hdg5sec);
|
||
|
|
setprop("/it-autoflight/output/lat", 0);
|
||
|
|
setprop("/it-autoflight/mode/lat", "HDG");
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
} else if (latset == 4) {
|
||
|
|
lnavwptt.stop();
|
||
|
|
setprop("/it-autoflight/output/lat", 4);
|
||
|
|
setprop("/it-autoflight/mode/lat", "ALGN");
|
||
|
|
} else if (latset == 5) {
|
||
|
|
lnavwptt.stop();
|
||
|
|
setprop("/it-autoflight/output/lat", 5);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
var lat_arm = func {
|
||
|
|
var latset = getprop("/it-autoflight/input/lat");
|
||
|
|
if (latset == 0) {
|
||
|
|
setprop("/it-autoflight/input/lat-arm", 0);
|
||
|
|
setprop("/it-autoflight/mode/arm", "HDG");
|
||
|
|
} else if (latset == 1) {
|
||
|
|
if (getprop("/autopilot/route-manager/route/num") > 0 and getprop("/autopilot/route-manager/active") == 1) {
|
||
|
|
setprop("/it-autoflight/input/lat-arm", 1);
|
||
|
|
setprop("/it-autoflight/mode/arm", "LNV");
|
||
|
|
} else {
|
||
|
|
gui.popupTip("Please make sure you have a route set, and that it is Activated!");
|
||
|
|
}
|
||
|
|
} else if (latset == 3) {
|
||
|
|
var hdgnow = int(getprop("/orientation/heading-magnetic-deg")+0.5);
|
||
|
|
setprop("/it-autoflight/input/hdg", hdgnow);
|
||
|
|
setprop("/it-autoflight/input/lat-arm", 0);
|
||
|
|
setprop("/it-autoflight/mode/arm", "HDG");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# Master Vertical
|
||
|
|
setlistener("/it-autoflight/input/vert", func {
|
||
|
|
if ((getprop("/gear/gear[1]/wow") == 0) and (getprop("/gear/gear[2]/wow") == 0)) {
|
||
|
|
vertical();
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
var vertical = func {
|
||
|
|
var vertset = getprop("/it-autoflight/input/vert");
|
||
|
|
if (vertset == 0) {
|
||
|
|
alandt.stop();
|
||
|
|
alandt1.stop();
|
||
|
|
mng_sys_stop();
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/vert", 0);
|
||
|
|
setprop("/it-autoflight/mode/vert", "ALT HLD");
|
||
|
|
if (getprop("/it-autoflight/output/loc-armed")) {
|
||
|
|
setprop("/it-autoflight/mode/arm", "LOC");
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
}
|
||
|
|
var altnow = int((getprop("/instrumentation/altimeter/indicated-altitude-ft")+50)/100)*100;
|
||
|
|
setprop("/it-autoflight/input/alt", altnow);
|
||
|
|
setprop("/it-autoflight/internal/alt", altnow);
|
||
|
|
thrustmode();
|
||
|
|
} else if (vertset == 1) {
|
||
|
|
alandt.stop();
|
||
|
|
alandt1.stop();
|
||
|
|
mng_sys_stop();
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
var altinput = getprop("/it-autoflight/input/alt");
|
||
|
|
setprop("/it-autoflight/internal/alt", altinput);
|
||
|
|
var vsnow = int(getprop("/velocities/vertical-speed-fps")*0.6)*100;
|
||
|
|
setprop("/it-autoflight/input/vs", vsnow);
|
||
|
|
setprop("/it-autoflight/output/vert", 1);
|
||
|
|
setprop("/it-autoflight/mode/vert", "V/S");
|
||
|
|
if (getprop("/it-autoflight/output/loc-armed")) {
|
||
|
|
setprop("/it-autoflight/mode/arm", "LOC");
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
}
|
||
|
|
thrustmode();
|
||
|
|
} else if (vertset == 2) {
|
||
|
|
if (getprop("/it-autoflight/output/lat") == 2) {
|
||
|
|
# Do nothing because VOR/LOC is active
|
||
|
|
} else {
|
||
|
|
setprop("/instrumentation/nav[0]/signal-quality-norm", 0);
|
||
|
|
setprop("/instrumentation/nav[1]/signal-quality-norm", 0);
|
||
|
|
setprop("/it-autoflight/output/loc-armed", 1);
|
||
|
|
}
|
||
|
|
if ((getprop("/it-autoflight/output/vert") == 2) or (getprop("/it-autoflight/output/vert") == 6)) {
|
||
|
|
# Do nothing because G/S or LAND or FLARE is active
|
||
|
|
} else {
|
||
|
|
setprop("/instrumentation/nav[0]/gs-rate-of-climb", 0);
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 1);
|
||
|
|
setprop("/it-autoflight/mode/arm", "ILS");
|
||
|
|
}
|
||
|
|
} else if (vertset == 3) {
|
||
|
|
alandt.stop();
|
||
|
|
alandt1.stop();
|
||
|
|
mng_sys_stop();
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var alt = getprop("/it-autoflight/internal/alt");
|
||
|
|
var dif = calt - alt;
|
||
|
|
var vsnow = getprop("/it-autoflight/internal/vert-speed-fpm");
|
||
|
|
if (calt < alt) {
|
||
|
|
setprop("/it-autoflight/internal/max-vs", vsnow);
|
||
|
|
} else if (calt > alt) {
|
||
|
|
setprop("/it-autoflight/internal/min-vs", vsnow);
|
||
|
|
}
|
||
|
|
minmaxtimer.start();
|
||
|
|
thrustmode();
|
||
|
|
setprop("/it-autoflight/output/vert", 0);
|
||
|
|
setprop("/it-autoflight/mode/vert", "ALT CAP");
|
||
|
|
} else if (vertset == 4) {
|
||
|
|
alandt.stop();
|
||
|
|
alandt1.stop();
|
||
|
|
mng_sys_stop();
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
var altinput = getprop("/it-autoflight/input/alt");
|
||
|
|
setprop("/it-autoflight/internal/alt", altinput);
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var alt = getprop("/it-autoflight/internal/alt");
|
||
|
|
var dif = calt - alt;
|
||
|
|
if (dif < 250 and dif > -250) {
|
||
|
|
alt_on();
|
||
|
|
} else {
|
||
|
|
flch_on();
|
||
|
|
}
|
||
|
|
if (getprop("/it-autoflight/output/loc-armed")) {
|
||
|
|
setprop("/it-autoflight/mode/arm", "LOC");
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
}
|
||
|
|
} else if (vertset == 5) {
|
||
|
|
fpa_calc();
|
||
|
|
alandt.stop();
|
||
|
|
alandt1.stop();
|
||
|
|
mng_sys_stop();
|
||
|
|
fpa_calct.start();
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
var altinput = getprop("/it-autoflight/input/alt");
|
||
|
|
setprop("/it-autoflight/internal/alt", altinput);
|
||
|
|
var fpanow = (int(10*getprop("/it-autoflight/internal/fpa")))*0.1;
|
||
|
|
print(fpanow);
|
||
|
|
setprop("/it-autoflight/input/fpa", fpanow);
|
||
|
|
setprop("/it-autoflight/output/vert", 5);
|
||
|
|
setprop("/it-autoflight/mode/vert", "FPA");
|
||
|
|
if (getprop("/it-autoflight/output/loc-armed") == 1) {
|
||
|
|
setprop("/it-autoflight/mode/arm", "LOC");
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
}
|
||
|
|
thrustmode();
|
||
|
|
} else if (vertset == 6) {
|
||
|
|
setprop("/it-autoflight/output/vert", 6);
|
||
|
|
setprop("/it-autoflight/mode/vert", "LAND");
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
thrustmode();
|
||
|
|
mng_sys_stop();
|
||
|
|
alandt.stop();
|
||
|
|
alandt1.start();
|
||
|
|
} else if (vertset == 7) {
|
||
|
|
alandt.stop();
|
||
|
|
alandt1.stop();
|
||
|
|
mng_sys_stop();
|
||
|
|
setprop("/it-autoflight/output/vert", 7);
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
var altinput = getprop("/it-autoflight/input/alt");
|
||
|
|
setprop("/it-autoflight/internal/alt", altinput);
|
||
|
|
thrustmodet.start();
|
||
|
|
} else if (vertset == 8) {
|
||
|
|
if (getprop("/autopilot/route-manager/route/num") > 0 and getprop("/autopilot/route-manager/active") == 1 and getprop("/it-autoflight/internal/alt-const") >= 100) {
|
||
|
|
alandt.stop();
|
||
|
|
alandt1.stop();
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/vert", 8);
|
||
|
|
mng_run();
|
||
|
|
setprop("/it-autoflight/mode/vert", "mng");
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
var altinput = getprop("/it-autoflight/input/alt");
|
||
|
|
setprop("/it-autoflight/internal/alt", altinput);
|
||
|
|
if (getprop("/it-autoflight/output/loc-armed")) {
|
||
|
|
setprop("/it-autoflight/mode/arm", "LOC");
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
}
|
||
|
|
mng_maint.start();
|
||
|
|
thrustmodet.stop();
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/input/vert", 4);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# Helpers
|
||
|
|
var toggle_trkfpa = func {
|
||
|
|
var trkfpa = getprop("/it-autoflight/custom/trk-fpa");
|
||
|
|
if (trkfpa == 0) {
|
||
|
|
setprop("/it-autoflight/custom/trk-fpa", 1);
|
||
|
|
if (getprop("/it-autoflight/output/vert") == 1) {
|
||
|
|
setprop("/it-autoflight/input/vert", 5);
|
||
|
|
}
|
||
|
|
setprop("/it-autoflight/input/trk", 1);
|
||
|
|
var hed = getprop("/it-autoflight/internal/heading-error-deg");
|
||
|
|
if (hed >= -10 and hed <= 10 and getprop("/it-autoflight/output/lat") == 0) {
|
||
|
|
setprop("/it-autoflight/input/lat", 3);
|
||
|
|
}
|
||
|
|
} else if (trkfpa == 1) {
|
||
|
|
setprop("/it-autoflight/custom/trk-fpa", 0);
|
||
|
|
if (getprop("/it-autoflight/output/vert") == 5) {
|
||
|
|
setprop("/it-autoflight/input/vert", 1);
|
||
|
|
}
|
||
|
|
setprop("/it-autoflight/input/trk", 0);
|
||
|
|
var hed = getprop("/it-autoflight/internal/heading-error-deg");
|
||
|
|
if (hed >= -10 and hed <= 10 and getprop("/it-autoflight/output/lat") == 0) {
|
||
|
|
setprop("/it-autoflight/input/lat", 3);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
var lnavwpt = func {
|
||
|
|
if (getprop("/autopilot/route-manager/route/num") > 0) {
|
||
|
|
if (getprop("/autopilot/route-manager/wp/dist") <= 1.0) {
|
||
|
|
var wptnum = getprop("/autopilot/route-manager/current-wp");
|
||
|
|
if ((wptnum + 1) < getprop("/autopilot/route-manager/route/num")) {
|
||
|
|
setprop("/autopilot/route-manager/current-wp", wptnum + 1);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
var flch_on = func {
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/vert", 4);
|
||
|
|
thrustmodet.start();
|
||
|
|
}
|
||
|
|
var alt_on = func {
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/vert", 0);
|
||
|
|
setprop("/it-autoflight/mode/vert", "ALT CAP");
|
||
|
|
setprop("/it-autoflight/internal/max-vs", 500);
|
||
|
|
setprop("/it-autoflight/internal/min-vs", -500);
|
||
|
|
minmaxtimer.start();
|
||
|
|
}
|
||
|
|
|
||
|
|
var fpa_calc = func {
|
||
|
|
var VS = getprop("/velocities/vertical-speed-fps");
|
||
|
|
var TAS = getprop("/velocities/uBody-fps");
|
||
|
|
if (TAS < 10) TAS = 10;
|
||
|
|
if (VS < -200) VS =-200;
|
||
|
|
if (abs(VS/TAS) <= 1) {
|
||
|
|
var FPangle = math.asin(VS/TAS);
|
||
|
|
FPangle *=90;
|
||
|
|
setprop("/it-autoflight/internal/fpa", FPangle);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
setlistener("/it-autoflight/input/kts-mach", func {
|
||
|
|
var ias = getprop("/instrumentation/airspeed-indicator/indicated-speed-kt");
|
||
|
|
var mach = getprop("/instrumentation/airspeed-indicator/indicated-mach");
|
||
|
|
if (getprop("/it-autoflight/input/kts-mach") == 0) {
|
||
|
|
if (ias >= 100 and ias <= 360) {
|
||
|
|
setprop("/it-autoflight/input/spd-kts", math.round(ias, 1));
|
||
|
|
} else if (ias < 100) {
|
||
|
|
setprop("/it-autoflight/input/spd-kts", 100);
|
||
|
|
} else if (ias > 360) {
|
||
|
|
setprop("/it-autoflight/input/spd-kts", 360);
|
||
|
|
}
|
||
|
|
} else if (getprop("/it-autoflight/input/kts-mach") == 1) {
|
||
|
|
if (mach >= 0.50 and mach <= 0.95) {
|
||
|
|
setprop("/it-autoflight/input/spd-kts", math.round(mach, 0.001));
|
||
|
|
} else if (mach < 0.50) {
|
||
|
|
setprop("/it-autoflight/input/spd-kts", 0.50);
|
||
|
|
} else if (mach > 0.95) {
|
||
|
|
setprop("/it-autoflight/input/spd-kts", 0.95);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
# Takeoff Modes
|
||
|
|
# Lat Active
|
||
|
|
var latarms = func {
|
||
|
|
if (getprop("/position/gear-agl-ft") >= 20) {
|
||
|
|
if (getprop("/it-autoflight/input/lat-arm") == 1) {
|
||
|
|
setprop("/it-autoflight/input/lat", getprop("/it-autoflight/input/lat-arm"));
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# TOGA
|
||
|
|
setlistener("/it-autoflight/input/toga", func {
|
||
|
|
if (getprop("/it-autoflight/input/toga") == 1) {
|
||
|
|
setprop("/it-autoflight/input/vert", 7);
|
||
|
|
vertical();
|
||
|
|
setprop("/it-autoflight/output/loc-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
setprop("/it-autoflight/input/toga", 0);
|
||
|
|
togasel();
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
var togasel = func {
|
||
|
|
if ((getprop("/gear/gear[1]/wow") == 0) and (getprop("/gear/gear[2]/wow") == 0)) {
|
||
|
|
var iasnow = int(getprop("/instrumentation/airspeed-indicator/indicated-speed-kt")+0.5);
|
||
|
|
setprop("/it-autoflight/input/spd-kts", iasnow);
|
||
|
|
setprop("/it-autoflight/input/kts-mach", 0);
|
||
|
|
setprop("/it-autoflight/mode/vert", "G/A CLB");
|
||
|
|
setprop("/it-autoflight/input/lat", 3);
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/input/lat", 5);
|
||
|
|
lateral();
|
||
|
|
setprop("/it-autoflight/mode/lat", "T/O");
|
||
|
|
setprop("/it-autoflight/mode/vert", "T/O CLB");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
setlistener("/it-autoflight/mode/vert", func {
|
||
|
|
var vertm = getprop("/it-autoflight/mode/vert");
|
||
|
|
if (vertm == "T/O CLB") {
|
||
|
|
reduct.start();
|
||
|
|
} else {
|
||
|
|
reduct.stop();
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
setlistener("/it-autoflight/mode/lat", func {
|
||
|
|
var vertm = getprop("/it-autoflight/mode/lat");
|
||
|
|
if (vertm == "T/O") {
|
||
|
|
latarmt.start();
|
||
|
|
} else {
|
||
|
|
latarmt.stop();
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
var toga_reduc = func {
|
||
|
|
if (getprop("/position/gear-agl-ft") >= getprop("/it-autoflight/settings/reduc-agl-ft")) {
|
||
|
|
setprop("/it-autoflight/input/vert", 8);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# Altitude Capture and FPA Timer Logic
|
||
|
|
setlistener("/it-autoflight/output/vert", func {
|
||
|
|
var vertm = getprop("/it-autoflight/output/vert");
|
||
|
|
if (vertm == 1) {
|
||
|
|
altcaptt.start();
|
||
|
|
fpa_calct.stop();
|
||
|
|
} else if (vertm == 4) {
|
||
|
|
altcaptt.start();
|
||
|
|
fpa_calct.stop();
|
||
|
|
} else if (vertm == 5) {
|
||
|
|
altcaptt.start();
|
||
|
|
} else if (vertm == 7) {
|
||
|
|
altcaptt.start();
|
||
|
|
fpa_calct.stop();
|
||
|
|
} else if (vertm == 8) {
|
||
|
|
altcaptt.stop();
|
||
|
|
fpa_calct.stop();
|
||
|
|
} else {
|
||
|
|
altcaptt.stop();
|
||
|
|
fpa_calct.stop();
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
# Altitude Capture
|
||
|
|
var altcapt = func {
|
||
|
|
var vsnow = getprop("/it-autoflight/internal/vert-speed-fpm");
|
||
|
|
if ((vsnow >= 0 and vsnow < 500) or (vsnow < 0 and vsnow > -500)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 100);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -100);
|
||
|
|
} else if ((vsnow >= 500 and vsnow < 1000) or (vsnow < -500 and vsnow > -1000)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 200);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -200);
|
||
|
|
} else if ((vsnow >= 1000 and vsnow < 1500) or (vsnow < -1000 and vsnow > -1500)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 300);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -300);
|
||
|
|
} else if ((vsnow >= 1500 and vsnow < 2000) or (vsnow < -1500 and vsnow > -2000)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 400);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -400);
|
||
|
|
} else if ((vsnow >= 2000 and vsnow < 3000) or (vsnow < -2000 and vsnow > -3000)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 600);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -600);
|
||
|
|
} else if ((vsnow >= 3000 and vsnow < 4000) or (vsnow < -3000 and vsnow > -4000)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 900);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -900);
|
||
|
|
} else if ((vsnow >= 4000 and vsnow < 5000) or (vsnow < -4000 and vsnow > -5000)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 1200);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -1200);
|
||
|
|
} else if ((vsnow >= 5000) or (vsnow < -5000)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 1500);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -1500);
|
||
|
|
}
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var alt = getprop("/it-autoflight/internal/alt");
|
||
|
|
var dif = calt - alt;
|
||
|
|
if (dif < getprop("/it-autoflight/internal/captvs") and dif > getprop("/it-autoflight/internal/captvsneg")) {
|
||
|
|
if (vsnow > 0 and dif < 0) {
|
||
|
|
setprop("/it-autoflight/input/vert", 3);
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 0);
|
||
|
|
} else if (vsnow < 0 and dif > 0) {
|
||
|
|
setprop("/it-autoflight/input/vert", 3);
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 0);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
var altinput = getprop("/it-autoflight/input/alt");
|
||
|
|
setprop("/it-autoflight/internal/alt", altinput);
|
||
|
|
}
|
||
|
|
|
||
|
|
# Min and Max Pitch Reset
|
||
|
|
var minmax = func {
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var alt = getprop("/it-autoflight/internal/alt");
|
||
|
|
var dif = calt - alt;
|
||
|
|
if (dif < 50 and dif > -50) {
|
||
|
|
setprop("/it-autoflight/internal/max-vs", 500);
|
||
|
|
setprop("/it-autoflight/internal/min-vs", -500);
|
||
|
|
var vertmode = getprop("/it-autoflight/output/vert");
|
||
|
|
if (vertmode == 1 or vertmode == 2 or vertmode == 4 or vertmode == 5 or vertmode == 6 or vertmode == 7) {
|
||
|
|
# Do not change the vertical mode because we are not trying to capture altitude.
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/mode/vert", "ALT HLD");
|
||
|
|
}
|
||
|
|
minmaxtimer.stop();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# Thrust Mode Selector
|
||
|
|
var thrustmode = func {
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var alt = getprop("/it-autoflight/internal/alt");
|
||
|
|
var vertm = getprop("/it-autoflight/output/vert");
|
||
|
|
if (vertm == 4) {
|
||
|
|
if (calt < alt) {
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 2);
|
||
|
|
setprop("/it-autoflight/mode/thr", " PITCH");
|
||
|
|
setprop("/it-autoflight/mode/vert", "SPD CLB");
|
||
|
|
} else if (calt > alt) {
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 1);
|
||
|
|
setprop("/it-autoflight/mode/thr", " PITCH");
|
||
|
|
setprop("/it-autoflight/mode/vert", "SPD DES");
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 0);
|
||
|
|
setprop("/it-autoflight/mode/thr", "THRUST");
|
||
|
|
setprop("/it-autoflight/input/vert", 3);
|
||
|
|
}
|
||
|
|
} else if (vertm == 7) {
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 2);
|
||
|
|
setprop("/it-autoflight/mode/thr", " PITCH");
|
||
|
|
} else if (vertm == 8) {
|
||
|
|
thrustmodet.stop();
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 0);
|
||
|
|
setprop("/it-autoflight/mode/thr", "THRUST");
|
||
|
|
thrustmodet.stop();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# ILS and Autoland
|
||
|
|
# LOC and G/S arming
|
||
|
|
var update_arms = func {
|
||
|
|
update_locarmelec();
|
||
|
|
update_apparmelec();
|
||
|
|
}
|
||
|
|
|
||
|
|
var update_locarmelec = func {
|
||
|
|
var loca = getprop("/it-autoflight/output/loc-armed");
|
||
|
|
if (loca) {
|
||
|
|
locarmcheck();
|
||
|
|
} else {
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
var update_apparmelec = func {
|
||
|
|
var appra = getprop("/it-autoflight/output/appr-armed");
|
||
|
|
if (appra) {
|
||
|
|
apparmcheck();
|
||
|
|
} else {
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
var locarmcheck = func {
|
||
|
|
var locdefl = getprop("instrumentation/nav[0]/heading-needle-deflection-norm");
|
||
|
|
var locdefl_b = getprop("instrumentation/nav[1]/heading-needle-deflection-norm");
|
||
|
|
if ((locdefl < 0.9233) and (getprop("instrumentation/nav[0]/signal-quality-norm") > 0.99) and (getprop("/FMGC/internal/loc-source") == "NAV0")) {
|
||
|
|
make_loc_active();
|
||
|
|
} else if ((locdefl_b < 0.9233) and (getprop("instrumentation/nav[1]/signal-quality-norm") > 0.99) and (getprop("/FMGC/internal/loc-source") == "NAV1")) {
|
||
|
|
make_loc_active();
|
||
|
|
} else {
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
var make_loc_active = func {
|
||
|
|
setprop("/it-autoflight/output/loc-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/lat", 2);
|
||
|
|
setprop("/it-autoflight/mode/lat", "LOC");
|
||
|
|
if (getprop("/it-autoflight/output/appr-armed") == 1) {
|
||
|
|
# Do nothing because G/S is armed
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
var apparmcheck = func {
|
||
|
|
var signal = getprop("/instrumentation/nav[0]/gs-needle-deflection-norm");
|
||
|
|
if ((signal <= -0.000000001) and (getprop("/FMGC/internal/loc-source") == "NAV0") and (getprop("/it-autoflight/output/lat") == 2)) {
|
||
|
|
make_appr_active();
|
||
|
|
} else {
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
var make_appr_active = func {
|
||
|
|
mng_sys_stop();
|
||
|
|
setprop("/it-autoflight/output/appr-armed", 0);
|
||
|
|
setprop("/it-autoflight/output/vert", 2);
|
||
|
|
setprop("/it-autoflight/mode/vert", "G/S");
|
||
|
|
setprop("/it-autoflight/mode/arm", " ");
|
||
|
|
alandt.start();
|
||
|
|
thrustmode();
|
||
|
|
}
|
||
|
|
|
||
|
|
# Autoland Stage 1 Logic (Land)
|
||
|
|
var aland = func {
|
||
|
|
var ap1 = getprop("/it-autoflight/output/ap1");
|
||
|
|
var ap2 = getprop("/it-autoflight/output/ap2");
|
||
|
|
if (getprop("/position/gear-agl-ft") <= 100) {
|
||
|
|
setprop("/it-autoflight/input/lat", 4);
|
||
|
|
setprop("/it-autoflight/input/vert", 6);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
var aland1 = func {
|
||
|
|
var aglal = getprop("/position/gear-agl-ft");
|
||
|
|
if (aglal <= 50 and aglal > 5) {
|
||
|
|
setprop("/it-autoflight/mode/vert", "FLARE");
|
||
|
|
}
|
||
|
|
var gear1 = getprop("/gear/gear[1]/wow");
|
||
|
|
var gear2 = getprop("/gear/gear[2]/wow");
|
||
|
|
if (gear1 == 1 or gear2 == 1) {
|
||
|
|
setprop("/it-autoflight/input/ap1", 0);
|
||
|
|
setprop("/it-autoflight/input/ap2", 0);
|
||
|
|
alandt1.stop();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# Autoland Stage 2 Logic (Rollout)
|
||
|
|
# Not yet working, planned.
|
||
|
|
|
||
|
|
# Managed Climb/Descent
|
||
|
|
var mng_main = func {
|
||
|
|
if (getprop("/autopilot/route-manager/route/num") > 0 and getprop("/autopilot/route-manager/active") == 1) {
|
||
|
|
var altinput = getprop("/it-autoflight/input/alt");
|
||
|
|
setprop("/it-autoflight/internal/alt", altinput);
|
||
|
|
var wp_curr = getprop("/autopilot/route-manager/current-wp");
|
||
|
|
var mng_alt_wp = getprop("/autopilot/route-manager/route/wp",wp_curr,"altitude-ft");
|
||
|
|
if (getprop("/it-autoflight/internal/alt-const") == mng_alt_wp) {
|
||
|
|
# Do nothing
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/internal/alt-const", mng_alt_wp);
|
||
|
|
}
|
||
|
|
mng_alt_selector();
|
||
|
|
if (getprop("/it-autoflight/internal/alt-const") < 100) {
|
||
|
|
setprop("/it-autoflight/input/vert", 4);
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/input/vert", 4);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
var mng_sys_stop = func {
|
||
|
|
mng_maint.stop();
|
||
|
|
mng_altcaptt.stop();
|
||
|
|
mng_minmaxt.stop();
|
||
|
|
mng_des_fpmt.stop();
|
||
|
|
mng_des_todt.stop();
|
||
|
|
setprop("/it-autoflight/mode/mng", "NONE");
|
||
|
|
}
|
||
|
|
|
||
|
|
setlistener("/it-autoflight/input/alt", func {
|
||
|
|
if (getprop("/it-autoflight/output/vert") == 8) {
|
||
|
|
mng_alt_selector();
|
||
|
|
mng_run();
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
setlistener("/it-autoflight/internal/alt-const", func {
|
||
|
|
if (getprop("/it-autoflight/output/vert") == 8) {
|
||
|
|
mng_alt_selector();
|
||
|
|
mng_run();
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
setlistener("/autopilot/route-manager/current-wp", func {
|
||
|
|
if (getprop("/it-autoflight/output/vert") == 8) {
|
||
|
|
mng_alt_selector();
|
||
|
|
mng_run();
|
||
|
|
}
|
||
|
|
});
|
||
|
|
|
||
|
|
var mng_run = func {
|
||
|
|
if (getprop("/autopilot/route-manager/route/num") > 0 and getprop("/autopilot/route-manager/active") == 1) {
|
||
|
|
var wp_curr = getprop("/autopilot/route-manager/current-wp");
|
||
|
|
var wptnum = getprop("/autopilot/route-manager/current-wp");
|
||
|
|
var mng_alt_wp = getprop("/autopilot/route-manager/route/wp",wp_curr,"altitude-ft");
|
||
|
|
if ((wptnum - 1) < getprop("/autopilot/route-manager/route/num")) {
|
||
|
|
var mng_alt_wp_prev = getprop("/autopilot/route-manager/route/wp",wp_curr - 1,"altitude-ft");
|
||
|
|
var altcurr = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
if (mng_alt_wp_prev >= 100) {
|
||
|
|
if (mng_alt_wp_prev > mng_alt_wp) {
|
||
|
|
mng_des_todt.start();
|
||
|
|
setprop("/it-autoflight/internal/mng-mode", "DES");
|
||
|
|
} else if (mng_alt_wp_prev == mng_alt_wp) {
|
||
|
|
mng_des_todt.stop();
|
||
|
|
setprop("/it-autoflight/internal/top-of-des-nm", 0);
|
||
|
|
setprop("/it-autoflight/internal/mng-mode", "XX");
|
||
|
|
} else if (mng_alt_wp_prev <= mng_alt_wp) {
|
||
|
|
mng_des_todt.stop();
|
||
|
|
setprop("/it-autoflight/internal/top-of-des-nm", 0);
|
||
|
|
setprop("/it-autoflight/internal/mng-mode", "CLB");
|
||
|
|
}
|
||
|
|
} else if (mng_alt_wp_prev < 100) {
|
||
|
|
if (altcurr > mng_alt_wp) {
|
||
|
|
mng_des_todt.start();
|
||
|
|
setprop("/it-autoflight/internal/mng-mode", "DES");
|
||
|
|
} else if (altcurr == mng_alt_wp) {
|
||
|
|
mng_des_todt.stop();
|
||
|
|
setprop("/it-autoflight/internal/top-of-des-nm", 0);
|
||
|
|
setprop("/it-autoflight/internal/mng-mode", "XX");
|
||
|
|
} else if (altcurr <= mng_alt_wp) {
|
||
|
|
mng_des_todt.stop();
|
||
|
|
setprop("/it-autoflight/internal/top-of-des-nm", 0);
|
||
|
|
setprop("/it-autoflight/internal/mng-mode", "CLB");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
mng_des_todt.stop();
|
||
|
|
setprop("/it-autoflight/internal/top-of-des-nm", 0);
|
||
|
|
}
|
||
|
|
if (mng_alt_wp >= 100) {
|
||
|
|
if (getprop("/it-autoflight/internal/mng-mode") == "CLB") {
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var valt = getprop("/it-autoflight/internal/mng-alt");
|
||
|
|
var vdif = calt - valt;
|
||
|
|
if (vdif > 250 or vdif < -250) {
|
||
|
|
mng_clb();
|
||
|
|
} else {
|
||
|
|
mng_alt_sel();
|
||
|
|
}
|
||
|
|
} else if (getprop("/it-autoflight/internal/mng-mode") == "DES") {
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var valt = getprop("/it-autoflight/internal/mng-alt");
|
||
|
|
var vdif = calt - valt;
|
||
|
|
if (vdif > 250 or vdif < -250) {
|
||
|
|
mng_des_spd();
|
||
|
|
} else {
|
||
|
|
mng_alt_sel();
|
||
|
|
}
|
||
|
|
} else if (getprop("/it-autoflight/internal/mng-mode") == "XX") {
|
||
|
|
# Do nothing for now
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/input/vert", 4);
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
setprop("/it-autoflight/input/vert", 4);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# Managed Top of Descent
|
||
|
|
var mng_des_tod = func {
|
||
|
|
if (getprop("/autopilot/route-manager/route/num") > 0 and getprop("/autopilot/route-manager/active") == 1) {
|
||
|
|
var wp_curr = getprop("/autopilot/route-manager/current-wp");
|
||
|
|
var mng_alt_wp = getprop("/autopilot/route-manager/route/wp",wp_curr,"altitude-ft");
|
||
|
|
var alt_curr = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var dist = getprop("/autopilot/route-manager/wp/dist");
|
||
|
|
var vdist = dist + 1;
|
||
|
|
var alttl = abs(alt_curr - mng_alt_wp);
|
||
|
|
setprop("/it-autoflight/internal/top-of-des-nm", (alttl / 1000) * 3);
|
||
|
|
if (vdist < getprop("/it-autoflight/internal/top-of-des-nm")) {
|
||
|
|
mng_des_todt.stop();
|
||
|
|
var salt = getprop("/it-autoflight/internal/alt");
|
||
|
|
var valt = getprop("/it-autoflight/internal/alt-const");
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var sdif = abs(calt - salt);
|
||
|
|
var vdif = abs(calt - valt);
|
||
|
|
if (sdif <= vdif) {
|
||
|
|
setprop("/it-autoflight/internal/mng-alt", getprop("/it-autoflight/internal/alt"));
|
||
|
|
} else if (sdif > vdif) {
|
||
|
|
setprop("/it-autoflight/internal/mng-alt", getprop("/it-autoflight/internal/alt-const"));
|
||
|
|
}
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var valt = getprop("/it-autoflight/internal/mng-alt");
|
||
|
|
var vdif = calt - valt;
|
||
|
|
if (vdif > 550 or vdif < -550) {
|
||
|
|
mng_des_spd();
|
||
|
|
} else {
|
||
|
|
mng_alt_sel();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# Managed Altitude Selector
|
||
|
|
var mng_alt_selector = func {
|
||
|
|
var salt = getprop("/it-autoflight/internal/alt");
|
||
|
|
var valt = getprop("/it-autoflight/internal/alt-const");
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var sdif = abs(calt - salt);
|
||
|
|
var vdif = abs(calt - valt);
|
||
|
|
if (getprop("/it-autoflight/internal/mng-mode") == "CLB") {
|
||
|
|
if (sdif <= vdif) {
|
||
|
|
setprop("/it-autoflight/internal/mng-alt", getprop("/it-autoflight/internal/alt"));
|
||
|
|
} else if (sdif > vdif) {
|
||
|
|
setprop("/it-autoflight/internal/mng-alt", getprop("/it-autoflight/internal/alt-const"));
|
||
|
|
}
|
||
|
|
} else if (getprop("/it-autoflight/internal/mng-mode") == "DES") {
|
||
|
|
var dist = getprop("/autopilot/route-manager/wp/dist");
|
||
|
|
var vdist = dist - 1;
|
||
|
|
if (vdist < getprop("/it-autoflight/internal/top-of-des-nm")) {
|
||
|
|
if (sdif <= vdif) {
|
||
|
|
setprop("/it-autoflight/internal/mng-alt", getprop("/it-autoflight/internal/alt"));
|
||
|
|
} else if (sdif > vdif) {
|
||
|
|
setprop("/it-autoflight/internal/mng-alt", getprop("/it-autoflight/internal/alt-const"));
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# Managed Altitude
|
||
|
|
var mng_alt_sel = func {
|
||
|
|
setprop("/it-autoflight/internal/max-vs", 500);
|
||
|
|
setprop("/it-autoflight/internal/min-vs", -500);
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 0);
|
||
|
|
setprop("/it-autoflight/output/vert-mng", 0);
|
||
|
|
setprop("/it-autoflight/mode/thr", "THRUST");
|
||
|
|
setprop("/it-autoflight/mode/mng", "MNG CAP");
|
||
|
|
mng_minmaxt.start();
|
||
|
|
}
|
||
|
|
|
||
|
|
# Managed Climb
|
||
|
|
var mng_clb = func {
|
||
|
|
mng_des_fpmt.stop();
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 2);
|
||
|
|
setprop("/it-autoflight/mode/thr", " PITCH");
|
||
|
|
setprop("/it-autoflight/output/vert-mng", 4);
|
||
|
|
setprop("/it-autoflight/mode/vert", "MNG CLB");
|
||
|
|
mng_altcaptt.start();
|
||
|
|
}
|
||
|
|
|
||
|
|
# Managed Descent
|
||
|
|
var mng_des_spd = func {
|
||
|
|
mng_des_fpmt.stop();
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 1);
|
||
|
|
setprop("/it-autoflight/mode/thr", " PITCH");
|
||
|
|
setprop("/it-autoflight/output/mng-vert", 4);
|
||
|
|
setprop("/it-autoflight/mode/mng", "MNG DES");
|
||
|
|
mng_altcaptt.start();
|
||
|
|
}
|
||
|
|
var mng_des_pth = func {
|
||
|
|
mng_des_fpmt.start();
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 0);
|
||
|
|
setprop("/it-autoflight/mode/thr", "THRUST");
|
||
|
|
setprop("/it-autoflight/output/mng-vert", 1);
|
||
|
|
setprop("/it-autoflight/mode/mng", "MNG DES");
|
||
|
|
mng_altcaptt.start();
|
||
|
|
}
|
||
|
|
var mng_des_fpm = func {
|
||
|
|
if (getprop("/autopilot/route-manager/route/num") > 0 and getprop("/autopilot/route-manager/active") == 1) {
|
||
|
|
var gndspd = getprop("/velocities/groundspeed-kt");
|
||
|
|
var desfpm = ((gndspd * 0.5) * 10);
|
||
|
|
setprop("/it-autoflight/internal/mng-fpm", desfpm);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# Managed Capture
|
||
|
|
var mng_altcapt = func {
|
||
|
|
var vsnow = getprop("/it-autoflight/internal/vert-speed-fpm");
|
||
|
|
if ((vsnow >= 0 and vsnow < 500) or (vsnow < 0 and vsnow > -500)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 100);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -100);
|
||
|
|
} else if ((vsnow >= 500 and vsnow < 1000) or (vsnow < -500 and vsnow > -1000)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 200);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -200);
|
||
|
|
} else if ((vsnow >= 1000 and vsnow < 1500) or (vsnow < -1000 and vsnow > -1500)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 300);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -300);
|
||
|
|
} else if ((vsnow >= 1500 and vsnow < 2000) or (vsnow < -1500 and vsnow > -2000)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 400);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -400);
|
||
|
|
} else if ((vsnow >= 2000 and vsnow < 3000) or (vsnow < -2000 and vsnow > -3000)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 600);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -600);
|
||
|
|
} else if ((vsnow >= 3000 and vsnow < 4000) or (vsnow < -3000 and vsnow > -4000)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 900);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -900);
|
||
|
|
} else if ((vsnow >= 4000 and vsnow < 5000) or (vsnow < -4000 and vsnow > -5000)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 1200);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -1200);
|
||
|
|
} else if ((vsnow >= 5000) or (vsnow < -5000)) {
|
||
|
|
setprop("/it-autoflight/internal/captvs", 1500);
|
||
|
|
setprop("/it-autoflight/internal/captvsneg", -1500);
|
||
|
|
}
|
||
|
|
var MNGalt = getprop("/it-autoflight/internal/mng-alt");
|
||
|
|
var MCPalt = getprop("/it-autoflight/internal/alt");
|
||
|
|
var MNGdif = abs(MNGalt - MCPalt);
|
||
|
|
if (MNGdif <= 20) {
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var alt = getprop("/it-autoflight/internal/alt");
|
||
|
|
var dif = calt - alt;
|
||
|
|
if (dif < getprop("/it-autoflight/internal/captvs") and dif > getprop("/it-autoflight/internal/captvsneg")) {
|
||
|
|
if (vsnow > 0 and dif < 0) {
|
||
|
|
setprop("/it-autoflight/input/vert", 3);
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 0);
|
||
|
|
} else if (vsnow < 0 and dif > 0) {
|
||
|
|
setprop("/it-autoflight/input/vert", 3);
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 0);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var valt = getprop("/it-autoflight/internal/mng-alt");
|
||
|
|
var vdif = calt - valt;
|
||
|
|
if (vdif < getprop("/it-autoflight/internal/captvs") and vdif > getprop("/it-autoflight/internal/captvsneg")) {
|
||
|
|
if (vsnow > 0 and vdif < 0) {
|
||
|
|
mng_capture_alt();
|
||
|
|
} else if (vsnow < 0 and vdif > 0) {
|
||
|
|
mng_capture_alt();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
var mng_capture_alt = func {
|
||
|
|
var vsnow = getprop("/it-autoflight/internal/vert-speed-fpm");
|
||
|
|
mng_altcaptt.stop();
|
||
|
|
mng_des_fpmt.stop();
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var alt = getprop("/it-autoflight/internal/alt");
|
||
|
|
var valt = getprop("/it-autoflight/internal/mng-alt");
|
||
|
|
if (calt < valt) {
|
||
|
|
setprop("/it-autoflight/internal/max-vs", vsnow);
|
||
|
|
} else if (calt > valt) {
|
||
|
|
setprop("/it-autoflight/internal/min-vs", vsnow);
|
||
|
|
}
|
||
|
|
mng_minmaxt.start();
|
||
|
|
setprop("/it-autoflight/output/thr-mode", 0);
|
||
|
|
setprop("/it-autoflight/output/vert-mng", 0);
|
||
|
|
setprop("/it-autoflight/mode/thr", "THRUST");
|
||
|
|
setprop("/it-autoflight/mode/vert", "MNG CAP");
|
||
|
|
}
|
||
|
|
|
||
|
|
# Managed Min and Max Pitch Reset
|
||
|
|
var mng_minmax = func {
|
||
|
|
var calt = getprop("/instrumentation/altimeter/indicated-altitude-ft");
|
||
|
|
var valt = getprop("/it-autoflight/internal/mng-alt");
|
||
|
|
var vdif = calt - valt;
|
||
|
|
if (vdif < 50 and vdif > -50) {
|
||
|
|
setprop("/it-autoflight/internal/max-vs", 500);
|
||
|
|
setprop("/it-autoflight/internal/min-vs", -500);
|
||
|
|
var vertmode = getprop("/it-autoflight/output/vert-mng");
|
||
|
|
if (vertmode == 0) {
|
||
|
|
setprop("/it-autoflight/mode/vert", "MNG HLD");
|
||
|
|
}
|
||
|
|
mng_minmaxt.stop();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
# For Canvas Nav Display.
|
||
|
|
setlistener("/it-autoflight/input/hdg", func {
|
||
|
|
setprop("/autopilot/settings/heading-bug-deg", getprop("/it-autoflight/input/hdg"));
|
||
|
|
});
|
||
|
|
|
||
|
|
setlistener("/it-autoflight/internal/alt", func {
|
||
|
|
setprop("/autopilot/settings/target-altitude-ft", getprop("/it-autoflight/internal/alt"));
|
||
|
|
});
|
||
|
|
|
||
|
|
# Timers
|
||
|
|
var update_armst = maketimer(0.5, update_arms);
|
||
|
|
var altcaptt = maketimer(0.5, altcapt);
|
||
|
|
var thrustmodet = maketimer(0.5, thrustmode);
|
||
|
|
var minmaxtimer = maketimer(0.5, minmax);
|
||
|
|
var alandt = maketimer(0.5, aland);
|
||
|
|
var alandt1 = maketimer(0.5, aland1);
|
||
|
|
var reduct = maketimer(0.5, toga_reduc);
|
||
|
|
var latarmt = maketimer(0.5, latarms);
|
||
|
|
var fpa_calct = maketimer(0.1, fpa_calc);
|
||
|
|
var lnavwptt = maketimer(1, lnavwpt);
|
||
|
|
var mng_maint = maketimer(0.5, mng_main);
|
||
|
|
var mng_altcaptt = maketimer(0.5, mng_altcapt);
|
||
|
|
var mng_minmaxt = maketimer(0.5, mng_minmax);
|
||
|
|
var mng_des_fpmt = maketimer(0.5, mng_des_fpm);
|
||
|
|
var mng_des_todt = maketimer(0.5, mng_des_tod);
|
||
|
|
|