Focused Trajectory Planning for autonomous on-road driving | IEEE Conference Publication | IEEE Xplore