Skip to content

Path Planners: Probabilistic Road Map#61

Open
guilyx wants to merge 5 commits intoShisatoYano:mainfrom
guilyx:feat/probabilistic-road-map
Open

Path Planners: Probabilistic Road Map#61
guilyx wants to merge 5 commits intoShisatoYano:mainfrom
guilyx:feat/probabilistic-road-map

Conversation

@guilyx
Copy link
Contributor

@guilyx guilyx commented Feb 9, 2026

Probabilistic Road Map (PRM) Path Planner

Algorithm (src/components/plan/prm/prm_path_planner.py):

  • Sampling phase: Uniformly samples 500 collision-free points in world space (seeded RNG for reproducibility)
  • Connection phase: Connects each node to neighbours within a 5.0m radius via collision-free straight-line local paths (20-point line sampling)
  • Search phase: Dijkstra on the resulting roadmap graph from start to goal
  • Clearance-aware: Treats both obstacles (1.0) and clearance zones (0.75) as impassable
  • Search GIF: 5-phase animation — sampling nodes, connecting edges, Dijkstra expansion, path drawing, hold

Simulation (src/simulations/path_planning/prm_path_planning/prm_path_planning.py):

  • Same obstacle layout as other planners (two obstacles)
  • Generates prm_search.gif (roadmap construction + search) and prm_navigate.gif (PurePursuit car following)

@ShisatoYano ShisatoYano self-requested a review March 7, 2026 10:39
@ShisatoYano ShisatoYano added the enhancement New feature or request label Mar 7, 2026
#### PRM
Planning
![](src/simulations/path_planning/prm_path_planning/prm_search.gif)
Navigation
Copy link
Owner

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

You don't have to add GIF of navigation in README. Please pull the latest changes at main branch into your working branch and remove it from README.

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

enhancement New feature or request

Projects

None yet

Development

Successfully merging this pull request may close these issues.

2 participants