iPlanner: Imperative Path Planning
Authors:
- Fan YangFYFan Yang
- Chen WangCWChen Wang
- Cesar CadenaCCCesar Cadena
- Marco HutterMHMarco Hutter
Preprint
Abstract
The problem of path planning has been studied for years. Classic planning pipelines, including perception, mapping, and path searching, can result in latency and compounding errors between modules. While recent studies have demonstrated the effectiveness of end-to-end learning methods in achieving high planning efficiency, these methods often struggle to match the generalization abilities of classic approaches in handling different environments. Moreover, end-to-end training of policies often requires a large number of labeled data or training iterations to reach convergence. In this paper, we present a novel Imperative Learning (IL) approach. This approach leverages a differentiable cost map to provide implicit supervision during policy training, eliminating the need for demonstrations or labeled trajectories. Furthermore, the policy training adopts a Bi-Level Optimization (BLO) process, which combines network update and metric-based trajectory optimization, to generate a smooth and collision-free path toward the goal based on a single depth measurement. The proposed method allows task-level costs of predicted trajectories to be backpropagated through all components to update the network through direct gradient descent. In our experiments, the method demonstrates around 4x faster planning than the classic approach and robustness against localization noise. Additionally, the IL approach enables the planner to generalize to various unseen environments, resulting in an overall 26-87% improvement in SPL performance compared to baseline learning methods.Keywords
All Related Versions
This publication has 8 references indexed in Scilit:
- GNM: A General Navigation Model to Drive Any Robot2023
- Learning Forward Dynamics Model and Informed Trajectory Sampler for Safe Quadruped Navigation2022
- Investigating Bi-Level Optimization for Learning and Vision From a Unified Perspective: A Survey and BeyondIEEE Transactions on Pattern Analysis and Machine Intelligence, 2021
- Learning high-speed flight in the wildScience Robotics, 2021
- BADGR: An Autonomous Self-Supervised Learning-Based Navigation SystemIEEE Robotics and Automation Letters, 2021
- Falco: Fast likelihood‐based collision avoidance with extension to human‐guided navigationJournal of Field Robotics, 2020
- End-to-End Navigation Strategy With Deep Reinforcement Learning for Mobile RobotsIEEE Transactions on Industrial Informatics, 2019
- Reinforced Imitation: Sample Efficient Deep Reinforcement Learning for Mapless Navigation by Leveraging Prior DemonstrationsIEEE Robotics and Automation Letters, 2018