This is a shortest path algorithm implemented using a 2d graph based occupancy grid map
Primary LanguageC++Apache License 2.0Apache-2.0