Hierarchical Motion Planning for Autonomous Vehicles in Unstructured Dynamic Environments
- 9 December 2022
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Robotics and Automation Letters
- Vol. 8 (2) , 496-503
Abstract
This letter presents a hierarchical motion planner for generating smooth and feasible trajectories for autonomous vehicles in unstructured environments with static and moving obstacles. The framework enables real-time computation by progressively shrinking the solution space. First, a graph searcher based on combined heuristic and partial motion planning is proposed for finding coarse trajectories in spatiotemporal space. To enable fast online planning, a time interval-based algorithm that considers obstacle prediction trajectories is proposed, which uses line segment intersection detection to check for collisions. Second, to practically smooth the coarse trajectory, a continuous optimizer is implemented in three layers, corresponding to the whole path, the near-future path and the speed profile. We use discrete points to represent the far-future path and parametric curves to represent the near-future path and the whole speed profile. The approach is validated in both simulations and real-world off-road environments based on representative scenarios, including the “wait and go” scenario. The experimental results show that the proposed method improves the success rate and travel efficiency while actively avoiding static and moving obstacles.Keywords
Funding Information
- National Key Research and Development Program of China (2016YFB0100903)
This publication has 30 references indexed in Scilit:
- A survey of robotic motion planning in dynamic environmentsRobotics and Autonomous Systems, 2018
- Speed profile planning in dynamic environments via temporal optimization2017
- A Survey of Motion Planning and Control Techniques for Self-Driving Urban VehiclesIEEE Transactions on Intelligent Vehicles, 2016
- A Review of Motion Planning Techniques for Automated VehiclesIEEE Transactions on Intelligent Transportation Systems, 2015
- A practical trajectory planning framework for autonomous ground vehicles driving in urban environments2015
- Path Planning for Autonomous Vehicles in Unknown Semi-structured EnvironmentsThe International Journal of Robotics Research, 2010
- Planning Long Dynamically Feasible Maneuvers for Autonomous VehiclesThe International Journal of Robotics Research, 2009
- Crowds by ExampleComputer Graphics Forum, 2007
- Optimal Rough Terrain Trajectory Generation for Wheeled Mobile RobotsThe International Journal of Robotics Research, 2007
- Motion Planning in Dynamic Environments Using Velocity ObstaclesThe International Journal of Robotics Research, 1998