Created the findPath() function for the A* algorithm. Currently intending to use an STL vector to store nodes in path.