void dqp_torque(const ColumnVector & q, const ColumnVector & qp, const ColumnVector & dqp, ColumnVector & torque, ColumnVector & dtorque);
None (torque and dtorque are modified on output)