CN111474925A - 一种非规则形状移动机器人的路径规划方法 - Google Patents
一种非规则形状移动机器人的路径规划方法 Download PDFInfo
- Publication number
- CN111474925A CN111474925A CN202010157313.3A CN202010157313A CN111474925A CN 111474925 A CN111474925 A CN 111474925A CN 202010157313 A CN202010157313 A CN 202010157313A CN 111474925 A CN111474925 A CN 111474925A
- Authority
- CN
- China
- Prior art keywords
- robot
- node
- path
- working space
- network
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 239000011159 matrix material Substances 0.000 claims abstract description 69
- 238000013529 biological neural network Methods 0.000 claims abstract description 50
- 238000004364 calculation method Methods 0.000 claims abstract description 29
- 210000000299 nuclear matrix Anatomy 0.000 claims abstract description 9
- 102000008297 Nuclear Matrix-Associated Proteins Human genes 0.000 claims abstract description 8
- 108010035916 Nuclear Matrix-Associated Proteins Proteins 0.000 claims abstract description 8
- 230000001788 irregular Effects 0.000 claims abstract description 8
- 210000002569 neuron Anatomy 0.000 claims description 13
- 230000007613 environmental effect Effects 0.000 claims description 10
- 238000010276 construction Methods 0.000 claims description 6
- 230000005284 excitation Effects 0.000 claims description 6
- 238000000605 extraction Methods 0.000 claims description 6
- 230000002093 peripheral effect Effects 0.000 claims description 6
- 230000004913 activation Effects 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 8
- 238000013527 convolutional neural network Methods 0.000 description 3
- 238000013528 artificial neural network Methods 0.000 description 2
- 231100000681 Certain safety factor Toxicity 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000903 blocking effect Effects 0.000 description 1
- 210000004027 cell Anatomy 0.000 description 1
- 125000004122 cyclic group Chemical group 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/0088—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0217—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/02—Neural networks
- G06N3/04—Architecture, e.g. interconnection topology
- G06N3/045—Combinations of networks
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N5/00—Computing arrangements using knowledge-based models
- G06N5/01—Dynamic search techniques; Heuristics; Dynamic trees; Branch-and-bound
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/004—Artificial life, i.e. computing arrangements simulating life
- G06N3/006—Artificial life, i.e. computing arrangements simulating life based on simulated virtual individual or collective life forms, e.g. social simulations or particle swarm optimisation [PSO]
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/004—Artificial life, i.e. computing arrangements simulating life
- G06N3/008—Artificial life, i.e. computing arrangements simulating life based on physical entities controlled by simulated intelligence so as to replicate intelligent life forms, e.g. based on robots replicating pets or humans in their appearance or behaviour
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/02—Neural networks
- G06N3/06—Physical realisation, i.e. hardware implementation of neural networks, neurons or parts of neurons
- G06N3/061—Physical realisation, i.e. hardware implementation of neural networks, neurons or parts of neurons using biological neurons, e.g. biological neurons connected to an integrated circuit
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Theoretical Computer Science (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- General Engineering & Computer Science (AREA)
- Mathematical Physics (AREA)
- Health & Medical Sciences (AREA)
- Computational Linguistics (AREA)
- Data Mining & Analysis (AREA)
- Software Systems (AREA)
- Computing Systems (AREA)
- Biophysics (AREA)
- Molecular Biology (AREA)
- General Health & Medical Sciences (AREA)
- Biomedical Technology (AREA)
- Life Sciences & Earth Sciences (AREA)
- Business, Economics & Management (AREA)
- Game Theory and Decision Science (AREA)
- Medical Informatics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
- Manipulator (AREA)
Abstract
本发明提供一种非规则形状移动机器人的路径规划方法,包括以下步骤:将机器人的二维工作空间均匀划分成拓扑的工作空间网络T,并进行生物神经动力学迭代计算,构成工作空间的生物神经网络S;根据移动机器人的形状特征构成核矩阵;将核矩阵与工作空间的生物神经网络进行卷积计算,获得机器人在网络节点的移动状态矩阵和转动状态矩阵;以机器人在工作空间初始位置和方向为初始条件,逐步迭代搜索,构建从初始状态到目标状态的节点树Tree;反向搜索节点树Tree,获得机器人的规划路径。机器人可以是任意非规则形状,考虑了机器人的在平面空间的3自由度运动,并且在卷积计算中增加安全系数因子,控制规划路径与障碍物之间的距离,调节行使路径的安全性。
Description
技术领域
本发明属于移动机器人路径规划技术领域,具体涉及一种非规则形状移动机器人的路径规划方法。
背景技术
路径规划是移动机器人研究领域的一个核心问题,它的目标就是在工作环境中寻找一条连接机器人当前状态和目标状态的行使路线,并且避免与环境中的障碍物发生碰撞。目前,路径规划的研究方法包括细胞分解法、人工势场法以及各类智能算法等,但这些方法主要是针对单点机器人,即将机器人视为形状规则的单个元素,以机器人的尺寸对工作空间进行网络划分,在此基础上进行路径规划,路径规划算法中只考虑机器人的2自由度移动。实际情况下,大多数机器人的形状是非规则的,非规则形状机器人的路径规划不仅需要考虑2自由度移动,还需要考虑其转动,例如,在某些复杂环境下,受到障碍物的影响,机器人只能作移动运动或在一定角度范围内转动,这些是路径规划中的重要约束。其次,工作空间中的障碍物有可能比机器人的尺寸要小,现在的解决办法是将障碍物形状进行拓展,即划分的工作空间网格内只要有障碍物,就将整个网格均视为障碍物,这就造成可能的行使路径被忽略了,即所谓的“path blocked”问题。此外,路径规划中,还需要考虑机器人行使的安全性,避免“too close”或者“too far”问题。
发明内容
针对上述技术问题,本发明提出了一种非规则形状移动机器人的路径规划方法,本发明是将生物神经网络和卷积神经网络相融合,可以控制路径安全性的规划方法,以解决复杂环境下、非规则形状移动机器人的路径规划难题。该方法将机器人的工作空间均匀划分成拓扑网络结构,并进行生物神经动力学迭代计算,采用迭代计算稳定后的网络节点函数值描述工作空间的环境信息;根据移动机器人的形状特征构成核矩阵,将核矩阵与工作空间的生物神经网络进行卷积计算,获得机器人在网络节点的移动状态矩阵和转动状态矩阵;以机器人在工作空间初始节点位置和方向为初始条件,逐步迭代搜索,构建从初始状态到目标状态的节点树,最后反向搜索节点树,获得机器人的规划路径。
路径规划中,机器人和目标均包括x、y坐标和方向θ三维状态参数,考虑了机器人的2自由度移动和1自由度转动运动,并且可以通过调节卷积计算中的安全系数因子,控制规划路径与障碍物之间的距离,调节机器人行使路径的安全性。
本发明的技术方案是:一种非规则形状移动机器人的路径规划方法,包括以下步骤:
构建工作空间网络:将机器人的二维工作空间均匀划分成拓扑的工作空间网络T,并对工作空间网络T进行生物神经动力学迭代计算,构成工作空间的生物神经网络S,生物神经网络S描述了整个工作空间的环境信息;
构建机器人形状核矩阵:根据移动机器人的形状特征构成核矩阵;
构建机器人的移动状态矩阵和转动状态矩阵:将核矩阵与工作空间的生物神经网络进行卷积计算,获得机器人在网络节点的移动状态矩阵和转动状态矩阵;
构建节点树Tree:以机器人在工作空间初始位置和方向为初始条件,逐步迭代搜索,构建从初始状态到目标状态的节点树Tree;
生成规划路径:反向搜索节点树Tree,获得机器人的规划路径。
上述方案中,所述构建工作空间网络的步骤具体为:
将机器人的二维工作空间均匀划分成拓扑的工作空间网络T,工作空间网络T的每个节点包括自由空间和障碍物占据两个状态,自由空间的节点函数值设定为0,障碍物占据的节点函数值设定为1,工作空间网络T中的节点Ti会与周边8个节点相邻,将工作空间网络T进行生物神经动力学迭代计算,构成工作空间的生物神经网络S,生物神经网络S上节点的函数值描述了该节点所在位置的环境信息,生物神经网络S则描述了整个工作空间的环境信息。
上述方案中,所述生物神经网络S迭代计算公式为:
公式一中,xi为第i个神经元节点Si的在t时刻的函数值,A、B、D为设定的非负恒定参数,且有A>B>D,Ii为生物神经网络节点Si的外界激励,且有障碍物占据节点的外界激励为Ii=E,自由空间节点的外界激励为Ii=-E,且有E>>B,Ij为第j个相邻的神经元,j=1,2...8,公式一迭代算计法中区分自由空间和障碍物的阈值函数定义为:[a]+=max{a,0}、[a]-=max{-a,0},相邻神经元的连接权重wij=1/d,d为第i和第j个神经元节点之间的距离,k=8为周边8个相邻的神经元。
上述方案中,所述构建机器人形状核矩阵步骤具体为:
将移动机器人所占据区域扩展成规则矩形或正方形区域,并进行均匀划分,构成核矩阵W,矩阵的每个元素包括自由空间和机器人占据两个状态,自由空间的元素值设定为0,机器人占据的元素值设定为1,将机器人在工作空间内,间隔45°进行旋转,构建反映机器人8个方向的核矩阵Wθ,θ=1,2,...,8。
进一步的,所述构建机器人的移动状态矩阵和转动状态矩阵的步骤具体为:
将8组反映机器人形状的核矩阵Wθ分别与生物神经网络S进行卷积计算,得到8个一层卷积网络H1,θ,H1,θ网络中每个节点的输出h1,θ(x,y)表示机器人是否能够以θ方向放置于工作空间节点(x,y),且h1,θ(x,y)=0表示能够放置,h1,θ(x,y)=-1表示不能够放置;
构建8个3×3的核矩阵Mθ,用Mθ分别对一层卷积网络H1,θ进行二次卷积计算,得到8个二层卷积网络H2,θ,H2,θ网络中每个节点的输出h2,θ(x,y)表示机器人是否能够以θ方向从当前节点(x,y)行使进入相邻的节点,且h2,θ(x,y)=0表示能够行驶进入,h2,θ(x,y)=-1表示不能够行驶进入;
提取h2,θ(x,y),θ=1,2,...,8,构成一个1×8的移动状态矩阵TSM(x,y),描述了机器人在当前节点的移动输出状态,即是否能够从节点(x,y)行使进入相邻的8个节点的状态;
提取h1,θ(x,y),θ=1,2,...,8,构成一个1×8的转动状态矩阵RSM(x,y),它由‘0’或‘-1’组成,描述机器人在节点(x,y)的转动状态。
进一步的,所述第一层卷积计算方法为:
上述方案中,所述构建节点树的步骤具体为:
以机器人的初始状态,搜索机器人能够进入的相邻神经元信息,构成一组节点信息集合Pstep,搜索步长step=step+1,判断目标信息是否属于信息集合Pstep,如果目标信息属于信息集合Pstep,则停止搜索,如果目标信息不属于信息集合Pstep,则更新已经搜索的节点树Tree,并将节点信息集合Pstep设定为当前状态,进行下一步搜索,直到搜索到目标信息为止;
由每一步长的节点集合Pstep,step=1,2,...p,构成一个从初始状态到目标状态的节点树Tree。
上述方案中,所述生成规划路径具体步骤为:
根据所述节点树Tree,输入机器人的初始位置(x0,y0)和方向θ0,输入目标位置(xp,yp)和方向θp;
从目标信息节点出发,搜索与之相连的父节点,构成父节点集合,确定路径节点,更新路径节点Path,然后进行循环搜索,直到步长step=1,由每一步长step=1,2,...p搜索到的节点构成连接目标位置和初始位置的路径节点Path,即规划路径。
进一步的,所述确定路径节点的确定具体为:如果父节点集合中有水平或垂直相连的父节点,则将其作为机器人行走路径节点,如果没有,则寻找与机器人当前方向转动角度较小的父节点,并将其作为机器人行走路径节点。
上述方案中,所述生物神经网络S的节点所描述的实际空间与反映机器人形状的核矩阵Wθ的节点所描述的实际空间相等,机器人放置于生物神经网络S中所占据的是一个与核矩阵W大小相等的子网络,将反映机器人形状的核矩阵Wθ放置于生物神经网络S中,能够保证Wθ与S的节点位置一一对应。
与现有技术相比,本发明的有益效果是:本发明将生物神经网络和卷积神经网络融入路径规划中,提出一种非规则形状移动机器人的路径规划方法,通过构建核矩阵描述机器人的形状特征,用于任意非规则形状的移动机器人在复杂工作空间下的安全路径规划;由于工作空间划分网络的尺寸远小于机器人的尺寸,可以很好的描述小障碍物特征,解决密集散点障碍工作环境下“path blocked”难题;只需要改变卷积计算中安全系数,就可实现规划路径与障碍物的距离的调节,方便地控制规划路径的安全性。
附图说明
图1是本发明一实施方式的机器人的工作空间划分示意图。
图2是本发明一实施方式的工作空间神经元节点连接示意图。
图3是本发明一实施方式的工作空间的生物神经网络构建示意图。
图4是本发明一实施方式的机器人形状核矩阵构建示意图。
图5是本发明一实施方式的卷积神经网络计算示意图。
图6是本发明一实施方式的二次卷积计算核矩阵示意图。
图7是本发明一实施方式的节点树的构建流程图。
图8是本发明一实施方式的生成规划路径的流程图。
图9是本发明一实施方式的在U型障碍工作环境下的规划路径图。
图10是本发明一实施方式的在密集散点障碍工作环境下的规划路径图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
一种非规则形状移动机器人的路径规划方法,包括以下步骤:
构建工作空间网络:将机器人的二维工作空间均匀划分成拓扑的工作空间网络T,并对工作空间网络T进行生物神经动力学迭代计算,构成工作空间的生物神经网络S,生物神经网络S描述了整个工作空间的环境信息;
构建机器人形状核矩阵:根据移动机器人的形状特征构成核矩阵;
构建机器人的移动状态矩阵和转动状态矩阵:将核矩阵与工作空间的生物神经网络进行卷积计算,获得机器人在网络节点的移动状态矩阵和转动状态矩阵;
构建节点树Tree:以机器人在工作空间初始位置和方向为初始条件,逐步迭代搜索,构建从初始状态到目标状态的节点树Tree;
生成规划路径:最后反向搜索节点树Tree,获得机器人的规划路径。
所述构建工作空间网络的步骤具体为:
如图1所示,将移动机器人的二维工作空间沿x和y方向均匀划分成拓扑的工作空间网络T,图1中划分成100×100的网络结构,工作空间网络T的每个节点T(x,y)包括自由空间和障碍物占据两个状态,自由空间如图1中白色区域所示,自由空间的节点函数值设定为T(x,y)=0,障碍物占据如图1中黑色区域所示,障碍物占据的节点函数值设定为T(x,y)=1。
如图2所示,工作空间网络T中的节点Ti的坐标为(x,y),节点Ti会与周边8个节点相邻Tj,j=1,2,...,8。
将工作空间网络T进行生物神经动力学迭代计算,构成工作空间的生物神经网络S,计算公式为
公式一中,xi为第i个神经元节点Si的在t时刻的函数值,A、B、D为设定的非负恒定参数,且有A>B>D,Ii为生物神经网络节点Si的外界激励,且有障碍物占据节点的外界激励为Ii=E,自由空间节点的外界激励为Ii=-E,且有E>>B,Ij为第j个相邻的神经元,j=1,2...8,式中的阈值函数定义为:[a]+=max{a,0}、[a]-=max{-a,0},相邻神经元的连接权重wij=1/d,d为第i和第j个神经元节点之间的距离,k=8为周边8个相邻的神经元。根据E>>B,A>B,B>D设定参数A、B、D、E,可以使生物神经网络S中,障碍物占据节点的函数值远大于自由空间节点的函数值,两者之间形成连续的梯度过渡,使得自由空间节点的函数值随着与障碍物距离的增大而逐步减小。
当设定参数A=10、B=1、D=0、E=50时,迭代计算稳定后得到的工作空间生物神经网络S如图3所示。
生物神经网络S上节点的函数值描述了该节点所在位置的环境信息,生物神经网络S则描述了整个工作空间的环境信息。
所述构建机器人形状核矩阵的步骤具体为:
移动机器人的形状可以是任意的;
假设为“箭头”形状移动机器人,将移动机器人所占据区域扩展成规则的矩形或正方形区域,并进行均匀划分,构成核矩阵W,图4中划分为9×9的正方形矩阵,矩阵的每个元素W(m,n)包括自由空间和机器人占据两个状态,自由空间的元素值设定为W(m,n)=0,机器人占据的元素值设定为W(m,n)=1。
将机器人在工作空间内,间隔45°进行旋转,构建反映机器人8个方向的核矩阵Wθ,θ表示机器人前进方向,θ=1,2,...,8,如图4所示。
构建的生物神经网络S的节点所描述的实际空间应该与机器人形状核矩阵Wθ的节点所描述的实际空间相等。
机器人放置于生物神经网络S中所占据的是一个与核矩阵W大小相等的子网络。
将机器人形状核矩阵Wθ放置于生物神经网络S中,能够保证Wθ与S的节点位置一一对应。
所述构建机器人的移动状态矩阵和转动状态矩阵的步骤具体为:
卷积神经网络计算结构参阅图5,构建的核矩阵参阅图6。
卷积神经网络计算结构如图5所示,将8组反映机器人形状的核矩阵Wθ分别与生物神经网络S进行卷积计算,得到8个一层卷积网络H1,θ,卷积计算方法为
公式中,s为核矩阵Wθ所在生物神经网络S中所占据的子空间集合,Sp,q为s的子空间,‘*’代表卷积计算,b表示安全系数,采用符号激活函数f(·),定
卷积计算后,H1,θ网络中每个节点的输出h1,θ(x,y)表示机器人是否能够以θ方向放置于工作空间节点(x,y),且h1,θ(x,y)=0表示能够放置,h1,θ(x,y)=-1表示不能够放置。
如图6所示,构建8个3×3的核矩阵Mθ,θ=1,2,…,8。
用Mθ分别对一层卷积网络H1,θ进行二次卷积计算,得到8个二层卷积网络H2,θ,卷积计算中安全系数b设定为0。
二次卷积H2,θ网络中每个节点的输出h2,θ(x,y)表示机器人是否能够以θ方向从当前节点(x,y)行使进入相邻的节点,且h2,θ(x,y)=0表示能够行驶进入,h2,θ(x,y)=-1表示不能够行驶进入。
提取h2,θ(x,y),θ=1,2,...,8,构成一个1×8的移动状态矩阵TSM(x,y),它由‘0’或‘-1’组成,描述了机器人在当前节点的移动输出状态,即是否能够从节点(x,y)行使进入相邻的8个节点的状态。
例如,TSM(x,y)=[0,-1,-1,0,0,0,-1,0],表示机器人可以从节点(x,y)行使进入相邻5个节点(x+1,y)、(x+1,y-1)、(x,y-1)、(x-1,y-1)和(x-1,y+1)。
提取h1,θ(x,y),θ=1,2,...,8,构成一个1×8的转动状态矩阵RSM(x,y),它由‘0’或‘-1’组成,描述机器人在节点(x,y)的转动状态。
例如,RSM(x,y)=[-1,-1,-1,0,0,0,-1,0],表示机器人在节点(i,j)位置,可以在θ=4,5,和6范围内转动。
所述构建节点树的步骤具体为:
如图7所示,首先进行参数初始化:构建机器人工作空间信息,构建工作空间网络T;根据移动机器人的形状构建8个核矩阵Wθ;输入机器人的初始位置(x0,y0)和方向θ0,输入目标位置(xp,yp)和方向θp;设定规划路径的安全系数b;步长step=0。
其次,根据工作空间网络T计算工作空间的生物神经网络S;通过卷积计算,获得生物神经网络S上机器人在每个节点的移动状态矩阵TSM和转动状态矩阵RSM。
然后,进入循环搜索程序。
以机器人的初始状态,搜索机器人能够进入的相邻神经元信息,构成一组节点信息集合Pstep,搜索步长step=step+1;
判断目标信息是否属于信息集合Pstep,如果目标信息属于信息集合Pstep,则停止搜索;如果目标信息不属于信息集合Pstep,则更新已经搜索的节点树Tree,并将节点信息集合Pstep设定为当前状态,进行下一步搜索,直到搜索到目标信息为止。
节点信息集合Pstep包括机器人的位置和方向,只有当它们与目标位置(xp,yp)和方向θp均相等时,才说明机器人到达目标。
由每一步长的节点集合Pstep,step=1,2,...p,构成一个从初始状态到目标状态的节点树Tree。
搜索完成后,程序返回构建的搜索节点树Tree。
所述生成规划路径具体步骤为:
如图8所示:首先,输入已经建立的搜索树Tree,输入机器人的初始位置(x0,y0)和方向θ0,输入目标位置(xp,yp)和方向θp;步长step=step-1;
其次,从目标信息节点出发,搜索与之相连的父节点,构成父节点集合;如果父节点集合中有水平或垂直相连的父节点,则将其作为机器人行走路径节点,如果没有,则寻找与机器人当前方向转动角度较小的父节点,并将其作为机器人行走路径节点。
将上一步确定的路径节点作为当前节点,更新路径节点Path,然后进行循环搜索,直到步长step=1。
由每一步长step=1,2,...p搜索到的节点增加到路径节点Path,即逐步更新规划路径Path。
程序返回连接目标位置和初始位置的路径节点Path,即规划路径。
节点树Tree的构建过程中,只需要通过设定第一层卷积计算中的安全系数b,可以控制路径与障碍物之间的距离,且随着b的增大,路径与障碍物之间的距离随之增加,以保证机器人行使的安全性。
规划得到的路径是在一定安全系数b情况下的最短路径。
U型障碍工作环境下的规划路径:
如图9所示,图9中箭头为前进方向,非规则形状移动机器人的路径规划考虑了机器人在工作空间内的3自由度运动,即2自由度平移和1自由度转动,机器人需要同时满足到达目标位置(xp,yp)和方向θp,才能生成路径。
可以通过设定安全系数b,改变所规划的路径,图9中,b3>b2>b1,可见随着安全系数的增大,所规划的路径也会随之作改变,规划的路径与障碍物的距离随之增大,以保证机器人运动的安全性。
密集散点障碍工作环境下的规划路:
如图10所示,本发明中,构建的生物神经网络S的节点所描述的实际空间与机器人形状的核矩阵Wθ的节点所描述的实际空间相等,机器人在S中是占据一个子网络,且Wθ与S的节点位置一一对应。这就使得生物神经网络S的节点所描述的实际空间要远小于机器人的尺寸,它可以更好的描述小障碍环境,图10给出了在密集散点障碍工作环境下的规划路径结果,通过设定安全系数b,b2>b1,也可以调节路径与障碍物的距离。
可见本发明是用于任意非规则形状的移动机器人在复杂工作空间下的安全路径规划,将机器人的工作空间均匀划分成拓扑网络结构,并进行生物神经动力学迭代计算,采用迭代计算稳定后的网络节点函数值描述工作空间的环境信息;根据移动机器人的形状特征构成核矩阵,将核矩阵与工作空间的生物神经网络进行卷积计算,获得机器人在网络节点的移动状态矩阵和转动状态矩阵;以机器人在工作空间初始位置和方向为初始条件,逐步迭代搜索,构建从初始状态到目标状态的节点树,最后反向搜索节点树,获得机器人的规划路径。该方法中,机器人可以是任意非规则形状,考虑了机器人的在平面空间的3自由度运动,并且在卷积计算中增加安全系数因子,控制规划路径与障碍物之间的距离,解决密集散点障碍工作环境下“path blocked”难题;只需要改变卷积计算中安全系数,就可实现规划路径与障碍物的距离的调节,方便地控制规划路径的安全性。
上文所列出的一系列的详细说明仅仅是针对本发明的可行性实施例的具体说明,它们并非用以限制本发明的保护范围,凡未脱离本发明技艺精神所作的等效实施例或变更均应包含在本发明的保护范围之内。
Claims (10)
1.一种非规则形状移动机器人的路径规划方法,其特征在于,包括以下步骤:
构建工作空间网络:将机器人的二维工作空间均匀划分成拓扑的工作空间网络T,并对工作空间网络T进行生物神经动力学迭代计算,构成工作空间的生物神经网络S,生物神经网络S描述了整个工作空间的环境信息;
构建机器人形状核矩阵:根据移动机器人的形状特征构成核矩阵;
构建机器人的移动状态矩阵和转动状态矩阵:将核矩阵与工作空间的生物神经网络进行卷积计算,获得机器人在网络节点的移动状态矩阵和转动状态矩阵;
构建节点树Tree:以机器人在工作空间初始位置和方向为初始条件,逐步迭代搜索,构建从初始状态到目标状态的节点树Tree;
生成规划路径:反向搜索节点树Tree,获得机器人的规划路径。
2.根据权利要求1所述的非规则形状移动机器人的路径规划方法,其特征在于,所述构建工作空间网络的步骤具体为:
将机器人的二维工作空间均匀划分成拓扑的工作空间网络T,工作空间网络T的每个节点包括自由空间和障碍物占据两个状态,自由空间的节点函数值设定为0,障碍物占据的节点函数值设定为1,工作空间网络T中的节点Ti会与周边8个节点相邻,将工作空间网络T进行生物神经动力学迭代计算,构成工作空间的生物神经网络S,生物神经网络S上节点的函数值描述了该节点所在位置的环境信息,生物神经网络S则描述了整个工作空间的环境信息。
4.根据权利要求1所述的非规则形状移动机器人的路径规划方法,其特征在于,所述构建机器人形状核矩阵步骤具体为:
将移动机器人所占据区域扩展成规则矩形或正方形区域,并进行均匀划分,构成核矩阵W,矩阵的每个元素包括自由空间和机器人占据两个状态,自由空间的元素值设定为0,机器人占据的元素值设定为1,将机器人在工作空间内,间隔45°进行旋转,构建反映机器人8个方向的核矩阵Wθ,θ=1,2,…,8。
5.根据权利要求4所述的非规则形状移动机器人的路径规划方法,其特征在于,所述构建机器人的移动状态矩阵和转动状态矩阵的步骤具体为:
将8组反映机器人形状的核矩阵Wθ分别与生物神经网络S进行卷积计算,得到8个一层卷积网络H1,θ,H1,θ网络中每个节点的输出h1,θ(x,y)表示机器人是否能够以θ方向放置于工作空间节点(x,y),且h1,θ(x,y)=0表示能够放置,h1,θ(x,y)=-1表示不能够放置;
构建8个3×3的核矩阵Mθ,用Mθ分别对一层卷积网络H1,θ进行二次卷积计算,得到8个二层卷积网络H2,θ,H2,θ网络中每个节点的输出h2,θ(x,y)表示机器人是否能够以θ方向从当前节点(x,y)行使进入相邻的节点,且h2,θ(x,y)=0表示能够行驶进入,h2,θ(x,y)=-1表示不能够行驶进入;
提取h2,θ(x,y),θ=1,2,…,8,构成一个1×8的移动状态矩阵TSM(x,y),描述了机器人在当前节点的移动输出状态,即是否能够从节点(x,y)行使进入相邻的8个节点的状态;
提取h1,θ(x,y),θ=1,2,…,8,构成一个1×8的转动状态矩阵RSM(x,y),它由‘0’或‘-1’组成,描述机器人在节点(x,y)的转动状态。
7.根据权利要求1所述的非规则形状移动机器人的路径规划方法,其特征在于,所述构建节点树的步骤具体为:
以机器人的初始状态,搜索机器人能够进入的相邻神经元信息,构成一组节点信息集合Pstep,搜索步长step=step+1,判断目标信息是否属于信息集合Pstep,如果目标信息属于信息集合Pstep,则停止搜索,如果目标信息不属于信息集合Pstep,则更新已经搜索的节点树Tree,并将节点信息集合Pstep设定为当前状态,进行下一步搜索,直到搜索到目标信息为止;
由每一步长的节点集合Pstep,step=1,2,…p,构成一个从初始状态到目标状态的节点树Tree。
8.根据权利要求1所述的非规则形状移动机器人的路径规划方法,其特征在于,所述生成规划路径具体步骤为:
根据所述节点树Tree,输入机器人的初始位置(x0,y0)和方向θ0,输入目标位置(xp,yp)和方向θp;
从目标信息节点出发,搜索与之相连的父节点,构成父节点集合,确定路径节点,更新路径节点Path,然后进行循环搜索,直到步长step=1,由每一步长step=1,2,…p搜索到的节点构成连接目标位置和初始位置的路径节点Path,即规划路径。
9.根据权利要求8所述的非规则形状移动机器人的路径规划方法,其特征在于,所述确定路径节点的确定具体为:如果父节点集合中有水平或垂直相连的父节点,则将其作为机器人行走路径节点,如果没有,则寻找与机器人当前方向转动角度较小的父节点,并将其作为机器人行走路径节点。
10.根据权利要求1所述的非规则形状移动机器人的路径规划方法,其特征在于,所述生物神经网络S的节点所描述的实际空间与反映机器人形状的核矩阵Wθ的节点所描述的实际空间相等,机器人放置于生物神经网络S中所占据的是一个与核矩阵W大小相等的子网络,将反映机器人形状的核矩阵Wθ放置于生物神经网络S中,能够保证Wθ与S的节点位置一一对应。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010157313.3A CN111474925B (zh) | 2020-03-09 | 2020-03-09 | 一种非规则形状移动机器人的路径规划方法 |
GB2105342.6A GB2593058B (en) | 2020-03-09 | 2020-04-24 | Path planning method for irregularly shaped mobile robot |
PCT/CN2020/086533 WO2021179409A1 (zh) | 2020-03-09 | 2020-04-24 | 一种非规则形状移动机器人的路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010157313.3A CN111474925B (zh) | 2020-03-09 | 2020-03-09 | 一种非规则形状移动机器人的路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111474925A true CN111474925A (zh) | 2020-07-31 |
CN111474925B CN111474925B (zh) | 2021-09-10 |
Family
ID=71747225
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010157313.3A Active CN111474925B (zh) | 2020-03-09 | 2020-03-09 | 一种非规则形状移动机器人的路径规划方法 |
Country Status (3)
Country | Link |
---|---|
CN (1) | CN111474925B (zh) |
GB (1) | GB2593058B (zh) |
WO (1) | WO2021179409A1 (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113156933A (zh) * | 2020-12-30 | 2021-07-23 | 徐宁 | 一种机器人行进控制***和方法 |
CN117804463A (zh) * | 2024-03-01 | 2024-04-02 | 山东力聚机器人科技股份有限公司 | 一种智慧勘查机器人和路径规划方法 |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114898013B (zh) * | 2022-07-15 | 2022-11-22 | 深圳市城市交通规划设计研究中心股份有限公司 | 一种交通等时圈生成方法、电子设备及存储介质 |
CN116922398B (zh) * | 2023-09-15 | 2023-12-22 | 华侨大学 | 一种绳索机器人及其路径规划方法和装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101077578A (zh) * | 2007-07-03 | 2007-11-28 | 北京控制工程研究所 | 一种基于二元环境信息的移动机器人局部路径规划方法 |
CN101441736A (zh) * | 2007-11-21 | 2009-05-27 | 新乡市起重机厂有限公司 | 汽车起重机机器人路径规划方法 |
KR101200209B1 (ko) * | 2006-09-11 | 2012-11-09 | 가부시키가이샤 히타치세이사쿠쇼 | 이동 장치 |
CN104317292A (zh) * | 2014-09-16 | 2015-01-28 | 哈尔滨恒誉名翔科技有限公司 | 一种复杂形状机器人避碰路径的方法 |
CN109814557A (zh) * | 2019-01-23 | 2019-05-28 | 西北工业大学 | 一种全局规划器主导的机器人路径规划方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8364629B2 (en) * | 2009-07-02 | 2013-01-29 | Palo Alto Research Center Incorporated | Depth-first search for target value problems |
CN104050390B (zh) * | 2014-06-30 | 2017-05-17 | 西南交通大学 | 一种基于可变维粒子群膜算法的移动机器人路径规划方法 |
US11017679B2 (en) * | 2017-01-13 | 2021-05-25 | Skydio, Inc. | Unmanned aerial vehicle visual point cloud navigation |
CN106843211B (zh) * | 2017-02-07 | 2019-11-08 | 东华大学 | 一种基于改进遗传算法的移动机器人路径规划方法 |
US20190184561A1 (en) * | 2017-12-15 | 2019-06-20 | The Regents Of The University Of California | Machine Learning based Fixed-Time Optimal Path Generation |
CN109839110B (zh) * | 2019-01-09 | 2020-07-24 | 浙江大学 | 一种基于快速随机搜索树的多目标点路径规划方法 |
CN110057362B (zh) * | 2019-04-26 | 2022-09-16 | 安徽理工大学 | 有限单元地图的移动机器人路径规划方法 |
CN110426044A (zh) * | 2019-08-09 | 2019-11-08 | 华南理工大学 | 一种基于凸集计算和优化蚁群算法的避障路径规划方法 |
-
2020
- 2020-03-09 CN CN202010157313.3A patent/CN111474925B/zh active Active
- 2020-04-24 WO PCT/CN2020/086533 patent/WO2021179409A1/zh active Application Filing
- 2020-04-24 GB GB2105342.6A patent/GB2593058B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101200209B1 (ko) * | 2006-09-11 | 2012-11-09 | 가부시키가이샤 히타치세이사쿠쇼 | 이동 장치 |
CN101077578A (zh) * | 2007-07-03 | 2007-11-28 | 北京控制工程研究所 | 一种基于二元环境信息的移动机器人局部路径规划方法 |
CN101441736A (zh) * | 2007-11-21 | 2009-05-27 | 新乡市起重机厂有限公司 | 汽车起重机机器人路径规划方法 |
CN104317292A (zh) * | 2014-09-16 | 2015-01-28 | 哈尔滨恒誉名翔科技有限公司 | 一种复杂形状机器人避碰路径的方法 |
CN109814557A (zh) * | 2019-01-23 | 2019-05-28 | 西北工业大学 | 一种全局规划器主导的机器人路径规划方法 |
Non-Patent Citations (6)
Title |
---|
BEN BEKLISI KWAMEAYAWLI,ETC: "Path planning for mobile robots using Morphological Dilation Voronoi Diagram Roadmap algorithm", 《 SCIENTIFIC AFRICAN》 * |
FUYUAN LING,ETC: "An Improved Geometrical Path Planning Algorithm for UAV in Irregular-obstacle Environment", 《2019 IEEE 8TH JOINT INTERNATIONAL INFORMATION TECHNOLOGY AND ARTIFICIAL INTELLIGENCE CONFERENCE (ITAIC)》 * |
SHIWEI LI: "Robot Path Planning Algorithm Based on Particle Swarm Optimization and Feedforward Neural Network in Network Environment", 《AIVR2020: 2020 4TH INTERNATIONAL CONFERENCE ON ARTIFICIAL INTELLIGENCE AND VIRTUAL REALITY》 * |
周滔,等: "复杂环境下移动机器人全局路径规划与跟踪", 《计算机工程》 * |
国海涛,等: "基于栅格法的机器人路径规划快速搜索随机树算法", 《南京师范大学学报(工程技术版)》 * |
杨洋,等: "面向未知地图的六足机器人路径规划算法", 《计算机应用》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113156933A (zh) * | 2020-12-30 | 2021-07-23 | 徐宁 | 一种机器人行进控制***和方法 |
CN117804463A (zh) * | 2024-03-01 | 2024-04-02 | 山东力聚机器人科技股份有限公司 | 一种智慧勘查机器人和路径规划方法 |
CN117804463B (zh) * | 2024-03-01 | 2024-06-28 | 广东众聚人工智能科技有限公司 | 一种智慧勘查机器人和路径规划方法 |
Also Published As
Publication number | Publication date |
---|---|
WO2021179409A1 (zh) | 2021-09-16 |
GB2593058A (en) | 2021-09-15 |
GB202105342D0 (en) | 2021-05-26 |
GB2593058B (en) | 2022-09-07 |
CN111474925B (zh) | 2021-09-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111474925B (zh) | 一种非规则形状移动机器人的路径规划方法 | |
Zhen et al. | Rotary unmanned aerial vehicles path planning in rough terrain based on multi-objective particle swarm optimization | |
CN108415425B (zh) | 一种基于改进基因调控网络的分布式群机器人协同集群算法 | |
CN104050390B (zh) | 一种基于可变维粒子群膜算法的移动机器人路径规划方法 | |
WO2018176596A1 (zh) | 基于权重改进粒子群算法的无人自行车路径规划方法 | |
Zhao et al. | A path planning method based on multi-objective cauchy mutation cat swarm optimization algorithm for navigation system of intelligent patrol car | |
CN116772880B (zh) | 一种基于无人机视觉的无人车路径规划方法 | |
CN115033016A (zh) | 一种异构无人集群编队避障方法及*** | |
CN115729238A (zh) | 一种用于移动机器人自主避障的动态路径规划方法 | |
CN115297484A (zh) | 基于新型紧凑粒子群算法的传感器网络覆盖率优化方法 | |
Liang et al. | Global path planning for mobile robot based genetic algorithm and modified simulated annealing algorithm | |
Chen et al. | A multirobot distributed collaborative region coverage search algorithm based on Glasius bio-inspired neural network | |
Shi et al. | Path planning for mobile robots in complex environments based on improved ant colony algorithm. | |
CN108227718B (zh) | 一种自适应切换的自动搬运小车路径规划方法 | |
Yuhang et al. | An Adaptive evolutionary multi-objective estimation of distribution algorithm and its application to multi-UAV path planning | |
CN116483094A (zh) | 一种融合空地视角和多维信息的无人车路径规划方法 | |
Tuba et al. | Water cycle algorithm for robot path planning | |
Li et al. | Vision-based obstacle avoidance algorithm for mobile robot | |
Chen et al. | Cooperative Search Self-Organizing Strategy for Multiple Unmanned Aerial Vehicles Based on Probability Map and Uncertainty Map | |
CN114740849A (zh) | 基于行人步行决策规则的移动机器人自主导航方法及装置 | |
Xu et al. | Hybrid frontier detection strategy for autonomous exploration in multi-obstacles environment | |
Zhang et al. | Mobile robot path planning based on hybrid ant colony optimization | |
Oyana et al. | Three-layer multi-uavs path planning based on ROBL-MFO | |
Yevsieiev et al. | Route constructing for a mobile robot based on the D-star algorithm | |
CN111531542B (zh) | 一种基于改进a*算法的机械臂无碰撞路径规划方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |