[Stay Aligned] Increase yaw correction rate for good IMUs (#1445)

This commit is contained in:
jabberrock
2025-05-27 12:40:01 -07:00
committed by GitHub
parent ca14fa05e5
commit d71879cc4d

View File

@@ -41,9 +41,9 @@ object StayAlignedDefaults {
const val YAW_ERRORS_NEIGHBOR_ERROR_WEIGHT = 1.0f
// Yaw correction for each type of IMU
val YAW_CORRECTION_IMU_GOOD = Angle.ofDeg(0.1f)
val YAW_CORRECTION_IMU_OK = Angle.ofDeg(0.2f)
val YAW_CORRECTION_IMU_BAD = Angle.ofDeg(0.4f)
val YAW_CORRECTION_IMU_GOOD = Angle.ofDeg(0.15f)
val YAW_CORRECTION_IMU_OK = Angle.ofDeg(0.20f)
val YAW_CORRECTION_IMU_BAD = Angle.ofDeg(0.40f)
val YAW_CORRECTION_IMU_DISABLED = Angle.ZERO
val IMU_TO_YAW_CORRECTION = buildMap {