public boolean sameBearingAsNearFriend(double[] position, double bearing) {
        for (double[] agentVals : agentInfo.values()) {
            double normal = Math.abs(agentVals[2] - bearing);
            if (normal >= 345 || normal <= 10) {
                //Similar heading, check proximity.
                if (agentVals[0] - position[0] < Math.abs(0.1) && agentVals[1] - position[1] < Math.abs(0.1)) {
                    return true;
                }
            }
        }
        return false;
    }