公开/公告号CN112799385A
专利类型发明专利
公开/公告日2021-05-14
原文格式PDF
申请/专利权人 中国科学院沈阳自动化研究所;
申请/专利号CN201911020315.1
申请日2019-10-25
分类号G05D1/02(20200101);
代理机构21002 沈阳科苑专利商标代理有限公司;
代理人王倩
地址 110016 辽宁省沈阳市沈河区南塔街114号
入库时间 2023-06-19 11:00:24
技术领域
本发明属于路径规划领域,特别涉及一种基于人工势场的路径规划,利用自适应域场和域引导场方法。
背景技术
随着智能体和人工智能理论的不断发展,自主式移动智能体技术日益成熟,并且在工业、军事、医疗、服务等诸多领域得到广泛应用。与此同时,智能体所面临的任务也愈加复杂,所处环境由原来的单一智能体、确定性环境转变为多智能体、不确定环境。因此,近年来对复杂系统中智能体自主智能控制技术的研究得到了学术界和工业界的广泛关注,而路径规划及导航作为其中的关键性技术成为了目前智能体学的研究热点之一。
目前路径规划技术包括两大类:基于确定环境的全局规划和基于传感探测信息的局部规划。前者是在静态已知的环境中进行路径规划,又称静态路径规划方法,目前应用比较多的方法有:贪心算法,Dijkstra算法及A*算法;后者针对环境信息未知的情况,需要根据传感器输入的环境信息实时地进行路径规划,主流的方法有人工势场法,神经网络法,模糊逻辑法等。
人工势场法是一种虚拟力场法,其将智能体在环境中的运动虚拟为一种在人工力场的运动,目标点产生引力,障碍物产生斥力,引力和斥力的合力控制机器人的运动。机器人的运动同时受引力和斥力的控制。该算法因其数学分析简单、计算量小、路径光滑等优点被广泛应用在实时避障和路径规划领域。
发明内容
本发明提出域-人工势场法解决多目标点任务中局部稳定点问题。首先加入小范围强作用力的域势场,帮助机器人在陷入局部稳定点时通过域场逃离局部稳定点。其次为了域场范围难以确定的问题,进一步提出根据地图情况自动调整域场的大小的自适应域-人工势场法,解决不同地图情况局部稳定点的问题。最后加入域引导势场,对启发点进行域势场传递,解决复杂障碍下的局部稳定点问题。自适应域-人工势场法和域引导势场可以起到解决多目标点和复杂障碍物局部稳定点问题的作用,加强机器人工作效率。
本发明为实现上述目的所采用的技术方案是:
一种基于引导域人工势场的智能体路径规划方法,包括以下步骤:
步骤一:构建人工势场,人工势场由引力势场和斥力势场叠加而成;目标点对智能体提供引力,形成引力势场;障碍物对智能体提供斥力,形成斥力势场;
步骤二:在势场中加入自适应,使智能体在域场自适应中寻找目标点;
步骤三:针对障碍物的智能体算法优化,加入域引导势场,对智能体进行域势场传递,寻找目标点。
所述步骤一中势场的构建过程为:
1)根据障碍物与目标点的位置,分别构建障碍物和目标点的引力场,其中引力场如下:
其中U
2)构建障碍物的斥力场
其中U
还包括针对局部稳定点情况,构建域势场
其中U
所述步骤二中在势场中加入自适应,过程为:
1)设定初始域即范围场的范围值;
2)加大智能体的目标点域的范围值,直到智能体跳出局部稳定点;
3)当智能体达到某个预设的目标点后,重置所有目标点域的范围场。
所述步骤三的步骤为:
a)找到距离目标点最近的临近障碍物的位置p作为原始启发点,将p加入启发点列表L,记录p的域势场;
b)扫描p的邻域,找到所有未被扫描过的临近障碍物的位置加入到启发点列表中;
c)每次从启发点列表中取出一个启发点,通过步骤a)扫描该启发点,并将该启发点的位置加入引导势场,所述引导势场为衰减率与域势场的乘积,随着步骤a)的进行减小,最后将该点移出启发点列表;
d)迭代进行步骤b)和c),直到启发点列表中为空,返回势场;
e)智能体根据返回的势场向身边最小的势场所在位置移动。
针对局部稳定点情况,所述势场为引力场、斥力场、域势场的叠加。
所述障碍物为非凸障碍物。
本发明用于工业智能仓储机器人路径规划。
本发明具有以下有益效果及优点:
1.本发明自适应域场,在多目标点情况适应传统算法陷入局部最优的情况,自适应学习如何跳出局部稳定点;
2.在改进域场的情况下使用域引导场,帮助复杂情况的机器人跳出局部稳定点,寻找正确路径。
附图说明
图1是本发明方法的自适应域场流程框图。
具体实施方式
本发明提出域-人工势场法解决多目标点任务中局部稳定点问题。首先加入小范围强作用力的域势场,帮助机器人在陷入局部稳定点时通过域场逃离局部稳定点。其次为了域场范围难以确定的问题,进一步提出根据地图情况自动调整域场的大小的自适应域-人工势场法,解决不同地图情况局部稳定点的问题。最后加入域引导势场,对启发点进行域势场传递,解决复杂障碍下的局部稳定点问题。自适应域-人工势场法和域引导势场可以起到解决多目标点和复杂障碍物局部稳定点问题的作用,加强机器人工作效率。
实施例:
智能仓储机器人采用智能操作系统,通过系统指令,将所需货架移动到操作人员面前以供拣选,实现“货找人,货架找人”的新型模式:通过先进的自动称重拍照、多层传送、交叉式分拣等系统,可以实现生产力翻番。智能仓储机器人同时具有稳定、灵活、高效、智能的特点。依靠无线网络连接,设有雷达扫描,自动寻找、定位,自动充电,可以24小时不间断工作,利用大数据分析,智能适配各种仓储模式。
智能仓储机器人的使用有利于降低物流分拣搬运的成本,减少人员的投入,改善物流管理,降低货物搬运损伤的概率,可提高现代物流的分拣效率,促进物流行业的发展。加强智能仓储机器人面对不同障碍物时的鲁棒性很有价值。
接下来结合具体过程对本发明的实施步骤进行详细地阐述:
如图1所示,一种基于人工势场的智能仓储机器人路径规划方法,主要采用基于自适应域场与域引导势场的人工势场的路径规划方法,步骤如下:
步骤一:构建改进的人工势场,在环境中构建虚拟的势场,势场由两种势场叠加而成,目标点对智能仓储机器人提供引力,形成引力势场;障碍物则提供斥力,形成斥力势场。在势场合力的驱动下,智能仓储机器人沿无碰路径到达目标点。
步骤二:在势场中加入自适应,智能仓储机器人陷入局部稳定点保持静止后开始域场自适应,不断提高域场范围,寻找目标点。
步骤三:针对非凸障碍物的智能仓储机器人算法优化,加入域引导势场,对启发点进行域势场传递,解决复杂障碍下的局部稳定点问题。
步骤一所述的势场构建过程如下:
1)根据障碍物与目标点的位置,分别构建障碍物和目标点的引力场,其中引力场如下:
其中U
2)构建障碍物的斥力场
其中U
3)针对多目标点的局部稳定点情况,构建小范围强作用力的域势场
其中U
步骤二所述的域场自适应:
1)首先设定初始域的范围值
2)加大目标点域即当前时刻的下一时刻的域的范围值。直到机器人跳出局部稳定点为止。
3)为了防止域的范围值过大,当机器人达到某个目标点后,重置所有目标点域的范围值。
步骤三所述的针对非凸障碍物的智能仓储机器人算法优化:
a)找到距离目标点最近的临近障碍物(最接近障碍物的像素)的位置p作为原始启发点,将p加入启发点列表L,记录p的域势场。
b)扫描p周围位置,找到所有未被扫描过的临近障碍物的位置加入到启发点列表中。
c)每次从启发点列表中取出一个启发点,使用步骤a)扫描该启发点,并将该启发点的位置加入引导势场,所述引导势场为衰减率与域势场的乘积,随着算法的进行减小。最后将该点移出启发点列表。
d)迭代进行步骤b)和c),直到启发点列表中为空,返回势场。
e)机器人根据返回的势场不断移动向身边最小的势场所在位置移动。
上述实施例用来解释说明本发明,而不是对本发明进行限制,在本发明的精神和权利要求的保护范围内,对本发明做出的任何修改和改变,都落入本发明的保护范围。
机译: 基于障碍分类的人工势场路径规划方法和医用系统转向柔性针
机译: 一种产生Trib-2mut重组弹性体结构域的方法,一种基因工程构建体pGDTrib2mut,确定大肠杆菌细胞中Trib-2mut的生物合成,一种产生大肠杆菌M15 / pGDTrib2mut的菌株以及一种基于聚合物的聚合物材料的制备方法在这种蛋白质上
机译: 一种基于指针的对象获取方法,用于对计算机系统的信息进行有形处理,该方法基于一种自然语言,并且该机器人或机器人的人工智能系统对该计算机系统的接收信号作出反应,该计算机系统具有相应的关联机器人或机器人的人工智能,该机器人或机器人的人工智能计算机系统的相应思想得到证实