Browse Source

AP_NavEKF3: out-of-date comments removed

GPS, Static and ExtNav yaw buffers have been separated
zr-v5.1
Randy Mackay 4 years ago committed by Andrew Tridgell
parent
commit
647c568ab9
  1. 3
      libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp

3
libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp

@ -1075,12 +1075,10 @@ bool NavEKF3_core::fuseEulerYaw(yawFusionMethod method) @@ -1075,12 +1075,10 @@ bool NavEKF3_core::fuseEulerYaw(yawFusionMethod method)
}
case yawFusionMethod::GPS:
// both external sensor yaw and last yaw when static are stored in yawAngDataDelayed.yawAng
innovYaw = wrap_PI(yawAngPredicted - yawAngDataDelayed.yawAng);
break;
case yawFusionMethod::STATIC:
// both external sensor yaw and last yaw when static are stored in yawAngDataDelayed.yawAng
innovYaw = wrap_PI(yawAngPredicted - yawAngDataStatic.yawAng);
break;
@ -1094,7 +1092,6 @@ bool NavEKF3_core::fuseEulerYaw(yawFusionMethod method) @@ -1094,7 +1092,6 @@ bool NavEKF3_core::fuseEulerYaw(yawFusionMethod method)
break;
case yawFusionMethod::EXTNAV:
// both external sensor yaw and last yaw when static are stored in yawAngDataDelayed.yawAng
innovYaw = wrap_PI(yawAngPredicted - extNavYawAngDataDelayed.yawAng);
break;
}

Loading…
Cancel
Save