Safe navigation controller