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
+1 -1
View File
@@ -274,7 +274,7 @@ bool Ekf::initialiseFilter()
const baroSample &baro_newest = _baro_buffer.get_newest();
_baro_hgt_offset = baro_newest.hgt;
_state.pos(2) = -math::max(_rng_filt_state * _R_rng_to_earth_2_2, _params.rng_gnd_clearance);
ECL_INFO("EKF using range finder height - commencing alignment");
ECL_INFO_TIMESTAMPED("EKF using range finder height - commencing alignment");
} else if (_control_status.flags.ev_hgt) {
// if we are using external vision data for height, then the vertical position state needs to be reset