now with super working dwa local planner! next step: implementing topo navigation