“…And this trajectory must consider the vehicle dynamics, its maneuver capabilities in the presence of obstacles, along with road boundaries and traffic rules [ 13 ]. For the motion planning of autonomous on-road driving, existing planning methods originate primarily from the field of mobile robotics [ 13 ], and they have been subsequently applied to different on-rod and off-road vehicles and operational environments [ 14 , 15 , 16 , 17 ]. Over the past decade, numerous motion planning algorithms (e.g., potential-field methods, grid-based methods, sampling-based methods) have been proposed in the robotics literature [ 1 , 2 , 3 , 4 , 5 , 6 , 10 , 11 , 12 ].…”