Toward asymptotically optimal motion planning for kinodynamic systems using a two-point boundary value problem solver.