Goal-Based Pathing complete

Finished (more or less) the goal based pathing but it's not efficient
enough to use in game. Working on A* now.
Revert "Goal-Based Pathing complete"

This reverts commit c22e44e711d0672629b139c06edbcbe9348e1ac4.
Goal-Based Pathing Implemented (unusable)

Can't use the goal based pathfinding for larger maps. May try and create
a hybrid with A* for the final pathing system.