function A=T56(a6,d6)
A=[1 0 0 -a6;0 0 -1 -d6;0 1 0 0;0 0 0 1];
