Sensor-based trajectory deformation and docking for nonholonomic mobile robots

This video demonstrates motion planning and reactive obstacle avoidance for nonholonomic robots. A mobile robot with a trailer is asked to park into a U-shaped obstacle. Motion planning is performed by a visibility-based PRM algorithm using a flatness-based steering method built on convex combinations of canonical curves. The planned trajectory is then followed by the robot while detecting obstacles using a laser scanner. The current trajectory is locally deformed in order to avoid obstacles and to end at the detected U-shaped obstacle.