Two Wheel Localizer
constructor(@NonNull driveModel: DriveModel, @NonNull params: TwoWheelLocalizer.Params, @Nullable par: RawEncoder, @Nullable perp: RawEncoder, @Nullable imu: IMU)
Create a new TwoWheelLocalizer that will run on two parallel and one perpendicular encoders, with an IMU for heading information.
Parameters
drive Model
the drive model to use for kinematics
params
the parameters for the dead wheel localizer
par
the parallel encoder
perp
the perpendicular encoder
imu
the IMU to use for heading