CN110000788A - 用于远程操作***的有限时间容错控制方法 - Google Patents
用于远程操作***的有限时间容错控制方法 Download PDFInfo
- Publication number
- CN110000788A CN110000788A CN201910309534.5A CN201910309534A CN110000788A CN 110000788 A CN110000788 A CN 110000788A CN 201910309534 A CN201910309534 A CN 201910309534A CN 110000788 A CN110000788 A CN 110000788A
- Authority
- CN
- China
- Prior art keywords
- robot
- master
- slave
- fault
- actuator
- 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 40
- 238000013461 design Methods 0.000 claims abstract description 10
- 238000011217 control strategy Methods 0.000 claims abstract description 6
- 239000013598 vector Substances 0.000 claims description 23
- 230000005540 biological transmission Effects 0.000 claims description 10
- 239000004576 sand Substances 0.000 claims description 7
- 230000036962 time dependent Effects 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000005259 measurement Methods 0.000 abstract 2
- 230000009897 systematic effect Effects 0.000 abstract 1
- 241000282414 Homo sapiens Species 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1646—Programme controls characterised by the control loop variable structure system, sliding mode control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种用于远程操作***的有限时间容错控制方法,具体为:针对带有执行器故障的远程操作***,根据测量的主、从机器人的参数,得到标称***;基于标称***中主、从机器人位置和速度信息,针对主、从机器人分别设计有限时间,用于在线估计主、从机器人的执行器故障及***不确定信息;基于测量的关节位置和速度信息,设计终端滑模面;基于终端滑模面、执行器故障及***不确定估计信息,设计有限时间控制策略;利用李雅普诺夫方程建立***收敛速度与控制器参数关系。本发明通过对执行器故障和***不确定的有限时间在线精确估计,从而在控制器设计中成功实现了执行器故障和***不确定对***影响的补偿,保证了闭环远程操作***的稳定运行。
Description
技术领域
本发明属于远程操作***控制技术领域,涉及一种远程操作***的有限时间容错控制方法。
背景技术
远程操作***又名遥操作***,其作为能最大限度发挥人类和机械***各自优势的远距离操作***,在当代具有广泛的应用前景及巨大的应用价值。遥操作***主要由操作者、主机器人、网络信息传输通道、从机器人和远端的外界工作环境五部分组成。其工作模式大致可描述为:操作者操作本地主机器人,将主机器人的位置、速度等信息通过网络等传输媒介传送给从机器人,从机器人按照接收到的主机器人的位置和速度信息,在特定环境下模拟主机器人的行为从而完成各种工作,同时将从机器人的工作状态反馈至主端操作者,便于操作者根据从机器人的运动状态做出正确的决策。遥操作***的控制在目前的发展过程中遇到了很多难题,一方面是由于组成遥操作***的主、从机器人本身为复杂的非线性***;另一方面遥操作***中的从机器人大多工作于复杂的人类无法或不事宜接触的环境,如海底、外空以及危险救援环境等场景。遥操作***所接触的复杂外界环境,以及***本身所具有的强非线性,都给***的稳定运行带来了诸多挑战。
另外考虑到遥操作***中从机器人往往工作在人不方便接触的远端危险环境中,所以从机器人***的故障是影响***正常工作的主要原因之一,而执行器故障作为***中最常出现的一种故障,极易造成从端机器人***不稳定,严重影响从端机器人***在实际应用中的工作性能。因此如何降低执行器故障对***性能的影响,保证执行器故障下遥操作***的稳定运行具有十分重要的意义。另外,实际应用中对遥操作***收敛速度具有一定的要求,因此研究如何设计控制方法保证执行器故障下闭环遥操作***在有限时间内实现***稳定运行具有很强的现实意义。
发明内容
针对现有技术的不足,本发明提供一种针对执行器饱和下的远程操作***的有限时间容错控制方法,其不仅能够在线精确估计执行器故障以及***不确定对***的影响;而且可以实现远程操作***的有限时间收敛,因此保证了远程操作***在执行器故障和***不确定下的高性能稳定运行。
本发明是这样实现的:
一种用于远程操作***的有限时间容错控制方法,其具体包括以下步骤:
步骤1,针对带有执行器故障的远程操作***,根据测量的主机器人和从机器人的***参数,得到远程操作***的标称***;
步骤2,基于标称***中的主机器人位置、从机器人位置、主机器人速度信息和从机器人速度信息,针对主机器人设计有限时间,用于在线估计主机器人的执行器故障及***不确定信息,针对从机器人设计有限时间,用于在线估计从机器人的执行器故障及***不确定信息;
步骤3,基于测量的主机器人以及从机器人的关节位置和速度信息,设计终端滑模面;
步骤4,基于步骤3所设计的终端滑模面和步骤2估计的执行器故障及***不确定信息,设计有限时间控制策略;
步骤5,利用李雅普诺夫方程建立远程操作***收敛速度与容错控制器参数关系,确保***在此控制器作用下可以在有限时间内收敛。
优选地,步骤1中的具体步骤为:
建立基于关节空间的远程操作***的标称***的动力学模型:
其中,m表示主机器人参数,s表示从机器人参数,qm,qs∈Rn分别表示主机器人、从机器人的关节位移向量;分别表示主机器人、从机器人的关节速度向量,分别表示主机器人、从机器人的关节加速度向量;Mm(qm),Ms(qs)∈Rn×n分别为主***、从***的正定惯性矩阵;分别表示主机器人、从机器人的哥氏力和离心力的向量;Gm(qm),Gs(qs)∈Rn分别为主机器人***、从机器人***的重力力矩;分别为主机器人***、从机器人***存在的未知摩擦力以及有界外界干扰;Fh∈Rn为操作者施加的力,Fe∈Rn为环境施加的力矩;τm∈Rn为容错控制器提供的控制力矩,τs∈Rn为从控制器提供的控制力矩,
考虑实际应用中***模型均存在不确定,因此
Mm(qm)=Mmo(qm)+ΔMm(qm),
Ms(qs)=Mso(qs)+ΔMs(qs),
Gm(qm)=Gmo(qm)+ΔGm(qm),
Gs(qs)=Gso(qs)+ΔGs(qs);
Mmo(qm),Mso(qs),Gmo(qm)和Gso(qs)表示远程操作***的标称部分即已知部分,而ΔMm(qm),ΔMs(qs),ΔGm(qm)和ΔGs(qs)表示远程操作***的不确定部分。
优选地,步骤2中,针对主机器人和从机器人分别设计有限时间在线估计执行器故障及***不确定信息的具体步骤为:
结合步骤1中考虑实际应用中***存在不确定因素,远程操作***的动力学模型(1)被重新写作
其中,视为远程操作主机器人***的不确定;视为远程操作从机器人***的不确定。
针对主机器人和从机器人设计故障重建律在线估计***故障及不确定部分,当主机器人、从机器人发生执行器故障时,有
其中,τm(t)表示主机器人执行器产生的扭矩,τs(t)分别表示从机器人执行器产生的扭矩;τm0(t)表示主机器人执行器产生的标称扭矩,τs0(t)表示从机器人执行器产生的标称扭矩;表示主机器人执行器故障向量,表示从机器人执行器故障向量,
结合式(1),主机器人和从机器人的远程操作动力学模型进一步表示为:
其中,
定义一个新矢量:它的导数为:
其中,
定义新的变量
其中,Km1、Ks1是已知的正实数,ψm(l)、ψs(l)是根据式(5)所设计的辅助函数,由式(6)可知ψm(t)、ψs(t)为新定义的与时间有关的辅助函数,且当时间给定时二者是可得的;
其导数为:
上式看作是分别以为未知输入的线性***,其输出表示为
针对主机器人和从机器人执行器设计滑模观测器,如下:
其中,分别表示ψm、ψs的观测值,εm、εm分别表示ψm和ψs和之间的观测误差,即pm1、ps1∈Rn,pm2、ps2∈Rn且pm1<pm2,ps1<ps2,Km2,Km3,Km4,Ks2,Ks3,Ks4均为可调参数,em表示主机器人***位置同步误差变量,es表示从机器人***位置同步误差变量;
设计重建律以在线估计***不确定性及故障
进一步可得
其中,xme表示主机器人执行器故障及不确定信息的估计误差,xse表示从机器人执行器故障及不确定信息的估计误差。
优选地,步骤3具体包括以下步骤:
首先,定义主机器人***和从机器人***位置同步误差变量分别为
em=qm-qs(t-Ts),es=qs-qm(t-Tm) (15)
其中,t表示时间变量,Tm、Ts分别为主机器人、从机器人信息传输的时延,本发明所针对的在固定时延下主机器人、从机器人间的信息传输问题,故Tm、Ts为可测常数值;
针对主机器人和从机器人选取终端滑模面:
其中,sm,ss∈Rn分别表示主机器人、从机器人滑模面上的滑动变量,σm1、σm2、σs1、σs2是根据实际应用所分别选取的主机器人、从机器人遥操作***正定矩阵,其中
σm1=diag(σm11,σm12,…,σm1n)∈Rn×n,σs1=diag(σs11,σs12,…,σs1n)∈Rn×n,
σm2=diag(σm21,σm22,…,σm2n)∈Rn×n,σs2=diag(σs21,σs22,…,σs2n)∈Rn×n;lm,ls和zm,zs是正数且分别满足1<lm/zm<2,1<ls/zs<2,βm>lm/zm,βs>ls/zs。
优选地,基于步骤2中在线估计出的主机器人和从机器人执行器故障,在步骤4中,分别对主机器人和从机器人设计有限时间控制策略的方法,以在有限时间内消除远程操作***中执行器故障,
容错控制器设计为:
其中,τmeq、τseq分别用来控制主机器人、从机器人标称***部分,τmre、τsre分别用来补偿主机器人、从机器人***中的不确定部分以消除远程操作***中产生的不确定部分,设计如下:
其中,ηm、ηs表示极小正实数。
优选地,步骤5中,利用李雅普诺夫方程建立***收敛速度与容错控制器参数关系,确保***在此控制器作用下可以在有限时间内收敛,具体方法如下:
选取新的李亚普诺夫方程如下:
其导数为:
将(19)、(20)和(21)三式代入(23),结合步骤2得出:
其中,且由李雅普诺夫稳定判据可知***稳定;
确定主机器人***容错控制有限时间为:
有限时间Tm、Ts分别表示主机器人***和从机器人***到达滑模面所用的时间。
与现有技术相比,本发明具有以下有益效果:
1、本发明通过对执行器故障和***不确定的有限时间在线精确估计,从而在控制器设计中成功实现了执行器故障和***不确定对***影响的补偿,保证了闭环远程操作***的稳定运行。
2、在控制器方法设计中利用引入非奇异快速终端滑模面加快了***的收敛速度,提高了***的收敛精度,提高***的快速性。
3、设计故障估计器在线估计***不确定性及故障,并选取合适的李雅普诺夫函数,从而提高***稳定性,采用终端滑模观测器来估计误差,实现***的有限时间收敛以及***的稳定性。
4、在容错控制器下,***正常工作时可以消除***不确定部分以及故障,保证***的稳态性能,提高控制精度。
5、本方法适用于远程操作***、四旋翼飞行器、轮式小车等设备,而且解决了***执行器故障与不确定因素引起的***收敛速度慢以及精度低等问题。
附图说明
图1是远程操作***的结构框图;
图2是本发明的控制原理框图。
具体实施方式
以下将参考附图详细说明本发明的示例性实施例、特征和性能方面。附图中相同的附图标记表示功能相同或相似的元件。尽管在附图中示出了实施例的各种方面,但是除非特别指出,不必按比例绘制附图。
如图1所示,远程操作***又称遥操作***,远程操作***主要由操作者1、主机器人2、网络信息传输通道3、从机器人4和远端的外界工作环境5五部分组成。其工作模式大致可描述为:操作者1操作本地主机器人2,将主机器人2的位置、速度等信息通过网络等传输媒介传送给从机器人4,从机器人4按照接收到的主机器人1的位置和速度信息,在特定环境下模拟主机器人1的行为从而完成各种工作,同时将从机器人4的工作状态反馈至主端操作者1,便于操作者1根据从机器人4的运动状态做出正确的决策。
如图2所示,本发明提供一种用于远程操作***的有限时间容错控制方法,通过故障估计器、终端滑模控制器和容错控制器进行控制,具体包括以下步骤:
步骤1,针对带有执行器故障的远程操作***,根据测量的主机器人和从机器人的***参数,得到远程操作***的标称***:
建立基于关节空间的远程操作***的标称***的动力学模型:
其中,m表示主机器人参数,s表示从机器人参数,qm,qs∈Rn分别表示主机器人、从机器人的关节位移向量;分别表示主机器人、从机器人的关节速度向量,分别表示主机器人、从机器人的关节加速度向量;Mm(qm),Ms(qs)∈Rn×n分别为主***、从***的正定惯性矩阵;分别表示主机器人、从机器人的哥氏力和离心力的向量;Gm(qm),Gs(qs)∈Rn分别为主机器人***、从机器人***的重力力矩;分别为主机器人***、从机器人***存在的未知摩擦力以及有界外界干扰;Fh∈Rn为操作者施加的力,Fe∈Rn为环境施加的力矩;τm∈Rn为容错控制器提供的控制力矩,τs∈Rn为从控制器提供的控制力矩,
考虑实际应用中***模型均存在不确定,因此
Mm(qm)=Mmo(qm)+ΔMm(qm),
Ms(qs)=Mso(qs)+ΔMs(qs),
Gm(qm)=Gmo(qm)+ΔGm(qm),
Gs(qs)=Gso(qs)+ΔGs(qs);
Mmo(qm),Mso(qs),Gmo(qm),Gso(qs)表示远程操作***的标称部分即已知部分,而ΔMm(qm),ΔMs(qs),ΔGm(qm)和ΔGs(qs)表示远程操作***的不确定部分;
因此远程操作***的动力学模型(1)被重新写作
其中,视为远程操作主机器人***的不确定;视为远程操作从机器人***的不确定。
步骤2,基于标称***中的主机器人位置、从机器人位置、主机器人速度信息和从机器人速度信息,故障估计器针对主机器人设计有限时间,用于在线估计主机器人的执行器故障及***不确定信息,故障估计器针对从机器人设计有限时间,用于在线估计从机器人的执行器故障及***不确定信息,具体为:
针对主机器人和从机器人设计故障重建律在线估计***故障及不确定部分,当主机器人、从机器人发生执行器故障时,有
其中,τm(t)表示主机器人执行器产生的扭矩,τs(t)分别表示从机器人执行器产生的扭矩;τm0(t)表示主机器人执行器产生的标称扭矩,τs0(t)表示从机器人执行器产生的标称扭矩;表示主机器人执行器故障向量,表示从机器人执行器故障向量,
结合式(1),主机器人和从机器人的远程操作动力学模型进一步表示为:
其中,
表示主机器人执行器故障向量,表示从机器人执行器故障向量,
定义一个新矢量:
它的导数为:
其中,
定义新的变量
其中,Km1、Ks1是已知的正实数,ψm(l)、ψs(l)是根据式(5)所设计的辅助函数,为了得到后面的线性***,由式(6)可知ψm(t)、ψs(t)为新定义的与时间有关的辅助函数,且当时间给定时二者是可得的;
定义新的变量
其中,Km1、Ks1是已知的正实数,由(6)式可知ψm(t)、ψs(t)为新定义的与时间有关的辅助函数,且当时间给定时二者是可得的;
其导数为:
上式看作是分别以为未知输入的线性***,其输出表示为
针对主机器人和从机器人执行器设计滑模观测器,如下:
其中,分别表示ψm、ψs的观测值,εm、εm分别表示ψm和ψs和之间的观测误差,即pm1、ps1∈Rn,pm2、ps2∈Rn且pm1<pm2,ps1<ps2,Km2,Km3,Km4,Ks2,Ks3,Ks4均为可调参数,em表示主机器人***位置同步误差变量,es表示从机器人***位置同步误差变量;
设计重建律以在线估计***不确定性及故障:
进一步可得
其中,xme表示主机器人执行器故障及不确定信息的估计误差,xse表示从机器人执行器故障及不确定信息的估计误差。
为验证本方法的可行性,选取李雅普诺夫方程
其导数为
从而可知上述方法能够在有限时间内完成对主机器人和从机器人执行器不确定性及故障的在线估计,有限时间为
其中Tmr为上述方法对主机器人完成执行器故障在线估计所用有限时间,Tsr为上述方法对从机器人完成执行器故障在线估计所用有限时间,当t≥max(Tmr,Tsr)时,观测误差εm、εs在有限时间内趋于零,即主机器人和从机器人执行器不确定性及故障可由上述方法有限时间内在线估计。
步骤3,基于测量的主机器人以及从机器人的关节位置和速度信息,设计终端滑模面,终端滑模控制器进行相应控制:
首先,定义主机器人***和从机器人***位置同步误差变量分别为
em=qm-qs(t-Ts),es=qs-qm(t-Tm) (15)
其中,t表示时间变量,Tm、Ts分别为主机器人、从机器人信息传输的时延,本发明所针对的在固定时延下主、从机器人间的信息传输问题,故Tm、Ts为可测常数值;
针对主机器人和从机器人选取终端滑模面:
其中,sm,ss∈Rn分别表示主机器人、从机器人滑模面上的滑动变量,σm1、σm2、σs1、σs2是根据实际应用所分别选取的主机器人、从机器人遥操作***正定矩阵,其中
σm1=diag(σm11,σm12,…,σm1n)∈Rn×n,σs1=diag(σs11,σs12,…,σs1n)∈Rn×n,
σm2=diag(σm21,σm22,…,σm2n)∈Rn×n,σs2=diag(σs21,σs22,…,σs2n)∈Rn×n;lm,ls和zm,zs是正数且分别满足1<lm/zm<2,1<ls/zs<2,βm>lm/zm,βs>ls/zs。
为了确保***能够在有限时间内到达滑模面,滑模面导数应满足
进一步,将(3)-(6)式代入(17)式中,得到滑模面导数为:
步骤4,基于步骤3所设计的终端滑模面和步骤2估计的执行器故障及***不确定信息,设计有限时间控制策略,容错控制器在有限时间内消除远程操作***中执行器故障:
容错控制器设计为:
其中,τmeq、τseq分别用来控制主机器人、从机器人标称***部分,τmre、τsre分别用来补偿主机器人、从机器人***中的不确定部分以消除远程操作***中产生的不确定部分,设计如下:
其中,ηm、ηs表示极小正实数,无限趋近于0的正实数。
步骤5,利用李雅普诺夫方程建立远程操作***收敛速度与容错控制器参数关系,确保***在此控制器作用下可以在有限时间内收敛:
选取新的李亚普诺夫方程如下:
其导数为:
将(19)、(20)和(21)三式代入(23),结合步骤2得出:
其中,且由李雅普诺夫稳定判据可知,所涉及的控制器可在有限时间内使***稳定;
根据容错控制器参数可确定主机器人***容错控制有限时间为
有限时间Tm、Ts分别表示主机器人***和从机器人***到达滑模面所用的时间。
综上,经李雅普诺夫判据验证,本发明的方法可以实现,且能够在有限时间内消除远程操作***中执行器故障,确保***在控制器作用下可以在有限时间内收敛,解决了***执行器故障与不确定因素引起的***不稳定以及收敛速度慢、精度低等问题。
最后应说明的是:以上所述的各实施例仅用于说明本发明技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述实施例所记载的技术方案进行修改,或者对其中部分或全部技术特征进行等同替换;而这些修改或替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (6)
1.一种用于远程操作***的有限时间容错控制方法,其特征在于:其具体包括以下步骤:
步骤1,针对带有执行器故障的远程操作***,根据测量的主机器人和从机器人的***参数,得到远程操作***的标称***;
步骤2,基于标称***中的主机器人位置、从机器人位置、主机器人速度信息和从机器人速度信息,针对主机器人设计有限时间,用于在线估计主机器人的执行器故障及***不确定信息,针对从机器人设计有限时间,用于在线估计从机器人的执行器故障及***不确定信息;
步骤3,基于测量的主机器人以及从机器人的关节位置和速度信息,设计终端滑模面;
步骤4,基于步骤3所设计的终端滑模面和步骤2估计的执行器故障及***不确定信息,设计有限时间控制策略;
步骤5,利用李雅普诺夫方程建立远程操作***收敛速度与容错控制器参数关系,确保***在此控制器作用下可以在有限时间内收敛。
2.根据权利要求1所述的用于远程操作***的有限时间容错控制方法,其特征在于:步骤1中的具体步骤为:
建立基于关节空间的远程操作***的标称***的动力学模型:
其中,m表示主机器人参数,s表示从机器人参数,qm,qs∈R n分别表示主机器人、从机器人的关节位移向量;分别表示主机器人、从机器人的关节速度向量,分别表示主机器人、从机器人的关节加速度向量;Mm(qm),Ms(qs)∈Rn×n分别为主***、从***的正定惯性矩阵;分别表示主机器人、从机器人的哥氏力和离心力的向量;Gm(qm),Gs(qs)∈Rn分别为主机器人***、从机器人***的重力力矩;分别为主机器人***、从机器人***存在的未知摩擦力以及有界外界干扰;Fh∈Rn为操作者施加的力,Fe∈Rn为环境施加的力矩;τm∈Rn为容错控制器提供的控制力矩,τs∈Rn为从控制器提供的控制力矩,
考虑实际应用中***模型均存在不确定,因此
Mm(qm)=Mmo(qm)+ΔMm(qm),
Ms(qs)=Mso(qs)+ΔMs(qs),
Gm(qm)=Gmo(qm)+ΔGm(qm),
Gs(qs)=Gso(qs)+ΔGs(qs);
Mmo(qm),Mso(qs),Gmo(qm)和Gso(qs)表示远程操作***的标称部分即已知部分,而ΔMm(qm),ΔMs(qs),ΔGm(qm)和ΔGs(qs)表示远程操作***的不确定部分。
3.根据权利要求2所述的用于远程操作***的有限时间容错控制方法,其特征在于:步骤2中,针对主机器人和从机器人分别设计有限时间在线估计执行器故障及***不确定信息的具体步骤为:
结合步骤1中考虑实际应用中***存在不确定因素,远程操作***的动力学模型(1)被重新写作
其中,视为远程操作主机器人***的不确定;视为远程操作从机器人***的不确定;
针对主机器人和从机器人设计故障重建律在线估计***故障及不确定部分,当主机器人、从机器人发生执行器故障时,有
其中,τm(t)表示主机器人执行器产生的扭矩,τs(t)分别表示从机器人执行器产生的扭矩;τm0(t)表示主机器人执行器产生的标称扭矩,τs0(t)表示从机器人执行器产生的标称扭矩;表示主机器人执行器故障向量,表示从机器人执行器故障向量,
结合式(1),主机器人和从机器人的远程操作动力学模型进一步表示为:
其中,
定义一个新矢量:它的导数为:
其中,
定义新的变量
其中,Km1、Ks1是已知的正实数,ψm(l)、ψs(l)是根据式(5)所设计的辅助函数,由式(6)可知ψm(t)、ψs(t)为新定义的与时间有关的辅助函数,且当时间给定时二者是可得的;
其导数为:
上式看作是分别以为未知输入的线性***,其输出表示为
针对主机器人和从机器人执行器设计滑模观测器,如下:
其中,分别表示ψm、ψs的观测值,εm、εm分别表示ψm和ψs和之间的观测误差,即pm1、ps1∈Rn,pm2、ps2∈Rn且pm1<pm2,ps1<ps2,Km2,Km3,Km4,Ks2,Ks3,Ks4均为可调参数,em表示主机器人***位置同步误差变量,es表示从机器人***位置同步误差变量;
设计重建律以在线估计***不确定性及故障
进一步可得
其中,xme表示主机器人执行器故障及不确定信息的估计误差,xse表示从机器人执行器故障及不确定信息的估计误差。
4.根据权利要求3所述的用于远程操作***的有限时间容错控制方法,其特征在于:步骤3具体包括以下步骤:
首先,定义主机器人***和从机器人***位置同步误差变量分别为
em=qm-qs(t-Ts),es=qs-qm(t-Tm) (15)
其中,t表示时间变量,Tm、Ts分别为主机器人、从机器人信息传输的时延,本发明所针对的在固定时延下主机器人、从机器人间的信息传输问题,故Tm、Ts为可测常数值;
针对主机器人和从机器人选取终端滑模面:
其中,sm,ss∈Rn分别表示主机器人、从机器人滑模面上的滑动变量,σm1、σm2、σs1、σs2是根据实际应用所分别选取的主机器人、从机器人遥操作***正定矩阵,其中σm1=diag(σm11,σm12,…,σm1n)∈Rn×n,σs1=diag(σs11,σs12,…,σs1n)∈Rn×n,σm2=diag(σm21,σm22,…,σm2n)∈Rn ×n,σs2=diag(σs21,σs22,…,σs2n)∈Rn×n;lm,ls和zm,zs是正数且分别满足1<lm/zm<2,1<ls/zs<2,βm>lm/zm,βs>ls/zs。
5.根据权利要求4所述的用于远程操作***的有限时间容错控制方法,其特征在于:基于步骤2中在线估计出的主机器人和从机器人执行器故障,在步骤4中,分别对主机器人和从机器人设计有限时间控制策略的方法,以在有限时间内消除远程操作***中执行器故障,
容错控制器设计为:
其中,τmeq、τseq分别用来控制主机器人、从机器人标称***部分,τmre、τsre分别用来补偿主机器人、从机器人***中的不确定部分以消除远程操作***中产生的不确定部分,设计如下:
其中,
6.根据权利要求5所述的用于远程操作***的有限时间容错控制方法,其特征在于:步骤5中,利用李雅普诺夫方程建立***收敛速度与容错控制器参数关系,确保***在此控制器作用下可以在有限时间内收敛,具体方法如下:
选取新的李亚普诺夫方程如下:
其导数为:
将(19)、(20)和(21)三式代入(23),结合步骤2得出:
其中,且由李雅普诺夫稳定判据可知***稳定;
确定主机器人***容错控制有限时间为:
有限时间Tm、Ts分别表示主机器人***和从机器人***到达滑模面所用的时间。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910309534.5A CN110000788B (zh) | 2019-04-17 | 2019-04-17 | 用于远程操作***的有限时间容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910309534.5A CN110000788B (zh) | 2019-04-17 | 2019-04-17 | 用于远程操作***的有限时间容错控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110000788A true CN110000788A (zh) | 2019-07-12 |
CN110000788B CN110000788B (zh) | 2020-10-09 |
Family
ID=67172571
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910309534.5A Active CN110000788B (zh) | 2019-04-17 | 2019-04-17 | 用于远程操作***的有限时间容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110000788B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111136633A (zh) * | 2020-01-13 | 2020-05-12 | 燕山大学 | 针对时变时延下柔性主-从机器人***的全状态控制方法 |
CN113110070A (zh) * | 2021-05-25 | 2021-07-13 | 南京邮电大学 | 一种执行器饱和下遥操作***自适应控制方法 |
CN113820978A (zh) * | 2021-09-08 | 2021-12-21 | 华侨大学 | 一种网络遥操作机器人***的准同步控制方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
AU2008353981A1 (en) * | 2008-04-02 | 2009-10-08 | Irobot Corporation | Robotics systems |
US20160306340A1 (en) * | 2015-04-17 | 2016-10-20 | Seiko Epson Corporation | Robot and control device |
US20160324588A1 (en) * | 2011-05-31 | 2016-11-10 | Intuitive Surgical Operations, Inc. | Surgical instrument with control for detected fault condition |
CN106647281A (zh) * | 2017-01-18 | 2017-05-10 | 燕山大学 | 一种基于终端滑模的遥操作***干扰有限时间补偿方法 |
CN106933103A (zh) * | 2017-04-20 | 2017-07-07 | 清华大学深圳研究生院 | 一种有限时间收敛的遥操作双边控制器的控制方法 |
CN108549226A (zh) * | 2018-04-13 | 2018-09-18 | 燕山大学 | 一种时变时延下遥操作***的连续有限时间控制方法 |
CN108983734A (zh) * | 2018-08-29 | 2018-12-11 | 燕山大学 | 一种考虑三角形结构下遥操作***的有限时间控制方法 |
CN109240086A (zh) * | 2018-10-16 | 2019-01-18 | 浙江大学 | 一种非线性双边遥操作***的自适应鲁棒控制方法 |
-
2019
- 2019-04-17 CN CN201910309534.5A patent/CN110000788B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
AU2008353981A1 (en) * | 2008-04-02 | 2009-10-08 | Irobot Corporation | Robotics systems |
US20160324588A1 (en) * | 2011-05-31 | 2016-11-10 | Intuitive Surgical Operations, Inc. | Surgical instrument with control for detected fault condition |
US20160306340A1 (en) * | 2015-04-17 | 2016-10-20 | Seiko Epson Corporation | Robot and control device |
CN106647281A (zh) * | 2017-01-18 | 2017-05-10 | 燕山大学 | 一种基于终端滑模的遥操作***干扰有限时间补偿方法 |
CN106933103A (zh) * | 2017-04-20 | 2017-07-07 | 清华大学深圳研究生院 | 一种有限时间收敛的遥操作双边控制器的控制方法 |
CN108549226A (zh) * | 2018-04-13 | 2018-09-18 | 燕山大学 | 一种时变时延下遥操作***的连续有限时间控制方法 |
CN108983734A (zh) * | 2018-08-29 | 2018-12-11 | 燕山大学 | 一种考虑三角形结构下遥操作***的有限时间控制方法 |
CN109240086A (zh) * | 2018-10-16 | 2019-01-18 | 浙江大学 | 一种非线性双边遥操作***的自适应鲁棒控制方法 |
Non-Patent Citations (2)
Title |
---|
YANG, YANA; HUA, CHANGCHUN; LI, JUNPENG: "Fixed-time Coordination Control for Bilateral Telerobotics System with Asymmetric Time-varying Delays", 《JOURNAL OF INTELLIGENT & ROBOTIC SYSTEMS》 * |
杨亚娜: "网络诱导时延下遥操作***的暂稳态性能约束控制研究", 《中国博士学位论文全文数据库 信息科技辑》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111136633A (zh) * | 2020-01-13 | 2020-05-12 | 燕山大学 | 针对时变时延下柔性主-从机器人***的全状态控制方法 |
CN113110070A (zh) * | 2021-05-25 | 2021-07-13 | 南京邮电大学 | 一种执行器饱和下遥操作***自适应控制方法 |
CN113820978A (zh) * | 2021-09-08 | 2021-12-21 | 华侨大学 | 一种网络遥操作机器人***的准同步控制方法 |
CN113820978B (zh) * | 2021-09-08 | 2023-05-26 | 华侨大学 | 一种网络遥操作机器人***的准同步控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110000788B (zh) | 2020-10-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106647281B (zh) | 一种基于终端滑模的遥操作***干扰有限时间补偿方法 | |
CN110000788B (zh) | 用于远程操作***的有限时间容错控制方法 | |
CN104260107B (zh) | 一种实现空间机械臂柔性关节齿隙补偿的方法 | |
Yao et al. | Adaptive robust control of DC motors with extended state observer | |
CN107561935B (zh) | 基于多层神经网络的电机位置伺服***摩擦补偿控制方法 | |
Yao et al. | RISE-based precision motion control of DC motors with continuous friction compensation | |
CN108628172B (zh) | 一种基于扩张状态观测器的机械臂高精度运动控制方法 | |
Yao et al. | Nonlinear adaptive robust backstepping force control of hydraulic load simulator: Theory and experiments | |
CN103728882B (zh) | 微陀螺仪的自适应反演非奇异终端滑模控制方法 | |
CN112180729A (zh) | 一种机械臂自适应轨迹跟踪控制方法 | |
CN107272639B (zh) | 刚性航天器反作用飞轮故障的检测、估计及其调节方法 | |
CN106773679A (zh) | 一种基于角速度观测器的航天器容错控制方法 | |
CN110116409B (zh) | 一种基于扰动观测器的四通道遥操作双边控制方法 | |
CN108227497B (zh) | 一种考虑***性能受限下网络化遥操作***的控制方法 | |
US10591876B2 (en) | Method and system for adaptive compensation of dry friction | |
CN107505841A (zh) | 一种基于干扰估计器的机械臂姿态鲁棒控制方法 | |
CN110673472A (zh) | 基于神经网络补偿死区反演误差的自适应鲁棒控制方法 | |
CN104614984A (zh) | 一种电机位置伺服***的高精度控制方法 | |
CN105045103A (zh) | 一种基于LuGre摩擦模型伺服机械手摩擦补偿控制***及方法 | |
CN115202216A (zh) | 考虑输入约束的机械臂抗干扰有限时间控制方法 | |
CN115981162A (zh) | 一种基于新型扰动观测器的机器人***滑模控制轨迹跟踪方法 | |
CN104965413B (zh) | 受控化发射平台的摩擦补偿自适应控制方法 | |
CN115202189A (zh) | 分数阶机械臂模型的变结构有限时间振动抑制方法 | |
CN112147894A (zh) | 基于运动学和动力学模型的轮式移动机器人主动控制方法 | |
WO2024093507A1 (zh) | 用于实现机械手***轨迹跟踪的广义动态预测控制方法 |
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 |