function [pos_x, pos_y, pos_z] = changep(p_x,p_y,p_z,u,v,w,dt);
pos_x=p_x+u*dt;
pos_y=p_y+v*dt;
pos_z=p_z+w*dt;
end