Angular velocity of link {i} in frame {j} coordinates

ω[dh_, 0, 0] := {0, 0, 0} ;

ω[dh_, i_, i_] := R[dh, i, i - 1] . ω[dh, i - 1, i - 1] + If[dh[[i, 5]] == 0, Dt[dh[[i, 4]], t] {0, 0, 1}, {0, 0, 0}]

ω[dh_, j_, i_] := <br />    R[dh, j, i] . ω[dh, i, i]


Created by Mathematica  (October 21, 2003)