function Rz = rotzd(theta)
% Creates rotation matrix about axis Z
% input in degrees
theta=theta*pi/180;
ct=cos(theta);
st=sin(theta);
Rz=[ct -st 0 0;st ct 0 0;0 0 1 0;0 0 0 1];