update in navigation, fixed orientational controller, bad cross product