function A=T12(theta, d1)
A=[1 0 0 0;0 0 1 0;0 -1 0 d1;0 0 0 1];
