Efficient and Asymptotically Optimal Kinodynamic Motion Planning