Matlab实现Optimal Trajectory Generation for Dynamic Street Scenarios in a Frenet Frame论文的方法，具体网站https://blog.csdn.net/caokaifa/article/details/108015374