Commit 58

Pathfinding works for heroes. Issues with movement. Beginning of mega
tidy up.