a dense visual odometry implemented in matlab