function R = rot(theta,sj)



N = size(sj,1);

R = cos(theta/2)*eye(N)-j*sin(theta/2)*sj;