Closed WZG3661 closed 9 months ago
The timestamp of the state, e.g. state->_timestamp
, is actually the camera time (see the bottom of the propagate_and_clone()
function). Thus we need to take into account the time offset the first time the fast propagate function is called. After the first time the fast propagation is called, the cache_state_time
will be in the IMU clock frame, so the cache_t_off
will be zero (see bottom of fast_state_propagate()
function).
On the line 154 of Propagator.cpp, the timestamp is originally in IMU clock, why add cache_t_off?