Real-Time Mapping based on RGBD Visual Odometry