CN110658811B - 基于神经网络的受限移动机器人协同路径跟踪控制方法 - Google Patents
基于神经网络的受限移动机器人协同路径跟踪控制方法 Download PDFInfo
- Publication number
- CN110658811B CN110658811B CN201910848231.0A CN201910848231A CN110658811B CN 110658811 B CN110658811 B CN 110658811B CN 201910848231 A CN201910848231 A CN 201910848231A CN 110658811 B CN110658811 B CN 110658811B
- Authority
- CN
- China
- Prior art keywords
- mobile robot
- error
- path
- neural network
- representing
- 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.)
- Active
Links
- 238000013528 artificial neural network Methods 0.000 title claims abstract description 57
- 238000000034 method Methods 0.000 title claims abstract description 32
- 230000015572 biosynthetic process Effects 0.000 claims abstract description 43
- 238000013461 design Methods 0.000 claims abstract description 21
- 239000011159 matrix material Substances 0.000 claims description 20
- 230000001276 controlling effect Effects 0.000 claims description 8
- 230000003044 adaptive effect Effects 0.000 claims description 7
- 239000000126 substance Substances 0.000 claims description 7
- 230000004888 barrier function Effects 0.000 claims description 5
- 238000004891 communication Methods 0.000 claims description 5
- 238000012545 processing Methods 0.000 claims description 4
- 239000011717 all-trans-retinol Substances 0.000 claims description 3
- 230000002457 bidirectional effect Effects 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 230000001105 regulatory effect Effects 0.000 claims description 3
- ZDQWESQEGGJUCH-UHFFFAOYSA-N Diisopropyl adipate Chemical compound CC(C)OC(=O)CCCCC(=O)OC(C)C ZDQWESQEGGJUCH-UHFFFAOYSA-N 0.000 claims description 2
- 230000001052 transient effect Effects 0.000 abstract description 8
- 238000010586 diagram Methods 0.000 description 14
- 238000004088 simulation Methods 0.000 description 8
- 238000005516 engineering process Methods 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012360 testing method Methods 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/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- 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/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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于神经网络的受限移动机器人协同路径跟踪控制方法,该方法步骤为:建立移动机器人的运动学与动力学模型;定义路径跟踪误差方程;建立移动机器人的性能受限tan型障碍李雅普诺夫函数;基于图论知识,建立多个移动机器人的编队方式;建立移动机器人的路径参数更新率方程;针对移动机器人的非线性建模不确定项,采用后推设计方法,设计基于神经网络的控制器;设计编队控制器。本发明不仅能够保证单个移动机器人的路径跟踪误差最终收敛到小邻域内,还能保证误差始终在给定的区间内,保证暂态性能,同时,本发明实现了多个移动机器人的协同控制,使多个移动机器人根据路径参数均匀分布在同一条路径上。
Description
技术领域
本发明涉及移动机器人编队控制领域,具体涉及一种基于神经网络的受限移动机器人协同路径跟踪控制方法。
背景技术
目前移动机器人在实际场景中有着众多应用,例如无人送货小车、快递自动分拣、港口货物自动运输,乃至无人驾驶技术。随着机器人应用领域的不断扩大,人们对移动机器人的控制性能包括暂态性能、安全性等要求越来越高,这就意味着对于移动机器人所设计的控制器需要具备良好的暂态性能和不违背安全边界要求。目前该方面的研究非常少,很多控制方法只能保证系统的最终稳定性,对暂态性能没有考虑,当工作环境对收敛速度和安全边界要求比较高时,现有的控制器通常不能满足实际应用要求。
随着应用场景越来越复杂,任务越来越多,单个移动机器人越来越不能满足多任务应用需求,具有一定编队形式的多个移动机器人在完成某些复杂危险任务(诸如目标搜寻、环境保护、资源测量等)时效率会更高、获取环境信息能力也更强。因此,多个移动机器人的协同编队控制问题迫切需要研究,但是移动机器人的编队控制不仅仅是多个移动机器人控制的简单叠加,而是需要应用通信、协同控制等技术构建一个统一的协同控制系统。
此外,移动机器人通常存在未知参数或非线性建模不确定项等问题,这些问题的存在增加了移动机器人控制器设计的难度,如何有效辨识未知参数或非线性建模不确定项是智能控制领域的难点课题之一。目前,自适应控制方法提供了处理未知参数的有效方法,然而,该方法无法处理非线性建模不确定项。
发明内容
为了克服现有技术存在的缺陷与不足,本发明提供了一种基于神经网络的受限移动机器人协同路径跟踪控制方法,针对移动机器人的暂态性能问题,本发明采用tan型障碍李雅普诺夫函数来对误差进行分析,保证了暂态性能,达到了性能受限的目的;本发明针对多任务应用场景,采用编队控制方法,通过相邻移动机器人路径参数信息的交换,设计编队控制器,实现多个移动机器人协同运动在一条路径上;针对实际应用中存在未知参数或非线性建模不确定项等问题,本发明采用自适应神经网络对与状态有关的非线性建模不确定项进行辨识,通过自适应神经网络的万能逼近定理,达到自适应控制的目的。
为了达到上述目的,本发明采用以下技术方案:
本发明提供一种基于神经网络的受限移动机器人协同路径跟踪控制方法,包括下述步骤:
S1:构建单个移动机器人的运动学与动力学模型,然后对模型方程进行转换,将所述单个移动机器人的运动学和动力学模型转换成位姿和状态的微分方程,并扩充到多个移动机器人后形成动态方程;
S2:构建移动机器人的位置和方向角误差方程;
先构建x轴、y轴和方向角的误差方程,然后求导得到下述误差方程:
其中,xei,yei分别是第i个移动机器人的x轴方向、y轴方向误差,zei是第i个移动机器人的位置误差,是第i个移动机器人位置误差的导数,ψei是第i个移动机器人的方向角误差,是第i个移动机器人方向角误差的导数,vi、wi分别是第i个移动机器人的线速度与角速度,ψi是第i个移动机器人的方向角,是第i个移动机器人路径参数的导数,x′di,y′di分别是第i个移动机器人x轴,y轴路径对路径参数si的微分;
S3:构建移动机器人的性能受限tan型障碍李雅普诺夫函数;
S4:基于图论知识,构建多个移动机器人的编队方式;
S5:构建单个移动机器人的路径参数更新率方程,采用后推设计方法设计虚拟控制器;
S6:设计自适应神经网络控制器;
采用神经网络辨识与状态有关的非线性建模不确定项,设计神经网络控制器为:
其中,τvi表示第i个移动机器人线速度动态中的控制力矩,τwi表示第i个移动机器人角速度动态中的控制力矩,表示第i个移动机器人的神经网络输出,k1i,k2i表示设计的控制器增益常数,表示第i个移动机器人线速度动态中的惯性系数,表示第i个移动机器人角速度动态中的惯性系数,z11i表示第i个移动机器人真实线速度和虚拟线速度的差值,z12i表示第i个移动机器人真实角速度和虚拟角速度的差值,表示第i个移动机器人虚拟线速度控制器的导数,表示第i个移动机器人虚拟角速度控制器的导数,βdi表示位置误差的边界函数,δdi表示位置误差的跟踪函数,βψi表示方向角误差的边界函数,π表示圆周率;
S7:将各个相邻移动机器人的路径参数信息进行交换,然后设计编队控制器对多个移动机器人进行协同路径编队控制。
作为优选的技术方案,步骤S1所述的构建单个移动机器人的运动学与动力学模型,具体表示为:
η=[x,y,ψ]T;
w=[w1,w2]T;
τ=[τ1,τ2];
其中,x,y表示移动机器人的位置坐标,ψ表示移动机器人的方向角,w1,w2分别表示移动机器人左轮与右轮的角速度,τ1,τ2分别表示移动机器人左轮与右轮的控制力矩,M表示惯性矩阵,表示向心力和科氏力矩阵,D表示表面摩擦力矩阵,J(η)表示旋转矩阵。
作为优选的技术方案,步骤S1中所述扩充到多个移动机器人后形成动态方程,具体表示为:
其中,(xi,yi)和ψi分别表示第i个移动机器人的位置和方向角,vi表示第i个移动机器人的线速度,wi表示第i个移动机器人的角速度,Φvi和Φwi表示第i个移动机器人的不确定非线性项。
作为优选的技术方案,步骤S2中所述构建移动机器人的位置和方向角误差方程,具体构建方式为:
构建x轴、y轴和方向角的误差方程:
xei=xd(si)-xi
yei=yd(si)-yi
ψei=ψi-ψdi
作为优选的技术方案,步骤S3中所述构建移动机器人的性能受限tan型障碍李雅普诺夫函数,具体为:
第i个移动机器人的性能受限tan型障碍李雅普诺夫函数为:
其中,Vzei,Vψei分别是处理位置误差zei,方向角误差ψei的tan型障碍李雅普诺夫函数;βdi表示位置误差的边界函数,βdi,0是位置初始误差,βdi,∞是位置终值误差,t表示时间,κdi是位置误差边界函数调节参数;δdi是位置误差的跟踪函数,δdi,0是初始误差,δdi,∞是终值误差,参数满足:βdi,0>βdi,∞>0,δdi,0>δdi,∞>0,δdi,0-δdi,∞>βdi,0-βdi,∞>0,δdi,∞>βdi,∞;βψi(t)是方向角误差的边界函数,βψi,0是方向角初始误差,βψi,∞是方向角终值误差,κψi是方向角误差边界函数调节参数,且满足βψi,0>βψi,∞>0,
作为优选的技术方案,步骤S4中所述构建多个移动机器人的编队方式,具体方式为:
采用固定和双向的编队拓扑,编队两端设置为独立于跟随者的虚拟领导者,标号分别为机器人N+1,机器人N+2,每个跟随者与它相邻的机器人进行路径参数信息交换,所述机器人的编队通信拓扑根据图论知识得到:
其中,02×N是2行N列的零矩阵,02×2是2行2列的零矩阵,L1和L2分别表示为:
作为优选的技术方案,步骤S5中所述构建单个移动机器人的路径参数更新率方程,具体方法为:
定义第i个移动机器人路径参数更新率方程为:
其中,vs是参考速度,χi是一个设计变量;
定义中间误差变量为:
Z11i=vi-αvi
Z12i=wi-αwi
其中,αvi,αwi分别表示虚拟线速度和角速度,vi、wi分别是第i个移动机器人的线速度与角速度;
所述设计虚拟控制器为:
作为优选的技术方案,在步骤S6中,将神经网络权值的更新调整率设置为:
S1i(Z1i)=[s11i,s12i,…,s1Ni]T
S2i(Z2i)=[s21i,s22i,…,s2Ni]T
其中,Z1i=Z2i=[vi,wi]T为神经网络的输入,Γ1i,Γ2i为神经网络权值更新率的增益项,σ1i,σ2i为设计的正常数,S1i(Z1i)、S2i(Z2i)、s1ji、s2ji为高斯基函数,θ1ji,θ2ji为中心点,η1ji,η2ji为宽度,j=1,…,N,N为神经网络节点数;
设计控制力矩为:
其中,τ1i,τ2i分别是第i个移动机器人的左轮和右轮的控制力矩。
作为优选的技术方案,步骤S7中所述设计编队控制器对多个移动机器人进行协同路径编队控制,具体步骤为:
定义路径参数误差为:
其中,ei是第i个移动机器人路径参数误差,si是第i个移动机器人的路径参数,sj是第j个移动机器人的路径参数,aij是上面L1矩阵中在第i行第j列的取值;
定义编队中两个虚拟机器人的路径参数更新率为:
定义e=[e1,…,eN]T,χ=[x1,…,χN]T,则有
将χi作为一个状态,设计控制器为:
本发明与现有技术相比,具有如下优点和有益效果:
(1)本发明通过设计基于自适应神经网络的受限移动机器人协同路径跟踪控制方法,采用tan型障碍李雅普诺夫函数对误差进行分析,通过调整边界函数的参数对误差收敛速度和终值进行调节,保证了暂态性能,实现了安全性能要求的目的。
(2)本发明通过将x轴和y轴误差转换为距离误差,将两输入三输出系统转换成两输入两输出系统,从而将欠驱动移动机器人系统转换成全驱动系统,使自适应神经网络控制器设计变得简单。
(3)本发明通过对多个移动机器人进行协同编队控制,使该系统可以实现更多的任务,应用在更复杂的环境中,具有比单个移动机器人难以比拟的优势。
(4)本发明采用自适应神经网络技术,采用神经网络辨识与状态有关的非线性建模不确定项进行逼近,结合性能受限条件和通信约束,设计基于神经网络的受限移动机器人协同路径跟踪控制方法,不仅能够处理系统中的非线性不确定项,保证安全性能和暂态性能要求,而且能够实现多个移动机器人的编队控制,提高了系统的应用普遍性。
附图说明
图1为本实施例的移动机器人路径跟踪协同控制方法的整体控制框图;
图2为本实施例的移动机器人模型示意图;
图3为本实施例的移动机器人路径跟踪协同运动的相平面图;
图4为本实施例的移动机器人的距离误差仿真图;
图5为本实施例的移动机器人的方向角误差仿真图;
图6为本实施例移动机器人的编队方式拓扑图;
图7为本实施例的神经网络权值W1的2范数仿真图;
图8为本实施例的神经网络权值W2的2范数仿真图;
图9为本实施例的移动机器人的左轮控制力矩图;
图10为本实施例的移动机器人的右轮控制力矩图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
实施例
如图1所示,本实施例提供一种基于神经网络的受限移动机器人协同路径跟踪控制方法,包括下述步骤:
步骤1、如图2所示,建立单个移动机器人的运动学与动力学模型,然后对模型方程进行转换,将基本的运动学和动力学模型转换成位姿和状态的微分方程,并扩充到第i个移动机器人,本实施例编队中采用3个移动机器人进行举例说明;
建立单个移动机器人的运动学和动力学模型为:
其中,η=[x,y,ψ]T,x,y,ψ分别是移动机器人的位置(x,y)和方向角(ψ),w=[w1,w2]T,w1,w2分别为移动机器人左轮与右轮的角速度,τ=[τ1,τ2],τ1,τ2分别为移动机器人左轮与右轮的控制力矩,M是惯性矩阵,是向心力和科氏力矩阵,D为表面摩擦力矩阵,J(η)是旋转矩阵;
其中, m11=0.25b-2r2(mb2+I)+Iw,m12=0.25b-2r2(mb2-I),m=mc+2mw,c=0.5b- 1r2mca,I=mca2+2mwb2+Ic+2Imm,其中mc表示移动机器人车体的质量,mw表示移动机器人带电机车轮的质量,d11和d22表示耦合系数,r表示移动机器人的车轮半径,b表示移动机器人的一半车体宽度,a表示移动机器人两轮中点到质点的距离,c表示移动机器人的向心力科氏力系数,Ic是移动机器人车体绕质点的惯性值,Iw是带电机的车轮绕车轴的惯性值,Im是带电机的车轮绕车轮直径的惯性值;
移动机器人模型进行转换和扩充至第i个移动机器人后的动态方程为:
其中,(xi,yi)和ψi分别为第i个移动机器人的位置和方向角,vi表示第i个移动机器人的线速度,wi表示第i个移动机器人的角速度,Φvi和Φwi表示第i个移动机器人的不确定非线性项,τvi表示第i个移动机器人线速度动态中的控制力矩,τwi表示第i个移动机器人角速度动态中的控制力矩,是第i个移动机器人线速度动态中的惯性系数,其形式为 是第i个移动机器人角速度动态中的惯性系数,其形式为
本实例中,αi=0.3,bi=0.75,ri=0.15,mwi=1,mci=30,Iwi=0.005,Ici=15.625,Imi=0.0025,给定参考路径为:
ηd=[3s,0]T,s≤sc
ηd=[3sc+60(sin(0.05(s-sc))),40(1-cos(0.05(s-sc)))]T,s>sc
其中,sc=24,矩阵中前一项为x轴方向上的路径xd(s),后一项为y轴方向上的路径yd(s)。第一移动机器人初始位置为η1(0)=[-1,-0.7,0]T,第二移动机器人初始位置为η2(0)=[-1,-0.5,0]T,第三移动机器人初始位置为η3(0)=[-1,-0.2,0]T,三个移动机器人的初始线速度、角速度都为0;
如图3所示,三个移动机器人路径跟踪协同运动的相平面图中的左边小图清楚地显示了实际路径和参考路径在开始时刻存在一定的偏差,其他部分都显示了三个移动机器人的实际路径可以很好地跟踪参考路径;
步骤2、建立移动机器人的位置和方向角误差方程;
先构建x轴、y轴和方向角的误差方程,移动机器人的误差方程为:
xei=xd(si)-xi
yei=yd(si)-yi
ψei=ψi-ψdi
其中,表示第i个移动机器人的理想方向角,si是第i个移动机器人的路径参数,xd(si)是路径参数取si时对应x轴的位置,yd(si)是路径参数取si时对应y轴的位置;xei,yei,zei分别是第i个移动机器人的x轴方向误差、y轴方向误差和位置误差,ψei是第i个移动机器人的方向角误差;
然后求导得到以下误差方程:
其中,xei,yei分别是第i个移动机器人的x轴方向、y轴方向误差,zei是第i个移动机器人的位置误差,是第i个移动机器人位置误差的导数,是第i个移动机器人方向角误差的导数,vi、wi分别是第i个移动机器人的线速度与角速度,ψi是第i个移动机器人的方向角,是第i个移动机器人路径参数的导数,x′di,y′di分别是第i个移动机器人x轴,y轴路径对路径参数si的微分;
步骤3、建立移动机器人的性能受限tan型障碍李雅普诺夫函数;
第i个移动机器人的性能受限tan型障碍李雅普诺夫函数为:
其中,Vzei,Vψei分别是处理位置误差zei,方向角误差ψei的tan型障碍李雅普诺夫函数;是位置误差的边界函数,式中,βdi,0是位置初始误差,βdi,∞是位置终值误差,t表示时间,κdi是位置误差边界函数调节参数;是位置误差的跟踪函数,式中,δdi,0是初始误差,δdi,∞是终值误差,为了限制位置误差zei在大于0的区域,参数需要满足:βdi,0>βdi,∞>0,δdi,0>δdi,∞>0,δdi,0-δdi,∞>βdi,0-βdi,∞>0,δdi,∞>βdi,∞;同理是方向角误差的边界函数,式中,βψi,0是方向角初始误差,βψi,∞是方向角终值误差,κψi是方向角误差边界函数调节参数,且满足βψi,0>βψi,∞>0,
在本实施例中,通过多次试验,参数优选为:βdi(t)=(1-0.05)e-0.3t+0.05,δdi(t)=(1-0.1)e-0.3t+0.1,βψi(t)=(1-0.1)e-0.3t+0.1,κdi=0.3,κψi=0.3;
如图4所示,三个移动机器人的距离误差仿真图清楚地显示了三个移动机器人的距离误差始终保持在给定区域内且大于0;如图5所示,从三个移动机器人的方向角误差仿真图可以看出方向角误差始终保持在给定区域,并且收敛到零的小邻域内。
步骤4、如图6所示,使用图论知识,建立多个移动机器人的编队方式;
移动机器人的编队方式为:
移动机器人的编队拓扑是固定和双向的,编队两端是独立于跟随者的虚拟领导者,标号分别为机器人N+1,机器人N+2,每个跟随者与它相邻的机器人进行路径参数信息交换,其通信拓扑根据图论知识得:
其中,02×N是2行N列的零矩阵,02×2是2行2列的零矩阵,L1和L2分别表达为:
在本实施例中,优选3个移动机器人进行编队控制,则有:
步骤5、建立单个移动机器人的路径参数更新率方程,使用后推设计方法,设计虚拟控制器;
步骤5具体实现过程为:
定义第i个移动机器人路径参数更新率方程为:
其中,vs是参考速度,本实施例优选为vs=1.2,χi是一个设计变量;
定义中间误差变量为:
Z11i=vi-αvi
Z12i=wi-αwi
其中,αvi,αwi分别为虚拟线速度和角速度,vi、wi分别是第i个移动机器人的线速度与角速度,
设计虚拟控制器为:
步骤6、设计自适应神经网络控制器;
采用神经网络辨识与状态有关的非线性建模不确定项,设计神经网络控制器为:
其中,τvi表示第i个移动机器人线速度动态中的控制力矩,τwi表示第i个移动机器人角速度动态中的控制力矩,表示第i个移动机器人的神经网络输出,k1i,k2i表示设计的控制器增益常数,表示第i个移动机器人线速度动态中的惯性系数,表示第i个移动机器人角速度动态中的惯性系数,z11i表示第i个移动机器人真实线速度和虚拟线速度的差值,z12i表示第i个移动机器人真实角速度和虚拟角速度的差值,表示第i个移动机器人虚拟线速度控制器的导数,表示第i个移动机器人虚拟角速度控制器的导数,βdi表示位置误差的边界函数,8di是位置误差的跟踪函数,βψi是方向角误差的边界函数,π表示圆周率,zei是第i个移动机器人的位置误差,ψei是第i个移动机器人的方向角误差;
其中,Z1i=Z2i=[vi,wi]T为神经网络的输入,Γ1i,Γ2i为神经网络权值更新率的增益项,σ1i,σ2i为设计的正常数,S1i(Z1i)=[s11i,s12i,…,s1Ni]T,
在本实施例中,参数设置为:k1i=9,k2i=12,神经网络的初始值为神经网络节点数为N=21×11=231,中心点均匀分布在[2 4]×[-0.5 0.5]上,宽度为η1j=η2j=5;神经网络权值更新率的增益项Γ1i=diag[2,2],Γ2i=diag[2,2],神经网络权值更新率的设计常数σ1i=σ2i=diag[0,0]。
如图7、图8所示,在神经网络权值W1的2范数仿真图和神经网络权值W2的2范数仿真图显示了三个移动机器人的神经网络权值都能最终稳定,证明了本实施例神经网络的有效性,如图9、图10所示,从移动机器人的左轮控制力矩图和移动机器人的右轮控制力矩图可以看出,控制力矩是有界的。
设计控制力矩为:
其中,τ1i,τ2i分别是第i个移动机器人的左轮和右轮的控制力矩;
步骤7、将各个相邻移动机器人的路径参数信息进行交换,然后设计编队控制器对多个移动机器人进行协同路径编队控制。
设计编队控制器具体步骤如下:
定义路径参数误差为:
其中,ei是第i个移动机器人路径参数误差,si是第i个移动机器人的路径参数,sj是第j个移动机器人的路径参数,aij是上面L1矩阵中在第i行第j列的取值;
定义编队中两个虚拟机器人的路径参数更新率为:
其中,是头部虚拟移动机器人路径参数的导数,是尾部虚拟移动机器人路径参数的导数,且满足初始时刻sN+1(t0)<sN+2(t0),在本实施例中,si(0)=0,i=1,2,3,sN+2(0)=4,sN+1(0)=0;
定义e=[e1,…,eN]T,χ=[χ1,…,χN]T,则有
将χi作为一个状态,设计编队控制器为:
在本实施例中,k3i=1,k4i=0.3,关于编队性能,图3的右边小图可以清晰地看出三个移动机器人保持设计的编队方式,同时保持着一定安全距离。
上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。
Claims (9)
1.一种基于神经网络的受限移动机器人协同路径跟踪控制方法,其特征在于,包括下述步骤:
S1:构建单个移动机器人的运动学与动力学模型,然后对模型方程进行转换,将所述单个移动机器人的运动学和动力学模型转换成位姿和状态的微分方程,并扩充到多个移动机器人后形成动态方程;
S2:构建移动机器人的位置和方向角误差方程;
先构建x轴、y轴和方向角的误差方程,然后求导得到下述误差方程:
其中,xei,yei分别是第i个移动机器人的x轴方向、y轴方向误差,zei是第i个移动机器人的位置误差,是第i个移动机器人位置误差的导数,ψei是第i个移动机器人的方向角误差,是第i个移动机器人方向角误差的导数,vi、wi分别是第i个移动机器人的线速度与角速度,ψi是第i个移动机器人的方向角,是第i个移动机器人路径参数的导数,x′di,y′di分别是第i个移动机器人x轴,y轴路径对路径参数si的微分;
S3:构建移动机器人的性能受限tan型障碍李雅普诺夫函数;
S4:基于图论知识,构建多个移动机器人的编队方式;
S5:构建单个移动机器人的路径参数更新率方程,采用后推设计方法设计虚拟控制器;
S6:设计自适应神经网络控制器;
采用神经网络辨识与状态有关的非线性建模不确定项,设计神经网络控制器为:
其中,τvi表示第i个移动机器人线速度动态中的控制力矩,τwi表示第i个移动机器人角速度动态中的控制力矩,表示第i个移动机器人的神经网络输出,k1i,k2i表示设计的控制器增益常数,表示第i个移动机器人线速度动态中的惯性系数,表示第i个移动机器人角速度动态中的惯性系数,z11i表示第i个移动机器人真实线速度和虚拟线速度的差值,z12i表示第i个移动机器人真实角速度和虚拟角速度的差值,表示第i个移动机器人虚拟线速度控制器的导数,表示第i个移动机器人虚拟角速度控制器的导数,βdi表示位置误差的边界函数,δdi表示位置误差的跟踪函数,βψi表示方向角误差的边界函数,π表示圆周率;
S7:将各个相邻移动机器人的路径参数信息进行交换,然后设计编队控制器对多个移动机器人进行协同路径编队控制,
设计编队控制器为:
5.根据权利要求1所述基于神经网络的受限移动机器人协同路径跟踪控制方法,其特征在于,步骤S3中所述构建移动机器人的性能受限tan型障碍李雅普诺夫函数,具体为:
第i个移动机器人的性能受限tan型障碍李雅普诺夫函数为:
其中,Vzei,Vψei分别是处理位置误差zei,方向角误差ψei的tan型障碍李雅普诺夫函数;βdi表示位置误差的边界函数,βdi,0是位置初始误差,βdi,∞是位置终值误差,t表示时间,κdi是位置误差边界函数调节参数;δdi是位置误差的跟踪函数,δdi,0是初始误差,δdi,∞是终值误差,参数满足:βdi,0>βdi,∞>0,δdi,0>δdi,∞>0,δdi,0-δdi,∞>βdi,0-βdi,∞>0,δdi,∞>βdi,∞;βψi(t)是方向角误差的边界函数,βψi,0是方向角初始误差,βψi,∞是方向角终值误差,κψi是方向角误差边界函数调节参数,且满足βψi,0>βψi,∞>0,
8.根据权利要求1所述基于神经网络的受限移动机器人协同路径跟踪控制方法,其特征在于,在步骤S6中,将神经网络权值的更新调整率设置为:
S1i(Z1i)=[s11i,s12i,…,s1Ni]T
S2i(Z2i)=[s21i,s22i,...,s2Ni]T
其中,Z1i=Z2i=[vi,wi]T为神经网络的输入,Γ1i,Γ2i为神经网络权值更新率的增益项,σ1i,σ2i为设计的正常数,S1i(Z1i)、S2i(Z2i)、s1ji、s2ji为高斯基函数,θ1ji,θ2ji为中心点,η1ji,η2ji为宽度,j=1,…,N,N为神经网络节点数;
设计控制力矩为:
其中,τ1i,τ2i分别是第i个移动机器人的左轮和右轮的控制力矩。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910848231.0A CN110658811B (zh) | 2019-09-09 | 2019-09-09 | 基于神经网络的受限移动机器人协同路径跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910848231.0A CN110658811B (zh) | 2019-09-09 | 2019-09-09 | 基于神经网络的受限移动机器人协同路径跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110658811A CN110658811A (zh) | 2020-01-07 |
CN110658811B true CN110658811B (zh) | 2020-09-18 |
Family
ID=69038014
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910848231.0A Active CN110658811B (zh) | 2019-09-09 | 2019-09-09 | 基于神经网络的受限移动机器人协同路径跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110658811B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111136633B (zh) * | 2020-01-13 | 2021-04-09 | 燕山大学 | 针对时变时延下柔性主-从机器人系统的全状态控制方法 |
CN113009930B (zh) * | 2021-03-05 | 2022-02-11 | 北京航空航天大学 | 一种无人飞艇编队飞行轨迹跟踪控制方法及系统 |
CN116039636B (zh) * | 2022-12-15 | 2024-01-30 | 南通大学 | 考虑车轮打滑的轮式移动机器人自适应神经网络控制方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3765713B2 (ja) * | 2000-07-10 | 2006-04-12 | 独立行政法人科学技術振興機構 | ロボットの協調制御方法及び協調制御装置 |
JP2014079819A (ja) * | 2012-10-12 | 2014-05-08 | Nippon Telegr & Teleph Corp <Ntt> | ロボット協調搬送計画装置、方法、プログラム |
CN106654987A (zh) * | 2016-11-18 | 2017-05-10 | 华北电力大学(保定) | 电力线路多机器人协作巡检方法 |
CN107168369A (zh) * | 2017-06-13 | 2017-09-15 | 中国科学院声学研究所 | 一种欠驱动无人车的编队控制方法及系统 |
RU2658684C1 (ru) * | 2017-01-10 | 2018-06-22 | Федеральное государственное бюджетное образовательное учреждение высшего образования "Санкт-Петербургский государственный университет телекоммуникаций им. проф. М.А. Бонч-Бруевича" | Мультиагентная робототехническая система |
CN109857115A (zh) * | 2019-02-27 | 2019-06-07 | 华南理工大学 | 一种基于视觉反馈的移动机器人的有限时间编队控制方法 |
CN109917818A (zh) * | 2019-01-31 | 2019-06-21 | 天津大学 | 基于地面机器人的协同搜索围堵方法 |
CN110045600A (zh) * | 2018-01-15 | 2019-07-23 | 北京航空航天大学 | 一种欠驱动多移动机器人的编队迭代学习控制方法 |
CN110083166A (zh) * | 2019-05-30 | 2019-08-02 | 浙江远传信息技术股份有限公司 | 针对多机器人的协同调度方法、装置、设备及介质 |
CN110196597A (zh) * | 2019-06-06 | 2019-09-03 | 哈尔滨理工大学 | 一种基于轨迹约束的多移动机器人协同运输方法 |
-
2019
- 2019-09-09 CN CN201910848231.0A patent/CN110658811B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3765713B2 (ja) * | 2000-07-10 | 2006-04-12 | 独立行政法人科学技術振興機構 | ロボットの協調制御方法及び協調制御装置 |
JP2014079819A (ja) * | 2012-10-12 | 2014-05-08 | Nippon Telegr & Teleph Corp <Ntt> | ロボット協調搬送計画装置、方法、プログラム |
CN106654987A (zh) * | 2016-11-18 | 2017-05-10 | 华北电力大学(保定) | 电力线路多机器人协作巡检方法 |
RU2658684C1 (ru) * | 2017-01-10 | 2018-06-22 | Федеральное государственное бюджетное образовательное учреждение высшего образования "Санкт-Петербургский государственный университет телекоммуникаций им. проф. М.А. Бонч-Бруевича" | Мультиагентная робототехническая система |
CN107168369A (zh) * | 2017-06-13 | 2017-09-15 | 中国科学院声学研究所 | 一种欠驱动无人车的编队控制方法及系统 |
CN110045600A (zh) * | 2018-01-15 | 2019-07-23 | 北京航空航天大学 | 一种欠驱动多移动机器人的编队迭代学习控制方法 |
CN109917818A (zh) * | 2019-01-31 | 2019-06-21 | 天津大学 | 基于地面机器人的协同搜索围堵方法 |
CN109857115A (zh) * | 2019-02-27 | 2019-06-07 | 华南理工大学 | 一种基于视觉反馈的移动机器人的有限时间编队控制方法 |
CN110083166A (zh) * | 2019-05-30 | 2019-08-02 | 浙江远传信息技术股份有限公司 | 针对多机器人的协同调度方法、装置、设备及介质 |
CN110196597A (zh) * | 2019-06-06 | 2019-09-03 | 哈尔滨理工大学 | 一种基于轨迹约束的多移动机器人协同运输方法 |
Non-Patent Citations (6)
Title |
---|
Cooperative Robot Localization and Target Tracking based on Least Squares Minimization;Aamir Ahmad;《2013 IEEE International Conference on Robotics and Automation (ICRA)》;20130510;5696-5701 * |
Globally Stable Adaptive Cooperative Path Following Controller Design for Multiple AUVs;Hao Wang 等;《2016 3rd International Conference Systems on Informative and Cybernetics for Computational Social (1CCSS)》;20161231;312-316 * |
Robot Learning System Based on Adaptive Neural Control and Dynamic Movement Primitives;Chenguang Yang 等;《IEEE TRANSACTIONS ON NEURAL NETWORKS AND LEARNING SYSTEMS》;20190331;第30卷(第3期);777-787 * |
一种基于模糊方法的领导-跟随型多机器人编队控制;吴垠 等;《智能系统学报》;20150831;第10卷(第4期);533-540 * |
基于路径参数协同的多移动机器人编队控制;王银涛 等;《计算机仿真》;20110630;第28卷(第6期);193-197 * |
多移动机器人编队的鲁棒预测控制;刘安东 等;《控制工程》;20180228;第25卷(第2期);267-272 * |
Also Published As
Publication number | Publication date |
---|---|
CN110658811A (zh) | 2020-01-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Binh et al. | An adaptive backstepping trajectory tracking control of a tractor trailer wheeled mobile robot | |
Li et al. | Robust tracking control strategy for a quadrotor using RPD-SMC and RISE | |
Wang et al. | A robust model predictive control strategy for trajectory tracking of omni-directional mobile robots | |
CN110658811B (zh) | 基于神经网络的受限移动机器人协同路径跟踪控制方法 | |
CN111665855B (zh) | 一种机器人预设性编队控制方法 | |
Tsai et al. | Distributed consensus formation control with collision and obstacle avoidance for uncertain networked omnidirectional multi-robot systems using fuzzy wavelet neural networks | |
Rajappa et al. | Adaptive super twisting controller for a quadrotor uav | |
Dong et al. | Formation control of nonholonomic mobile robots | |
Tran et al. | Switching formation strategy with the directed dynamic topology for collision avoidance of a multi‐robot system in uncertain environments | |
Gkountas et al. | Leader/follower force control of aerial manipulators | |
CN115639830A (zh) | 一种空地智能体协同编队控制系统及其编队控制方法 | |
Qian et al. | Observer-based leader-following formation control of uncertain multiple agents by integral sliding mode | |
Bazoula et al. | Formation control of multi-robots via fuzzy logic technique | |
CN114935943A (zh) | 一种无人机与无人车集群编队跟踪控制方法及系统 | |
Zhang et al. | A distributed adaptive mixed self-/event-triggered formation control approach for multiple stratospheric airships with relative state constraints and input delay | |
Chung et al. | Cooperative robot control and synchronization of Lagrangian systems | |
Barogh et al. | Formation control of non-holonomic agents with collision avoidance | |
Seghour et al. | Consensus-based approach and reactive fuzzy navigation for multiple no-holonomic mobile robots | |
Lindqvist et al. | Collision avoidance for multiple MAVs using fast centralized NMPC | |
Kanjanawanishkul | Coordinated path following for mobile robots using a virtual structure strategy with model predictive control | |
Ali et al. | Control system analysis and design of quadcopter in the presence of unmodelled dynamics and disturbances | |
Watanabe et al. | Stabilization of a fire truck robot by an invariant manifold theory | |
CN113821028A (zh) | 基于分布式模型预测控制的欠驱动auv编队轨迹跟踪控制方法 | |
Xu et al. | Multivehicle motion planning with posture constraints in real world | |
Li et al. | A Hierarchical Path Tracking Method for High-speed Unmanned Tracked Vehicle |
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 |