Motion planner code

I’m not sure if I understood you question.