Fixed issues with pathfinding, goal selection, and added more data gathering.