function R = HRX(q)
    cq = cos(q); sq = sin(q);
    R = eye(4);
    R(2,2)=cq; R(2,3)=-sq;
    R(3,2)=sq; R(3,3)= cq;
end