addVisionMeasurement

fun addVisionMeasurement(measurement: Pose2d, timestamp: Double)

Add a vision measurement to the swerve drive's pose estimator.

measurement

The pose measurement to add.

timestamp

The timestamp of the pose measurement.

Add a vision measurement to the swerve drive's pose estimator.

measurement

The vision measurement to add, contains its own pose and timestamp.