P0-B5: Part 1274: Debugging, Improvements

I am having some issues with the AI navmesh generation, but these issues are solveable.

The graph generation is working fine, but I need to rewrite some of the pathfinding logic to work with the new type of interior building.

I have already made many improvements to the new pathfinding system that fix bugs and add new features, and smooth out the movements itself.

I will probably need to replace the older interior navigation system with the new one eventually.