nav2 fixes