Title
Toward asymptotically optimal motion planning for kinodynamic systems using a two-point boundary value problem solver
Abstract
We present an approach for asymptotically optimal motion planning for kinodynamic systems with arbitrary nonlinear dynamics amid obstacles. Optimal sampling-based planners like RRT*, FMT*, and BIT* when applied to kinodynamic systems require solving a two-point boundary value problem (BVP) to perform exact connections between nodes in the tree. Two-point BVPs are non-trivial to solve, hence the prevalence of alternative approaches that focus on specific instances of kinodynamic systems, use approximate solutions to the two-point BVP, or use random propagation of controls. In this work, we explore the feasibility of exploiting recent advances in numerical optimal control and optimization to solve these two-point BVPs for arbitrary kinodynamic systems and how they can be integrated with existing optimal planning algorithms. We combine BIT* with a two-point BVP solver that uses sequential quadratic programming (SQP). We consider the problem of computing minimum-time trajectories. Since the duration of trajectories is not known a-priori, we include the time-step as part of the optimization to allow SQP to optimize over the duration of the trajectory while keeping the number of discrete steps fixed for every connection attempted. Our experiments indicate that using a two-point BVP solver in the inner-loop of BIT* is competitive with the state-of-the-art in sampling-based optimal planning that explicitly avoids the use of two-point BVP solvers.
Year
DOI
Venue
2015
10.1109/ICRA.2015.7139776
IEEE International Conference on Robotics and Automation
Keywords
Field
DocType
asymptotic stability,boundary-value problems,mobile robots,nonlinear dynamical systems,optimal control,path planning,quadratic programming,trajectory control,BVP,SQP,asymptotically optimal motion planning,boundary value problem solver,holonomic robot,kinodynamic system,nonlinear dynamics,sequential quadratic programming,trajectory duration optimization
Motion planning,Boundary value problem,Kinodynamic planning,Mathematical optimization,Nonlinear system,Optimal control,Control theory,Control engineering,Solver,Sequential quadratic programming,Asymptotically optimal algorithm,Mathematics
Conference
Volume
Issue
ISSN
2015
1
1050-4729
Citations 
PageRank 
References 
7
0.51
16
Authors
4
Name
Order
Citations
PageRank
Christopher Xie1223.84
Jur van den Berg2197793.23
Sachin Patil376437.93
Pieter Abbeel46363376.48