as following (line 359), what do you say about adding sim.agent->state.Set(m, d); before mj_step.
my reason is that , controller need instant state info to control robot, instant time info is good for interpolating right control info, or it will be failed in some hard scenarios.
i am not sure about this suggestion, because the performance does not improve yet.
The state is set below in this line. The planner has access to the most up-to-date state. However, I am noticing that we might not be initializing the planner state from the model default state since this function does nothing.
as following (line 359), what do you say about adding sim.agent->state.Set(m, d); before mj_step. my reason is that , controller need instant state info to control robot, instant time info is good for interpolating right control info, or it will be failed in some hard scenarios.
i am not sure about this suggestion, because the performance does not improve yet.