C++库：https://github.com/longjianquan/reeds_shepp
从ompl里提取。
在主函数里面：r->reedsShepp(q0,q1).length_[i]每段路径的大小（正为前，负为后）
RStypes=r->xingshentype(q0,q1);RS曲线类型。
C++库：https://github.com/longjianquan/reeds_shepp
从ompl里提取。
在主函数里面：r->reedsShepp(q0,q1).length_[i]每段路径的大小（正为前，负为后）
RStypes=r->xingshentype(q0,q1);RS曲线类型。
道可道，非常道；名可名，非常名。 无名，天地之始，有名，万物之母。 故常无欲，以观其妙，常有欲，以观其徼。 此两者，同出而异名，同谓之玄，玄之又玄，众妙之门。