roughlyEquals

fun roughlyEquals(other: Pose, positionTolerance: Double = 0.01, angleTolerance: Double = 0.001): Boolean