From 3974deb3876f9e66fe4c38f54c2919065dcd24be Mon Sep 17 00:00:00 2001 From: Steve Macenski Date: Tue, 20 Feb 2024 10:41:31 -0800 Subject: [PATCH] Adding context to MPPI readme Signed-off-by: Steve Macenski Signed-off-by: enricosutera --- nav2_mppi_controller/README.md | 2 ++ 1 file changed, 2 insertions(+) diff --git a/nav2_mppi_controller/README.md b/nav2_mppi_controller/README.md index b6cfc0e452..2a9a25a863 100644 --- a/nav2_mppi_controller/README.md +++ b/nav2_mppi_controller/README.md @@ -288,6 +288,8 @@ If you don't require path following behavior (e.g. just want to follow a goal po By default, the controller is tuned and has the capabilities established in the PathAlign/Obstacle critics to generally follow the path closely when no obstacles prevent it, but able to deviate from the path when blocked. See `PathAlignCritic::score()` for details, but it is disabled when the local path is blocked so the obstacle critic takes over in that state. +If you want to slow further on approach to goal, consider increasing the ``threshold_to_consider`` parameters to give a hand off from the path tracking critics to the goal approach critics sooner - then tune those critics for your profile of interest. + ### Prediction Horizon, Costmap Sizing, and Offsets As this is a predictive planner, there is some relationship between maximum speed, prediction times, and costmap size that users should keep in mind while tuning for their application. If a controller server costmap is set to 3.0m in size, that means that with the robot in the center, there is 1.5m of information on either side of the robot. When your prediction horizon (time_steps * model_dt) at maximum speed (vx_max) is larger than this, then your robot will be artificially limited in its maximum speeds and behavior by the costmap limitation. For example, if you predict forward 3 seconds (60 steps @ 0.05s per step) at 0.5m/s maximum speed, the **minimum** required costmap radius is 1.5m - or 3m total width.