Start of pathfinding code. Not finished and not all code was commited. Code for the "JumpPoint" class was excluded due to many, many errors.