More preparation for the future

Made navgateTo() more useful, you can now tell it to move z first by
passing true as the fourth variable