function A=Tlink(teta,l,d,alpha)
p=[l 0 d]';
A=rotz(teta)*trans(p)*rotx(alpha);