From 4163d3bed96dfd7907d40876b8945bae60567efe Mon Sep 17 00:00:00 2001
From: Josh Davidson <joshuadavidson2000@gmail.com>
Date: Tue, 2 Nov 2021 17:37:01 -0400
Subject: [PATCH] Control: Fix attitude stability drifting

---
 Systems/a320-fbw.xml | 21 +++++++++++++++++++--
 1 file changed, 19 insertions(+), 2 deletions(-)

diff --git a/Systems/a320-fbw.xml b/Systems/a320-fbw.xml
index 8ec6ca99..f5a71254 100644
--- a/Systems/a320-fbw.xml
+++ b/Systems/a320-fbw.xml
@@ -483,6 +483,23 @@
 			</test>
 		</switch>
 		
+		<!-- Because we want to be attitude stable -->
+		<fcs_function name="fbw/roll/p-rad_sec">
+			<function>
+				<toradians>
+					<property>/orientation/roll-rate-degps</property>
+				</toradians>
+			</function>
+		</fcs_function>
+		
+		<fcs_function name="fbw/pitch/thetadot-rad_sec">
+			<function>
+				<toradians>
+					<property>/orientation/pitch-rate-degps</property>
+				</toradians>
+			</function>
+		</fcs_function>
+		
 	</channel>
 	
 	<channel name="Computers">
@@ -981,7 +998,7 @@
 		</pure_gain>
 		
 		<switch name="fbw/roll/p-r_s-s">
-			<default value="velocities/p-rad_sec"/>
+			<default value="fbw/roll/p-rad_sec"/>
 			<test value="0">
 				gear/unit[0]/WOW eq 1
 			</test>
@@ -1483,7 +1500,7 @@
 		</pure_gain>
 		
 		<switch name="fbw/pitch/t-r_s-s">
-			<default value="velocities/thetadot-rad_sec"/>
+			<default value="fbw/pitch/thetadot-rad_sec"/>
 			<test value="0">
 				gear/unit[0]/WOW eq 1
 			</test>