Create ZMP_Harada_step_cubic