Adjusted optimization parameters to legs' active dof for useKneeCnostraint case
(A major edit, apparently resolved initialization on angularVels in Body,
needs to be also applied when useKneeCnostraint is off,
should be cleaned up and optimized later)