# 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); vertical(); } } } # 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);