karlkurzer / path_planner C++ 1.9K 571 Hybrid A* Path Planner for the KTH Research Concept Vehicle motion-planning planning-algorithms robotics