Add timestamp to ECL print statements, (#644)

which is helpful for EKF replay debugging.
This commit is contained in:
kritz
2019-09-25 11:24:42 +02:00
committed by Julian Oes
parent bb88d4ce5e
commit 4a38f5a2f6
11 changed files with 61 additions and 45 deletions
+4 -4
View File
@@ -101,7 +101,7 @@ void Ekf::fuseMag()
// we need to re-initialise covariances and abort this fusion step
resetMagCovariance();
ECL_ERR("EKF magX fusion numerical error - covariance reset");
ECL_ERR_TIMESTAMPED("EKF magX fusion numerical error - covariance reset");
return;
}
@@ -120,7 +120,7 @@ void Ekf::fuseMag()
// we need to re-initialise covariances and abort this fusion step
resetMagCovariance();
ECL_ERR("EKF magY fusion numerical error - covariance reset");
ECL_ERR_TIMESTAMPED("EKF magY fusion numerical error - covariance reset");
return;
}
@@ -139,7 +139,7 @@ void Ekf::fuseMag()
// we need to re-initialise covariances and abort this fusion step
resetMagCovariance();
ECL_ERR("EKF magZ fusion numerical error - covariance reset");
ECL_ERR_TIMESTAMPED("EKF magZ fusion numerical error - covariance reset");
return;
}
@@ -677,7 +677,7 @@ void Ekf::fuseHeading()
// we reinitialise the covariance matrix and abort this fusion step
initialiseCovariance();
ECL_ERR("EKF mag yaw fusion numerical error - covariance reset");
ECL_ERR_TIMESTAMPED("EKF mag yaw fusion numerical error - covariance reset");
return;
}