solve the drift problem inside with the online Naveau PG+Dynamic filter.

src/PatternGeneratorInterfacePrivate.cpp

src/ZMPRefTrajectoryGeneration/DynamicFilter.cpp

src/ZMPRefTrajectoryGeneration/ZMPVelocityReferencedSQP.cpp

src/ZMPRefTrajectoryGeneration/ZMPVelocityReferencedSQP.hh

src/ZMPRefTrajectoryGeneration/nmpc_generator.cpp

src/ZMPRefTrajectoryGeneration/nmpc_generator.hh

tests/TestNaveau2015.cpp