[发明专利]无精确参考轨迹的分数阶MEMS陀螺仪加速自适应反演控制方法有效
申请号: | 202011156531.1 | 申请日: | 2020-10-26 |
公开(公告)号: | CN112286055B | 公开(公告)日: | 2022-08-26 |
发明(设计)人: | 罗绍华;赵乐;马欢欢;李少波;H·瓦卡德 | 申请(专利权)人: | 贵州大学 |
主分类号: | G05B13/04 | 分类号: | G05B13/04;G05B13/02;G01C19/00 |
代理公司: | 北京同恒源知识产权代理有限公司 11275 | 代理人: | 赵荣之 |
地址: | 550025 贵州省*** | 国省代码: | 贵州;52 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 精确 参考 轨迹 分数 mems 陀螺仪 加速 自适应 反演 控制 方法 | ||
1.一种无精确参考轨迹的分数阶MEMS陀螺仪加速自适应反演控制方法,其特征在于:包括:
构造分数阶MEMS陀螺仪的数学模型;所述分数阶MEMS陀螺仪的数学模型包括:
MEMS陀螺仪包括质量块、悬臂梁、驱动电极、感应器件和基座,其中,所述驱动电极作为系统的动力源,向质量块施加驱动力,质量块沿着驱动力的方向运动,感应装置能测量出因质量块位移而引起的电容变化,然后根据电容变化量计算出运动物体的角速度;
MEMS陀螺仪的动力学方程写为:
其中m表示质量,表示角速度,表示阻尼系数,表示耦合系数,表示x-轴的阻尼系数,表示y-轴的阻尼系数,表示x-轴的弹簧常数,表示y-轴的弹簧常数,表示x-轴的控制输入,表示y-轴的控制输入;
引入无量纲参数x1=x*/q0,x3=y*/q0和t=w0t*,其中q0表示参考长度,w0表示x轴和y轴的共振频率,构建MEMS陀螺仪的分数阶模型,具有未知扰动的dx和dy分数阶MEMS陀螺的无量纲方程写为:
其中
构造产生规则和复杂行为的模拟电路,揭示混沌振荡;所述模拟电路的电路方程通过基尔霍夫定律获得:
其中C1、C2、C3、C4表示电容,R1、R4、R9、R10、R11、R12、R13、R16、R17、R18、R19、R20表示电阻,v1,v2,v3,v4表示电压;
通过拉普拉斯变换,分数阶积分近似为:
其中pT表示转角频率,H表示线性传递函数的阶数,H定义为
H=1+Integer(log(wmax/p0)/log(ab))
其中p0=pT10y/20α,a=10[y/10(1-α)],b=10[y/10α],y表示锯齿形值与其期望值之间的误差,wmax表示频带宽度;
在上式中,近似传递函数通过wmax=100,pT=0.01和y=2dB得出,极点和零点通过z0=p010y/10(1-α)......zH-1=pH-110y/10(1-α),pH=zH-110y/10α计算出;
计算近似传递函数
H(s)=F(s)/Cr
其中Cr表示电路中积分器的电容;
分数阶模拟电路由以下步骤实现:
S11:构造MEMS陀螺仪的整数阶模拟电路,即阶次α=1;
S12:设计近似电路单元,用于替代整数阶电路中积分运算放大器的电容,从而实现分数阶电路模块功能;
S13:在模拟电路中,构造积分运算放大电路和比例运算放大电路,实现积分运算和反比例运算;
系统模型中的初始参数为x1(0)=0.4,x2(0)=0,x3(0)=0.6和x4(0)=0,且无量纲参数为wxy=70.99,Ωz=0.1,dxx=0.01,dyy=0.01和dxy=0.002;
利用傅里叶级数和区间二型模糊逻辑系统对不精确的参考轨迹进行重构;所述参考轨迹重构具体包括以下内容:
参考轨迹xid,i=1,3写为
其中表示xid,i=1,3的估计值,h0i(t),i=1,3表示估计误差;为了提高跟踪精度,引入傅立叶级数和区间二型模糊逻辑系统进行逼近估计误差h0i(t),i=1,3;
估计误差h0i(t),i=1,3分解为具有基本周期Ti,i=1,3的周期函数hTi(t),i=1,3和非周期函数hNi(t),i=1,3;
周期函数hTi(t),i=1,3的傅里叶级数展开式如下:
其中傅里叶系数a0i,ali和bli,i=1,3是未知的;将基本周期Ti,i=1,3分解成已知常数T0i,i=1,3和未知常数ΔTi∈(-T0i,T0i),i=1,3;
Ti=T0i+ΔTi,i=1,3
其中Ai(t)=[a0i,s1i,…,sri,q1i,…,qri]T∈R2r+1,i=1,3表示未知向量函数,表示可计算向量函数,r表示一个正整数,表示截断误差;
引入区间二型模糊逻辑系统来近似未知的非周期函数hNi(t),i=1,3
hNi(t)=Pi(t)Tψi(t)+ξNi(t),i=1,3
其中Pi(t)∈Rm,i=1,3表示未知理想权向量函数,ψi(t)∈Rm,i=1,3表示已知的基向量函数,ξNi(t),i=1,3表示区间二型模糊逻辑系统的近似误差;
则h0i(t),i=1,3重写为
其中ξi(t)=ξTi(t)+ξNi(t),i=1,3表示残余误差;Ai(t),i=1,3表示未知时变常数且满足条件||Ai||≤Ami<∞和其中Ami和Adi,i=1,3表示未知常数,向量函数及其一阶、二阶导数是有界且可计算的;未知的理想权向量函数Pi(t),i=1,3及其导数都是有界,并满足条件||Pi||≤Pmi<∞和其中Pmi和Pdi,i=1,3表示未知正常数;
使用带有自适应律的区间二型模糊逻辑系统逼近未知函数;所述区间二型模糊逻辑系统包括单列模糊化层、模糊规则库、推理机、类型减速器和中心平均解模糊器;
在单例模糊化层中,将输入向量zi,i=1,…,n映射到相应区间二型模糊逻辑系统的集合输入模糊集的隶属点描述为
其中z′i∈Rn;
模糊规则库的模糊规则集描述如下:
如果z1等于等于等于
那么y等于
其中j=1,2,…,I,n∈[1,Hn]和Hn表示规则数,和表示区间二型模糊逻辑系统的输入和输出,
在模糊推理机中,每个隶属函数点可以通过每个z′i的隶属区间得到;
第n个的映射区间为
Ycos=[yl,yr]表示由yl和yr构成的区间集,Ycos定义为
其中Ycos由左端点yl和右端点yr来定义,它们分别表示为
其中和
根据上述描述,区间二型模糊逻辑系统的输出为
其中φT=[φl φr],ξT=[ξl/2 ξr/2];
定义一个紧集Ω,对于连续函数f(x),下列不等式总是成立,即
其中ε(x)表示区间二型模糊逻辑系统的逼近误差;
构造速度函数提高分数阶MEMS陀螺仪系统的瞬态响应速度;所述速度函数的数学表达式定义为:
其中bψ表示设计常数且满足0<bψ=1,T∈(0,∞)表示采样时间,ψ(t)表示具有初始值ψ(0)=1的严格单调递增函数;定义其中表示连续可微有界函数;
引入跟踪微分器解决复杂项爆炸问题,分数阶跟踪微分器表示为:
其中δr和κr表示设计常数且满足δr∈(0,1)和κr>0,表示虚拟控制输入,θr和θr+1表示跟踪微分器的状态特性。
2.根据权利要求1所述的无精确参考轨迹的分数阶MEMS陀螺仪加速自适应反演控制方法,其特征在于:具体包括:
定义实际跟踪误差变量ei和可计算跟踪误差变量zi为
其中xi=i=1,…,4表示系统状态变量,表示虚拟控制器,ei,i=1,…,4表示跟踪误差变量,zi,i=1,…,4表示可计算误差变量;
定义加速跟踪补偿误差变量Si(t),i=1,…,4
Si(t)=ψ(t)zi,i=1,…,4
根据反演法的递推特性,包括以下步骤:
S21:S1(t)的分数阶导数计算:
将第一个Lyapunov候选函数定义为
V1的分数导数计算为
代入得到
设计为
其中k1>0表示设计常数;
代入得到
S22:S2(t)的分数导数计算如下:
其中表示x轴的控制器,表示未知非线性函数;
分数阶跟踪微分器表示为
其中δr和κr表示设计常数且满足δr∈(0,1)和κr>0,表示虚拟控制输入,θr和θr+1表示跟踪微分器的状态特性;
引入区间二型模糊逻辑系统来以任意精度逼近即
定义变量为
其中表示φi的估计值;
构造第二个Lyapunov候选函数
V2(t)的分数阶导数计算为
将控制输入和自适应率设计为
其中k2,γ2和v2表示正设计常数;
代入得到
S23:S3(t)的分数导数计算如下:
定义第三个Lyapunov候选函数
V3(t)的分数导数计算如下:
代入得到
然后,构造为
其中k3>0表示设计常数;
代入得到:
S24:S4(t)的分数导数计算如下:
其中表示y轴的控制输入,表示未知非线性函数;
引入区间二型模糊逻辑系统来逼近存在
将最后一个Lyapunov候选函数构造为
V4(t)的分数阶导数计算如下:
然后,控制输入和自适应率设计为:
其中k4,γ4和v4表示正设计常数
代入得到:
其中κ4=min{k1,k2,k3,k4,2v2γ2,2v4γ4}表示正设计常数,
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于贵州大学,未经贵州大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011156531.1/1.html,转载请声明来源钻瓜专利网。
- 上一篇:缝纫机中的底线线量检测装置
- 下一篇:一种大角度宽带频率选择表面