Fixed the message queue. It should work correctly now. Agents can now
send maps and if they need to go home.

Improved A* search method so it is less buggy. However, there are still
bugs that will cause the agents to loop in a circle or just outright
crash.