[RST-2202] Wait for a valid timestamp #74
Merged
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Wait for a valid timestamp before loading the plugins. This prevents the ignition sensor from generating an initial state with the wrong stamp.
Previously the ignition sensor was generating a constraint at time 0, before the clock had been initialized. Once the clock was initialized, the motion model would then generate a constraint from 0 to the current time (~4000s in my test). This results in a large uncertainty for the current state, leading to an ill-conditioned jacobian matrix, leading to numerical errors when computing covariances (and probably other things). I note that had this been real data, the delta between 0 and a real stamp would have been much much much worse.