Refactor SLAM main steps for better clarity.
CheckFramestep that runs all sanity checks of incoming frames
- Perform motion extrapolation in EgoMotion step as it aims at estimating relative motion
UpdateFrameTimeand modify point-wise
timefield only if undistortion is enabled
- Minor changes of printed info and reorganization of other steps