graphopper edgeFilter by azimuth

EdgeFilterDirection.java

package com.graphhopper.util;

import com.graphhopper.routing.util.EdgeFilter;
import com.graphhopper.routing.util.FlagEncoder;
import com.graphhopper.storage.NodeAccess;

public class EdgeFilterDirection implements EdgeFilter{

    private final double azimuth;
    private AngleCalc2D angleCalc = new AngleCalc2D();
    private final NodeAccess nodeAccess;
    private final FlagEncoder encoder;
    
    public EdgeFilterDirection(NodeAccess nodeAccess, FlagEncoder encoder ,double azimuth){
        this.azimuth = azimuth;
        this.nodeAccess = nodeAccess;
        this.encoder = encoder;
    }
    
    @Override
    public boolean accept(EdgeIteratorState edge) {
        if(Helper.isBidirect(encoder, edge.getFlags()))
            return true;
        double lat1 = nodeAccess.getLat(edge.getBaseNode());
        double lon1 = nodeAccess.getLon(edge.getBaseNode());
        double lat2 = nodeAccess.getLat(edge.getAdjNode());
        double lon2 = nodeAccess.getLon(edge.getAdjNode());
        double edgeAzimuth = angleCalc.calcAzimuth(lat1, lon1, lat2, lon2);
        double min = edgeAzimuth - 90;
        double max = edgeAzimuth + 90;
        
        if(azimuth > min && azimuth < max)
            return true;
        return false;
    }
    
}