integrationtests: mavros/mission_test.py bump yaw_error_std threshold (heading init is delayed, but not wrong)

This commit is contained in:
Daniel Agar 2024-04-30 10:12:58 -04:00 committed by Mathieu Bresciani
parent 5173830718
commit bb5dfc7d51
2 changed files with 2 additions and 2 deletions

View File

@ -308,7 +308,7 @@ class MavrosMissionTest(MavrosTestCommon):
self.assertTrue(res['pitch_error_std'] < 5.0, str(res))
# TODO: fix by excluding initial heading init and reset preflight
self.assertTrue(res['yaw_error_std'] < 10.0, str(res))
self.assertTrue(res['yaw_error_std'] < 13.0, str(res))
if __name__ == '__main__':

View File

@ -150,7 +150,7 @@ void Ekf::controlMagFusion()
const bool starting_conditions_passing = continuing_conditions_passing
&& checkMagField(mag_sample.mag)
&& (_mag_counter > 5) // wait until we have more than a few samples through the filter
&& (_mag_counter > 3) // wait until we have more than a few samples through the filter
&& (_control_status.flags.yaw_align == _control_status_prev.flags.yaw_align) // no yaw alignment change this frame
&& (_state_reset_status.reset_count.quat == _state_reset_count_prev.quat) // don't allow starting on same frame as yaw reset
&& isNewestSampleRecent(_time_last_mag_buffer_push, MAG_MAX_INTERVAL);