topological navigation works! next step: check navigability when creating edges. problem: dwa local planner sometimes hangs in corridors -> keeps slowly going forward until route is blocked