private boolean isQuadOneDimensional(Point3f[] vertices) { for (int i = 0; i < vertices.length; i++) { Point3f vertex = vertices[i]; for (int n = i + 1; n < vertices.length; n++) { float epsilon = 1e-4F; if (vertex.epsilonEquals(vertices[n], epsilon)) { return true; } } } return false; }
private boolean isQuadOneDimensional(Point3f[] vertices) { for (int i = 0; i < vertices.length; i++) { Point3f vertex = vertices[i]; for (int n = i + 1; n < vertices.length; n++) { float epsilon = 1e-4F; if (vertex.epsilonEquals(vertices[n], epsilon)) { return true; } } } return false; }
@Override public boolean epsilonEquals(FootstepPlanningRequestPacket other, double epsilon) { if (!initialStanceSide.equals(other.initialStanceSide)) return false; if (!stanceFootPositionInWorld.epsilonEquals(other.stanceFootPositionInWorld, (float) epsilon)) return false; if (!RotationTools.quaternionEpsilonEquals(stanceFootOrientationInWorld, other.stanceFootOrientationInWorld, (float) epsilon)) return false; if (!goalPositionInWorld.epsilonEquals(other.goalPositionInWorld, (float) epsilon)) return false; if (!RotationTools.quaternionEpsilonEquals(goalOrientationInWorld, other.goalOrientationInWorld, (float) epsilon)) return false; return true; }
@Override public boolean epsilonEquals(LidarScanMessage other, double epsilon) { if (!lidarPosition.epsilonEquals(other.lidarPosition, (float) epsilon)) return false; if (!lidarOrientation.epsilonEquals(other.lidarOrientation, (float) epsilon)) return false; if (scan.length != other.scan.length) return false; for (int i = 0; i < scan.length; i++) { if (!MathTools.epsilonEquals(scan[i], other.scan[i], epsilon)) return false; } return true; } }
if (!regionOrigin.epsilonEquals(other.regionOrigin, (float) epsilon)) return false; if (!regionNormal.epsilonEquals(other.regionNormal, (float) epsilon))