diff --git a/src/ZMPRefTrajectoryGeneration/ZMPVelocityReferencedQP.cpp b/src/ZMPRefTrajectoryGeneration/ZMPVelocityReferencedQP.cpp index 6bc8573718598d23afb0c55aad47f1744cba3557..f03ecba6bd4ec262532279e22ecdacee2d1b9fe0 100644 --- a/src/ZMPRefTrajectoryGeneration/ZMPVelocityReferencedQP.cpp +++ b/src/ZMPRefTrajectoryGeneration/ZMPVelocityReferencedQP.cpp @@ -434,17 +434,8 @@ int InitStateOrientPrw_ = OrientPrw_->CurrentTrunkState() ; FinalCurrentStateOrientPrw_ = OrientPrw_->CurrentTrunkState() ; - FootAbsolutePosition supportFoot ; - if (InitLeftFootAbsolutePosition.stepType<0) - { - supportFoot = InitLeftFootAbsolutePosition ; - }else - { - supportFoot = InitRightFootAbsolutePosition ; - } - dynamicFilter_->init(0.0,m_SamplingPeriod,InterpolationPeriod_, - QP_T_,QP_N_*QP_T_,CoMHeight_,supportFoot); + QP_T_,QP_N_*QP_T_,CoMHeight_,InitLeftFootAbsolutePosition); return 0; }