ma2tetr/src/main/java/ma2tetr/invariant/RadiusInvariant.java

package ma2tetr.invariant;

import java.util.Set;

import ma2tetr.model.Coords3D;

public class RadiusInvariant extends AbstractInvariant {

    private Set<Coords3D> points;
    private Coords3D center;
    private double radius;

    public RadiusInvariant(Set<Coords3D> points, Coords3D center, double radius) {
        this.points = points;
        this.center = center;
        this.radius = radius;
    }

    @Override
    public boolean isFulfilled() {
        for (Coords3D point : points) {
            double len = center.distance(point);
            if (!checkEqual(len, radius)) {
                return false;
            }
        }
        return true;
    }    

    public double firstDifference() {
        for (Coords3D point : points) {
            double len = center.distance(point);
            if (!checkEqual(len, radius)) {
                return radius - len;
            }
        }
        return 0.0;
    }
    
}