Changed the interface for Navigation and revamped velocity, though it
still does not seem to work