CN110658811B - 基于神经网络的受限移动机器人协同路径跟踪控制方法 - Google Patents

基于神经网络的受限移动机器人协同路径跟踪控制方法 Download PDF

Info

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
Application number
CN201910848231.0A
Other languages
English (en)
Other versions
CN110658811A (zh
Inventor
王敏
张玉望
戴诗陆
杨辰光
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Foshan Newhinken Intelligent Technology Co ltd
South China University of Technology SCUT
Original Assignee
Foshan Newhinken Intelligent Technology Co ltd
South China University of Technology SCUT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Foshan Newhinken Intelligent Technology Co ltd, South China University of Technology SCUT filed Critical Foshan Newhinken Intelligent Technology Co ltd
Priority to CN201910848231.0A priority Critical patent/CN110658811B/zh
Publication of CN110658811A publication Critical patent/CN110658811A/zh
Application granted granted Critical
Publication of CN110658811B publication Critical patent/CN110658811B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control 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轴和方向角的误差方程,然后求导得到下述误差方程:
Figure BDA0002195999340000021
Figure BDA0002195999340000022
其中,xei,yei分别是第i个移动机器人的x轴方向、y轴方向误差,zei是第i个移动机器人的位置误差,
Figure BDA0002195999340000023
是第i个移动机器人位置误差的导数,ψei是第i个移动机器人的方向角误差,
Figure BDA0002195999340000024
是第i个移动机器人方向角误差的导数,vi、wi分别是第i个移动机器人的线速度与角速度,ψi是第i个移动机器人的方向角,
Figure BDA0002195999340000031
是第i个移动机器人路径参数的导数,x′di,y′di分别是第i个移动机器人x轴,y轴路径对路径参数si的微分;
S3:构建移动机器人的性能受限tan型障碍李雅普诺夫函数;
S4:基于图论知识,构建多个移动机器人的编队方式;
S5:构建单个移动机器人的路径参数更新率方程,采用后推设计方法设计虚拟控制器;
S6:设计自适应神经网络控制器;
采用神经网络辨识与状态有关的非线性建模不确定项,设计神经网络控制器为:
Figure BDA0002195999340000032
Figure BDA0002195999340000033
其中,τvi表示第i个移动机器人线速度动态中的控制力矩,τwi表示第i个移动机器人角速度动态中的控制力矩,
Figure BDA0002195999340000034
表示第i个移动机器人的神经网络输出,k1i,k2i表示设计的控制器增益常数,
Figure BDA0002195999340000035
表示第i个移动机器人线速度动态中的惯性系数,
Figure BDA0002195999340000036
表示第i个移动机器人角速度动态中的惯性系数,z11i表示第i个移动机器人真实线速度和虚拟线速度的差值,z12i表示第i个移动机器人真实角速度和虚拟角速度的差值,
Figure BDA0002195999340000037
表示第i个移动机器人虚拟线速度控制器的导数,
Figure BDA0002195999340000038
表示第i个移动机器人虚拟角速度控制器的导数,βdi表示位置误差的边界函数,δdi表示位置误差的跟踪函数,βψi表示方向角误差的边界函数,π表示圆周率;
S7:将各个相邻移动机器人的路径参数信息进行交换,然后设计编队控制器对多个移动机器人进行协同路径编队控制。
作为优选的技术方案,步骤S1所述的构建单个移动机器人的运动学与动力学模型,具体表示为:
Figure BDA0002195999340000041
η=[x,y,ψ]T
w=[w1,w2]T
Figure BDA0002195999340000042
τ=[τ1,τ2];
其中,x,y表示移动机器人的位置坐标,ψ表示移动机器人的方向角,w1,w2分别表示移动机器人左轮与右轮的角速度,τ1,τ2分别表示移动机器人左轮与右轮的控制力矩,M表示惯性矩阵,
Figure BDA0002195999340000043
表示向心力和科氏力矩阵,D表示表面摩擦力矩阵,J(η)表示旋转矩阵。
作为优选的技术方案,步骤S1中所述扩充到多个移动机器人后形成动态方程,具体表示为:
Figure BDA0002195999340000044
Figure BDA0002195999340000045
Figure BDA0002195999340000046
Figure BDA0002195999340000047
Figure BDA0002195999340000048
其中,(xi,yi)和ψi分别表示第i个移动机器人的位置和方向角,vi表示第i个移动机器人的线速度,wi表示第i个移动机器人的角速度,Φvi和Φwi表示第i个移动机器人的不确定非线性项。
作为优选的技术方案,步骤S2中所述构建移动机器人的位置和方向角误差方程,具体构建方式为:
构建x轴、y轴和方向角的误差方程:
xei=xd(si)-xi
yei=yd(si)-yi
Figure BDA0002195999340000051
ψei=ψidi
其中,
Figure BDA0002195999340000052
表示第i个移动机器人的理想方向角,si是第i个移动机器人的路径参数,xd(si)是路径参数取si时对应x轴的位置,yd(si)是路径参数取si时对应y轴的位置。
作为优选的技术方案,步骤S3中所述构建移动机器人的性能受限tan型障碍李雅普诺夫函数,具体为:
第i个移动机器人的性能受限tan型障碍李雅普诺夫函数为:
Figure BDA0002195999340000053
Figure BDA0002195999340000054
Figure BDA0002195999340000055
Figure BDA0002195999340000056
Figure BDA0002195999340000057
其中,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,0di,∞>βdi,0di,∞>0,δdi,∞>βdi,∞;βψi(t)是方向角误差的边界函数,βψi,0是方向角初始误差,βψi,∞是方向角终值误差,κψi是方向角误差边界函数调节参数,且满足βψi,0>βψi,∞>0,
Figure BDA0002195999340000061
作为优选的技术方案,步骤S4中所述构建多个移动机器人的编队方式,具体方式为:
采用固定和双向的编队拓扑,编队两端设置为独立于跟随者的虚拟领导者,标号分别为机器人N+1,机器人N+2,每个跟随者与它相邻的机器人进行路径参数信息交换,所述机器人的编队通信拓扑根据图论知识得到:
Figure BDA0002195999340000062
其中,02×N是2行N列的零矩阵,02×2是2行2列的零矩阵,L1和L2分别表示为:
Figure BDA0002195999340000063
作为优选的技术方案,步骤S5中所述构建单个移动机器人的路径参数更新率方程,具体方法为:
定义第i个移动机器人路径参数更新率方程为:
Figure BDA0002195999340000064
其中,vs是参考速度,χi是一个设计变量;
定义中间误差变量为:
Z11i=vivi
Z12i=wiwi
其中,αvi,αwi分别表示虚拟线速度和角速度,vi、wi分别是第i个移动机器人的线速度与角速度;
所述设计虚拟控制器为:
Figure BDA0002195999340000071
Figure BDA0002195999340000072
其中,kji,kj1i表示调节参数,满足
Figure BDA0002195999340000073
Figure BDA0002195999340000074
表示位置误差跟踪函数的导数。
作为优选的技术方案,在步骤S6中,将神经网络权值的更新调整率设置为:
Figure BDA0002195999340000075
Figure BDA0002195999340000076
S1i(Z1i)=[s11i,s12i,…,s1Ni]T
S2i(Z2i)=[s21i,s22i,…,s2Ni]T
Figure BDA0002195999340000077
Figure BDA0002195999340000078
其中,Z1i=Z2i=[vi,wi]T为神经网络的输入,Γ1i,Γ2i为神经网络权值更新率的增益项,σ1i,σ2i为设计的正常数,S1i(Z1i)、S2i(Z2i)、s1ji、s2ji为高斯基函数,θ1ji,θ2ji为中心点,η1ji,η2ji为宽度,j=1,…,N,N为神经网络节点数;
设计控制力矩为:
Figure BDA0002195999340000079
Figure BDA00021959993400000710
其中,τ1i,τ2i分别是第i个移动机器人的左轮和右轮的控制力矩。
作为优选的技术方案,步骤S7中所述设计编队控制器对多个移动机器人进行协同路径编队控制,具体步骤为:
定义路径参数误差为:
Figure BDA0002195999340000081
其中,ei是第i个移动机器人路径参数误差,si是第i个移动机器人的路径参数,sj是第j个移动机器人的路径参数,aij是上面L1矩阵中在第i行第j列的取值;
定义编队中两个虚拟机器人的路径参数更新率为:
Figure BDA0002195999340000082
其中,
Figure BDA0002195999340000083
是头部虚拟移动机器人路径参数的导数,
Figure BDA0002195999340000084
是尾部虚拟移动机器人路径参数的导数,且满足初始时刻sN+1(t0)<sN+2(t0);
定义e=[e1,…,eN]T,χ=[x1,…,χN]T,则有
Figure BDA0002195999340000085
将χi作为一个状态,设计控制器为:
Figure BDA0002195999340000086
Figure BDA0002195999340000087
Figure BDA0002195999340000088
其中,k3i,k4i是正常数,
Figure BDA0002195999340000089
是中间状态。
本发明与现有技术相比,具有如下优点和有益效果:
(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个移动机器人进行举例说明;
建立单个移动机器人的运动学和动力学模型为:
Figure BDA0002195999340000101
Figure BDA0002195999340000102
其中,η=[x,y,ψ]T,x,y,ψ分别是移动机器人的位置(x,y)和方向角(ψ),w=[w1,w2]T,w1,w2分别为移动机器人左轮与右轮的角速度,τ=[τ1,τ2],τ1,τ2分别为移动机器人左轮与右轮的控制力矩,M是惯性矩阵,
Figure BDA0002195999340000103
是向心力和科氏力矩阵,D为表面摩擦力矩阵,J(η)是旋转矩阵;
其中,
Figure BDA0002195999340000104
Figure BDA0002195999340000111
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个移动机器人后的动态方程为:
Figure BDA0002195999340000112
Figure BDA0002195999340000113
Figure BDA0002195999340000114
Figure BDA0002195999340000115
Figure BDA0002195999340000116
其中,(xi,yi)和ψi分别为第i个移动机器人的位置和方向角,vi表示第i个移动机器人的线速度,wi表示第i个移动机器人的角速度,Φvi和Φwi表示第i个移动机器人的不确定非线性项,τvi表示第i个移动机器人线速度动态中的控制力矩,τwi表示第i个移动机器人角速度动态中的控制力矩,
Figure BDA0002195999340000117
是第i个移动机器人线速度动态中的惯性系数,其形式为
Figure BDA0002195999340000118
Figure BDA0002195999340000119
是第i个移动机器人角速度动态中的惯性系数,其形式为
Figure BDA00021959993400001110
本实例中,α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
Figure BDA0002195999340000121
ψei=ψidi
其中,
Figure BDA0002195999340000122
表示第i个移动机器人的理想方向角,si是第i个移动机器人的路径参数,xd(si)是路径参数取si时对应x轴的位置,yd(si)是路径参数取si时对应y轴的位置;xei,yei,zei分别是第i个移动机器人的x轴方向误差、y轴方向误差和位置误差,ψei是第i个移动机器人的方向角误差;
然后求导得到以下误差方程:
Figure BDA0002195999340000123
Figure BDA0002195999340000124
其中,xei,yei分别是第i个移动机器人的x轴方向、y轴方向误差,zei是第i个移动机器人的位置误差,
Figure BDA0002195999340000125
是第i个移动机器人位置误差的导数,
Figure BDA0002195999340000126
是第i个移动机器人方向角误差的导数,vi、wi分别是第i个移动机器人的线速度与角速度,ψi是第i个移动机器人的方向角,
Figure BDA0002195999340000137
是第i个移动机器人路径参数的导数,x′di,y′di分别是第i个移动机器人x轴,y轴路径对路径参数si的微分;
步骤3、建立移动机器人的性能受限tan型障碍李雅普诺夫函数;
第i个移动机器人的性能受限tan型障碍李雅普诺夫函数为:
Figure BDA0002195999340000131
Figure BDA0002195999340000132
其中,Vzei,Vψei分别是处理位置误差zei,方向角误差ψei的tan型障碍李雅普诺夫函数;
Figure BDA0002195999340000133
是位置误差的边界函数,式中,βdi,0是位置初始误差,βdi,∞是位置终值误差,t表示时间,κdi是位置误差边界函数调节参数;
Figure BDA0002195999340000134
是位置误差的跟踪函数,式中,δdi,0是初始误差,δdi,∞是终值误差,为了限制位置误差zei在大于0的区域,参数需要满足:βdi,0>βdi,∞>0,δdi,0>δdi,∞>0,δdi,0di,∞>βdi,0di,∞>0,δdi,∞>βdi,∞;同理
Figure BDA0002195999340000135
是方向角误差的边界函数,式中,βψi,0是方向角初始误差,βψi,∞是方向角终值误差,κψi是方向角误差边界函数调节参数,且满足βψi,0>βψi,∞>0,
Figure BDA0002195999340000136
在本实施例中,通过多次试验,参数优选为:β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,每个跟随者与它相邻的机器人进行路径参数信息交换,其通信拓扑根据图论知识得:
Figure BDA0002195999340000141
其中,02×N是2行N列的零矩阵,02×2是2行2列的零矩阵,L1和L2分别表达为:
Figure BDA0002195999340000142
在本实施例中,优选3个移动机器人进行编队控制,则有:
Figure BDA0002195999340000143
步骤5、建立单个移动机器人的路径参数更新率方程,使用后推设计方法,设计虚拟控制器;
步骤5具体实现过程为:
定义第i个移动机器人路径参数更新率方程为:
Figure BDA0002195999340000144
其中,vs是参考速度,本实施例优选为vs=1.2,χi是一个设计变量;
定义中间误差变量为:
Z11i=vivi
Z12i=wiwi
其中,αvi,αwi分别为虚拟线速度和角速度,vi、wi分别是第i个移动机器人的线速度与角速度,
设计虚拟控制器为:
Figure BDA0002195999340000151
Figure BDA0002195999340000152
其中,kji,kj1i是调节参数,并且满足kji>2kj1i
Figure BDA0002195999340000153
Figure BDA0002195999340000154
Figure BDA0002195999340000155
是位置误差跟踪函数的导数,在本实施例中,参数设置为:kdi=12.6,kd1i=6,kψi=5.4,kψ1i=2.7;
步骤6、设计自适应神经网络控制器;
采用神经网络辨识与状态有关的非线性建模不确定项,设计神经网络控制器为:
Figure BDA0002195999340000156
Figure BDA0002195999340000157
其中,τvi表示第i个移动机器人线速度动态中的控制力矩,τwi表示第i个移动机器人角速度动态中的控制力矩,
Figure BDA0002195999340000158
表示第i个移动机器人的神经网络输出,k1i,k2i表示设计的控制器增益常数,
Figure BDA0002195999340000159
表示第i个移动机器人线速度动态中的惯性系数,
Figure BDA00021959993400001510
表示第i个移动机器人角速度动态中的惯性系数,z11i表示第i个移动机器人真实线速度和虚拟线速度的差值,z12i表示第i个移动机器人真实角速度和虚拟角速度的差值,
Figure BDA0002195999340000161
表示第i个移动机器人虚拟线速度控制器的导数,
Figure BDA0002195999340000162
表示第i个移动机器人虚拟角速度控制器的导数,βdi表示位置误差的边界函数,8di是位置误差的跟踪函数,βψi是方向角误差的边界函数,π表示圆周率,zei是第i个移动机器人的位置误差,ψei是第i个移动机器人的方向角误差;
在步骤6中,选择神经网络权值
Figure BDA0002195999340000163
的更新调整率为:
Figure BDA0002195999340000164
Figure BDA0002195999340000165
其中,Z1i=Z2i=[vi,wi]T为神经网络的输入,Γ1i,Γ2i为神经网络权值更新率的增益项,σ1i,σ2i为设计的正常数,S1i(Z1i)=[s11i,s12i,…,s1Ni]T
Figure BDA0002195999340000166
Figure BDA0002195999340000167
为高斯基函数,θ1ji,θ2ji为中心点,η1ji,η2ji为宽度,j=1,…,N,N为神经网络节点数;
在本实施例中,参数设置为:k1i=9,k2i=12,神经网络的初始值为
Figure BDA0002195999340000168
神经网络节点数为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所示,从移动机器人的左轮控制力矩图和移动机器人的右轮控制力矩图可以看出,控制力矩是有界的。
设计控制力矩为:
Figure BDA0002195999340000171
Figure BDA0002195999340000172
其中,τ1i,τ2i分别是第i个移动机器人的左轮和右轮的控制力矩;
步骤7、将各个相邻移动机器人的路径参数信息进行交换,然后设计编队控制器对多个移动机器人进行协同路径编队控制。
设计编队控制器具体步骤如下:
定义路径参数误差为:
Figure BDA0002195999340000173
其中,ei是第i个移动机器人路径参数误差,si是第i个移动机器人的路径参数,sj是第j个移动机器人的路径参数,aij是上面L1矩阵中在第i行第j列的取值;
定义编队中两个虚拟机器人的路径参数更新率为:
Figure BDA0002195999340000174
其中,
Figure BDA0002195999340000175
是头部虚拟移动机器人路径参数的导数,
Figure BDA0002195999340000176
是尾部虚拟移动机器人路径参数的导数,且满足初始时刻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,则有
Figure BDA0002195999340000177
将χi作为一个状态,设计编队控制器为:
Figure BDA0002195999340000178
Figure BDA0002195999340000179
其中,k3i,k4i是正常数,
Figure BDA00021959993400001710
是中间状态,ξi的形式如下:
Figure BDA0002195999340000181
在本实施例中,k3i=1,k4i=0.3,关于编队性能,图3的右边小图可以清晰地看出三个移动机器人保持设计的编队方式,同时保持着一定安全距离。
上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。

Claims (9)

1.一种基于神经网络的受限移动机器人协同路径跟踪控制方法,其特征在于,包括下述步骤:
S1:构建单个移动机器人的运动学与动力学模型,然后对模型方程进行转换,将所述单个移动机器人的运动学和动力学模型转换成位姿和状态的微分方程,并扩充到多个移动机器人后形成动态方程;
S2:构建移动机器人的位置和方向角误差方程;
先构建x轴、y轴和方向角的误差方程,然后求导得到下述误差方程:
Figure FDA0002559145550000011
Figure FDA0002559145550000012
其中,xei,yei分别是第i个移动机器人的x轴方向、y轴方向误差,zei是第i个移动机器人的位置误差,
Figure FDA0002559145550000013
是第i个移动机器人位置误差的导数,ψei是第i个移动机器人的方向角误差,
Figure FDA0002559145550000014
是第i个移动机器人方向角误差的导数,vi、wi分别是第i个移动机器人的线速度与角速度,ψi是第i个移动机器人的方向角,
Figure FDA0002559145550000015
是第i个移动机器人路径参数的导数,x′di,y′di分别是第i个移动机器人x轴,y轴路径对路径参数si的微分;
S3:构建移动机器人的性能受限tan型障碍李雅普诺夫函数;
S4:基于图论知识,构建多个移动机器人的编队方式;
S5:构建单个移动机器人的路径参数更新率方程,采用后推设计方法设计虚拟控制器;
S6:设计自适应神经网络控制器;
采用神经网络辨识与状态有关的非线性建模不确定项,设计神经网络控制器为:
Figure FDA0002559145550000021
Figure FDA0002559145550000022
其中,τvi表示第i个移动机器人线速度动态中的控制力矩,τwi表示第i个移动机器人角速度动态中的控制力矩,
Figure FDA0002559145550000023
表示第i个移动机器人的神经网络输出,k1i,k2i表示设计的控制器增益常数,
Figure FDA0002559145550000024
表示第i个移动机器人线速度动态中的惯性系数,
Figure FDA0002559145550000025
表示第i个移动机器人角速度动态中的惯性系数,z11i表示第i个移动机器人真实线速度和虚拟线速度的差值,z12i表示第i个移动机器人真实角速度和虚拟角速度的差值,
Figure FDA0002559145550000026
表示第i个移动机器人虚拟线速度控制器的导数,
Figure FDA0002559145550000027
表示第i个移动机器人虚拟角速度控制器的导数,βdi表示位置误差的边界函数,δdi表示位置误差的跟踪函数,βψi表示方向角误差的边界函数,π表示圆周率;
S7:将各个相邻移动机器人的路径参数信息进行交换,然后设计编队控制器对多个移动机器人进行协同路径编队控制,
设计编队控制器为:
Figure FDA0002559145550000028
Figure FDA0002559145550000029
Figure FDA00025591455500000210
其中,k3i,k4i是正常数,χi是编队控制器的状态变量,
Figure FDA00025591455500000211
是中间状态,ei是第i个移动机器人路径参数误差。
2.根据权利要求1所述基于神经网络的受限移动机器人协同路径跟踪控制方法,其特征在于,步骤S1所述的构建单个移动机器人的运动学与动力学模型,具体表示为:
Figure FDA0002559145550000031
η=[x,y,ψ]T
w=[w1,w2]T
Figure FDA0002559145550000032
τ=[τ12];
其中,x,y表示移动机器人的位置坐标,ψ表示移动机器人的方向角,w1,w2分别表示移动机器人左轮与右轮的角速度,τ12分别表示移动机器人左轮与右轮的控制力矩,M表示惯性矩阵,
Figure FDA0002559145550000033
表示向心力和科氏力矩阵,D表示表面摩擦力矩阵,J(η)表示旋转矩阵。
3.根据权利要求1所述基于神经网络的受限移动机器人协同路径跟踪控制方法,其特征在于,步骤S1中所述扩充到多个移动机器人后形成动态方程,具体表示为:
Figure FDA0002559145550000034
Figure FDA0002559145550000035
Figure FDA0002559145550000036
Figure FDA0002559145550000037
Figure FDA0002559145550000038
其中,(xi,yi)和ψi分别表示第i个移动机器人的位置和方向角,vi表示第i个移动机器人的线速度,wi表示第i个移动机器人的角速度,Φvi和Φwi表示第i个移动机器人的不确定非线性项。
4.根据权利要求1所述基于神经网络的受限移动机器人协同路径跟踪控制方法,其特征在于,步骤S2中所述构建移动机器人的位置和方向角误差方程,具体构建方式为:
构建x轴、y轴和方向角的误差方程:
xei=xd(si)-xi
yei=yd(si)-yi
Figure FDA0002559145550000041
ψei=ψidi
其中,
Figure FDA0002559145550000042
表示第i个移动机器人的理想方向角,si是第i个移动机器人的路径参数,xd(si)是路径参数取si时对应x轴的位置,yd(si)是路径参数取si时对应y轴的位置。
5.根据权利要求1所述基于神经网络的受限移动机器人协同路径跟踪控制方法,其特征在于,步骤S3中所述构建移动机器人的性能受限tan型障碍李雅普诺夫函数,具体为:
第i个移动机器人的性能受限tan型障碍李雅普诺夫函数为:
Figure FDA0002559145550000043
Figure FDA0002559145550000044
Figure FDA0002559145550000045
Figure FDA0002559145550000046
Figure FDA0002559145550000047
其中,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,0di,∞>βdi,0di,∞>0,δdi,∞>βdi,∞;βψi(t)是方向角误差的边界函数,βψi,0是方向角初始误差,βψi,∞是方向角终值误差,κψi是方向角误差边界函数调节参数,且满足βψi,0>βψi,∞>0,
Figure FDA0002559145550000051
6.根据权利要求1所述基于神经网络的受限移动机器人协同路径跟踪控制方法,其特征在于,步骤S4中所述构建多个移动机器人的编队方式,具体方式为:
采用固定和双向的编队拓扑,编队两端设置为独立于跟随者的虚拟领导者,标号分别为机器人N+1,机器人N+2,每个跟随者与它相邻的机器人进行路径参数信息交换,所述机器人的编队通信拓扑根据图论知识得到:
Figure FDA0002559145550000052
其中,02×N是2行N列的零矩阵,02×2是2行2列的零矩阵,L1和L2分别表示为:
Figure FDA0002559145550000053
7.根据权利要求1所述基于神经网络的受限移动机器人协同路径跟踪控制方法,其特征在于,步骤S5中所述构建单个移动机器人的路径参数更新率方程,具体方法为:
定义第i个移动机器人路径参数更新率方程为:
Figure FDA0002559145550000054
其中,vs是参考速度,χi是一个设计变量;
定义中间误差变量为:
z11i=vivi
z12i=wiwi
其中,αvi,αwi分别表示虚拟线速度和角速度,vi、wi分别是第i个移动机器人的线速度与角速度;
所述设计虚拟控制器为:
Figure FDA0002559145550000061
Figure FDA0002559145550000062
其中,kji,kj1i表示调节参数,满足kji>2kj1i,
Figure FDA0002559145550000063
j=d,ψ,
Figure FDA0002559145550000064
表示位置误差跟踪函数的导数。
8.根据权利要求1所述基于神经网络的受限移动机器人协同路径跟踪控制方法,其特征在于,在步骤S6中,将神经网络权值的更新调整率设置为:
Figure FDA0002559145550000065
Figure FDA0002559145550000066
S1i(Z1i)=[s11i,s12i,…,s1Ni]T
S2i(Z2i)=[s21i,s22i,...,s2Ni]T
Figure FDA0002559145550000067
Figure FDA0002559145550000068
其中,Z1i=Z2i=[vi,wi]T为神经网络的输入,Γ1i2i为神经网络权值更新率的增益项,σ1i2i为设计的正常数,S1i(Z1i)、S2i(Z2i)、s1ji、s2ji为高斯基函数,θ1ji2ji为中心点,η1ji2ji为宽度,j=1,…,N,N为神经网络节点数;
设计控制力矩为:
Figure FDA0002559145550000071
Figure FDA0002559145550000072
其中,τ1i,τ2i分别是第i个移动机器人的左轮和右轮的控制力矩。
9.根据权利要求6所述基于神经网络的受限移动机器人协同路径跟踪控制方法,其特征在于,步骤S7中所述设计编队控制器对多个移动机器人进行协同路径编队控制,具体步骤为:
定义路径参数误差为:
Figure FDA0002559145550000073
其中,ei是第i个移动机器人路径参数误差,si是第i个移动机器人的路径参数,sj是第j个移动机器人的路径参数,aij是上面L1矩阵中在第i行第j列的取值;
定义编队中两个虚拟机器人的路径参数更新率为:
Figure FDA0002559145550000074
其中,
Figure FDA0002559145550000075
是头部虚拟移动机器人路径参数的导数,
Figure FDA0002559145550000076
是尾部虚拟移动机器人路径参数的导数,且满足初始时刻sN+1(t0)<sN+2(t0);
定义e=[e1,...,eN]T,χ=[χ1,...,χN]T,则有
Figure FDA0002559145550000077
CN201910848231.0A 2019-09-09 2019-09-09 基于神经网络的受限移动机器人协同路径跟踪控制方法 Active CN110658811B (zh)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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 哈尔滨理工大学 一种基于轨迹约束的多移动机器人协同运输方法

Patent Citations (10)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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