Rewrote navigations to use coordinates and made goto method

I know that this issue is under debate so I created a pull request for it. While there is a lot of refactoring that can be done to make it better (more efficient), I'm pushing this so that people can see what it looks like and can comment on whether they like it or not.