Enhancing Lattice-based Motion Planning with Introspective Learning and Reasoning
Authors:
- Mattias TigerMTMattias Tiger
- David BergströmDBDavid Bergström
- Andreas NorrstigANAndreas Norrstig
- Fredrik HeintzFHFredrik Heintz
Preprint
Abstract
Lattice-based motion planning is a hybrid planning method where a plan made up of discrete actions simultaneously is a physically feasible trajectory. The planning takes both discrete and continuous aspects into account, for example action pre-conditions and collision-free action-duration in the configuration space. Safe motion planing rely on well-calibrated safety-margins for collision checking. The trajectory tracking controller must further be able to reliably execute the motions within this safety margin for the execution to be safe. In this work we are concerned with introspective learning and reasoning about controller performance over time. Normal controller execution of the different actions is learned using reliable and uncertainty-aware machine learning techniques. By correcting for execution bias we manage to substantially reduce the safety margin of motion actions. Reasoning takes place to both verify that the learned models stays safe and to improve collision checking effectiveness in the motion planner by the use of more accurate execution predictions with a smaller safety margin. The presented approach allows for explicit awareness of controller performance under normal circumstances, and timely detection of incorrect performance in abnormal circumstances. Evaluation is made on the nonlinear dynamics of a quadcopter in 3D using simulation. Video: https://youtu.be/STmZduvSUMMKeywords
All Related Versions
This publication has 10 references indexed in Scilit:
- Incremental reasoning in probabilistic Signal Temporal LogicInternational Journal of Approximate Reasoning, 2020
- A path planning and path‐following control framework for a general 2‐trailer with a car‐like tractorJournal of Field Robotics, 2019
- Robust and Efficient Quadrotor Trajectory Generation for Fast Autonomous FlightIEEE Robotics and Automation Letters, 2019
- Motion planning under uncertainty in graduated fidelity latticesRobotics and Autonomous Systems, 2018
- A Review of Motion Planning Techniques for Automated VehiclesIEEE Transactions on Intelligent Transportation Systems, 2015
- Real-time motion planning methods for autonomous on-road driving: State-of-the-art and future research directionsTransportation Research Part C: Emerging Technologies, 2015
- ACADO toolkit—An open‐source framework for automatic control and dynamic optimizationOptimal Control Applications and Methods, 2011
- Differentially constrained mobile robot motion planning in state latticesJournal of Field Robotics, 2009
- On Motion Planning in Changing, Partially Predictable EnvironmentsThe International Journal of Robotics Research, 1997
- Kinodynamic motion planningJournal of the ACM, 1993