Сделать Approach
Необходимо реализовать простенький approach, вдохновляясь teb local planner, с дальнейшей возможностью заменить компонент на teb_local_planner.(Надо сделать фасад и реализацию с возможностью потом заменить реализациб на teb local planner)