欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2013102468986
申请人: 华南农业大学
专利类型:发明专利
专利状态:已下证
专利领域: 测量;测试
更新日期:2024-01-05
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种基于弧线路径生成的自主车辆避障方法,其特征在于,包括下述步骤:

S1、通过定位系统得到任意时刻车辆的位置;

S2、根据车辆上探测传感器的测量信息,在探测传感器探测范围内设计了两个虚拟触角,分别是位于车辆正前方中间的两个矩形虚拟触角Drecb(L×Wb)和Drecs(L×Ws),L代表虚拟触角长度,Wb代表较大的虚拟触角的宽度,Ws代表较小的虚拟触角的宽度,其中Wb>Ws;

车身所在区域用矩形DR(Lr×Wr)表示,Lr代表车身长度,Wr代表车身宽度,探测传感器安装在车辆行驶方向的正前方获得较大有效视野,判断探测范围内特定区域内有无障碍物,如有障碍物,测量车辆与障碍物之间的距离;

S3、根据障碍物分布情况,车辆选择“趋向目标前进”或“绕障碍物行走”,实现未知环境下定目标点无碰撞导航;

所述“趋向目标前进”模式为当车辆对准目标点,且Drecs触角内没有探测到障碍物,表明在安全范围内前方道路畅通,执行直线行走,直到以下结束条件之一满足为止:a)到达目标T,即完成导航任务;

b)直线行走过程中,Drecs触角探测到障碍物,表明不可继续前进,需要绕过障碍物重新找到目标,即探测到障碍物的车体位置为相遇点,进入绕障碍物行走模式;

所述“绕障碍物行走”模式包括绕障碍物的直线行走和绕障碍物的转弯行走,其中,绕障碍物行走模式下的直线行走:一旦避开转弯结束,即执行直线行走,直到以下结束条件之一满足为止:c)直线行走过程中,Drecs触角内出现障碍物;

d)无障碍直线行走距离达到直线行走前车身质点与障碍物之间距离的一半,即直线行走距离跟车体、障碍物之间距离成正比例关系,出现以上两个结束条件之一均使机器人进入相应转弯行走,由于当前模式下的直线行走用于远离障碍物,为了再次接近障碍物,规定了直线行走结束后优先执行接近转弯,当接近转弯方向不能通行才转而执行避开转弯;

绕障碍物的转弯行走以转弯的方式远离或接近障碍物的行走方式,分别有避开转弯和接近转弯:

1)避开转弯,是指为防止与前方障碍物碰撞而转弯远离障碍物边缘的避障动作,当绕障碍物行走模式下满足以下条件之一即执行避开转弯:e)绕障碍物行走模式的首个动作;

f)接近转向时Drecs触角遇到障碍物且由“转弯路线选择机制”预测得知当前接近转向不能继续;

g)直线行走时Drecs触角遇到障碍物且由“转弯路线选择机制”预测得知接近转弯方向不可通行;

转弯过程中使用“转弯路线选择机制”更新转弯半径,并且仅用转弯方向一侧的候选路线进行预测,以减少运算,避开转弯直到如下三个结束条件之一满足为止:h)Drecb触角检测不到障碍物;

i)对准T且当前车辆位置点满足脱离条件;

g)由“转弯路线选择机制”预测得知避开转弯方向不能继续通行;

2)接近转弯,是指绕障碍物行走过程中接近被绕行障碍物的动作,绕障碍物行走模式下满足以下条件之一即触发接近转弯:k)无障碍直线行走距离达到g后;

l)直线行走时Drecs触角内出现障碍物且接近转弯方向可通行;

对于k,接近转弯以最小转弯半径执行,对于l,使用“转弯路线选择机制”确定转弯半径,在接近转弯过程中,当Drecs触角内没有障碍物时,均以最小转弯半径执行转弯;当Drecs触角内有障碍物时,则以“转弯路线选择机制”确定转弯半径执行转弯,接近转弯直到如下两个结束条件之一满足为止:m)Drecs触角遇到障碍物且由“转弯路线选择机制”预测得知接近转弯不能继续;

n)对准T且当前车辆位置点满足脱离条件;

当接近转弯时由于障碍物的阻挡,使车辆无法满足脱离条件而改变转弯方向,需要在接近转弯过程中重新定义转弯方向,改变转弯方向,使车辆按合适的方向转弯,全局转弯方向取反后继续执行接近转弯;

S4、在“绕障碍物行走”下加入转弯路线选择机制,生成多条弧线候选路线,在候选路线的各位置上根据车体的位姿模拟出车体及虚拟触角所在的区域,并根据障碍物信息确定最优避障行驶路线。

2.根据权利要求1所述的基于弧线路径生成的自主车辆避障方法,其特征在于,所述的虚拟触角是车辆导航行走决策的依据:Drecs用于感知车辆在当前位姿下直线前进的通行性,区域内存在障碍物表明车辆直线前进将会与障碍物发生正面碰撞,理论上Ws=Wr,但由于路面颠簸和传感器误差的原因造成车辆瞬时航向与理论航向不一致,可能使车辆在障碍物旁通过时碰撞到障碍物,因此设计上使Ws略大于Wr;Drecb用于感知障碍物判断障碍物边缘绕行过程中避开转弯的结束时机,Drecb和Drecs配合,用于障碍物边缘绕行过程中避开转向的实现,L根据车辆最小转弯半径设计,保证车辆能在前方无法通行情况下安全掉头。

3.根据权利要求1所述的基于弧线路径生成的自主车辆避障方法,其特征在于,步骤S3中,具体为:S31、通过定位系统得到获得车辆的出发点、目标点的位置以及初始化航向角;

S32、车辆在出发点开始进入“趋向目标前进”模式,直到Drecs触角探测到障碍物或者到达目标点结束直线前进;

S33、当Drecs触角探测到障碍物后,车辆开始进入“绕障碍物行绕行走”模式,根据虚拟触角信息决策,当脱离条件成立时,车辆结束“绕障碍物行绕行走”模式再开始“趋向目标前进”模式,如此不断重复直到车辆到达目标点,“趋向目标前进”模式转变为“绕障碍物行绕行走”模式的转折点命名为相遇点,车辆由这一点开始绕行障碍物边缘;“绕障碍物行绕行走”模式转变为“趋向目标前进”模式的转折点命名为脱离点,车辆由这一点开始结束绕行障碍物边缘。

4.根据权利要求1所述的基于弧线路径生成的自主车辆避障方法,其特征在于,步骤S4中,将多条弧线候选路线用于预测和行动指导,预测方面,各候选路线的设计符合车辆转弯特性的要求,保证车辆能跟踪此规划路线行驶,在候选路线的各位置上根据车体的位姿模拟出车体及虚拟触角所在的区域;车体区域与障碍物区域重合表示按照该路线行走到该位置,车辆将发生碰撞,虚拟触角区域与障碍物区域重合表示按照该路线行走到该位置,车辆正前方仍有障碍物,最后综合以上两种方式的计算预测候选规划路线的通行性;行动指导方面,是指根据各候选路线的预测情况,选取能使车辆最快脱离视野范围内障碍物的候选路线作为转弯路线,所述转弯路线包括转弯方向和转弯半径。

5.根据权利要求4所述的基于弧线路径生成的自主车辆避障方法,其特征在于,候选路线以车辆中心为起点延伸至车辆正前方为界的左右两个区域,各分布数条,且左右对称;第k条候选路线的转弯半径rk表示为:其中Rmin是车辆的最小转弯半径,ρ是影响因数,ρ的取值与候选路线分布状态有关,ρ越大,候选路线越往中间靠拢,两旁的候选路线显得稀疏;反之,候选路线越往中间两旁扩散,中间的候选路线显得稀疏甚至不存在;k为候选路线序号,依次为0,1,…,n-1,左右区域对称,且中间为一直线候选路线,所以n为奇数;编号小于(n-1)/2的是左区域候选路线,编号为(n-1)/2的是一条直线候选路线,大于(n-1)/2的是右区域候选路线,各候选路线长度均为最小转弯半径Rmin所成圆周长度的1/4。

6.根据权利要求5所述的基于弧线路径生成的自主车辆避障方法,其特征在于,根据位置状态,模拟构造该位置状态下车体及虚拟触角所在的区域,转弯路线选择机制就是依次计算每条候选路线上各位置点的车体、虚拟触角所占区域与障碍物区域的关系是相交还是不相交,判断哪一条候选路线能使车辆最快脱离障碍物,所述状态位置是编号k候选路线t时刻的位置状态,用Pkt表示,Pkt=[xkt,ykt,akt]T,xkt、ykt和akt分别代表在车体坐标系下模拟构造的车体的横轴、纵轴坐标和航向。