LocalPlanningPipeline code cleanup needed

[majid-khonji]

The _resolve to be cleanup up. The substrategies for path, velocity, vehavior planning interfaces need to be unified: globa plan, pm (or env) or setting.