Kinodynamic Motion Planning: Connecting Exploration Trees using Trajectory Optimization Methods. - Florent Lamiraux; Etienne Ferre; Erwan Vallee (ICRA, 2004)