Update ZMP_Harada_basic_quadric_step