C++ Pathfinding Algroithms and Testing Code

C++ code of three pathfinding algorithms, also including testing code.