/parallel_parking

R Gator Parallel Parking

Primary LanguageC++

parallel_parking

R Gator Parallel Parking

  1. Perception: Reimplemented the PointPillars algorithm on real vehicles to detect objects by pytorch, getting the goal position of parallel parking. Generated the grid map as the configuration space for planning. For this part, you can find more details from here: Reimplement-PointPillar
  2. Planning: Generated the path of parallel parking by hybrid A*. Added vehicle steering constraints, and penalties for turning, steering, and reversing. Combined the reeds shepp path and A* algorithm without obstacle as the heuristic part. Smoothed the path by the cost of curvature, smoothness, and obstacle.

Result

Simulation TEST

Vehicle Test

Simulation Test