AngleStatistics 

DifferentialDrivePoseEstimator 
This class wraps an Unscented Kalman
Filter to fuse latencycompensated vision measurements with differential drive encoder
measurements.

ExtendedKalmanFilter<States extends Num,Inputs extends Num,Outputs extends Num> 
A Kalman filter combines predictions from a model and measurements to give an estimate of the
true system state.

KalmanFilter<States extends Num,Inputs extends Num,Outputs extends Num> 
A Kalman filter combines predictions from a model and measurements to give an estimate of the
true system state.

KalmanFilterLatencyCompensator<S extends Num,I extends Num,O extends Num> 

MecanumDrivePoseEstimator 
This class wraps an Unscented Kalman Filter to fuse
latencycompensated vision measurements with mecanum drive encoder velocity measurements.

MerweScaledSigmaPoints<S extends Num> 
Generates sigma points and weights according to Van der Merwe's 2004 dissertation[1] for the
UnscentedKalmanFilter class.

SwerveDrivePoseEstimator 
This class wraps an Unscented Kalman Filter to fuse
latencycompensated vision measurements with swerve drive encoder velocity measurements.

UnscentedKalmanFilter<States extends Num,Inputs extends Num,Outputs extends Num> 
A Kalman filter combines predictions from a model and measurements to give an estimate of the
true system state.
