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