|
|
@ -446,7 +446,6 @@ bool NavEKF3_core::readyToUseOptFlow(void) const |
|
|
|
// return true if the filter is ready to start using body frame odometry measurements
|
|
|
|
// return true if the filter is ready to start using body frame odometry measurements
|
|
|
|
bool NavEKF3_core::readyToUseBodyOdm(void) const |
|
|
|
bool NavEKF3_core::readyToUseBodyOdm(void) const |
|
|
|
{ |
|
|
|
{ |
|
|
|
|
|
|
|
|
|
|
|
// Check for fresh visual odometry data that meets the accuracy required for alignment
|
|
|
|
// Check for fresh visual odometry data that meets the accuracy required for alignment
|
|
|
|
bool visoDataGood = (imuSampleTime_ms - bodyOdmMeasTime_ms < 200) && (bodyOdmDataNew.velErr < 1.0f); |
|
|
|
bool visoDataGood = (imuSampleTime_ms - bodyOdmMeasTime_ms < 200) && (bodyOdmDataNew.velErr < 1.0f); |
|
|
|
|
|
|
|
|
|
|
|