Added the odometry scaling filter. Velocity offset seems to work, not
sure about the wheel base/track width