fly/IDG-A32X
Archived
1
0
Fork 0
Code Issues Pull requests Projects Releases Wiki Activity
This repository has been archived on 2021-09-26. You can view files and clone it, but cannot push or open issues or pull requests.
IDG-A32X/Nasal/FMGC-b.nas

1289 lines
45 KiB
Text
Raw Normal View History

A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
# A3XX FMGC/Autoflight
# Joshua Davidson (it0uchpods) and Jonathan Redpath (legoboyvdlp)
A32X: Fix FADEC issue
2017-11-16 19:29:08 +00:00
##############################################
# Copyright (c) Joshua Davidson (it0uchpods) #
##############################################
Relicense: Copyright (c) A3XX Development Team, All Rights Reserved.
2017-07-13 17:30:33 +00:00
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
#################################
# IT-AUTOFLIGHT Based Autopilot #
#################################
A3XX: FMGC-b bugfix
2017-11-18 17:10:17 +00:00
setprop("/it-autoflight/internal/heading-deg", getprop("/orientation/heading-magnetic-deg"));
setprop("/it-autoflight/internal/track-deg", getprop("/orientation/track-magnetic-deg"));
A3XX: Fix FMGC errors in pause startup (i think)
2017-09-20 15:24:16 +00:00
setprop("/it-autoflight/internal/vert-speed-fpm", 0);
A3XX: FMGC-b bugfix
2017-11-18 17:10:17 +00:00
setprop("/it-autoflight/internal/heading-error-deg", 0);
A3XX: Fix FMGC errors in pause startup (i think)
2017-09-20 15:24:16 +00:00
setprop("/it-autoflight/internal/heading-5-sec-ahead", 0);
A3XX: Improve FMGC hold now
2017-11-12 03:47:10 +00:00
setprop("/it-autoflight/internal/altitude-5-sec-ahead", 0);
A3XX: Add better NAV system and very basic predictive turning
2017-11-18 04:17:34 +00:00
setprop("/it-autoflight/internal/lnav-advance-nm", 1);
A3XX: Fix FMGC errors in pause startup (i think)
2017-09-20 15:24:16 +00:00
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
setlistener("/sim/signals/fdm-initialized", func {
var trueSpeedKts = getprop("/instrumentation/airspeed-indicator/true-speed-kt");
var locdefl = getprop("/instrumentation/nav[0]/heading-needle-deflection-norm");
var signal = getprop("/instrumentation/nav[0]/gs-needle-deflection-norm");
A3XX: Less Garbage from FPA Loop
2017-07-12 21:46:29 +00:00
var VS = getprop("/velocities/vertical-speed-fps");
var TAS = getprop("/velocities/uBody-fps");
var FPangle = 0;
A3XX: Add Rollout mode to FMGC AP
2017-10-08 19:56:15 +00:00
var gear1 = getprop("/gear/gear[1]/wow");
var gear2 = getprop("/gear/gear[2]/wow");
A3XX: Improve NAV Mode
2017-12-15 02:28:19 +00:00
var gnds_mps = 0;
var current_course = 0;
A3XX: Fix some FMGC bugs, #110
2017-12-16 04:04:11 +00:00
var wp_fly_from = 0;
A3XX: Improve NAV Mode
2017-12-15 02:28:19 +00:00
var wp_fly_to = 0;
var next_course = 0;
var max_bank_limit = 0;
var delta_angle = 0;
var max_bank = 0;
var radius = 0;
var time = 0;
var delta_angle_rad = 0;
var R = 0;
var dist_coeff = 0;
var turn_dist = 0;
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
});
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
var APinit = func {
A3XX: FMGC: Fix HDG-TRK selecting Tru Heading
2017-11-16 02:54:32 +00:00
setprop("/instrumentation/efis[0]/trk-selected", 0);
setprop("/instrumentation/efis[1]/trk-selected", 0);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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);
A32X: Add new SRS engagement logic, SRS requires V2 speed
2017-10-24 22:57:27 +00:00
setprop("/it-autoflight/input/lat", 9);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
setprop("/it-autoflight/input/lat-arm", 0);
A32X: Add new SRS engagement logic, SRS requires V2 speed
2017-10-24 22:57:27 +00:00
setprop("/it-autoflight/input/vert", 9);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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);
A32X: Add new SRS engagement logic, SRS requires V2 speed
2017-10-24 22:57:27 +00:00
setprop("/it-autoflight/output/lat", 9);
setprop("/it-autoflight/output/vert", 9);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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);
A32X: Add new SRS engagement logic, SRS requires V2 speed
2017-10-24 22:57:27 +00:00
setprop("/it-autoflight/mode/thr", "THRUST");
setprop("/it-autoflight/mode/arm", " ");
setprop("/it-autoflight/mode/lat", " ");
setprop("/it-autoflight/mode/vert", " ");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
setprop("/it-autoflight/input/spd-kts", 100);
setprop("/it-autoflight/input/spd-mach", 0.50);
A3XX: Major Update: Update AP, FBW, Autotrim, FCU, add Preselect
2017-06-28 18:50:39 +00:00
setprop("/it-autoflight/custom/show-hdg", 0);
A3XX: FMGC TRK/FPA and mode engagement fixes
2017-10-21 02:51:30 +00:00
trkfpa_off();
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
ap_varioust.start();
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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");
A3XX: Improve FBW, AP unavailable unless Normal Law
2017-08-05 19:46:37 +00:00
var law = getprop("/it-fbw/law");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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);
}
A3XX: Fix FMGC altitude selector in various conditions, fix FMA issues
2017-11-15 16:17:01 +00:00
updateTimers();
A3XX: Improve FBW, AP unavailable unless Normal Law
2017-08-05 19:46:37 +00:00
} else if (apmas == 1 and ac_ess >= 110 and law == 0) {
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
if ((getprop("/gear/gear[1]/wow") == 0) and (getprop("/gear/gear[2]/wow") == 0)) {
A32X: Add new SRS engagement logic, SRS requires V2 speed
2017-10-24 22:57:27 +00:00
if (getprop("/it-autoflight/output/lat") == 9) {
setprop("/it-autoflight/input/lat", 3);
}
if (getprop("/it-autoflight/output/vert") == 9) {
if (getprop("/it-autoflight/custom/trk-fpa") == 0) {
setprop("/it-autoflight/input/vert", 1);
} else if (getprop("/it-autoflight/custom/trk-fpa") == 1) {
setprop("/it-autoflight/input/vert", 5);
}
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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");
A3XX: Improve FBW, AP unavailable unless Normal Law
2017-08-05 19:46:37 +00:00
var law = getprop("/it-fbw/law");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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);
}
A3XX: Fix FMGC altitude selector in various conditions, fix FMA issues
2017-11-15 16:17:01 +00:00
updateTimers();
A3XX: Improve FBW, AP unavailable unless Normal Law
2017-08-05 19:46:37 +00:00
} else if (apmas == 1 and ac_ess >= 110 and law == 0) {
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
if ((getprop("/gear/gear[1]/wow") == 0) and (getprop("/gear/gear[2]/wow") == 0)) {
A32X: Add new SRS engagement logic, SRS requires V2 speed
2017-10-24 22:57:27 +00:00
if (getprop("/it-autoflight/output/lat") == 9) {
setprop("/it-autoflight/input/lat", 3);
}
if (getprop("/it-autoflight/output/vert") == 9) {
if (getprop("/it-autoflight/custom/trk-fpa") == 0) {
setprop("/it-autoflight/input/vert", 1);
} else if (getprop("/it-autoflight/custom/trk-fpa") == 1) {
setprop("/it-autoflight/input/vert", 5);
}
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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);
A3XX: Fix FMGC altitude selector in various conditions, fix FMA issues
2017-11-15 16:17:01 +00:00
updateTimers();
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} 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);
A3XX: Fix FMGC altitude selector in various conditions, fix FMA issues
2017-11-15 16:17:01 +00:00
updateTimers();
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} 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/lat", 3);
A3XX: FMGC TRK/FPA and mode engagement fixes
2017-10-21 02:51:30 +00:00
if (getprop("/it-autoflight/custom/trk-fpa") == 0) {
setprop("/it-autoflight/input/vert", 1);
} else if (getprop("/it-autoflight/custom/trk-fpa") == 1) {
setprop("/it-autoflight/input/vert", 5);
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
setprop("/it-autoflight/output/fma-pwr", 0);
} else {
A32X: Canvas PFD is now default, many fixes to FMGC-b
2017-11-16 18:18:03 +00:00
setprop("/it-autoflight/input/vs", math.round(getprop("/it-autoflight/internal/vert-speed-fpm"), 100));
setprop("/it-autoflight/input/fpa", math.round(getprop("/it-autoflight/internal/fpa"), 0.1));
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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)) {
A3XX: Fix some FMGC bugs, #110
2017-12-16 04:04:11 +00:00
setprop("/it-autoflight/input/lat-arm", 0);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
lateral();
} else {
lat_arm();
}
});
var lateral = func {
var latset = getprop("/it-autoflight/input/lat");
if (latset == 0) {
alandt.stop();
alandt1.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();
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", " ");
A3XX: Major Update: Update AP, FBW, Autotrim, FCU, add Preselect
2017-06-28 18:50:39 +00:00
setprop("/it-autoflight/custom/show-hdg", 0);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else {
gui.popupTip("Please make sure you have a route set, and that it is Activated!");
}
} else if (latset == 2) {
A3XX: FMGC ILS improvements
2017-11-13 17:03:31 +00:00
if (getprop("/instrumentation/nav[0]/in-range") == 1) {
if (getprop("/it-autoflight/output/lat") != 2) {
setprop("/it-autoflight/output/loc-armed", 1);
setprop("/it-autoflight/mode/arm", "LOC");
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else {
setprop("/instrumentation/nav[0]/signal-quality-norm", 0);
}
} else if (latset == 3) {
alandt.stop();
alandt1.stop();
setprop("/it-autoflight/output/loc-armed", 0);
setprop("/it-autoflight/output/appr-armed", 0);
A3XX: FMGC AP bugfixes
2017-11-16 21:06:58 +00:00
var hdg5sec = math.round(getprop("/it-autoflight/internal/heading-5-sec-ahead"));
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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) {
setprop("/it-autoflight/output/lat", 4);
setprop("/it-autoflight/mode/lat", "ALGN");
A3XX: Major Update: Update AP, FBW, Autotrim, FCU, add Preselect
2017-06-28 18:50:39 +00:00
setprop("/it-autoflight/custom/show-hdg", 0);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else if (latset == 5) {
setprop("/it-autoflight/output/lat", 5);
A3XX: Major Update: Update AP, FBW, Autotrim, FCU, add Preselect
2017-06-28 18:50:39 +00:00
setprop("/it-autoflight/custom/show-hdg", 0);
A32X: Add new SRS engagement logic, SRS requires V2 speed
2017-10-24 22:57:27 +00:00
} else if (latset == 9) {
setprop("/it-autoflight/output/loc-armed", 0);
setprop("/it-autoflight/output/lat", 9);
setprop("/it-autoflight/mode/lat", " ");
setprop("/it-autoflight/mode/arm", " ");
A32X: Major Canvas PFD WIP work, fix HDG Pre-Select
2017-11-15 21:15:49 +00:00
setprop("/it-autoflight/custom/show-hdg", 1);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
}
var lat_arm = func {
var latset = getprop("/it-autoflight/input/lat");
if (latset == 0) {
setprop("/it-autoflight/input/lat-arm", 0);
A3XX: Fix stuck NAV annunciator
2017-06-28 19:04:37 +00:00
setprop("/it-autoflight/mode/arm", " ");
A3XX: Major Update: Update AP, FBW, Autotrim, FCU, add Preselect
2017-06-28 18:50:39 +00:00
setprop("/it-autoflight/custom/show-hdg", 1);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} 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");
A3XX: Major Update: Update AP, FBW, Autotrim, FCU, add Preselect
2017-06-28 18:50:39 +00:00
setprop("/it-autoflight/custom/show-hdg", 0);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else {
gui.popupTip("Please make sure you have a route set, and that it is Activated!");
}
} else if (latset == 3) {
A32X: Canvas PFD is now default, many fixes to FMGC-b
2017-11-16 18:18:03 +00:00
if (getprop("/it-autoflight/custom/trk-fpa") == 1) {
A3XX: FMGC AP bugfixes
2017-11-16 21:06:58 +00:00
var hdgnow = math.round(getprop("/it-autoflight/internal/track-deg"));
A32X: Canvas PFD is now default, many fixes to FMGC-b
2017-11-16 18:18:03 +00:00
} else {
A3XX: FMGC AP bugfixes
2017-11-16 21:06:58 +00:00
var hdgnow = math.round(getprop("/it-autoflight/internal/heading-deg"));
A32X: Canvas PFD is now default, many fixes to FMGC-b
2017-11-16 18:18:03 +00:00
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
setprop("/it-autoflight/input/hdg", hdgnow);
setprop("/it-autoflight/input/lat-arm", 0);
A3XX: Fix stuck NAV annunciator
2017-06-28 19:04:37 +00:00
setprop("/it-autoflight/mode/arm", " ");
A3XX: Major Update: Update AP, FBW, Autotrim, FCU, add Preselect
2017-06-28 18:50:39 +00:00
setprop("/it-autoflight/custom/show-hdg", 1);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
}
# 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");
A3XX: Fix bug in FMGC, fix bug in PFD
2017-11-02 00:40:32 +00:00
} else if (getprop("/it-autoflight/input/lat-arm") == 1) {
setprop("/it-autoflight/mode/arm", "LNV");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else {
setprop("/it-autoflight/mode/arm", " ");
}
A3XX: Improve FMGC hold now
2017-11-12 03:47:10 +00:00
var alt5sec = math.round(getprop("/it-autoflight/internal/altitude-5-sec-ahead"), 500);
setprop("/it-autoflight/input/alt", alt5sec);
setprop("/it-autoflight/internal/alt", alt5sec);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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);
A32X: Canvas PFD is now default, many fixes to FMGC-b
2017-11-16 18:18:03 +00:00
var vsnow = math.round(getprop("/it-autoflight/internal/vert-speed-fpm"), 100);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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");
A3XX: Fix bug in FMGC, fix bug in PFD
2017-11-02 00:40:32 +00:00
} else if (getprop("/it-autoflight/input/lat-arm") == 1) {
setprop("/it-autoflight/mode/arm", "LNV");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else {
setprop("/it-autoflight/mode/arm", " ");
}
thrustmode();
} else if (vertset == 2) {
A3XX: FMGC ILS improvements
2017-11-13 17:03:31 +00:00
if (getprop("/instrumentation/nav[0]/in-range") == 1) {
if (getprop("/it-autoflight/output/lat") != 2) {
setprop("/it-autoflight/output/loc-armed", 1);
}
if (getprop("/it-autoflight/output/vert") != 2 and getprop("/it-autoflight/output/vert") != 6) {
setprop("/it-autoflight/output/appr-armed", 1);
setprop("/it-autoflight/mode/arm", "ILS");
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else {
setprop("/instrumentation/nav[0]/signal-quality-norm", 0);
setprop("/instrumentation/nav[0]/gs-rate-of-climb", 0);
}
} 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");
A3XX: Fix bug in FMGC, fix bug in PFD
2017-11-02 00:40:32 +00:00
} else if (getprop("/it-autoflight/input/lat-arm") == 1) {
setprop("/it-autoflight/mode/arm", "LNV");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} 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);
A32X: Canvas PFD is now default, many fixes to FMGC-b
2017-11-16 18:18:03 +00:00
var fpanow = math.round(getprop("/it-autoflight/internal/fpa"), 0.1);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
setprop("/it-autoflight/input/fpa", fpanow);
setprop("/it-autoflight/output/vert", 5);
setprop("/it-autoflight/mode/vert", "FPA");
A3XX: Fix bug in FMGC, fix bug in PFD
2017-11-02 00:40:32 +00:00
if (getprop("/it-autoflight/output/loc-armed")) {
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
setprop("/it-autoflight/mode/arm", "LOC");
A3XX: Fix bug in FMGC, fix bug in PFD
2017-11-02 00:40:32 +00:00
} else if (getprop("/it-autoflight/input/lat-arm") == 1) {
setprop("/it-autoflight/mode/arm", "LNV");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else {
setprop("/it-autoflight/mode/arm", " ");
}
thrustmode();
} else if (vertset == 6) {
setprop("/it-autoflight/output/vert", 6);
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);
A32X: Add new SRS engagement logic, SRS requires V2 speed
2017-10-24 22:57:27 +00:00
if (getprop("/it-autoflight/output/loc-armed") == 1) {
setprop("/it-autoflight/mode/arm", "LOC");
} else if (getprop("/it-autoflight/input/lat-arm") == 1) {
# Do nothing
} else {
setprop("/it-autoflight/mode/arm", " ");
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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");
A3XX: Fix bug in FMGC, fix bug in PFD
2017-11-02 00:40:32 +00:00
} else if (getprop("/it-autoflight/input/lat-arm") == 1) {
setprop("/it-autoflight/mode/arm", "LNV");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else {
setprop("/it-autoflight/mode/arm", " ");
}
mng_maint.start();
thrustmodet.stop();
} else {
setprop("/it-autoflight/input/vert", 4);
A3XX: Fix Bug: OP CLB not getting engaged at ACC
2017-06-14 02:48:18 +00:00
vertical();
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
A32X: Add new SRS engagement logic, SRS requires V2 speed
2017-10-24 22:57:27 +00:00
} else if (vertset == 9) {
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);
setprop("/it-autoflight/output/vert", 9);
setprop("/it-autoflight/mode/vert", " ");
if (getprop("/it-autoflight/output/loc-armed")) {
setprop("/it-autoflight/mode/arm", "LOC");
A3XX: Fix bug in FMGC, fix bug in PFD
2017-11-02 00:40:32 +00:00
} else if (getprop("/it-autoflight/input/lat-arm") == 1) {
setprop("/it-autoflight/mode/arm", "LNV");
A32X: Add new SRS engagement logic, SRS requires V2 speed
2017-10-24 22:57:27 +00:00
} else {
setprop("/it-autoflight/mode/arm", " ");
}
thrustmode();
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
}
# Helpers
var toggle_trkfpa = func {
var trkfpa = getprop("/it-autoflight/custom/trk-fpa");
if (trkfpa == 0) {
A3XX: FMGC TRK/FPA and mode engagement fixes
2017-10-21 02:51:30 +00:00
trkfpa_on();
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else if (trkfpa == 1) {
A3XX: FMGC TRK/FPA and mode engagement fixes
2017-10-21 02:51:30 +00:00
trkfpa_off();
}
}
var trkfpa_off = func {
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);
A3XX: FMGC: Fix HDG-TRK selecting Tru Heading
2017-11-16 02:54:32 +00:00
setprop("/instrumentation/efis[0]/trk-selected", 0);
setprop("/instrumentation/efis[1]/trk-selected", 0);
A3XX: FMGC TRK/FPA and mode engagement fixes
2017-10-21 02:51:30 +00:00
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 trkfpa_on = func {
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);
A3XX: FMGC: Fix HDG-TRK selecting Tru Heading
2017-11-16 02:54:32 +00:00
setprop("/instrumentation/efis[0]/trk-selected", 1);
setprop("/instrumentation/efis[1]/trk-selected", 1);
A3XX: FMGC TRK/FPA and mode engagement fixes
2017-10-21 02:51:30 +00:00
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);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
}
A3XX: Improve NAV Mode
2017-12-15 02:28:19 +00:00
setlistener("/autopilot/route-manager/current-wp", func {
setprop("/autopilot/internal/wp-change-time", getprop("/sim/time/elapsed-sec"));
});
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
var ap_various = func {
trueSpeedKts = getprop("/instrumentation/airspeed-indicator/true-speed-kt");
if (trueSpeedKts > 420) {
setprop("/it-autoflight/internal/bank-limit", 15);
} else if (trueSpeedKts > 340) {
setprop("/it-autoflight/internal/bank-limit", 20);
} else {
setprop("/it-autoflight/internal/bank-limit", 25);
}
A3XX: Fix waypoint handling
2017-07-06 01:09:42 +00:00
if (getprop("/autopilot/route-manager/route/num") > 0 and getprop("/autopilot/route-manager/active") == 1) {
A3XX: Fix FMGC Nasal error, #111
2017-12-20 20:25:00 +00:00
if ((getprop("/autopilot/route-manager/current-wp") + 1) < getprop("/autopilot/route-manager/route/num")) {
gnds_mps = getprop("/velocities/groundspeed-kt") * 0.5144444444444;
wp_fly_from = getprop("/autopilot/route-manager/current-wp");
if (wp_fly_from < 0) {
wp_fly_from = 0;
}
current_course = getprop("/autopilot/route-manager/route/wp[" ~ wp_fly_from ~ "]/leg-bearing-true-deg");
wp_fly_to = getprop("/autopilot/route-manager/current-wp") + 1;
if (wp_fly_to < 0) {
wp_fly_to = 0;
}
next_course = getprop("/autopilot/route-manager/route/wp[" ~ wp_fly_to ~ "]/leg-bearing-true-deg");
max_bank_limit = getprop("/it-autoflight/internal/bank-limit");
A3XX: Improve NAV Mode
2017-12-15 02:28:19 +00:00
A3XX: Fix FMGC Nasal error, #111
2017-12-20 20:25:00 +00:00
delta_angle = math.abs(geo.normdeg180(current_course - next_course));
max_bank = delta_angle * 1.5;
if (max_bank > max_bank_limit) {
max_bank = max_bank_limit;
}
radius = (gnds_mps * gnds_mps) / (9.81 * math.tan(max_bank / 57.2957795131));
time = 0.64 * gnds_mps * delta_angle * 0.7 / (360 * math.tan(max_bank / 57.2957795131));
delta_angle_rad = (180 - delta_angle) / 114.5915590262;
R = radius/math.sin(delta_angle_rad);
dist_coeff = delta_angle * -0.011111 + 2;
if (dist_coeff < 1) {
dist_coeff = 1;
}
turn_dist = math.cos(delta_angle_rad) * R * dist_coeff / 1852;
if (getprop("/gear/gear[0]/wow") == 1 and turn_dist < 1) {
turn_dist = 1;
}
setprop("/it-autoflight/internal/lnav-advance-nm", turn_dist);
if (getprop("/sim/time/elapsed-sec")-getprop("/autopilot/internal/wp-change-time") > 60) {
setprop("/autopilot/internal/wp-change-check-period", time);
}
if (getprop("/autopilot/route-manager/wp/dist") <= turn_dist) {
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
setprop("/autopilot/route-manager/current-wp", getprop("/autopilot/route-manager/current-wp") + 1);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
}
}
A3XX: AP Disenage if sidestick force
2017-10-05 00:34:18 +00:00
if (getprop("/it-autoflight/output/ap1") == 1 or getprop("/it-autoflight/output/ap2") == 1) {
A3XX: Add better NAV system and very basic predictive turning
2017-11-18 04:17:34 +00:00
if (getprop("/controls/flight/aileron") > 0.3 or getprop("/controls/flight/aileron") < -0.2 or getprop("/controls/flight/elevator") > 0.3 or getprop("/controls/flight/elevator") < -0.2) {
A3XX: AP Disenage if sidestick force
2017-10-05 00:34:18 +00:00
setprop("/it-autoflight/input/ap1", 0);
setprop("/it-autoflight/input/ap2", 0);
}
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
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 {
A3XX: Less Garbage from FPA Loop
2017-07-12 21:46:29 +00:00
VS = getprop("/velocities/vertical-speed-fps");
TAS = getprop("/velocities/uBody-fps");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
if (TAS < 10) TAS = 10;
if (VS < -200) VS =-200;
if (abs(VS/TAS) <= 1) {
A3XX: Less Garbage from FPA Loop
2017-07-12 21:46:29 +00:00
FPangle = math.asin(VS/TAS);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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) {
A3XX: Improve FBW Pitch axis, fix FMGC bug
2017-07-08 20:49:38 +00:00
setprop("/it-autoflight/input/spd-mach", math.round(mach, 0.001));
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else if (mach < 0.50) {
A3XX: Improve FBW Pitch axis, fix FMGC bug
2017-07-08 20:49:38 +00:00
setprop("/it-autoflight/input/spd-mach", 0.50);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else if (mach > 0.95) {
A3XX: Improve FBW Pitch axis, fix FMGC bug
2017-07-08 20:49:38 +00:00
setprop("/it-autoflight/input/spd-mach", 0.95);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
}
});
# Takeoff Modes
# Lat Active
var latarms = func {
A32X: Add new SRS engagement logic, SRS requires V2 speed
2017-10-24 22:57:27 +00:00
if (getprop("/position/gear-agl-ft") >= 30) {
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
if (getprop("/it-autoflight/input/lat-arm") == 1) {
setprop("/it-autoflight/input/lat", getprop("/it-autoflight/input/lat-arm"));
A3XX: FMGC: Fix Stuck LAT lights on FCU
2017-07-21 21:37:45 +00:00
setprop("/it-autoflight/input/lat-arm", 0);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
}
}
# 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)) {
A3XX: FMGC AP bugfixes
2017-11-16 21:06:58 +00:00
var iasnow = math.round(getprop("/instrumentation/airspeed-indicator/indicated-speed-kt"));
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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");
A32X: Add new SRS engagement logic, SRS requires V2 speed
2017-10-24 22:57:27 +00:00
if (vertm == "T/O" or vertm == " ") {
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
latarmt.start();
} else {
latarmt.stop();
}
});
var toga_reduc = func {
A3XX: Fix FMGC bug
2017-07-30 17:51:16 +00:00
if (getprop("/instrumentation/altimeter/indicated-altitude-ft") >= getprop("/it-autoflight/settings/reduc-agl-ft") and getprop("/gear/gear[1]/wow") == 0 and getprop("/gear/gear[2]/wow") == 0) {
A3XX: Temporarily disable managed CLB or DES
2017-07-14 20:08:25 +00:00
setprop("/it-autoflight/input/vert", 4);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
}
# Altitude Capture and FPA Timer Logic
setlistener("/it-autoflight/output/vert", func {
A3XX: Fix FMGC altitude selector in various conditions, fix FMA issues
2017-11-15 16:17:01 +00:00
updateTimers();
});
var updateTimers = func {
if (getprop("/it-autoflight/output/fd1") == 1 or getprop("/it-autoflight/output/fd2") == 1 or getprop("/it-autoflight/output/ap1") == 1 or getprop("/it-autoflight/output/ap2") == 1) {
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 if (vertm == 9) {
altcaptt.start();
fpa_calct.stop();
} else {
altcaptt.stop();
fpa_calct.stop();
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else {
A3XX: Fix FMGC altitude selector in various conditions, fix FMA issues
2017-11-15 16:17:01 +00:00
altcaptt.start();
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
fpa_calct.stop();
}
A3XX: Fix FMGC altitude selector in various conditions, fix FMA issues
2017-11-15 16:17:01 +00:00
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
# 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);
}
A3XX: PFD, FMGC, FADEC bugfixes
2017-11-17 23:41:22 +00:00
if ((getprop("/it-autoflight/output/fd1") == 1 or getprop("/it-autoflight/output/fd2") == 1 or getprop("/it-autoflight/output/ap1") == 1 or getprop("/it-autoflight/output/ap2") == 1) and getprop("/it-autoflight/output/vert") != 9) {
A3XX: Fix FMGC altitude selector in various conditions, fix FMA issues
2017-11-15 16:17:01 +00:00
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);
setprop("/it-autoflight/mode/thr", "THRUST");
} else if (vsnow < 0 and dif > 0) {
setprop("/it-autoflight/input/vert", 3);
setprop("/it-autoflight/output/thr-mode", 0);
setprop("/it-autoflight/mode/thr", "THRUST");
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
}
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");
A3XX: Apply IT-AUTOFLIGHT V3.0.2 bugfix to FMGC
2017-08-29 13:57:34 +00:00
if (getprop("/it-autoflight/output/vert") == 4) {
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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);
}
A3XX: Apply IT-AUTOFLIGHT V3.0.2 bugfix to FMGC
2017-08-29 13:57:34 +00:00
} else if (getprop("/it-autoflight/output/vert") == 7) {
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
setprop("/it-autoflight/output/thr-mode", 2);
setprop("/it-autoflight/mode/thr", " PITCH");
A3XX: Apply IT-AUTOFLIGHT V3.0.2 bugfix to FMGC
2017-08-29 13:57:34 +00:00
} else if (getprop("/it-autoflight/output/vert") == 8) {
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
setlistener("/it-autoflight/output/loc-armed", func {
check_arms();
});
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
setlistener("/it-autoflight/output/appr-armed", func {
check_arms();
});
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
var check_arms = func {
if (getprop("/it-autoflight/output/loc-armed") or getprop("/it-autoflight/output/appr-armed")) {
update_armst.start();
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
} else {
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
update_armst.stop();
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
}
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
var update_arms = func {
A3XX: FMGC ILS improvements
2017-11-13 17:03:31 +00:00
if (getprop("/instrumentation/nav[0]/in-range") == 1) {
if (getprop("/it-autoflight/output/loc-armed")) {
locdefl = abs(getprop("/instrumentation/nav[0]/heading-needle-deflection-norm"));
if (locdefl < 0.95 and locdefl != 0 and getprop("/instrumentation/nav[0]/signal-quality-norm") > 0.99) {
make_loc_active();
} else {
return 0;
}
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
}
A3XX: FMGC ILS improvements
2017-11-13 17:03:31 +00:00
if (getprop("/it-autoflight/output/appr-armed")) {
signal = getprop("/instrumentation/nav[0]/gs-needle-deflection-norm");
if (((signal < 0 and signal >= -0.20) or (signal > 0 and signal <= 0.20)) and getprop("/it-autoflight/output/lat") == 2) {
make_appr_active();
} else {
return 0;
}
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
}
var make_loc_active = func {
setprop("/it-autoflight/output/loc-armed", 0);
setprop("/it-autoflight/output/lat", 2);
setprop("/it-autoflight/mode/lat", "LOC");
A3XX: Major Update: Update AP, FBW, Autotrim, FCU, add Preselect
2017-06-28 18:50:39 +00:00
setprop("/it-autoflight/custom/show-hdg", 0);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
if (getprop("/it-autoflight/output/appr-armed") == 1) {
# Do nothing because G/S is armed
} else {
setprop("/it-autoflight/mode/arm", " ");
}
}
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 {
A3XX: Improve Autoland, Improve PFD annunciators
2017-06-18 04:24:27 +00:00
if (getprop("/position/gear-agl-ft") <= 300) {
setprop("/it-autoflight/mode/vert", "LAND");
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
if (getprop("/position/gear-agl-ft") <= 100) {
setprop("/it-autoflight/input/vert", 6);
}
}
var aland1 = func {
var aglal = getprop("/position/gear-agl-ft");
A3XX: Improve Autoland, Improve PFD annunciators
2017-06-18 04:24:27 +00:00
if (aglal <= 80 and aglal > 5) {
setprop("/it-autoflight/input/lat", 4);
}
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
if (aglal <= 50 and aglal > 5) {
setprop("/it-autoflight/mode/vert", "FLARE");
}
A3XX: Fix minor bug in FMGC
2017-06-18 04:43:36 +00:00
var ap1 = getprop("/it-autoflight/output/ap1");
var ap2 = getprop("/it-autoflight/output/ap2");
if (aglal <= 18 and aglal > 5 and (ap1 or ap2)) {
A3XX: Improve Autoland, Improve PFD annunciators
2017-06-18 04:24:27 +00:00
thrustmodet.stop();
setprop("/it-autoflight/output/thr-mode", 1);
setprop("/it-autoflight/mode/thr", "RETARD");
}
A3XX: Add Rollout mode to FMGC AP
2017-10-08 19:56:15 +00:00
gear1 = getprop("/gear/gear[1]/wow");
gear2 = getprop("/gear/gear[2]/wow");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
if (gear1 == 1 or gear2 == 1) {
alandt1.stop();
A3XX: Add Rollout mode to FMGC AP
2017-10-08 19:56:15 +00:00
setprop("/it-autoflight/mode/lat", "RLOU");
setprop("/it-autoflight/mode/vert", "ROLLOUT");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
}
}
# 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);
A3XX: Fix FMA
2017-07-12 21:40:59 +00:00
setprop("/it-autoflight/mode/vert", "MNG DES");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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);
A3XX: Fix FMA
2017-07-12 21:40:59 +00:00
setprop("/it-autoflight/mode/vert", "MNG DES");
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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);
A3XX: Overhaul LOC G/S system, more improvements
2017-07-12 21:31:04 +00:00
var ap_varioust = maketimer(1, ap_various);
A3XX: Add Managed Climb mode, working
2017-06-13 19:24:56 +00:00
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);
Reference in a new issue Copy permalink