AHRS DCM: FOrmatting

13 years ago · 52b2aacf28
1 changed files with 4 additions and 1 deletions
--- a/libraries/AP_AHRS/AP_AHRS_DCM.h
+++ b/libraries/AP_AHRS/AP_AHRS_DCM.h
@ -22,6 +22,9 @@ public:
				@@ -22,6 +22,9 @@ public:
 		// with large drift levels
 		_ki = 0.0087;
 		_ki_yaw = 0.01;
+		_kp.set(0.4);
+		_kp_yaw.set(0.4);
+		gps_gain.set(1.0);
 	}

 	// return the smoothed gyro vector corrected for drift