Start development of odometry functionality