一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

兼顾多因素影响的轮式机器人自适应容错可靠控制系统及方法

2022-06-02 13:52:30 来源:中国专利 TAG:


1.本发明属于轮式机器人控制技术领域,涉及轮式机器人容错可靠控制技术,尤其涉及兼顾执行器故障、通讯攻击以及外部扰动等多因素影响的轮式机器人容错可靠控制方法;更为具体地讲,涉及包括受到执行器故障,外界扰动以及通讯攻击下一类轮式机器人系统的建模、系统基于事件机制的观测器设计、容错可靠制器设计、执行器-传感器通道事件触发机制的设计,进而实现轮式机器人容错可靠控制,并对该方法下的跟踪性能进行论证。


背景技术:

2.随着工业自动化程度不断提高,现代工业系统中充满了各种机器人系统,用以满足人们的不同需求。在诸多机器人中,轮式机器人以其高灵活性得到了诸多应用。然而,在实际工作中,机器人构成复杂,诸多传感器以及执行器同时包含在一个系统中。这导致了诸多控制问题。一方面,由于系统部件较多,干扰进入系统渠道增多,使得系统容易受到外界干扰的影响;另一方面,机器人通讯系统容易遭受攻击,如拒绝服务攻击(dos)等,同样影响系统的工作性能。此外,系统执行器还可能会遭受诸多故障等。
3.最近,为了节约系统的传输资源,研究者设计了基于事件的轮式机器人容错控制方法,该方法在非线性系统的应用成为了新的技术研究方向。s.dian等研究了轮式机器人的轨迹控制方法,设计了速度以及转矩控制量[“s.dian,h.fang,t.zhao,q.wu,y.hu,r.guo,s.li,modeling andtrajectory tracking control for magnetic wheeled mobile robots based onimproved dual-heuristic dynamic programming,ieee transactions on dustrial informatics 17(2)(2021)1470-1482.”]。huang等探讨轮式机器人系统在受到外界干扰情况下系统的速度控制问题,为了解决系统的干扰问题,设计了一种干扰观测器[“huang,dawei,zhai,junyong,weiqing,fei,shumin,disturbance observer based robust control for trajectory tracking of wheeled mobile robots,neurocomputing.”]。k.nath等则针对两轮机器人系统设计了其轨迹跟踪方法,为了节约系统的传输量,构建了系统的事件机制[“k.nath,a.yesmin,a.nanda,m.k.bera,event-triggered sliding-modecontrol of two wheeled mobile robot:an experimental validation,ieeejournal of emerging and selected topics in industrial electronics 2(3)(2021)218-226.”]。
[0004]
上述针对机器人系统干扰问题进行的控制研究,在进行系统触发条件设计时,往往基于输入值设定,少有基于系统的控制性能的触发条件的研究。且在已有文献中,少有研究将机器人系统执行器故障、通讯攻击以及外界干扰进行综合研究。此外,在设计系统控制器时,往往假设系统的状态是可测的,该假设增强了系统保守性。


技术实现要素:

[0005]
目前现有轮式机器人容错控制技术存在的难以有效兼顾执行器故障、通讯攻击及
外界干扰,以及基于输入设定、假设条件导致的系统信息传输量大、控制成本高和控制精度低等问题,本发明目的旨在提供一种兼顾多因素影响的轮式机器人自适应容错可靠控制系统及方法,兼顾执行器故障、通讯攻击以及外界干扰对系统的影响,在实现轮式机器人系统的轨迹跟踪控制能力的同时节约系统的通讯资源。
[0006]
为了达到上述目的,本发明采取以下技术方案来实现。
[0007]
本发明所针对的轮式机器人,如图1所示,其包括机器人本体1、安装于机器人本体上部的飞盘2和安装于机器人本体四周的四个车轮3,轮式机器人通过观测器、控制器和执行器来实现控制,轮式机器人通过传感器实时采集轮式机器人角度信息,观测器依据机器人采集的左右轮角度确定机器人状态,控制器根据机器人状态和期望轨迹向执行器发送控制信号。本发明的发明构思包括:
[0008]
(1)建立了轮式机器人系统在受到执行器故障,外界干扰以及通讯攻击影响时的轨迹跟踪控制模型。
[0009]
(2)设计一种新的基于输出触发信息的积分集成观测器,可以实现对该类机器人系统的状态以及总干扰信息的估计,在针对干扰信息估计的过程中,无需干扰信息的上界值。在针对干扰信息估计的过程中,引入了输出积分项,增加观测精度。
[0010]
(3)构建一种滑模控制模块,设计一种新的自适应容错可靠控制方法,在该方法中,包含了自适应参数以及故障-干扰补偿部分。
[0011]
(4)设计一种新的事件触发机制,即在传感器以及控制器两个通道分别设计了事件触发机制;其中,传感器通道设计为自适应触发机制,控制器通道以观测信息为基础设计触发机制,主要用于减少控制器的信息传输值,并对芝诺现象作出说明。
[0012]
(5)设计一种基于事件触发的容错可靠控制方法,在保证机器人系统跟踪能力的同时,有效减少了系统传输负载,并尽量减少故障干扰对系统的影响。
[0013]
基于上述发明构思,本发明提供的兼顾多因素影响的轮式机器人自适应容错可靠控制系统包括机机器人系统模型构建模块、接收模块、第一触发器、观测器、滑模控制模块、第二触发器和控制器:
[0014]
机器人系统模型构建模块,用于构建兼顾执行器故障、通讯攻击以及外界干扰的机器人轨迹跟踪控制模型;
[0015]
接收模块,用于实时接收机器人传感器输出的数据;
[0016]
第一触发器,用于判断传感器输出通道触发条件是否满足,并以满足触发条件时刻的机器人角度触发值作为传感器输出通道触发值发送给观测器;
[0017]
观测器,用于基于构建的机器人轨迹跟踪控制模型,并依据传感器输出通道触发值,对机器人实际状态及总干扰信息进行估计;
[0018]
滑模控制模块,用于基于轮式机器人系统滑模函数得到机器人控制自适应参数;
[0019]
第二触发器,用于判断控制器输出触发条件是否满足;
[0020]
控制器,用于依据观测器得到的机器人实际状态及总干扰信息估计结果及滑模控制模块得到的机器人控制自适应参数,得到满足控制器输出触发条件时刻的机器人实际输出控制,并将其发送给执行器。
[0021]
本发明中,利用机器人系统模型构建模块对机器人轨迹跟踪控制模型构建过程中,考虑轮式机器人系统受到执行器故障、通讯攻击以及外界干扰因素的影响,建模时将上
述因素考虑进去,得到了轮式机器人系统的综合控制模型。
[0022]
针对轮式机器人系统,其满足的动力学模型为:
[0023][0024]
其中,r表示轮胎半径,mi(i=1,2,3,4)表示四个轮的质量(m1=m2=m3=m4),mf表示中间飞盘质量,β表示车轮偏转角度,la和lb分别表示轮式机器人一半的长度和宽度,w
l
和wr分别表示左右轮角度,和分别表示左右轮角度的一阶导数和二阶导数,也即角速度和角加速度,i
z1
和i
zf
分别表示机器人本体和飞盘的惯性质量,fi(i=1,2,3,4)和fi(i=1,2,3,4)表示支撑力和摩擦力,h1=la/r,g表示重力常数因子,u
l
和ur分别表示左右轮的驱动力。
[0025]
进一步的,上述系统可化为:
[0026][0027]
其中,其中,这里,这里,a3=i
z1
,,a7=f2f2 f4f4,a8=f1f1 f3f3,和分别表示w的一阶导数和二阶导数。
[0028]
通过定义x1=w=[w
l wr]
t
,上述机器人系统可以化为:
[0029][0030]
其中和分别表示x1(t)和x2(t)的一阶导数,b(x1)=m(w)-1
,g(x)=b(x1)(-c(x1,x2)x
2-g(x1)-j(x1,x2,t)),uf=[u
f1
,...,u
fp
]
t
表示输入的执行器故障,p表示执行器维数,d1(t)和d2(t)分别表示外界的噪声以及干扰,y(t)表示机器人当前t时刻的机器人角度输出信息。
[0031]
执行器故障考虑为:
[0032]
uf(t)=γua(t) β(t-tf)u
bf
(t)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(4)
[0033]
其中ua(t)∈r
p
表示机器人实际的输出控制,γ表示系统执行器失效因子,γ∈[γ1,γ2],γ1和γ2表示γ的上下界,假设此处γn表示一正数,u
bf
(t)表示偏置故障,β(t-tf)表示偏置故障的指示因子,当β(t-tf)=1时表示偏置故障发生,tf则表示偏置故
障的发生时间。
[0034]
当进一步将通讯攻击考虑在内时,通讯攻击考虑为:
[0035][0036]
其中,n=0,1,2,...,{σn}和{ln}分别表示第n次攻击的结束时间点以及两次攻击间隔时间。
[0037]
在(3)中,由于函数g(x)难以从实际机器人系统中获得,因此再次使用神经网络方式进行处理。本发明中,以x1、x2作为输入,通过神经网络获取g(x)。由神经网络逼近机制,针对某非线性函数g(x)有g(x)=ξ
*t
ψ(x) θ
*
(x),||θ
*
(x)||<θc,其中x表示输入向量,x=[x
1 x2]
t
,ξ
*
表示权重向量,θ
*
(x)表示趋近误差,θc表示θ
*
(x)的上界,ψ(x)=[ψ1(x),...,ψj(x),...,ψ
l
(x)]
t
表示径向基向量,且ψj(x)选择为其中cj和υi分别表示神经网络第j神经元的中心和宽度,j=1,2,

,l,l表示神经元个数。
[0038]
综上可得,在具有执行器故障,通讯攻击以及外界干扰下的机器人轨迹跟踪控制模型可以写为:
[0039][0040]
其中,fe(x,t)=b(y)β(t-tf)u
bf
(t) θ
*
(x) d2(t),ξ
n,1
表示没有被攻击时间段的总和,ξ
n,1
=∪[σn,σn ln)(n=0,1,2,...),b(y)=b(x1)=m(w)-1

[0041]
上述接收模块,用于实时接收机器人传感器输出的数据,主要包括传感器测量的机器人左右轮角度数据。
[0042]
上述第一触发器,其设计为自适应触发机制,传感器输出通道触发条件为:
[0043]ey
(tkh λh)
t
ω
key
(tkh λh)≤μm(tkh λh)y(tkh)
t
ωky(tkh)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(7)
[0044]
其中ωk表示一权重矩阵,ey(tkh λh)=y(tkh λh)-y(tkh),y(tkh)表示触发时刻tkh对应的机器人角度触发值(即触发时刻tkh对应的机器人角度输出信息),y(tkh λh)表示触发时刻tkh λh对应的机器人角度触发值,{tk}表示第一触发序列,h表示采样周期,λ∈n,n表示正整数,μm(tkh λh)∈[μ
m1

m2
]为一待选择参数,0≤μ
m1
≤μ
m2
<1。μm(tkh λh)设计为其中ma和mb表示两个阈值参数且满足ma>0,mb>1。
[0045]
本发明设计的观测器是一种新的基于输出触发信息(即满足触发条件时刻的触发值)的积分集成观测器,其建立在机器人轨迹跟踪控制模型基础上,可以实现对机器人系统状态、故障以及集成总干扰信息的估计,能够保证机械人系统可靠的轨迹跟踪性能。在针对干扰信息估计的过程中,无需干扰信息的上界值;本发明通过设置的积分器引入了输出积分项y
ζ
(t),增加观测精度。其中,为减少变量观测时系统的传输量,采用第一触发器满足触发条件的触发值代替原有信号进行设计。此外,为补偿观测误差以及采用触发值为观测器设计造成的影响,本发明中观测器设计了观测误差补偿器
[0046]
基于上述分析,该观测器以传感器输出通道触发值作为输入,并在机器人轨迹跟踪控制模型基础上引入由观测器输出值和传感器输出通道触发值构建的积分项;具体设计如下:
[0047][0048]
其中和表示对x1(t),x2(t),y(t),γ以及ξ
*
的估计,ld,lm,l
ζ
和ln表示观测器增益,y(tkh)表示在tkh时刻的机器人角度触发值,表示基于记忆的补偿项,定义为:
[0049][0050][0051][0052]
其中也可以视为γ的输出,p表示适宜维数的正定对称矩阵,lz表示一待选对称矩阵。εa和εb表示两个待选对角矩阵。e
ζ
=[e1,e2,y
ζ
(t)]
t
,,i表示单位矩阵,le=[l
m l
n 0]
t
,λ(ua)表示ua分量的对角矩阵,即λ(ua)=diag[u
a1
,...,u
ap
]。
[0053]
上述公式(8)中的y
ζ
(t)由积分器按照满足条件得到。与其他文献不同,此处的y
ζ
(t)可以增加观测器的自由度,即利用传感器输出的积分信息进行观测器设计,可提高观测器的自由度,进一步增加观测精度。
[0054]
对于轮式机器人系统,其负载外界干扰总是有界的,而对应的上界值往往不易确定,在此假设其满足其中,表示机器人系统的等效干扰,κ为一未知增益,表示与系统干扰相关的新的变量,将在后续进行定义,则可得:其中和表示d1(t),fe(x,t)和的估计。
[0055]
为估计机器人系统干扰信号定义如下变量:
[0056][0057]
其中,i
ζ
=[i 0 0],x(t)的更新方式为:
[0058]
[0059]
其中,δ表示一大于零的标量,表示κ的估计,的更新方式为:αk>0表示一正标量。
[0060]
经上述分析,本发明中,机器人系统中集成干扰估计如下:
[0061][0062]
因此,基于本发明设计的观测器,可以对机器人实际状态和机器人系统干扰信号进行估计得到机器人实际状态估计结果(包括)和机器人系统干扰信号估计结果并将估计结果发送给控制器。
[0063]
上述自适应补充模块,设计目的在于提供一种可实现自适应容错可靠控制策略,提供自适应参数实现对机器人故障-干扰补偿。
[0064]
针对该类轮式机器人系统,本发明中的自适应补充模块是一种二阶积分滑模面,设计过程考虑了跟踪误差与控制效果的关系。具体的,轮式机器人系统滑模函数s(t)设计为:
[0065][0066]
其中表示s0(t)的一阶导数,em(t)=y(t)-yr(t)表示机器人角度与期望值的差值。ηs>1为一选择参数,ia=[i 0 0],ρa表示自适应参数,设计为:
[0067][0068]
其中||
·
||表示二范数,θa、βa、ωa、c分别表示待选参数,0<θa<1,ωa>0,βa>0,c>0,μ表示大于零的常数。
[0069]
对跟踪性能的分析,主要体为滑模函数的有限时间可到达性,在此当中,为保证有限时间到达,本发明进一步引入了参数自适应更新ks表示一正常数,表示的一阶导数。
[0070]
证明可表达为:设计选择李亚普洛夫函数为:其中,其中,表示τa的估计。经证明即李亚普洛夫函数的导数小于零且求解出系统状态的收敛时间为有限,表明滑模函数是有限时间可到达的。
[0071]
本发明中,第二触发器中控制器输出触发条件为:
[0072][0073]
其中πa、πb、πs、ka以及kb表示正常数,η>1表示一待选参数,表示一自适应参数,设计为其中{tq}为第二触发时间序列;表示t时刻观测器得到的x2(t)的估计值,表示第二触发器触发时刻tq观测器得到的x2(t)的估计值。
[0074]
对于机器人系统触发条件的芝诺现象分析:
[0075]
对于可以得到:
[0076][0077]
进一步可以推断得到:
[0078][0079]
其中,进而可以得到:其中tq=t
q 1-tq。表明相邻两个触发有下界,不会出现无限触发的情况,即没有芝诺现象。
[0080]
本发明设计的控制器为基于事件触发的控制器,引入输出触发值代替传统观测器设计中的输出值,在保证观测器稳定的条件下同时减少了观测器稳定需要的信息传输量,即用相对较少的输出量实现了有效的变量观测,从而在保证机器人系统跟踪能力的同时,有效减少了系统传输负载,并尽量减少故障干扰对系统的影响。控制器具体设计为:
[0081][0082]
其中,ua(tq)表示满足控制器输出触发条件时刻tq的机器人实际输出控制,σb表示一正标量,ib=[0 i 0],分别为yr(tq)的一阶导数和二阶导数。
[0083]
其中,将总干扰的估计引入控制器作为补偿部分,目的在于补偿由触发值代替连续值对系统的影响。
[0084]
最后由执行器按照实际输出控制来进行操作,控制轮式机器人按照期望轨迹运行。
[0085]
本发明进一步提供了一种兼顾多因素影响的轮式机器人自适应容错可靠控制方
法,其利用上述轮式机器人自适应容错可靠控制系统按照以下步骤进行:
[0086]
s1利用接收模块实时接收轮式机器人传感器输出的数据;
[0087]
s2利用第一触发器判断传感器输出通道触发条件是否满足,并以满足触发条件时刻的机器人角度触发值作为传感器输出通道触发值,发送给观测器;
[0088]
s3利用观测器依据机器人传感器输出的数据和满足第一触发器触发条件时刻的传感器输出通道触发值,对机器人实际状态及总干扰信息进行估计;
[0089]
s4利用滑模控制模块基于轮式机器人系统滑模函数得到机器人控制自适应参数;
[0090]
s5利用第二触发器判断控制器输出触发条件是否满足;
[0091]
s6利用控制器依据观测器得到的机器人实际状态及总干扰信息估计结果及滑模控制模块得到的机器人控制自适应参数,得到满足控制器输出触发条件时刻的机器人实际输出控制,并将其发送给执行器。
[0092]
本发明提供的兼顾多因素影响的轮式机器人自适应容错可靠控制系统及方法具有以下有益效果:
[0093]
(1)本发明引入位于传感器输出通道的输出触发机制和位于控制器端的输入触发机制,利用触发值代替传统设计中的连续值,一方面在保证观测器稳定的条件下同时减少了观测器稳定需要的信息传输量(即用相对较少的输出量实现了有效的变量观测),另一方面有效减少了控制器传输负载,从而极大减少了系统信息传输量以及控制成本;
[0094]
(2)本发明构建的机器人轨迹跟踪控制模型,同时考虑到了轮式机器人系统受到执行器故障、通讯攻击以及外界干扰因素的影响,能够在一定程度上增强控制系统可靠性;
[0095]
(3)本发明进一步通过在观测器中引入输出积分项和补偿项,能够在增加观测器自由度的同时,提高观测器的观测精度,并尽量减少故障干扰对系统的影响。
附图说明
[0096]
图1轮式机器人结构示意图。
[0097]
图2为兼顾多因素影响的轮式机器人自适应容错可靠控制系统原理示意图。
[0098]
图3为机器人仿真控制结果;其中,(a)机器人角度跟踪图,(b)机器人角速度跟踪图。
具体实施方式
[0099]
结合附图对本发明各实施例的技术方案进行清楚、完整的描述,显然,所描述实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所得到的所有其它实施例,都属于本发明。
[0100]
实施例1
[0101]
本实施例针对轮式机器人系统,提供一种控制系统,以获得可靠优化控制率。首先建立具有执行器故障、通讯攻击以及外界干扰的轮式机器人系统控制模型;其次对系统中得故障,干扰以及状态等因素进行估计;紧接着设计了一种滑模函数,并构建了控制器;为了节约系统的传输资源,进一步设计了系统输入输出的事件触发机制,其中输出触发机制为自适应调节,作用于观测器设计环节,输入触发机制以系统观测信息为基础,作用于控制器设计环节;最后,根据观测器输出、滑模函数设计以及触发机制,获得了系统的容错可靠
控制系统。
[0102]
本实施例提供的兼顾多因素影响的轮式机器人自适应容错可靠控制系统,如图2所示,其包括机器人系统模型构建模块、接收模块、第一触发器、观测器、滑模控制模块、第二触发器和控制器。
[0103]
上述机器人系统模型构建模块,用于构建兼顾执行器故障、通讯攻击以及外界干扰的机器人轨迹跟踪控制模型。
[0104]
本实施例中,基于前面分析,所构建的机器人轨迹跟踪控制模型如下所示:
[0105][0106]
fe(x,t)=b(y)β(t-tf)u
bf
(t) θ
*
(x) d2(t)
[0107]
其中,和分别表示x1(t)和x2(t)的一阶导数,x1=w=[w
l wr]
t
,,分别表示左右轮角度的一阶导数,d1(t)和d2(t)分别表示外界的噪声以及干扰,b(y)=m(w)-1
,ua(t)表示机器人实际的输出控制,γ表示系统执行器失效因子,ξ
*
表示权重向量,ψ(x)表示径向基向量,ξ
*
、ψ(x)和θ
*
(x)通过前面给出的神经网络确定,y(t)表示机器人轨迹,ξ
n,1
表示没有被攻击时间段的总和,ξ
n,1
=∪[σn,σn ln)(n=0,1,2,...)。
[0108]
上述接收模块,用于实时接收机器人传感器输出的数据,主要包括传感器测量的机器人左右轮角度数据。
[0109]
根据前面的分析,依据机器人的左右轮角度,便可得到机器人轨迹y(t)。
[0110]
上述第一触发器,判断传感器输出通道触发条件是否满足,并以满足触发条件时刻的第一触发器触发值作为传感器输出通道触发值发送给观测器。
[0111]
本实施例中,所设计的传感器输出通道触发条件为:
[0112]ey
(tkh λh)
t
ω
key
(tkh λh)≤μm(tkh λh)y(tkh)
t
ωky(tkh)
[0113]
其中,ωk表示一权重矩阵,ey(tkh λh)=y(tkh λh)-y(tkh),y(tkh)表示触发时刻tkh对应的机器人角度触发值(即触发时刻tkh对应的机器人角度输出信息),y(tkh λh)表示触发时刻tkh λh对应的机器人角度触发值,{tk}表示第一触发序列,h表示采样周期,λ∈n,n表示正整数,μm(tkh λh)∈[μ
m1

m2
]为一待选择参数,0≤μ
m1
≤μ
m2
<1,μm(tkh λh)设计为其中ma和mb表示两个阈值参数且满足ma>0,mb>1。
[0114]
当第一触发器tkh时刻满足触发条件时,第一触发器将tkh时刻的机器人角度触发值y(tkh)作为传感器输出通道触发值发送给观测器。
[0115]
上述观测器,用于基于构建的机器人轨迹跟踪控制模型,并依据传感器输出通道触发值,对机器人实际状态及总干扰信息进行估计。
[0116]
本实施例中,观测器以传感器输出通道触发值作为输入,并在机器人轨迹跟踪控制模型基础上结合机器人其它信息,同时积分器引入由观测器输出值和传感器输出通道触发值构建的积分项,将观测器具体设计为:
[0117][0118]
其中,和表示对x1(t),x2(t),y(t),γ以及ξ
*
的估计,ld,lm,l
ζ
和ln表示观测器增益,y(tkh)表示在tkh时刻对应的机器人角度触发值,表示基于记忆的补偿项,定义为:
[0119][0120][0121][0122]
其中,也可以视为γ的输出,p表示适宜维数的正定对称矩阵,lz表示一待选对称矩阵。εa和εb表示两个待选对角矩阵。e
ζ
=[e1,e2,y
ζ
(t)]
t
,,i表示单位矩阵,le=[l
m l
n 0]
t
,,λ(ua)表示ua分量的对角矩阵,即λ(ua)=diag[u
a1
,...,u
ap
]。
[0123]
机器人总干扰信息估计为:
[0124][0125]
其中,i
ζ
=[i 0 0],x(t)的更新方式为:
[0126][0127]
δ表示一大于零的标量,的更新方式为:αk>0表示一正标量。
[0128]
因此,基于本发明设计的观测器,可以对机器人实际状态和机器人系统干扰信号进行估计得到机器人实际状态估计结果(包括)和机器人系统干扰信号估计结果并将估计结果发送给控制器。
[0129]
上述滑模控制模块,用于基于轮式机器人系统滑模函数得到机器人控制自适应参数。
[0130]
本实施例中,轮式机器人系统滑模函数s(t)设计为:
[0131][0132]
其中,表示s0(t)的一阶导数,em(t)=y(t)-yr(t)表示表示机器人角度与期望值的差值。ηs>1为一选择参数,ia=[i 0 0],ρa表示自适应参数,设计为:
[0133][0134]
其中,||
·
||表示二范数,θa、βa、ωa、c分别表示待选参数,0<θa<1,ωa>0,βa>0,c>0,μ表示大于零的常数。
[0135]
为保证滑模函数的有限时间到达,本发明进一步引入了参数自适应更新ks表示一正常数,表示的一阶导数。
[0136]
上述第二触发器,用于判断控制器输出触发条件是否满足。
[0137]
第二触发器中控制器输出触发条件为:
[0138][0139]
其中πa、πb、πs、ka以及kb表示正常数,η>1表示一待选参数,表示一自适应参数,设计为其中{tq}为第二触发时间序列。
[0140]
当第二触发器tq时刻满足触发条件时,控制器将tq时刻的机器人实际输出控制发送给执行器。最后由执行器按照实际输出控制来进行操作,控制轮式机器人按照期望轨迹运行。
[0141]
上述控制器,用于依据观测器得到的机器人状态及总干扰信息估计结果及滑模控制模块得到的自适应参数,得到满足控制器输出触发条件时刻的机器人实际输出控制,并将其发送给执行器。
[0142]
控制器具体设计为:
[0143][0144]
其中,ua(tq)表示满足控制器输出触发条件时刻tq的机器人实际输出控制,σb表示一正标量,ib=[0 i 0],分别为yr(tq)的一阶导数和二阶导数。
[0145]
实施例2
[0146]
本实施例提供了一种兼顾多因素影响的轮式机器人自适应容错可靠控制方法,利用实施例1给出的轮式机器人自适应容错可靠控制系统,按照以下步骤进行:
[0147]
s1利用接收模块实时接收轮式机器人传感器输出的数据;
[0148]
s2利用第一触发器判断传感器输出通道触发条件是否满足,并以满足触发条件时刻的机器人角度触发值作为传感器输出通道触发值,发送给观测器;
[0149]
s3利用观测器依据机器人传感器输出的数据和满足第一触发器触发条件时刻的传感器输出通道触发值,对机器人实际状态及总干扰信息进行估计;
[0150]
s4利用滑模控制模块基于轮式机器人系统滑模函数得到机器人控制自适应参数;
[0151]
s5利用第二触发器判断控制器输出触发条件是否满足;
[0152]
s6利用控制器依据观测器得到的机器人实际状态及总干扰信息估计结果及滑模控制模块得到的机器人控制自适应参数,得到满足控制器输出触发条件时刻的机器人实际输出控制,并将其发送给执行器。
[0153]
本实施例设定机器人初始输出控制,使用上述步骤s1-s6依据期望轨迹(包括机器人期望车轮角度(设定左右轮角度相等)、车轮角速度),通过仿真得到机器人跟踪轨迹,仿真结果如图3所示。从图3可以看出,使用本发明提供的轮式机器人自适应容错可靠控制方法能够实现对轮式机器人的精准控制,使机器人按照预定轨迹运行。
[0154]
本领域的普通技术人员将会意识到,这里所述的实施例是为了帮助读者理解本发明的原理,应被理解为本发明的保护范围并不局限于这样的特别陈述和实施例。本领域的普通技术人员可以根据本发明公开的这些技术启示做出各种不脱离本发明实质的其它各种具体变形和组合,这些变形和组合仍然在本发明的保护范围内。
再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献