Added pathfinding back, fixed some bugs.

- Minions can now find a path even though their destination is
unreachable due to there being a minion on top of it (due to the
destination being the minion it wants to go to)
- Pathfinder now correctly maps the minions into the grid..
- Increased mapsize for more precision.
- Left in debug information for anyone interested in debugging this.