function R = rot_z(alpha) c = cos(alpha); s = sin(alpha); % R = [ c s 0 ; -s c 0; 0 0 1]; R = [ c -s 0 ; s c 0; 0 0 1];