Control: FMGC AP Improvements

This commit is contained in:
Joshua Davidson 2019-01-10 13:37:15 -05:00
parent ae6d2a67df
commit be097a736e
3 changed files with 59 additions and 36 deletions

View file

@ -36,6 +36,18 @@
<max>/it-autoflight/internal/max-vs</max>
</filter>
<filter>
<name>FPA ERROR</name>
<debug>false</debug>
<type>gain</type>
<gain>1.0</gain>
<input>/it-autoflight/internal/fpa</input>
<reference>/it-autoflight/input/fpa</reference>
<output>/it-autoflight/internal/fpa-error</output>
<min>-1.5</min>
<max>1.5</max>
</filter>
<pid-controller>
<name>FPA HOLD</name>
<debug>false</debug>
@ -67,8 +79,8 @@
</and>
</condition>
</enable>
<input>/it-autoflight/internal/fpa</input>
<reference>/it-autoflight/input/fpa</reference>
<input>/it-autoflight/internal/fpa-error</input>
<reference>0</reference>
<output>/it-autoflight/internal/target-fpm-d</output>
<config>
<Kp>
@ -80,7 +92,22 @@
</table>
</expression>
</Kp>
<Ti>2.0</Ti>
<Ti>
<condition>
<or>
<equals>
<property>/it-autoflight/output/ap1</property>
<value>1</value>
</equals>
<equals>
<property>/it-autoflight/output/ap2</property>
<value>1</value>
</equals>
</or>
</condition>
<value>2.0</value>
</Ti>
<Ti>10.0</Ti>
<Td>0.002</Td>
<u_min>
<expression>

View file

@ -8,9 +8,19 @@
<!-- Roll Axis -->
<pi-simple-controller>
<name>ROLL CONTROLLER: HDG/LNAV</name>
<filter>
<name>IT-CONTROLLER: HDG/LNAV ROLL</name>
<debug>false</debug>
<type>gain</type>
<gain>
<expression>
<table>
<property>/fdm/jsbsim/velocities/vc-kts</property>
<entry><ind>140</ind><dep>1.8</dep></entry>
<entry><ind>360</ind><dep>2.8</dep></entry>
</table>
</expression>
</gain>
<enable>
<condition>
<and>
@ -48,28 +58,18 @@
<input>/it-autoflight/internal/heading-error-deg</input>
<reference>0</reference>
<output>/it-autoflight/internal/target-roll-deg</output>
<config>
<Kp>
<expression>
<table>
<property>/fdm/jsbsim/velocities/vc-kts</property>
<entry><ind>140</ind><dep>-1.8</dep></entry>
<entry><ind>360</ind><dep>-2.8</dep></entry>
</table>
</expression>
</Kp>
<Ki>-0.000001</Ki>
<min>
<property>/it-autoflight/internal/bank-limit</property>
<scale>-1.0</scale>
</min>
<max>/it-autoflight/internal/bank-limit</max>
</config>
</pi-simple-controller>
<min>
<property>/it-autoflight/internal/bank-limit</property>
<scale>-1.0</scale>
</min>
<max>/it-autoflight/internal/bank-limit</max>
</filter>
<pi-simple-controller>
<name>VORLOC TRK</name>
<filter>
<name>IT-CONTROLLER: VORLOC ROLL</name>
<debug>false</debug>
<type>gain</type>
<gain>2.8</gain>
<enable>
<condition>
<and>
@ -101,16 +101,12 @@
<input>/it-autoflight/internal/nav-heading-error-deg</input>
<reference>0</reference>
<output>/it-autoflight/internal/target-roll-deg</output>
<config>
<Kp>-2.8</Kp>
<Ki>-0.0001</Ki>
<min>
<property>/it-autoflight/internal/bank-limit</property>
<scale>-1.0</scale>
</min>
<max>/it-autoflight/internal/bank-limit</max>
</config>
</pi-simple-controller>
<min>
<property>/it-autoflight/internal/bank-limit</property>
<scale>-1.0</scale>
</min>
<max>/it-autoflight/internal/bank-limit</max>
</filter>
<filter>
<name>ROLL DEG SYNC</name>

View file

@ -1 +1 @@
4732
4733