624 lines
15 KiB
XML
624 lines
15 KiB
XML
<?xml version="1.0"?>
|
|
|
|
<!-- IT-AUTOFLIGHT -->
|
|
<!-- Copyright (c) 2021 Josh Davidson (Octal450) -->
|
|
|
|
<PropertyList>
|
|
|
|
<!-- Pitch Axis -->
|
|
<filter>
|
|
<name>IT-CONTROLLER: Altitude Capture/Hold</name>
|
|
<debug>false</debug>
|
|
<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>
|
|
|
|
<logic>
|
|
<input>
|
|
<and>
|
|
<or>
|
|
<equals>
|
|
<property>/it-autoflight/output/vert</property>
|
|
<value>4</value>
|
|
</equals>
|
|
<equals>
|
|
<property>/it-autoflight/output/vert</property>
|
|
<value>7</value>
|
|
</equals>
|
|
</or>
|
|
<or>
|
|
<equals>
|
|
<property>/it-autoflight/output/ap1</property>
|
|
<value>1</value>
|
|
</equals>
|
|
<equals>
|
|
<property>/it-autoflight/output/ap2</property>
|
|
<value>1</value>
|
|
</equals>
|
|
<equals>
|
|
<property>/it-autoflight/output/fd1</property>
|
|
<value>1</value>
|
|
</equals>
|
|
<equals>
|
|
<property>/it-autoflight/output/fd2</property>
|
|
<value>1</value>
|
|
</equals>
|
|
</or>
|
|
</and>
|
|
</input>
|
|
<output>/it-autoflight/internal/flch-active</output>
|
|
</logic>
|
|
|
|
<pid-controller>
|
|
<name>IT-CONTROLLER: Speed By Pitch</name>
|
|
<debug>false</debug>
|
|
<enable>
|
|
<condition>
|
|
<property>/it-autoflight/internal/flch-active</property>
|
|
</condition>
|
|
</enable>
|
|
<input>
|
|
<condition>
|
|
<equals>
|
|
<property>/it-autoflight/input/kts-mach</property>
|
|
<value>0</value>
|
|
</equals>
|
|
</condition>
|
|
<property>/it-autoflight/internal/kts-predicted-15</property>
|
|
</input>
|
|
<input>
|
|
<condition>
|
|
<equals>
|
|
<property>/it-autoflight/input/kts-mach</property>
|
|
<value>1</value>
|
|
</equals>
|
|
</condition>
|
|
<property>/it-autoflight/internal/mach-predicted-15</property>
|
|
<scale>750</scale>
|
|
</input>
|
|
<reference>
|
|
<condition>
|
|
<equals>
|
|
<property>/it-autoflight/input/kts-mach</property>
|
|
<value>0</value>
|
|
</equals>
|
|
</condition>
|
|
<property>/it-autoflight/internal/flch-kts</property>
|
|
</reference>
|
|
<reference>
|
|
<condition>
|
|
<equals>
|
|
<property>/it-autoflight/input/kts-mach</property>
|
|
<value>1</value>
|
|
</equals>
|
|
</condition>
|
|
<property>/it-autoflight/internal/flch-mach</property>
|
|
<scale>750</scale>
|
|
</reference>
|
|
<output>/it-autoflight/internal/target-fpm-flch</output>
|
|
<config>
|
|
<Kp>-55</Kp>
|
|
<Ti>2.5</Ti>
|
|
<Td>0.001</Td>
|
|
<u_min>
|
|
<condition>
|
|
<equals>
|
|
<property>/it-autoflight/output/thr-mode</property>
|
|
<value>2</value>
|
|
</equals>
|
|
</condition>
|
|
<value>120</value>
|
|
</u_min>
|
|
<u_min>
|
|
<expression>
|
|
<difference>
|
|
<property>/it-autoflight/internal/vert-speed-fpm</property>
|
|
<value>2500</value>
|
|
</difference>
|
|
</expression>
|
|
</u_min>
|
|
<u_max>
|
|
<condition>
|
|
<and>
|
|
<equals>
|
|
<property>/it-autoflight/output/thr-mode</property>
|
|
<value>2</value>
|
|
</equals>
|
|
<or>
|
|
<equals>
|
|
<property>/gear/gear[1]/wow</property>
|
|
<value>1</value>
|
|
</equals>
|
|
<equals>
|
|
<property>/gear/gear[2]/wow</property>
|
|
<value>1</value>
|
|
</equals>
|
|
</or>
|
|
</and>
|
|
</condition>
|
|
<value>1000</value>
|
|
</u_max>
|
|
<u_max>
|
|
<condition>
|
|
<equals>
|
|
<property>/it-autoflight/output/thr-mode</property>
|
|
<value>1</value>
|
|
</equals>
|
|
</condition>
|
|
<value>-120</value>
|
|
</u_max>
|
|
<u_max>
|
|
<expression>
|
|
<sum>
|
|
<property>/it-autoflight/internal/vert-speed-fpm</property>
|
|
<value>2500</value>
|
|
</sum>
|
|
</expression>
|
|
</u_max>
|
|
</config>
|
|
</pid-controller>
|
|
|
|
<filter>
|
|
<name>Speed By Pitch Inactive Sync</name>
|
|
<debug>false</debug>
|
|
<type>gain</type>
|
|
<gain>1.0</gain>
|
|
<enable>
|
|
<condition>
|
|
<not><property>/it-autoflight/internal/flch-active</property></not>
|
|
</condition>
|
|
</enable>
|
|
<input>/it-autoflight/internal/vert-speed-fpm</input>
|
|
<output>/it-autoflight/internal/target-fpm-flch</output>
|
|
</filter>
|
|
|
|
<logic>
|
|
<input>
|
|
<and>
|
|
<equals>
|
|
<property>/it-autoflight/output/vert</property>
|
|
<value>5</value>
|
|
</equals>
|
|
<or>
|
|
<equals>
|
|
<property>/it-autoflight/output/ap1</property>
|
|
<value>1</value>
|
|
</equals>
|
|
<equals>
|
|
<property>/it-autoflight/output/ap2</property>
|
|
<value>1</value>
|
|
</equals>
|
|
<equals>
|
|
<property>/it-autoflight/output/fd1</property>
|
|
<value>1</value>
|
|
</equals>
|
|
<equals>
|
|
<property>/it-autoflight/output/fd2</property>
|
|
<value>1</value>
|
|
</equals>
|
|
</or>
|
|
</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>/it-autoflight/internal/target-fpm-fpa-raw</input>
|
|
<output>/it-autoflight/internal/target-fpm-fpa</output>
|
|
<max-rate-of-change>
|
|
<condition>
|
|
<not><property>/it-autoflight/internal/fpa-active</property></not>
|
|
</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>
|
|
<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>100</ind><dep>-2.80</dep></entry>
|
|
<entry><ind> 50</ind><dep>-2.12</dep></entry>
|
|
<entry><ind> 45</ind><dep>-0.61</dep></entry>
|
|
</table>
|
|
</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-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>
|
|
<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>100</ind><dep>-2.80</dep></entry>
|
|
<entry><ind> 50</ind><dep>-2.12</dep></entry>
|
|
<entry><ind> 40</ind><dep>-1.58</dep></entry>
|
|
<entry><ind> 30</ind><dep>-1.23</dep></entry>
|
|
<entry><ind> 20</ind><dep>-0.92</dep></entry>
|
|
<entry><ind> 10</ind><dep>-0.61</dep></entry>
|
|
</table>
|
|
</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-land</output>
|
|
<min>-1200</min>
|
|
<max>0</max>
|
|
</filter>
|
|
|
|
<filter>
|
|
<name>TARGET FPM</name>
|
|
<debug>false</debug>
|
|
<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/input/vs</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-raw</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>
|
|
<output>/it-autoflight/internal/target-common-fpm</output>
|
|
</filter>
|
|
|
|
<pid-controller>
|
|
<name>IT-CONTROLLER: FPM Hold</name>
|
|
<debug>false</debug>
|
|
<enable>
|
|
<condition>
|
|
<and>
|
|
<equals>
|
|
<property>/gear/gear[1]/wow</property>
|
|
<value>0</value>
|
|
</equals>
|
|
<equals>
|
|
<property>/gear/gear[2]/wow</property>
|
|
<value>0</value>
|
|
</equals>
|
|
<or>
|
|
<equals>
|
|
<property>/it-autoflight/output/ap1</property>
|
|
<value>1</value>
|
|
</equals>
|
|
<equals>
|
|
<property>/it-autoflight/output/ap2</property>
|
|
<value>1</value>
|
|
</equals>
|
|
</or>
|
|
</and>
|
|
</condition>
|
|
</enable>
|
|
<input>/it-autoflight/internal/vert-speed-fpm</input>
|
|
<reference>
|
|
<condition>
|
|
<equals>
|
|
<property>/it-autoflight/output/vert</property>
|
|
<value>1</value>
|
|
</equals>
|
|
</condition>
|
|
<property>/it-autoflight/internal/vs</property>
|
|
</reference>
|
|
<reference>
|
|
<condition>
|
|
<equals>
|
|
<property>/it-autoflight/output/vert</property>
|
|
<value>5</value>
|
|
</equals>
|
|
</condition>
|
|
<property>/it-autoflight/internal/target-fpm-fpa</property>
|
|
</reference>
|
|
<reference>
|
|
<condition>
|
|
<equals>
|
|
<property>/it-autoflight/output/vert</property>
|
|
<value>6</value>
|
|
</equals>
|
|
</condition>
|
|
<property>/it-autoflight/internal/target-fpm-land</property>
|
|
</reference>
|
|
<reference>/it-autoflight/internal/target-common-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>/fdm/jsbsim/velocities/vc-kts</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>
|
|
<debug>false</debug>
|
|
<type>gain</type>
|
|
<gain>1.0</gain>
|
|
<enable>
|
|
<condition>
|
|
<not>
|
|
<and>
|
|
<equals>
|
|
<property>/gear/gear[1]/wow</property>
|
|
<value>0</value>
|
|
</equals>
|
|
<equals>
|
|
<property>/gear/gear[2]/wow</property>
|
|
<value>0</value>
|
|
</equals>
|
|
<or>
|
|
<equals>
|
|
<property>/it-autoflight/output/ap1</property>
|
|
<value>1</value>
|
|
</equals>
|
|
<equals>
|
|
<property>/it-autoflight/output/ap2</property>
|
|
<value>1</value>
|
|
</equals>
|
|
</or>
|
|
</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>
|
|
<debug>false</debug>
|
|
<type>gain</type>
|
|
<gain>0.125</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>
|