System.ArgumentOutOfRangeException: 索引和长度必须引用该字符串内的位置。 参数名: length 在 System.String.Substring(Int32 startIndex, Int32 length) 在 zhuanliShow.Bind() AGV避障方法、装置、计算机设备及可读存储介质制造方法及图纸_技高网

AGV避障方法、装置、计算机设备及可读存储介质制造方法及图纸

技术编号:41128304 阅读:21 留言:0更新日期:2024-04-30 17:56
本发明专利技术公开了一种AGV避障方法、装置、计算机设备及可读存储介质。方法包括:设置机器人的安全防区,通过极坐标系方程表示安全防区的防区边界,对防区边界进行离散化得到离散边界;查找激光数据对应的离散边界,根据激光数据对应的离散边界确定障碍物所在的安全防区;若在避障区或减速区,则利用主动避障算法基于SL坐标系和三角函数曲线生成多条避障采样曲线;剔除错误避障曲线得到正确避障曲线,通过预设代价函数评估各正确避障曲线得到多个对应的代价值,将最小的代价值对应的正确避障曲线作为目标避障路径。本申请使得AGV可以高效检测出障碍物,并生成成本最低的路线主动绕障,提高了运输效率,提升AGV的灵活性和安全性。

【技术实现步骤摘要】

本专利技术涉及机器人,尤其涉及一种agv避障方法、装置、计算机设备及可读存储介质。


技术介绍

1、自动导引运输车(automated guided vehicle,agv)是装备有电磁或光学等自动导引装置,以充电电池为动力的无人驾驶自动运输车辆,能够沿规定的导引路径实现自动化运输。当前激光agv的行驶路径规划是通过读取预先绘制的地图软件路径完成,但agv在指定路径行驶过程中,可能遭遇临时摆放的障碍物、人为越界进入行驶路径、与其他agv发生路径冲突等问题。为了解决上述问题,过去常采取的方法是agv通过自身的避障传感器检测后原地停止,待障碍物移出检测区域后继续行驶。然而,如果障碍物无法及时移除,agv将一直停止在原地,无法继续通过该路径。这不仅会影响整个工序的进行节奏,还会破坏自动化生产流程的连贯性。

2、目前主流的agv系统通常需要强大的计算能力来处理大量的传感器数据、进行复杂的路径规划和决策,这导致了系统的高能耗和高昂的成本。此外,由于agv系统的算力限制,其在处理大规模任务和应对复杂环境时面临着诸多挑战。例如,在高密度存储和输送系统中,agv需要实时感知和响应周围环境的变化,以实现高效的货物搬运和管理。然而由于算力不足,agv往往无法快速准确地识别和处理大量的传感器数据,导致系统性能下降甚至发生错误操作。


技术实现思路

1、有鉴于此,本专利技术的目的是为了克服现有技术中的不足,提供一种agv避障方法、装置、计算机设备及可读存储介质。

2、本专利技术提供如下技术方案:

3、第一方面,本公开实施例中提供了一种agv避障方法,所述方法包括:

4、设置机器人的安全防区,通过极坐标系方程表示所述安全防区的防区边界,并依据激光雷达分辨率对所述防区边界进行离散化,得到离散边界,其中,所述安全防区包括避障区、减速区与急停区;

5、获取激光数据,通过索引查找所述激光数据对应的离散边界,根据所述激光数据对应的离散边界确定障碍物所在的安全防区;

6、若所述障碍物所在的安全防区为所述避障区或所述减速区,则利用主动避障算法基于sl坐标系和三角函数曲线生成多条避障采样曲线;

7、剔除各所述避障采样曲线中与所述障碍物碰撞的错误避障曲线,得到多条正确避障曲线,通过预设代价函数评估各所述正确避障曲线,得到多个对应的代价值,将最小的代价值对应的正确避障曲线作为目标避障路径。

8、进一步地,所述依据激光雷达分辨率对所述防区边界进行离散化,得到离散边界,包括:

9、f(ρi,θi)=0,θi=i×resolution,其中,i=1,2,…,n

10、式中,ρi为所述离散边界,θi为离散极角,resolution为所述激光雷达分辨率,n为离散总数,n=360/resolution。

11、进一步地,所述若所述障碍物的所在防区为所述避障区或所述减速区之前,还包括:

12、若所述障碍物所在的安全防区为所述急停区,则控制所述机器人停止运行;

13、若各所述安全防区内未检测到所述障碍物,则控制所述机器人按照预设速度运行。

14、进一步地,所述若所述障碍物所在的安全防区为所述避障区或所述减速区之后,还包括:

15、判断所述障碍物所在的安全防区是否为所述减速区;

16、若所述障碍物所在的安全防区为所述避障区,则控制所述机器人按照规划速度运行;

17、若所述障碍物所在的安全防区为所述减速区,则控制所述机器人降低所述规划速度。

18、进一步地,所述避障采样曲线包括离散纵向位置曲线与成离散横向位置曲线,所述利用主动避障算法基于sl坐标系和三角函数曲线生成多条避障采样曲线,包括:

19、利用所述主动避障算法基于所述sl坐标系,生成多个采样终点;

20、获取采样起点,并根据所述采样起点、所述采样终点与所述三角函数曲线,生成所述离散纵向位置曲线与所述成离散横向位置曲线。

21、进一步地,所述离散纵向位置曲线为:

22、si=si-1+vreftsample,i=1,2,…,n,n=tplan/tsample

23、式中,tsample为采样时间,si为i×tsample时刻所述机器人的纵向位置,si-1为(i-1)×tsample时刻所述机器人的纵向位置,vref为所述机器人的参考速度,tplan为规划时间,n为所述规划时间内的离散总数;

24、所述离散横向位置曲线为:

25、

26、式中,li为i×tsample时刻所述机器人的横向位置,l0为所述采样起点的横向位置,lfinal为所述采样终点的横向位置,s0为所述采样起点的纵向位置,sfinal为所述采样终点的纵向位置。

27、进一步地,所述预设代价函数为:

28、

29、式中,cost为代价值,wl为横向位移权重,wdl为横向速度权重,wddl为横向加速度权重,ws为纵向位移权重,为横向速度,为横向加速度,wjerk为纵向加速度权重,为纵向加速度,为纵向速度。

30、第二方面,本公开实施例中提供了一种agv避障装置,所述装置包括:

31、离散模块,用于设置机器人的安全防区,通过极坐标系方程表示所述安全防区的防区边界,并依据激光雷达分辨率对所述防区边界进行离散化,得到离散边界,其中,所述安全防区包括避障区、减速区与急停区;

32、确定模块,用于获取激光数据,通过索引查找所述激光数据对应的离散边界,根据所述激光数据对应的离散边界确定障碍物所在的安全防区;

33、生成模块,用于若所述障碍物所在的安全防区为所述避障区或所述减速区,则利用主动避障算法基于sl坐标系和三角函数曲线生成多条避障采样曲线;

34、评估模块,用于剔除各所述避障采样曲线中与所述障碍物碰撞的错误避障曲线,得到多条正确避障曲线,通过预设代价函数评估各所述正确避障曲线,得到多个对应的代价值,将最小的代价值对应的正确避障曲线作为目标避障路径。

35、第三方面,本公开实施例中提供了一种计算机设备,所述计算机设备包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现第一方面中所述的agv避障方法的步骤。

36、第四方面,本公开实施例中提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现第一方面中所述的agv避障方法的步骤。

37、本申请的有益效果:

38、本申请实施例提供的agv避障方法,方法包括:设置机器人的安全防区,通过极坐标系方程表示所述安全防区的防区边界,并依据激光雷达分辨率对所述防区边界进行离散化,得到离散边界,其中,所述安全防区包括避障区、减速区与急停区;获取激光数据,通过索引查找所述激光数据对应的离散边界,根据所述激光数据对应的离散边界确定本文档来自技高网...

【技术保护点】

1.一种AGV避障方法,其特征在于,所述方法包括:

2.根据权利要求1所述的AGV避障方法,其特征在于,所述依据激光雷达分辨率对所述防区边界进行离散化,得到离散边界,包括:

3.根据权利要求1所述的AGV避障方法,其特征在于,所述若所述障碍物的所在防区为所述避障区或所述减速区之前,还包括:

4.根据权利要求1所述的AGV避障方法,其特征在于,所述若所述障碍物所在的安全防区为所述避障区或所述减速区之后,还包括:

5.根据权利要求4所述的AGV避障方法,其特征在于,所述避障采样曲线包括离散纵向位置曲线与成离散横向位置曲线,所述利用主动避障算法基于SL坐标系和三角函数曲线生成多条避障采样曲线,包括:

6.根据权利要求5所述的AGV避障方法,其特征在于,所述离散纵向位置曲线为:

7.根据权利要求6所述的AGV避障方法,其特征在于,所述预设代价函数为:

8.一种AGV避障装置,其特征在于,所述装置包括:

9.一种计算机设备,其特征在于,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现权利要求1-7中任一项所述的AGV避障方法的步骤。

10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现权利要求1-7中任一项所述的AGV避障方法的步骤。

...

【技术特征摘要】

1.一种agv避障方法,其特征在于,所述方法包括:

2.根据权利要求1所述的agv避障方法,其特征在于,所述依据激光雷达分辨率对所述防区边界进行离散化,得到离散边界,包括:

3.根据权利要求1所述的agv避障方法,其特征在于,所述若所述障碍物的所在防区为所述避障区或所述减速区之前,还包括:

4.根据权利要求1所述的agv避障方法,其特征在于,所述若所述障碍物所在的安全防区为所述避障区或所述减速区之后,还包括:

5.根据权利要求4所述的agv避障方法,其特征在于,所述避障采样曲线包括离散纵向位置曲线与成离散横向位置曲线,所述利用主动避障算法基于sl坐标系和三角函数曲线生...

【专利技术属性】
技术研发人员:高大伟许义恒刘晓飞李昱峰
申请(专利权)人:浙江欣奕华智能科技有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1