Homogeneous transform for robot  from frame {j} to frame {i}

T[dh_, i_, j_] := <br />        Which[<br /> &nbs ... nbsp;         InverseT[TAll[Take[dh, {j + 1, i}]]]] ;

Created by Mathematica  (October 21, 2003)