* Pathfinding now uses std::vector instead of arrays
* Moved a lot initialisation stuff
* Fixed minor bugs
* And did some code cleaning :)