function Vs = velocity_s(xi_hat,theta_d)
%spational velocity for constant twist 
Vs = xi_hat*theta_d;
end