1
0
Fork 0
A320-family/Systems/fmgc-pitch.xml
2022-08-28 13:32:51 -04:00

867 lines
22 KiB
XML

<?xml version="1.0"?>
<!-- IT-AUTOFLIGHT -->
<!-- Copyright (c) 2022 Josh Davidson (Octal450) -->
<PropertyList>
<!-- Pitch Axis -->
<filter>
<name>IT-CONTROLLER: Altitude Capture/Hold</name>
<type>gain</type>
<gain>-5</gain>
<input>
<expression>
<sum>
<property>/instrumentation/altimeter/indicated-altitude-ft</property>
<value>-2</value>
</sum>
</expression>
</input>
<reference>/it-autoflight/internal/alt</reference>
<output>/it-autoflight/internal/target-fpm-alt</output>
<min>/it-autoflight/internal/min-vs</min>
<max>/it-autoflight/internal/max-vs</max>
</filter>
<filter>
<name>Vertical Speed VMO Protection</name>
<type>gain</type>
<input>
<expression>
<div>
<product>
<property>/instrumentation/airspeed-indicator/true-speed-kt</property>
<value>101.26859142607174</value> <!-- FPM to Knot -->
<dif>
<product>
<property>/fdm/jsbsim/forces/fbx-prop-lbs</property>
<cos>
<property>/fdm/jsbsim/aero/alpha-rad</property>
</cos>
</product>
<product>
<property>/fdm/jsbsim/forces/fwx-aero-lbs</property>
<sum>
<value>1</value>
<product>
<property>/it-autoflight/internal/vmo-mmo-error</property>
<value>-0.1</value>
</product>
</sum>
</product>
</dif>
</product>
<property>/fdm/jsbsim/inertia/weight-lbs</property>
</div>
</expression>
</input>
<output>/it-autoflight/internal/overspeed-vs</output>
<min>-6000</min>
<max>6000</max>
</filter>
<filter>
<name>Vertical Speed VLS Protection</name>
<type>gain</type>
<input>
<expression>
<div>
<product>
<property>/instrumentation/airspeed-indicator/true-speed-kt</property>
<value>101.26859142607174</value> <!-- FPM to Knot -->
<dif>
<product>
<property>/fdm/jsbsim/forces/fbx-prop-lbs</property>
<cos>
<property>/fdm/jsbsim/aero/alpha-rad</property>
</cos>
</product>
<product>
<property>/fdm/jsbsim/forces/fwx-aero-lbs</property>
<sum>
<value>1</value>
<product>
<property>/it-autoflight/internal/vls-error</property>
<value>-0.1</value>
</product>
</sum>
</product>
</dif>
</product>
<property>/fdm/jsbsim/inertia/weight-lbs</property>
</div>
</expression>
</input>
<output>/it-autoflight/internal/underspeed-vs</output>
<min>-6000</min>
<max>6000</max>
</filter>
<logic>
<input>
<and>
<greater-than>
<property>/instrumentation/airspeed-indicator/indicated-speed-kt</property>
<property>/FMGC/internal/vmo-mmo-minus-5</property>
</greater-than>
<or>
<and>
<equals>
<property>/it-autoflight/output/vert</property>
<value>1</value>
</equals>
<greater-than>
<property>/it-autoflight/internal/overspeed-vs</property>
<property>/it-autoflight/input/vs</property>
</greater-than>
</and>
<and>
<equals>
<property>/it-autoflight/output/vert</property>
<value>5</value>
</equals>
<greater-than>
<property>/it-autoflight/internal/overspeed-vs</property>
<property>/it-autoflight/internal/target-fpm-fpa-raw</property>
</greater-than>
</and>
</or>
</and>
</input>
<output>/it-autoflight/internal/overspeed-vs-prot</output>
</logic>
<logic>
<input>
<and>
<less-than>
<property>/instrumentation/airspeed-indicator/indicated-speed-kt</property>
<property>/FMGC/internal/vls-switched-plus-5</property>
</less-than>
<or>
<and>
<equals>
<property>/it-autoflight/output/vert</property>
<value>1</value>
</equals>
<less-than>
<property>/it-autoflight/internal/underspeed-vs</property>
<property>/it-autoflight/input/vs</property>
</less-than>
</and>
<and>
<equals>
<property>/it-autoflight/output/vert</property>
<value>5</value>
</equals>
<less-than>
<property>/it-autoflight/internal/underspeed-vs</property>
<property>/it-autoflight/internal/target-fpm-fpa-raw</property>
</less-than>
</and>
</or>
</and>
</input>
<output>/it-autoflight/internal/underspeed-vs-prot</output>
</logic>
<filter>
<name>Vertical Speed FPM Filter</name>
<type>noise-spike</type>
<input>
<condition>
<not>
<and>
<property>/it-autoflight/output/ap-on</property>
<equals>
<property>/it-autoflight/output/vert</property>
<value>1</value>
</equals>
<equals>
<property>/gear/gear[1]/wow</property>
<value>0</value>
</equals>
<equals>
<property>/gear/gear[2]/wow</property>
<value>0</value>
</equals>
</and>
</not>
</condition>
<property>/it-autoflight/internal/vert-speed-fpm</property>
</input>
<input>
<condition>
<property>/it-autoflight/internal/overspeed-vs-prot</property>
</condition>
<property>/it-autoflight/internal/overspeed-vs</property>
</input>
<input>
<condition>
<property>/it-autoflight/internal/underspeed-vs-prot</property>
</condition>
<property>/it-autoflight/internal/underspeed-vs</property>
</input>
<input>/it-autoflight/input/vs</input>
<output>/it-autoflight/internal/target-fpm-vs</output>
<max-rate-of-change>
<condition>
<and>
<property>/it-autoflight/output/ap-on</property>
<not><property>/it-autoflight/internal/overspeed-vs-prot</property></not>
<not><property>/it-autoflight/internal/underspeed-vs-prot</property></not>
<equals>
<property>/it-autoflight/output/vert</property>
<value>1</value>
</equals>
<equals>
<property>/gear/gear[1]/wow</property>
<value>0</value>
</equals>
<equals>
<property>/gear/gear[2]/wow</property>
<value>0</value>
</equals>
</and>
</condition>
<value>300</value>
</max-rate-of-change>
<max-rate-of-change>10000</max-rate-of-change>
</filter>
<logic>
<input>
<and>
<property>/it-autoflight/output/apfd-on</property>
<or>
<equals>
<property>/it-autoflight/output/vert</property>
<value>4</value>
</equals>
<equals>
<property>/it-autoflight/output/vert</property>
<value>7</value>
</equals>
</or>
</and>
</input>
<output>/it-autoflight/internal/flch-active</output>
</logic>
<filter>
<name>IT-CONTROLLER: Speed By Pitch Delta</name>
<type>gain</type>
<gain>
<expression>
<table>
<property>/velocities/airspeed-kt</property>
<entry><ind>140</ind><dep> 900</dep></entry>
<entry><ind>360</ind><dep>1400</dep></entry>
</table>
</expression>
</gain>
<input>
<condition>
<equals>
<property>/it-autoflight/input/kts-mach</property>
<value>1</value>
</equals>
</condition>
<property>/it-autoflight/internal/mach-rate</property>
</input>
<input>/it-autoflight/internal/kts-rate</input>
<reference>/it-autoflight/internal/flch-kts-error</reference>
<output>/it-autoflight/internal/flch-raw</output>
<min>
<condition>
<or>
<equals>
<property>/gear/gear[1]/wow</property>
<value>1</value>
</equals>
<equals>
<property>/gear/gear[2]/wow</property>
<value>1</value>
</equals>
</or>
</condition>
<value>0</value>
</min>
<min>-2000</min>
<max>2000</max>
</filter>
<filter>
<name>Speed By Pitch Filter</name>
<type>noise-spike</type>
<input>
<condition>
<property>/it-autoflight/internal/flch-active</property>
</condition>
<property>/it-autoflight/internal/flch-raw</property>
</input>
<input>/it-autoflight/internal/vert-speed-fpm</input>
<output>/it-autoflight/internal/flch-filtered</output>
<max-rate-of-change>
<condition>
<property>/it-autoflight/internal/flch-active</property>
</condition>
<value>1500</value>
</max-rate-of-change>
<max-rate-of-change>10000</max-rate-of-change>
</filter>
<filter>
<name>Speed By Pitch Final</name>
<type>gain</type>
<gain>1.0</gain>
<input>
<expression>
<sum>
<property>/it-autoflight/internal/vert-speed-fpm</property>
<property>/it-autoflight/internal/flch-filtered</property>
</sum>
</expression>
</input>
<output>/it-autoflight/internal/target-fpm-flch</output>
<min>
<condition>
<or>
<equals>
<property>/gear/gear[1]/wow</property>
<value>1</value>
</equals>
<equals>
<property>/gear/gear[2]/wow</property>
<value>1</value>
</equals>
</or>
</condition>
<value>0</value>
</min>
<min>
<condition>
<equals>
<property>/it-autoflight/output/thr-mode</property>
<value>2</value>
</equals>
</condition>
<value>120</value>
</min>
<min>-100000</min>
<max>
<condition>
<equals>
<property>/it-autoflight/output/thr-mode</property>
<value>1</value>
</equals>
</condition>
<value>-120</value>
</max>
<max>100000</max>
</filter>
<logic>
<input>
<and>
<property>/it-autoflight/output/apfd-on</property>
<equals>
<property>/it-autoflight/output/vert</property>
<value>5</value>
</equals>
</and>
</input>
<output>/it-autoflight/internal/fpa-active</output>
</logic>
<filter>
<name>IT-CONTROLLER: FPA</name>
<type>gain</type>
<gain>1.0</gain>
<input>
<condition>
<not><property>/it-autoflight/internal/fpa-active</property></not>
</condition>
<property>/it-autoflight/internal/vert-speed-fpm</property>
</input>
<input>
<expression>
<sum>
<difference> <!-- Fix an issue with the calculation -->
<property>/it-autoflight/internal/vert-speed-fpm</property>
<product>
<property>/velocities/vertical-speed-fps</property>
<value>60</value>
</product>
</difference>
<product>
<sin>
<deg2rad>
<property>/it-autoflight/input/fpa</property>
</deg2rad>
</sin>
<property>/instrumentation/airspeed-indicator/true-speed-kt</property>
<value>101.26859142607174</value> <!-- FPM to Knot -->
</product>
</sum>
</expression>
</input>
<output>/it-autoflight/internal/target-fpm-fpa-raw</output>
<min>
<expression>
<difference>
<property>/it-autoflight/internal/vert-speed-fpm</property>
<value>2500</value>
</difference>
</expression>
</min>
<max>
<expression>
<sum>
<property>/it-autoflight/internal/vert-speed-fpm</property>
<value>2500</value>
</sum>
</expression>
</max>
</filter>
<filter>
<name>FPA FPM Filter</name>
<type>noise-spike</type>
<input>
<condition>
<property>/it-autoflight/internal/overspeed-vs-prot</property>
</condition>
<property>/it-autoflight/internal/overspeed-vs</property>
</input>
<input>
<condition>
<property>/it-autoflight/internal/underspeed-vs-prot</property>
</condition>
<property>/it-autoflight/internal/underspeed-vs</property>
</input>
<input>/it-autoflight/internal/target-fpm-fpa-raw</input>
<output>/it-autoflight/internal/target-fpm-fpa</output>
<max-rate-of-change>
<condition>
<or>
<not><property>/it-autoflight/internal/fpa-active</property></not>
<property>/it-autoflight/internal/overspeed-vs-prot</property>
<property>/it-autoflight/internal/underspeed-vs-prot</property>
</or>
</condition>
<value>10000</value>
</max-rate-of-change>
<max-rate-of-change>300</max-rate-of-change>
</filter>
<filter>
<name>IT-CONTROLLER: Flare FD</name>
<type>gain</type>
<gain>1.0</gain>
<input>
<expression>
<max>
<property>/it-autoflight/internal/nav-rate-of-climb-fpm</property>
<sum>
<difference> <!-- Fix an issue with the calculation -->
<property>/it-autoflight/internal/vert-speed-fpm</property>
<product>
<property>/velocities/vertical-speed-fps</property>
<value>60</value>
</product>
</difference>
<product>
<sin>
<deg2rad>
<table>
<property>/position/gear-agl-ft</property>
<entry><ind>50</ind><dep>-3.0</dep></entry>
<entry><ind>45</ind><dep>-0.7</dep></entry>
</table>
</deg2rad>
</sin>
<property>/instrumentation/airspeed-indicator/true-speed-kt</property>
<value>101.26859142607174</value> <!-- FPM to Knot -->
</product>
</sum>
</max>
</expression>
</input>
<output>/it-autoflight/internal/target-fpm-land-fd</output>
<min>-1200</min>
<max>0</max>
</filter>
<filter>
<name>IT-CONTROLLER: Flare</name>
<type>gain</type>
<gain>1.0</gain>
<input>
<expression>
<max>
<property>/it-autoflight/internal/nav-rate-of-climb-fpm</property>
<sum>
<difference> <!-- Fix an issue with the calculation -->
<property>/it-autoflight/internal/vert-speed-fpm</property>
<product>
<property>/velocities/vertical-speed-fps</property>
<value>60</value>
</product>
</difference>
<product>
<sin>
<deg2rad>
<table>
<property>/position/gear-agl-ft</property>
<entry><ind>50</ind><dep>-3.0</dep></entry>
<entry><ind>40</ind><dep>-1.8</dep></entry>
<entry><ind>30</ind><dep>-1.5</dep></entry>
<entry><ind>20</ind><dep>-1.2</dep></entry>
<entry><ind> 5</ind><dep>-0.7</dep></entry>
</table>
</deg2rad>
</sin>
<property>/instrumentation/airspeed-indicator/true-speed-kt</property>
<value>101.26859142607174</value> <!-- FPM to Knot -->
</product>
</sum>
</max>
</expression>
</input>
<output>/it-autoflight/internal/target-fpm-land</output>
<min>-1200</min>
<max>0</max>
</filter>
<filter>
<name>Vertical Speed FD Input</name>
<type>gain</type>
<gain>1.0</gain>
<input>
<condition>
<property>/it-autoflight/internal/overspeed-vs-prot</property>
</condition>
<property>/it-autoflight/internal/overspeed-vs</property>
</input>
<input>
<condition>
<property>/it-autoflight/internal/underspeed-vs-prot</property>
</condition>
<property>/it-autoflight/internal/underspeed-vs</property>
</input>
<input>/it-autoflight/input/vs</input>
<output>/it-autoflight/internal/target-fpm-vs-fd</output>
</filter>
<filter>
<name>FPA FD Input</name>
<type>gain</type>
<gain>1.0</gain>
<input>
<condition>
<property>/it-autoflight/internal/overspeed-vs-prot</property>
</condition>
<property>/it-autoflight/internal/overspeed-vs</property>
</input>
<input>
<condition>
<property>/it-autoflight/internal/underspeed-vs-prot</property>
</condition>
<property>/it-autoflight/internal/underspeed-vs</property>
</input>
<input>/it-autoflight/internal/target-fpm-fpa</input>
<output>/it-autoflight/internal/target-fpm-fpa-fd</output>
</filter>
<filter>
<name>Target FPM</name>
<type>gain</type>
<gain>1.0</gain>
<input>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>0</value>
</equals>
</condition>
<property>/it-autoflight/internal/target-fpm-alt</property>
</input>
<input>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>1</value>
</equals>
</condition>
<property>/it-autoflight/internal/target-fpm-vs-fd</property>
</input>
<input>
<condition>
<or>
<equals>
<property>/it-autoflight/output/vert</property>
<value>4</value>
</equals>
<equals>
<property>/it-autoflight/output/vert</property>
<value>7</value>
</equals>
</or>
</condition>
<property>/it-autoflight/internal/target-fpm-flch</property>
</input>
<input>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>6</value>
</equals>
</condition>
<property>/it-autoflight/internal/target-fpm-land-fd</property>
</input>
<input>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>5</value>
</equals>
</condition>
<property>/it-autoflight/internal/target-fpm-fpa-fd</property>
</input>
<input>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>2</value>
</equals>
</condition>
<property>/it-autoflight/internal/nav-rate-of-climb-fpm</property>
</input>
<input>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>9</value>
</equals>
</condition>
<property>/it-autoflight/internal/vert-speed-fpm</property>
</input>
<output>/it-autoflight/internal/target-common-fpm</output>
</filter>
<logic>
<input>
<and>
<property>/it-autoflight/output/ap-on</property>
<equals>
<property>/gear/gear[1]/wow</property>
<value>0</value>
</equals>
<equals>
<property>/gear/gear[2]/wow</property>
<value>0</value>
</equals>
<not-equals>
<property>/it-autoflight/output/vert</property>
<value>9</value>
</not-equals>
</and>
</input>
<output>/it-autoflight/internal/vs-active</output>
</logic>
<filter>
<name>Target FPM Filter</name>
<type>noise-spike</type>
<input>
<condition>
<not><property>/it-autoflight/internal/vs-active</property></not>
</condition>
<property>/it-autoflight/internal/vert-speed-fpm</property>
</input>
<input>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>1</value>
</equals>
</condition>
<property>/it-autoflight/internal/target-fpm-vs</property>
</input>
<input>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>5</value>
</equals>
</condition>
<property>/it-autoflight/internal/target-fpm-fpa</property>
</input>
<input>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>6</value>
</equals>
</condition>
<property>/it-autoflight/internal/target-fpm-land</property>
</input>
<input>/it-autoflight/internal/target-common-fpm</input>
<output>/it-autoflight/internal/target-fpm</output>
<max-rate-of-change>
<condition>
<property>/it-autoflight/internal/vs-active</property>
</condition>
<value>700</value>
</max-rate-of-change>
<max-rate-of-change>10000</max-rate-of-change>
</filter>
<pid-controller>
<name>IT-CONTROLLER: FPM Hold</name>
<enable>
<condition>
<property>/it-autoflight/internal/vs-active</property>
</condition>
</enable>
<input>/it-autoflight/internal/vert-speed-fpm</input>
<reference>/it-autoflight/internal/target-fpm</reference>
<output>/it-autoflight/internal/target-pitch-deg</output>
<config>
<Kp>
<condition>
<not-equals>
<property>/it-autoflight/output/vert</property>
<value>6</value>
</not-equals>
</condition>
<expression>
<table>
<property>/velocities/airspeed-kt</property>
<entry><ind>140</ind><dep>0.0029</dep></entry>
<entry><ind>360</ind><dep>0.0009</dep></entry>
</table>
</expression>
</Kp>
<Kp>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>6</value>
</equals>
</condition>
<value>0.0055</value>
</Kp>
<Ti>2.5</Ti>
<Td>0.0001</Td>
<u_min>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>6</value>
</equals>
</condition>
<value>0</value>
</u_min>
<u_min>
<expression>
<max>
<dif>
<property>/orientation/pitch-deg</property>
<value>5</value>
</dif>
<value>-15</value>
</max>
</expression>
</u_min>
<u_max>
<condition>
<or>
<equals>
<property>/gear/gear[1]/wow</property>
<value>1</value>
</equals>
<equals>
<property>/gear/gear[2]/wow</property>
<value>1</value>
</equals>
</or>
</condition>
<value>10</value>
</u_max>
<u_max>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>7</value>
</equals>
</condition>
<expression>
<min>
<sum>
<property>/orientation/pitch-deg</property>
<value>5</value>
</sum>
<value>18</value>
</min>
</expression>
</u_max>
<u_max>
<expression>
<min>
<sum>
<property>/orientation/pitch-deg</property>
<value>5</value>
</sum>
<value>30</value>
</min>
</expression>
</u_max>
</config>
</pid-controller>
<filter>
<name>System Command: Pitch Target Inactive Sync</name>
<type>gain</type>
<gain>1.0</gain>
<enable>
<condition>
<not>
<and>
<property>/it-autoflight/output/ap-on</property>
<equals>
<property>/gear/gear[1]/wow</property>
<value>0</value>
</equals>
<equals>
<property>/gear/gear[2]/wow</property>
<value>0</value>
</equals>
<not-equals>
<property>/it-autoflight/output/vert</property>
<value>9</value>
</not-equals>
</and>
</not>
</condition>
</enable>
<input>/orientation/pitch-deg</input>
<output>/it-autoflight/internal/target-pitch-deg</output>
<min>-15</min>
<max>30</max>
</filter>
<filter>
<name>System Command: Pitch Rate Target</name>
<type>gain</type>
<gain>0.12</gain>
<input>/orientation/pitch-deg</input>
<reference>/it-autoflight/internal/target-pitch-deg</reference>
<output>/fdm/jsbsim/fbw/fmgc/pitch-cmd</output> <!-- Inputs to the FBW Pitch -->
<min>-0.3</min>
<max>0.3</max>
</filter>
</PropertyList>