赞
踩
C++库:https://github.com/longjianquan/reeds_shepp
从ompl里提取。
在主函数里面:r->reedsShepp(q0,q1).length_[i]每段路径的大小(正为前,负为后)
RStypes=r->xingshentype(q0,q1);RS曲线类型。