addPoseMarker
fun addPoseMarker(pose: Pose2d, linearTolerance: Double = 2.0, angularTolerance: Double = Math.toRadians(5.0), callback: MarkerCallback): TrajectoryBuilder
Adds a marker that triggers when the robot is within a certain linear and angular tolerance of a given pose.
Return
A new TrajectoryBuilder with the marker added.
Parameters
pose
The Pose2d to check proximity and orientation against.
linearTolerance
The distance tolerance for triggering the marker (default: 2.0 units).
angularTolerance
The angular tolerance in radians for triggering the marker (default: 5 degrees).
callback
The callback to execute when triggered.