ReturnMatrix torque_novelocity(const ColumnVector & q,
const ColumnVector & qpp);
ReturnMatrix torque_novelocity(const ColumnVector & q,
const ColumnVector & qpp,
const ColumnVector & Fext,
const ColumnVector & Next);
ColumnVector