There is still a null reference bug, in the pathfinding. This both my work and Niel's work.

I will continue to work on it, but here is the pull request for now.