Added wrenches, spatial inertias