How wuyi2121/scan-planner works
SCAN-Planner is a ROS local planner for route-guided quadruped navigation. A user selects a navigation mode and sensing source; the planning node manages replanning, produces a collision-aware trajectory, and a controller executes it. The repository also includes grid mapping, local path search, simulator sensing and map generation, visualization, and robot-motion simulation. The principal planning links are partly inferred from module roles: several implementation files were not excerpted, so those relationships are shown as unverified rather than asserted as source-proven calls.
Main entry points: planner_manager.cpp Planner Manager · grid_map.cpp Grid Map · pointcloud_render_node.cpp Local Sensing · bspline_optimizer.cpp B-spline Optimizer
Components 22
Planning
- Planning Node
src/planner/plan_manage/src/scan_planner_node.cpp - Replanning FSM
src/planner/plan_manage/src/scan_replan_fsm.cpp - Planner Manager
src/planner/plan_manage/src/planner_manager.cpp - Dynamic A*
src/planner/path_searching/src/dyn_a_star.cpp - B-spline Optimizer
src/planner/bspline_opt/src/bspline_optimizer.cpp - Gradient Optimizer
src/planner/bspline_opt/src/gradient_descent_optimizer.cpp - Uniform B-splines
src/planner/bspline_opt/src/uniform_bspline.cpp
Mapping
- Grid Map
src/planner/plan_env/src/grid_map.cpp - Raycasting
src/planner/plan_env/src/raycast.cpp
Execution
- Closed-loop Control
src/planner/plan_manage/src/closed_loop_controller.cpp - Open-loop Simulation
src/planner/plan_manage/src/open_loop_controller.cpp - Planning Visualization
src/planner/traj_utils/src/planning_visualization.cpp - Trajectory Utilities
src/planner/traj_utils/src/polynomial_traj.cpp
Simulation
- Local Sensing
src/simulator/local_sensing/src/pointcloud_render_node.cpp - Field-of-view Checker
src/simulator/local_sensing/include/FOV_Checker/FOV_Checker.cpp - Map Generator
src/simulator/mockamap/src/maps.cpp - Waypoint Generator
src/simulator/Utils/waypoint_generator/src/waypoint_generator.cpp - Go2 Kinematic Sim
src/planner/plan_manage/src/go2_kinematic_sim.cpp - Incremental KD-tree
src/simulator/local_sensing/include/ikd-Tree/ikd_Tree.cpp
Math Support
- GLM Math
src/simulator/local_sensing/include/glm
Other components
- Navigation User
- Robot Sensors
Connections 22
- Navigation User → Planning Node: selects mode
- Robot Sensors → Grid Map: supplies observations
- Planning Node → Replanning FSM: starts replanning
- Replanning FSM → Planner Manager: requests plans
- Planner Manager → Dynamic A*: searches path
- Planner Manager → B-spline Optimizer: optimizes trajectory
- B-spline Optimizer → Gradient Optimizer: uses optimizer
src/planner/bspline_opt/src/bspline_optimizer.cpp - B-spline Optimizer → Grid Map: checks occupancy
src/planner/bspline_opt/src/bspline_optimizer.cpp - Planner Manager → Uniform B-splines: generates trajectory
- Grid Map → Raycasting: updates occupancy
src/planner/plan_env/src/grid_map.cpp - Planner Manager → Closed-loop Control: publishes trajectory
- Planner Manager → Open-loop Simulation: publishes trajectory
- Closed-loop Control → Uniform B-splines: evaluates trajectory
src/planner/plan_manage/src/closed_loop_controller.cpp - Open-loop Simulation → Uniform B-splines: evaluates trajectory
src/planner/plan_manage/src/open_loop_controller.cpp - Planner Manager → Planning Visualization: visualizes plans
- Planner Manager → Trajectory Utilities: uses trajectory types
- Local Sensing → Field-of-view Checker: checks field of view
src/simulator/local_sensing/src/pointcloud_render_node.cpp - Local Sensing → Incremental KD-tree: uses spatial index
- Map Generator → Grid Map: supplies simulated maps
- Waypoint Generator → Navigation User: provides waypoints
- Go2 Kinematic Sim → Open-loop Simulation: simulates motion
- Local Sensing → GLM Math: uses math types