debugging the dynamic filter

src/MotionGeneration/ComAndFootRealizationByGeometry.cpp

src/RobotDynamics/pinocchiorobot.cpp

src/ZMPRefTrajectoryGeneration/DynamicFilter.cpp

src/ZMPRefTrajectoryGeneration/ZMPVelocityReferencedSQP.cpp

src/ZMPRefTrajectoryGeneration/nmpc_generator.cpp