Simplified pathfinding algorithm. Does not include enemies yet.