fly/A320-family
1
0
Fork 0
Code Activity

FMGC: Fix clamps on VS and PITCH in Autopilot

Browse source
This commit is contained in:
Josh Davidson 2020-07-08 17:08:58 -04:00
parent d875a8ec35
commit d2dbb68201
2 changed files with 39 additions and 104 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

24
Systems/fmgc-drivers.xml
View file

@ -43,23 +43,6 @@
</predict-simple> </predict-simple>
<!-- Autopilot Helpers/Calculators --> <!-- Autopilot Helpers/Calculators -->
<filter> <!-- Replace -->
<name>AUTOLAND FD FPM</name>
<type>gain</type>
<gain>1.0</gain>
<input>
<expression>
<table>
<property>/position/gear-agl-ft</property>
<entry><ind>100</ind><dep>-650</dep></entry>
<entry><ind> 50</ind><dep>-500</dep></entry>
<entry><ind> 45</ind><dep> -70</dep></entry>
</table>
</expression>
</input>
<output>/it-autoflight/internal/target-fpm-c2</output>
</filter>
<filter> <filter>
<name>FMGC Managed Knots</name> <name>FMGC Managed Knots</name>
<type>gain</type> <type>gain</type>
@ -152,7 +135,12 @@
<value>T/O CLB</value> <value>T/O CLB</value>
</equals> </equals>
</condition> </condition>
<property>/it-autoflight/settings/togaspd</property> <expression>
<sum>
<property>/it-autoflight/settings/togaspd</property>
<value>10</value>
</sum>
</expression>
</input> </input>
<input>/it-autoflight/input/spd-kts</input> <input>/it-autoflight/input/spd-kts</input>
<output>/it-autoflight/internal/flch-kts</output> <output>/it-autoflight/internal/flch-kts</output>

119
Systems/fmgc-pitch.xml
View file

@ -122,12 +122,6 @@
<value>120</value> <value>120</value>
</u_min> </u_min>
<u_min> <u_min>
<condition>
<equals>
<property>/it-autoflight/output/thr-mode</property>
<value>1</value>
</equals>
</condition>
<expression> <expression>
<difference> <difference>
<property>/it-autoflight/internal/vert-speed-fpm</property> <property>/it-autoflight/internal/vert-speed-fpm</property>
@ -135,32 +129,6 @@
</difference> </difference>
</expression> </expression>
</u_min> </u_min>
<u_max>
<condition>
<and>
<equals>
<property>/it-autoflight/output/thr-mode</property>
<value>2</value>
</equals>
<and>
<equals>
<property>/gear/gear[1]/wow</property>
<value>0</value>
</equals>
<equals>
<property>/gear/gear[2]/wow</property>
<value>0</value>
</equals>
</and>
</and>
</condition>
<expression>
<sum>
<property>/it-autoflight/internal/vert-speed-fpm</property>
<value>2500</value>
</sum>
</expression>
</u_max>
<u_max> <u_max>
<condition> <condition>
<and> <and>
@ -191,27 +159,7 @@
</condition> </condition>
<value>-120</value> <value>-120</value>
</u_max> </u_max>
<u_min>
<condition>
<equals>
<property>/it-autoflight/output/thr-mode</property>
<value>0</value>
</equals>
</condition>
<expression>
<difference>
<property>/it-autoflight/internal/vert-speed-fpm</property>
<value>2500</value>
</difference>
</expression>
</u_min>
<u_max> <u_max>
<condition>
<equals>
<property>/it-autoflight/output/thr-mode</property>
<value>0</value>
</equals>
</condition>
<expression> <expression>
<sum> <sum>
<property>/it-autoflight/internal/vert-speed-fpm</property> <property>/it-autoflight/internal/vert-speed-fpm</property>
@ -560,11 +508,14 @@
<Td>0.0001</Td> <Td>0.0001</Td>
<u_min> <u_min>
<condition> <condition>
<not-equals> <equals>
<property>/it-autoflight/output/vert</property> <property>/it-autoflight/output/vert</property>
<value>6</value> <value>6</value>
</not-equals> </equals>
</condition> </condition>
<value>0</value>
</u_min>
<u_min>
<expression> <expression>
<max> <max>
<dif> <dif>
@ -575,38 +526,6 @@
</max> </max>
</expression> </expression>
</u_min> </u_min>
<u_min>
<condition>
<equals>
<property>/it-autoflight/output/vert</property>
<value>6</value>
</equals>
</condition>
<value>0</value>
</u_min>
<u_max>
<condition>
<and>
<equals>
<property>/gear/gear[1]/wow</property>
<value>0</value>
</equals>
<equals>
<property>/gear/gear[2]/wow</property>
<value>0</value>
</equals>
</and>
</condition>
<expression>
<min>
<sum>
<property>/orientation/pitch-deg</property>
<value>5</value>
</sum>
<value>30</value>
</min>
</expression>
</u_max>
<u_max> <u_max>
<condition> <condition>
<or> <or>
@ -622,6 +541,34 @@
</condition> </condition>
<value>10</value> <value>10</value>
</u_max> </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> </config>
</pid-controller> </pid-controller>