Working homebrew nav graph

It's super fidgety and is really easy to break right now. Will work on
making more stable in the future