roughlyEquals

public boolean roughlyEquals(Pose pose, double accuracy)

This returns if a Pose is within a specified accuracy of this Pose in terms of x position, y position, and heading.

returns if the input Pose is within the specified accuracy of this Pose

pose

the input Pose to check

accuracy

the specified accuracy necessary to return true

public boolean roughlyEquals(Pose pose)

This checks if the input Pose is within 0.0001 in all values to this Pose.

returns if the input Pose is within 0.0001 of this Pose

pose

the input Pose