Depth Enhanced Monocular Odometry (RGBD camera version)