private double normalisoi(double kulma){
        if (kulma < 0){
            return kulma + Math.PI*2;
        } else if (kulma > Math.PI*2) {
            return kulma - Math.PI*2;
        } else {
            return kulma;
        }
    }