addVisionMeasurement

fun addVisionMeasurement(visionPose: Pose2d, timestamp: Time)

Adds a vision measurement to the pose estimator.

Parameters

visionPose

The pose measured by vision.

timestamp

The timestamp of the vision measurement.