Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-10 18:08:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_NavEKF3: define Yaw alignment min GPS speed per vehicle

Browse Source
This commit is contained in:
Randy Mackay 2023-07-03 20:33:46 +09:00
parent da6e4b8813
commit 26e990f409
2 changed files with 7 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp
View File

@ -6,6 +6,13 @@
#include <GCS_MAVLink/GCS.h>
#include <AP_DAL/AP_DAL.h>
// minimum GPS horizontal speed required to use GPS ground course for yaw alignment (m/s)
#if APM_BUILD_TYPE(APM_BUILD_ArduPlane)
#define GPS_VEL_YAW_ALIGN_MIN_SPD 5.0F
#else
#define GPS_VEL_YAW_ALIGN_MIN_SPD 1.0F
#endif
/********************************************************
* RESET FUNCTIONS *
********************************************************/

3
libraries/AP_NavEKF3/AP_NavEKF3_core.h
View File

@ -118,9 +118,6 @@
// number of continuous valid GPS velocity samples required to reset yaw
#define GPS_VEL_YAW_ALIGN_COUNT_THRESHOLD 5
// minimum GPS horizontal speed required to use GPS ground course for yaw alignment (m/s)
#define GPS_VEL_YAW_ALIGN_MIN_SPD 5.0F
// maximum GPs ground course uncertainty allowed for yaw alignment (deg)
#define GPS_VEL_YAW_ALIGN_MAX_ANG_ERR 15.0F