Помогите Расчет локации

Рассчитываю локацию таким методом

Code:

private static Location NextLoc(Location loc, double speed){
        double y = loc.getPitch();
        double xz = loc.getYaw();
        double newY = loc.getY()+speed*Math.sin(y);
        double newX = loc.getX()+speed*Math.cos(y)*Math.cos(xz);
        double newZ = loc.getZ()+speed*Math.cos(y)*Math.sin(xz);
        Location locnext = new Location(loc.getWorld(), newX, newY, newZ);
        return locnext;
    }

Летит вверх почему то.
Что не так?
Заранее спасибо

 

разобрался, в явке тригонометрия через радианы