IntrinsicMecanumLocalizer

constructor(@NonNull params: IntrinsicMecanumLocalizer.Params, @Nullable imu: IMU, @NonNull motorPowers: Supplier<Array<Double>>)

Create a new IntrinsicMecanumLocalizer.

Parameters

params

the coefficients used in calculating the intrinsic Mecanum pose

imu

the IMU to use for heading information

motorPowers

a four-wide double array supplier that supplies the current motor powers, in the form {frontLeft, backLeft, backRight, frontRight}