atPose

public boolean atPose(Pose pose, double xTolerance, double yTolerance, double headingTolerance)

Checks if the robot is at a certain pose within certain tolerances

Parameters

pose

Pose to compare with the current pose

xTolerance

Tolerance for the x position

yTolerance

Tolerance for the y position

headingTolerance

Tolerance for the heading


public boolean atPose(Pose pose, double xTolerance, double yTolerance)

Checks if the robot is at a certain pose within certain tolerances

Parameters

pose

Pose to compare with the current pose

xTolerance

Tolerance for the x position

yTolerance

Tolerance for the y position