cartwheel: (partly) replace Vector3d and Quaternion by Eigen equivalents
cartwheel: remove code to prevent leg intersections (did not seem
    to get used anyway)
kintree: re-order parameters in inverse joints for compatibility with
    RNE/CRB implementation