EKF: Fix bug preventing saved declination being used for first alignment

2026-10-21 11:03:34 +08:00 · 2018-11-15 07:16:31 +11:00
parent 4657a9cd21
commit df571202c5
1 changed files with 2 additions and 0 deletions
@@ -257,6 +257,8 @@ bool Ekf::initialiseFilter()
 		Vector3f mag_init = _mag_filt_state;

 		// calculate the initial magnetic field and yaw alignment
+		// Get the magnetic declination
+		calcMagDeclination();
 		_control_status.flags.yaw_align = resetMagHeading(mag_init);

 		if (_control_status.flags.rng_hgt) {