https://123dok.org/document/oy8oek5q-sampling-optimal-trajectory-planner-differentially-vehicles-constrained-dynamics.html