Working on minor fixing, working on pathfinding

src/navigation/PathFinder.h

@@ -109,6 +109,11 @@ private:
 	std::vector<Eigen::Vector3f> findNearestReachableImpl(const Eigen::Vector3f& start,
 	                                                      const Eigen::Vector3f& end,
 	                                                      const std::vector<unsigned char>& walkableGrid) const;
+
+    std::vector<Eigen::Vector3f> runAStar(const Eigen::Vector3f& start,
+        const Eigen::Vector3f& end,
+        const std::vector<unsigned char>& grid,
+        bool returnNearestOnFail) const;
 };
 
 } // namespace FRG