fuzzyEquals

fun fuzzyEquals(o: Pose2D, distanceTolerance: Double, angleTolerance: Double): Boolean