Update ZMP_Harada_basic_quadric_step_try2

with full Xc new (from t0 to t5)