fix some bug

...otTrajectoryGeneration/OnLineFootTrajectoryGeneration.cpp

src/ZMPRefTrajectoryGeneration/DynamicFilter.cpp

src/ZMPRefTrajectoryGeneration/DynamicFilter.hh

src/ZMPRefTrajectoryGeneration/OrientationsPreview.cpp

src/ZMPRefTrajectoryGeneration/ZMPVelocityReferencedQP.cpp

tests/TestHerdt2010DynamicFilter.cpp