TwoWheelLocalizer

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

driveModel

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