Fix the occasionally failure of testKinCnst, this is because resize in Eigen does not set the value to zero. So the constraint value can be garbage occasionally
Merge pull request #328 from hongkai-dai/fixTestKinCnst

fix testKinCnst error