odometry with gyro works now