begin the intergration of the interpolation. still work to do

src/ZMPRefTrajectoryGeneration/ZMPVelocityReferencedSQP.cpp

src/ZMPRefTrajectoryGeneration/nmpc_generator.cpp

src/ZMPRefTrajectoryGeneration/nmpc_generator.hh