Convex feasible set algorithm for constrained trajectory smoothing
Motion planning for autonomous driving with a conformal spatiotemporal lattice