Graceful controller for Nav2