https://es.mathworks.com/help/nav/ref/trajectoryoptimalfrenet.html
trajectoryOptimalFrenet - Find optimal trajectory along reference path - MATLAB
The trajectoryOptimalFrenet object is a path planner which samples and evaluates local trajectories based on a reference path.
findoptimaltrajectoryalongreference