function A=T23(theta, d2)
A=[1 0 0 0;0 1 0 0;0 0 1 d2;0 0 0 1]; 
