Pathfinder is up, needs cleaning up.

If it gives you grief just comment it all out or delete it and let me
know so i can fix it, currently can return an array of structs that
dictates the path, there is a seperate function for returning the length
of the array. it's not so intuitive currently so just ask me when you
want to implement it =)