First pass implementation (as now usual, not tested) of odometry for the kobuki