Fix MotionConstr::curTorque_ initialization:
  Must be mb.nrDof size and not juste actuated dof size.