fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

ekf2: GNSS yaw only reset test ratio for new samples

Browse Source 
- otherwise external test ratio monitoring could trigger a false positive
This commit is contained in:
Daniel Agar 2023-03-14 10:45:56 -04:00
parent e375e02974
commit 19a2b4ec31
1 changed files with 4 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
src/modules/ekf2/EKF/gps_yaw_fusion.cpp
View File

@ -48,10 +48,11 @@
void Ekf::updateGpsYaw(const gpsSample &gps_sample)
{
auto &gnss_yaw = _aid_src_gnss_yaw;
resetEstimatorAidStatus(gnss_yaw);
if (PX4_ISFINITE(gps_sample.yaw)) {
auto &gnss_yaw = _aid_src_gnss_yaw;
resetEstimatorAidStatus(gnss_yaw);
// initially populate for estimator_aid_src_gnss_yaw logging
// calculate the observed yaw angle of antenna array, converting a from body to antenna yaw measurement