test_legged_sim_mpc