本发明属于遥操作控制领域,具体来说是一种时延非线性双边遥操作系统的自适应模糊反演控制方法,在保证遥操作系统全局稳定性的同时提升遥操作系统的透明性。
背景技术
随着机器人技术的不断发展,依靠人机交互工作方式的遥操作技术已经在深海作业、医疗手术、虚拟现实等领域发挥了重要的作用。特别是具有力反馈的双边遥操作系统,提升了系统的透明性能,增强了操作者的临场感。然而,针对非线性的双边遥操作系统,存在通信时延、非线性、参数不确定性及模型不确定性等问题,从而影响系统的稳定性和透明性。
基于无源理论的双通道结构,主从端的力和速度分别表示网络中的电压和电流,是一种用于保证系统稳定性的控制方法。尽管双通道结构能够保证遥操作系统完成基本的遥操作任务,但是系统的透明性无法保证。基于主从端动力学匹配的四通道结构,是一种用于保证系统透明性的控制方法。尽管四通道结构能够实现遥操作系统的理想透明性,但是系统的稳定性无法保证。此外,针对非线性双边遥操作系统存在的非线性、参数不确定性、模型不确定性等问题,上述方法都不能达到很好的控制效果。为此,本发明专利针对上述遥操作系统存在的稳定性和透明性权衡和系统的非线性、参数不确定性和模型不确定性等问题,提出一种基于自适应模糊反演的非线性双边控制方法,在保证遥操作系统稳定性的同时提升遥操作系统的透明性。
技术实现要素:
本发明的目的在于提出一种基于自适应模糊反演的非线性遥操作双边控制方法,用以解决传统遥操作系统的稳定性、非线性、参数不确定性和模型不确定性等技术问题。
为实现上述目的,该发明的技术方案具体内容如下:
一种基于自适应模糊反演的非线性遥操作双边控制方法,包括以下步骤:
1)建立双边遥操作系统的非线性动力学模型,具体为:
1-1)建立双边遥操作系统的非线性动力学模型
其中,i=m,s表示双边遥操作系统中的主端或从端机械臂,j=h,e表示操作者或者外界环境,qi,
上述系统具有如下特性:
①惯性矩阵mi(qi)是正定对称矩阵,且mi(qi)有界,即存在
②惯性矩阵mi(qi)和向心力/科氏力矩阵
③公式(1)中的部分动力学方程可以写成如下线性方程的形式:
其中,θi∈rn表示主从端机械臂的未知参数,ζ∈rn×n表示模糊矩阵,
从端环境的非线性动力学模型如下:
其中,θe∈rn表示环境的未知参数。
2)设计从端机械臂的自适应模糊反演控制器,具体为:
2-1)定义xs1=qs,
式中,ms-1和cs都是未知非线性光滑函数。
2-2)设计虚拟控制项
2-3)设zs2=xs2-αs1,设计李雅普诺夫函数
2-4)对李雅普诺夫函数vs1求导,如果zs2=0,那么
2-5)设计李雅普诺夫函数
τs=-μs2zs2-zs1-φs-τe(12)
其中,μs2>0,zs1为跟踪误差,zs1=xs1-qsd,qsd为机械臂理想轨迹,φs为逼近非线性函数ηs的模糊系统,τe为传感器测量到的环境力矩;
2-6)采用为了实现无需模型信息的控制,采用模糊系统逼近ηs。假设φs是用于逼近非线性函数ηs的模糊系统,采用单值模糊化、乘积推理机和中心平均反模糊化,具体为:
定义
其中,ζt(xsw)为模糊向量,θs为自适应参数。
2-7)设计李雅普诺夫函数vs为
基于李雅普诺夫函数设计自适应参数θs的自适应率
其中,γs和ks是自适应系数;
3)从端环境的模糊逼近与主端环境的重构,具体为:
3-1)将从端环境的非线性动力学模型(2)写成模糊系统的形式,则
τe=ζt(xew)θe(28)
3-2)定义
3-3)由于通信时延的存在,为避免功率信号在通信通道内的传递而影响遥操作系统的无源性,将从端非功率环境参数的估计值
其中,
4)设计主端机械臂的自适应模糊反演控制器,具体为:
4-1)定义qmd(t)为主端机械臂的理想跟踪轨迹,且满足:
其中,
通过选取合适的θd,(30)可以生成无源的主端机械臂的理想跟踪轨迹qmd(t),从而设计主端自适应模糊反演控制器,使主端机械臂跟踪理想轨迹qmd(t)。
4-2)定义xm1=qm,
式中,mm-1和cm都是未知非线性光滑函数。
4-3)设计虚拟控制项
4-4)设zm2=xm2-αm1,设计李雅普诺夫函数
4-5)对李雅普诺夫函数vm1求导,如果zm2=0,那么
4-6)设计李雅普诺夫函数
τm=-μm2zm2-zm1-φm-τh(40)
其中,μm2>0,zm1为跟踪误差,zm1=xm1-qmd,qmd为机械臂理想轨迹,φm为逼近非线性函数ηm的模糊系统,τh为传感器测量到的操作者操作力矩;
4-7)采用为了实现无需模型信息的控制,采用模糊系统逼近ηm。假设φm是用于逼近非线性函数ηm的模糊系统,采用单值模糊化、乘积推理机和中心平均反模糊化,具体为:
定义
其中,ζt(xmw)为模糊向量,θm为自适应参数。
4-8)设计李雅普诺夫函数vm为
基于李雅普诺夫函数设计自适应参数θm的自适应率
其中,γm和km是自适应系数。
与现有技术相比,本发明具有如下有益效果:
1、采用模糊系统逼近未知的包含系统建模信息的非线性函数,并且设计自适应率在线调整模糊逻辑系统,避免因参数不确定性对系统造成的负效应。
2、基于自适应模糊反演的双边控制方法可以使主端和从端机械臂实时跟踪主端的位置信号,使跟踪误差稳定指数趋于0,提升了系统的暂态性能,保证了系统的透明性。
3、利用李雅普诺夫稳定性函数保证系统的稳定性和收敛性,从而保证所有信号的全局稳定性。
4、通过从端非功率环境系数的模糊估计和主端环境力的重构,避免了功率信号在通信通道中的传输,从而避免了传统遥操作系统无源性问题以及稳定性和透明性的权衡问题。
附图说明
图1是本发明提出的基于自适应模糊反演的非线性遥操作双边控制框图;
图2是本发明提出的xiw的隶属度函数图;
图3是本发明的主端机械臂与从端机械臂的位置跟踪和力反馈图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本发明的实施技术方案为:
(一)建立双边遥操作系统的非线性动力学模型
其中,i=m,s表示双边遥操作系统中的主端或从端机械臂,j=h,e表示操作者或者外界环境,qi,
上述系统具有如下特性:
①惯性矩阵mi(qi)是正定对称矩阵,且mi(qi)有界,即存在
②惯性矩阵mi(qi)和向心力/科氏力矩阵
③公式(1)中的部分动力学方程可以写成如下线性方程的形式:
其中,θi∈rn表示主从端机械臂的未知参数,ζ∈rn×n表示模糊矩阵,
如图1所示,在从端设计信号优化函数hf(s)=1/(1+τf)2,从主端通过通信通道传输到从端的位置信号qm(t-t(t)),经过信号优化函数,生成用于从端位置跟踪的理想输入信号qsd(t),
从端环境的非线性动力学模型如下:
其中,θe∈rn表示环境的未知参数。
非线性双边遥操作系统控制器的设计即基于上述动力学模型。
(二)设计非线性双边遥操作系统的从端机械臂自适应模糊反演控制器
定义xs1=qs,
式中,ms-1和cs都是未知非线性光滑函数。
非线性双边遥操作系统的反演控制器的设计包括2步。在步骤1中,构造虚拟控制项;在步骤2中,设计实际控制律,具体设计步骤如下:
步骤1:控制目标为xs1跟踪指令轨迹qsd。定义误差
zs1=xs1-qsd,zs2=xs2-αs1(4)
其中,αs1是xs2的估计,通过选取αs1,使得zs2趋近于0。
于是,
取虚拟控制项为
定义李雅普诺夫函数
那么vs1的导数为
如果zs2=0,那么
步骤2:
定义李雅普诺夫函数vs2为
由于
那么vs2的导数为
为实现
τs=-μs2zs2-zs1-φs-τε(12)
其中μs2>0,那么
其中,
为了实现无需建模信息的控制,采用模糊系统逼近ηs。假设φs是用于逼近非线性函数ηs的模糊系统,采用单值模糊化、乘积推理机和中心平均反模糊化方法,具体步骤如下:
针对ηs的模糊逼近,采用分别逼近的形式,相应的模糊系统设计为
其中,u为机械臂的自由度数。
定义
其中,
定义最优逼近常量
令
定义李雅普诺夫函数vs为
其中γs>0。
那么vs的导数为
设计自适应率为
那么
因为
由于
即
定义μs2>1,由于
定义
由于扰动ds∈rn有界,则存在
其中
其中vs(0)为vs的初值。
定义紧集
(三)从端环境的模糊逼近与主端环境的重构
将从端环境的非线性动力学模型(2)写成模糊系统的形式,则
τe=ζt(xew)θe(28)
定义
由于通信时延的存在,为避免功率信号在通信通道内的传递而影响遥操作系统的无源性,将从端非功率环境参数的估计值
其中,
(四)设计非线性双边遥操作系统的主端机械臂自适应模糊反演控制器
定义qmd(t)为主端机械臂的理想跟踪轨迹,且满足:
其中,
通过选取合适的θd,(30)可以生成无源的主端机械臂的理想跟踪轨迹qmd(t),从而设计主端自适应模糊反演控制器,使主端机械臂跟踪理想轨迹qmd(t)。
定义
式中,mm-1和cm都是未知非线性光滑函数。
步骤1:控制目标为xm1跟踪指令轨迹qmd。定义误差
zm1=xm1-qmd,zm2=xm2-αm1(32)
其中,αm1是xm2的估计,通过选取αm1,使得zm2趋近于0。
于是,
取虚拟控制项为
定义李雅普诺夫函数
那么vm1的导数为
如果zm2=0,那么
步骤2:
定义李雅普诺夫函数vm2为
由于
那么vm2的导数为
为实现
τm=-μm2zm2-zm1-φm-τh(40)
其中μm2>0,那么
其中,
为了实现无需建模信息的控制,采用模糊系统逼近ηm。假设φm是用于逼近非线性函数ηm的模糊系统,采用分别逼近的形式,相应的模糊系统设计为
其中,u为机械臂的自由度数。
定义
其中,
定义最优逼近常量
令
定义李雅普诺夫函数vm为
其中γm>0。
那么vm的导数为
设计自适应率为
那么
因为
由于
定义μm2>1,由于
定义
由于扰动dm∈rn有界,则存在
其中
其中vm(0)为vm的初值。
定义紧集
根据(二)和(四)可知,由于主端系统和从端系统都是稳定的,且通信通道内无功率信号的传输,因此双边遥操作系统是稳定的。
(五)进行仿真实验验证
为了验证上述理论的可行性,在matlab下进行仿真实验,仿真实验验证了基于自适应模糊反演的非线性遥操作双边控制的效果。
仿真参数选取如下:
取xyw的模糊隶属度函数为
其中,y=m,s,e,em表示主端,从端,环境和主端环境再现,隶属度函数如图2所示。
取从端控制器(12)和自适应率(19),其中μs1=35,μs2=55,ks=1.8,γs=2。
取主端控制器(40)和自适应率(47),其中,μm1=35,μm2=55,km=1.8,γm=2,
取环境参数为θe=[mecege]t,其中,
取信号优化函数参数τf=0.025,输入操作力为τh=[0.4sinπt/20.4cosπt/2]t。
系统中仿真2自由度的主从机械臂,参数为:
其中,mi11=ji1+ji2+2mi2ri2li1cosθi2,mi12=mi21=ji2+mi2ri2li1cosθi2,mi22=ji2,
图3为主端机械臂和从端机械臂的位置跟踪和力反馈曲线,从图中可以看出,位置跟踪和力反馈曲线都是有界的,即系统是稳定的;从端机械臂可以很好的跟踪主端的位置命令,主端操作者可以很好的接收从端的环境力,即系统是透明的。
以上内容仅为本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明权利要求书的保护范围之内。