Add tutorial with videos and images

Signed-off-by: methylDragon <[email protected]>
moveit · Aug 20, 2024 · ae5f747 · ae5f747
1 parent 2a2c8c2
commit ae5f747
Show file tree

Hide file tree

Showing 16 changed files with 348 additions and 2 deletions.
diff --git a/_static/videos/trajectory_cache/01_cache_and_execute_loop.webm b/_static/videos/trajectory_cache/01_cache_and_execute_loop.webm
diff --git a/_static/videos/trajectory_cache/02_trajectory_cache_demo.webm b/_static/videos/trajectory_cache/02_trajectory_cache_demo.webm
diff --git a/doc/how_to_guides/how_to_guides.rst b/doc/how_to_guides/how_to_guides.rst
@@ -25,6 +25,7 @@ Configuring and Using MoveIt
    pick_ik/pick_ik_tutorial
    trac_ik/trac_ik_tutorial
    benchmarking/benchmarking_tutorial
+   trajectory_cache/trajectory_cache_tutorial
 
 Developing and Documenting MoveIt
 ---------------------------------

diff --git a/doc/how_to_guides/trajectory_cache/images/demo_CacheAndExecute_best_trajectory.png b/doc/how_to_guides/trajectory_cache/images/demo_CacheAndExecute_best_trajectory.png
diff --git a/doc/how_to_guides/trajectory_cache/images/demo_CacheAndExecute_matchable_plans.png b/doc/how_to_guides/trajectory_cache/images/demo_CacheAndExecute_matchable_plans.png
diff --git a/...to_guides/trajectory_cache/images/demo_CacheAndExecute_title_and_statistics.png b/...to_guides/trajectory_cache/images/demo_CacheAndExecute_title_and_statistics.png
diff --git a/...w_to_guides/trajectory_cache/images/demo_CacheNoPruning_cache_visualization.png b/...w_to_guides/trajectory_cache/images/demo_CacheNoPruning_cache_visualization.png
diff --git a/..._to_guides/trajectory_cache/images/demo_CacheNoPruning_title_and_statistics.png b/..._to_guides/trajectory_cache/images/demo_CacheNoPruning_title_and_statistics.png
diff --git a/...to_guides/trajectory_cache/images/demo_CacheWithPruning_cache_visualization.png b/...to_guides/trajectory_cache/images/demo_CacheWithPruning_cache_visualization.png
diff --git a/...des/trajectory_cache/images/demo_CacheWithPruning_delete_worse_trajectories.png b/...des/trajectory_cache/images/demo_CacheWithPruning_delete_worse_trajectories.png
diff --git a/...o_guides/trajectory_cache/images/demo_CacheWithPruning_title_and_statistics.png b/...o_guides/trajectory_cache/images/demo_CacheWithPruning_title_and_statistics.png
diff --git a/...o_guides/trajectory_cache/images/demo_HighStartTolerance_diff_to_trajectory.png b/...o_guides/trajectory_cache/images/demo_HighStartTolerance_diff_to_trajectory.png
diff --git a/...guides/trajectory_cache/images/demo_HighStartTolerance_title_and_statistics.png b/...guides/trajectory_cache/images/demo_HighStartTolerance_title_and_statistics.png
diff --git a/doc/how_to_guides/trajectory_cache/images/demo_HighStartTolerance_tolerance.png b/doc/how_to_guides/trajectory_cache/images/demo_HighStartTolerance_tolerance.png
diff --git a/doc/how_to_guides/trajectory_cache/src/trajectory_cache_demo.cpp b/doc/how_to_guides/trajectory_cache/src/trajectory_cache_demo.cpp
@@ -56,13 +56,20 @@
  *
  * NOTE:
  *   Tutorial notes will be commented like this block!
- *
+ * 
  * PRE-REQUISITES
  * ^^^^^^^^^^^^^^
  * This tutorial assumes knowledge of the MoveGroupInterface.
  *
  * INTERACTIVITY
  * ^^^^^^^^^^^^^
+ * This demo has four phases that can be advanced using the `rviz_visual_tools` dialog box.
+ * 
+ * 1. Plan and cache (no pruning)
+ * 2. Plan and cache (with pruning)
+ * 3. Fetch from cache and execute (while still planning and caching with pruning)
+ * 4. Fetch from cache and execute, except with large start tolerances
+ * 
  * This tutorial also supports "reconfigurable" parameters!:
  *
  * You can adjust them with:
@@ -71,7 +78,7 @@
  * Tutorial parameters:
  *   - planner:
  *       Defaults to "RRTstar". The OMPL planner used.
- *       It's better to use a random-sampling, non-optimal planner to see the cache working.
+ *       It is better to use a random-sampling, non-optimal planner to see the cache working.
  *
  * Cache parameters:
  *   - start_tolerance:
@@ -648,6 +655,19 @@ int main(int argc, char** argv)
 
   // Interactivity. ================================================================================
 
+  /** [TUTORIAL NOTE]
+   * This demo has four phases that can be advanced using the `rviz_visual_tools` dialog box.
+   * 
+   * 1. Plan and cache (no pruning)
+   *   - Showcases basic cache functionality.
+   * 2. Plan and cache (with pruning)
+   *   - Showcases pruning functionality.
+   * 3. Fetch from cache and execute (while still planning and caching with pruning)
+   *   - Showcases cache fetches.
+   * 4. Fetch from cache and execute, except with large start tolerances
+   *   - Showcases fuzzy matching, and the impact of start tolerance.
+   */
+
   std::atomic<size_t> demo_phase = 0;
   std::atomic<bool> run_execute = false;
 

diff --git a/doc/how_to_guides/trajectory_cache/trajectory_cache_tutorial.rst b/doc/how_to_guides/trajectory_cache/trajectory_cache_tutorial.rst