function p = set_vel(p,xdot,n)
p.xdot(n,:) = xdot;
end