More Pathfinding, some cleanup

Pathfinding more-or-less implemented. 2 major things that need to be
fixed: detect non-connected graphs and prevent trying to find a path
between them, and 'blocky' movement.
Rearranged much of the folder structure for the project.