1: \begin{abstract}

2: 	Motion planning for robotic systems with complex dynamics is a challenging problem.

3: 	While recent sampling-based algorithms achieve asymptotic optimality by propagating random control inputs, their empirical convergence rate is often poor, especially in high-dimensional systems such as multirotors.

4: 	An alternative approach is to first plan with a simplified geometric model and then use trajectory optimization to follow the reference path while accounting for the true dynamics.

5: 	However, this approach

6: 	may fail to produce a valid trajectory if the initial guess is not close to a dynamically feasible trajectory.

7: 	In this paper, we present Iterative Discontinuity Bounded A* (iDb-A*), a novel kinodynamic motion planner that combines search and optimization iteratively.

8: 	The search step utilizes a finite set of short trajectories (motion primitives) that are interconnected while allowing for a bounded discontinuity between them.

9: 	The optimization step locally repairs the discontinuities with trajectory optimization.

10: 	By progressively reducing the allowed discontinuity and incorporating more motion primitives, our algorithm achieves asymptotic optimality with excellent any-time performance.

11: 	We provide a benchmark of 43 problems across eight different dynamical systems, including different versions of unicycles and multirotors.

12: 	Compared to state-of-the-art methods, iDb-A* consistently solves more problem instances and finds lower-cost solutions more rapidly.

13: \end{abstract}

14: