QPMotionConstr has been refactored.
Refactoring of some constaints.
Pass the first unit test.