欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2019114110620
申请人: 湖南大学
专利类型:发明专利
专利状态:未下证
专利领域: 控制;调节
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种基于图搜索和几何曲线融合的路径规划方法,其特征在于:包括如下步骤:步骤1:得到地图信息,确定车辆的起始点和目标点;

步骤2:通过Hybrid A*算法对节点进行拓展,得到新的节点及其状态信息;

步骤3:判断新节点在直行状态下,是否能与目标点所在射线相交,若能,则进行步骤4;

若不能,则计算该节点的f、h和g值,并将该节点放入Open集中,进行步骤5;

步骤4:判断新节点能否通过几何曲线路径到达目标点,若不能,则计算该节点的ΔL值,并将该节点放入ProState集合中,进行步骤5;若能,则采用几何路径到达目标点,并进行路径回溯;

步骤5:判断ProState集合是否为空集,若不为空集,则从ProState集合中挑出最佳节点,返回步骤2;若ProState集合为空集,则从Open中挑出最佳节点,返回步骤2。

2.根据权利要求1所述的基于图搜索和几何曲线融合的路径规划方法,其特征在于:所述步骤2用Hybrid A*算法对节点进行拓展的具体步骤如下:步骤21,记当前节点状态为:(x_current,y_current,〖heading〗_current,x_discurrent,y_discurrent),其中,x_current为当前状态的横坐标,y_current为当前状态的纵坐标,〖heading〗_current为当前状态的横摆角;

步骤22,记车辆最大转向角为α_max,则车辆可用转向角为:α=(-α_max,-α_max/2,0,α_max/2,α_max);

令车辆轴距为L_x,每次拓展路径即:车辆以固定转向角前行,直至与当前点之间的距离为L时,所行驶过的路径,则得到新节点状态:(xnew,ynew,headingnew,xdisnew,ydisnew)的公式为得到新节点的状态信息后,计算新节点与障碍物之间的距离是否大于安全距离。若小于安全距离,则放弃节点,不对该节点做任何处理。

3.根据权利要求1或2所述的基于图搜索和几何曲线融合的路径规划方法,其特征在于:所述步骤3中,判断新节点在直行状态下,是否能与目标点所在射线相交具体步骤如下:步骤31,记目标点的状态为(xgoal,ygoal,headinggoal,xdisgoal,ydisgoal),则射线方程为:y=tan(headinggoal)x-tan(headinggoal)xgoal+ygoal;

其中,x的取值范围是:

新节点所在直线方程为:

y=tan(headingnewl)x-tan(headingnew)xnew+ynew;

通过求解方程,即可确定新节点在直行状态下是否能与目标点所在射线相交。

4.根据权利要求3所述的基于图搜索和几何曲线融合的路径规划方法,其特征在于:所述步骤3中,计算该节点的f、h和g值的计算公式如下:f=g+h;

其中,g为新节点路径回溯至起始点的路径长度值。

5.根据权利要求4所述的基于图搜索和几何曲线融合的路径规划方法,其特征在于:所述步骤3中,节点放入Open集中具体过程为:步骤31,检测新节点的离散坐标与Open中已存在节点的离散坐标是否发生重合;若未发生重合,则将该节点放入Open集中;若发生重合,则比较两个节点的g值大小;若新节点的g值较小,则将新节点代替旧节点放入Open中;若新节点的g值较大,则放弃新节点,不对该节点做任何处理。

6.根据权利要求1或2所述的基于图搜索和几何曲线融合的路径规划方法,其特征在于:所述步骤4中,规划几何曲线路径分两种情况,分别是直线圆弧路径和圆弧直线路径,具体规划步骤如下:步骤41,直线圆弧路径情况为:若B点到目标点goal的距离L1小于新节点new到B点的距离L2,则几何路径为:车辆从新节点位置向前直行一段长度为L2-L1的线段至C点,然后朝目标方向转动方向盘,以R为转向半径,行驶一段弧度为θ1的圆弧至目标点;

其中,R和θ1计算公式为:

R=Ltanβ3;

θ1=π-2β3;

L=L1;

圆弧直线路径情况为:若B点到目标点goal的距离L1大于新节点new到B点的距离L2,则几何路径为:车辆从新节点位置朝目标方向转动方向盘,以R为转向半径,行驶一段弧度为θ1的圆弧直至与目标射线相切于C点,然后向前直行一段长度为L2-L1的线段至目标点goal;

其中,R和θ1计算公式为:

R=Ltanβ3;

θ1=π-2β3;

L=L1;

步骤42,确认几何路径后,若该路径与障碍物之间的距离大于安全距离,则可采用该路径到达目标点,否则放弃该节点,不对该节点做任何处理。

7.根据权利要求6所述的基于图搜索和几何曲线融合的路径规划方法,其特征在于:所述步骤4中,判断新节点能否通过几何路径到达目标点的具体过程为:步骤43,记新节点直行状态下,与目标射线的交点为B,B点与目标点之间的距离为L1,当且仅当L1满足下面公式,且规划出的路径与障碍物的距离大于安全距离时,新节点才能通过几何路径达到目标点,公式如下:L1≥dmin;

其中,dmin的计算公式为:

β1=headingnew;

β2=π-headinggoal。

8.根据权利要求1或2所述的基于图搜索和几何曲线融合的路径规划方法,其特征在于:所述步骤5中,从ProState集合中挑出最佳节点的具体过程为:从ProState集合中挑出ΔL值最小的节点,当作最佳节点。

9.根据权利要求8所述的基于图搜索和几何曲线融合的路径规划方法,其特征在于:从Open中挑出最佳节点的具体过程为:从Open中挑出f值最小的节点,当作最佳节点。