一种微陀螺仪自适应分数阶滑模控制方法技术

本发明专利技术公开了微陀螺仪控制技术领域的一种微陀螺仪自适应分数阶滑模控制方法，旨在解决现有技术中微陀螺仪因加工精度要求高，导致灵敏度和精度等与预期性能指标有所出入的技术问题。所述方法包括如下步骤：建立微陀螺仪的动力学模型，设计分数阶滑模面模型；基于动力学模型和分数阶滑模面模型设计分数阶滑模控制律，作为控制输入对微陀螺仪进行滑摸控制，所述控制律包括等效控制律和切换控制律；基于Lyapunov稳定性设计自适应控制算法，对控制律的系统未知参数进行实时更新，促使系统运动点的轨迹稳定跟踪动力学模型的轨迹。

An Adaptive Fractional sliding mode control method for micro-gyroscopes

【技术实现步骤摘要】
一种微陀螺仪自适应分数阶滑模控制方法
本专利技术涉及一种微陀螺仪自适应分数阶滑模控制方法，属于微陀螺仪控制

技术介绍
陀螺仪是一种具备传感、维持方向稳定和角运动检测功能的装置，其运行主要是基于角动量守恒定律，在角动量作用下，能够抗拒方向改变趋势，常被用作角速度计，作为惯性导航系统的基本测量元件，应用于军事、航空、航天等领域。与传统陀螺仪相比，微陀螺仪具备体积小、重量轻等诸多优势，在对尺寸和重量等要求严格的
得到了更为广泛的应用。以硅微陀螺仪为例，由于其运用微机械加工工艺制成，结构尺寸通常为微米级，集成封装后，尺寸也仅在毫米量级，因而对加工精度要求极高，由于加工工艺等现实问题，导致硅微陀螺仪的灵敏度、精度等与预期性能指标有所出入，进而导致微陀螺仪技术发展缓慢。
技术实现思路
本专利技术的目的在于克服现有技术中的不足，提供了一种微陀螺仪自适应分数阶滑模控制方法，包括如下步骤：建立微陀螺仪的动力学模型，设计分数阶滑模面模型；基于动力学模型和分数阶滑模面模型设计分数阶滑模控制律，作为控制输入对微陀螺仪进行滑摸控制，所述控制律包括等效控制律和切换控制律；基于Lyapunov稳定性设计自适应控制算法，对控制律的系统未知参数进行实时更新，促使系统运动点的轨迹稳定跟踪动力学模型的轨迹。进一步地，建立微陀螺仪的动力学模型，包括：建立动力学模型的转动坐标系，所述转动坐标系包括对微陀螺仪驱动振动的方向、检测振动的方向、输入角速度的方向分别进行设定；基于转动坐标系建立微陀螺仪驱动模态和检测模态的基本动力学模型；对基本动力学模型进行结构误差修正；对进行结构误差修正后的动力学模型进行无量纲化处理；将进行无量纲化处理后的动力学模型改写为其向量形式；在改写为向量形式的动力学模型中引入若干变量，所述变量包括外界干扰、系统参数不确定性。进一步地，基于动力学模型和分数阶滑模面模型设计分数阶滑模控制律，包括：利用动力学模型中外界干扰和系统参数不确定性表征系统运动点趋近切换面的速率，获取切换控制律；对分数阶滑模面模型进行求导，将滑摸控制到达条件引入进行求导后的分数阶滑模面模型，获取等效控制律。进一步地，基于Lyapunov稳定性设计自适应控制算法，包括：利用自适应控制算法获取系统未知参数的估计值；将系统未知参数的估计值代入滑模控制律，获取估计的滑模控制律；设定系统未知参数估计值与真实值的差值，作为系统未知参数的估计误差；将估计误差和估计的滑模控制律代入引入若干变量的向量形式的动力学模型，获取估计的向量形式的动力学模型；将估计的向量形式的动力学模型化简后，代入预设Lyapunov函数关于时间的一阶导数，根据Lyapunov稳定性的原理设计系统未知参数的自适应控制算法。进一步地，对控制律的系统未知参数进行实时更新，促使系统运动点的轨迹稳定跟踪动力学模型的轨迹，包括：利用自适应控制算法获取系统未知参数的估计值；将系统未知参数的估计值代入滑模控制律，获取估计的滑模控制律；以估计的滑模控制律作为控制输入对微陀螺仪进行滑摸控制。进一步地，设定X轴为微陀螺仪驱动振动的方向、Y轴为微陀螺仪检测振动的方向、Z轴为输入角速度的方向，微陀螺仪驱动模态和检测模态的基本动力学模型，包括如下公式：式中，m为微陀螺仪质量块的质量，x为质量块在驱动方向的位置向量，y为质量块在检测方向的位置向量，是x的一阶导数，是x的二阶导数，是y的一阶导数，是y的二阶导数，dx为驱动方向的阻尼系数，dy为检测方向的阻尼系数，kx为驱动方向的刚度系数，ky为检测方向的刚度系数，ux为驱动方向的控制输入，uy为检测方向的控制输入，Ωz为输入方向的角速度，是Ωz的一阶导数。进一步地，引入若干变量的向量形式的动力学模型，包括如下公式：其中，式中，q是微陀螺仪系统的输出轨迹，是q的一阶导数，是q的二阶导数，D、Ω、K均为系统未知参数，其中D为由修正后的驱动方向的阻尼系数dxx、修正后的检测方向的阻尼系数dyy和耦合阻尼系数dxy组成的矩阵，K为由修正后的驱动方向的刚度系数kxx的无量纲化形式ωx、修正后的检测方向的刚度系数kyy的无量纲形式ωy和耦合刚度系数kxy的无量纲形式ωxy组成的矩阵，Ω为由输入方向的角速度Ωz和输入方向的角速度的相反数-Ωz组成的矩阵，ΔD为D+2Ω的不确定性，u为分数阶滑模控制律，ΔK为K的不确定性，d为外界干扰。进一步地，分数阶滑模面模型，包括如下公式：其中，e＝q-qr＝[x-qr1,y-qr2]T，0＜α＜1，式中，s为非奇异滑模面，c、λ为正常数，e为跟踪误差，是e的一阶导数，α为分数阶阶数，T表示向量的转置，qr是微陀螺仪系统的期望轨迹，是qr的一阶导数，qr1为微陀螺仪系统x轴期望轨迹，qr2为微陀螺仪系统y轴期望轨迹，是qr1的一阶导数，是qr2的一阶导数。进一步地，预设Lyapunov函数，包括如下公式：其中，M＝MT＞0，N＝NT＞0，P＝PT＞0，式中，V为Lyapunov函数，tr{·}表示矩阵的求迹运算，M为正定对称矩阵1，N为正定对称矩阵2，P为正定对称矩阵3，为D的估计误差，为K的估计误差，为Ω的估计误差。进一步地，自适应控制算法，包括如下公式：式中，是的一阶导数，是的一阶导数，是的一阶导数，为未知参数D的估计值，为未知参数K的估计值，为未知参数Ω的估计值。与现有技术相比，本专利技术所达到的有益效果：分数阶滑模面增加了可以调节分数阶的阶数项，控制性能和控制精度得到提高；自适应控制算法可处理系统的不确定性，实现控制系统参数的在线自动整定。附图说明图1是本专利技术微陀螺仪系统的结构框图；图2是本专利技术实例中微陀螺仪dxx、dxy、dyy自适应辨识曲线；图3是本专利技术实例中微陀螺仪ωxy、自适应辨识曲线；图4是本专利技术实例中微陀螺仪Ωz自适应辨识曲线。具体实施方式下面结合附图对本专利技术作进一步描述。以下实施例仅用于更加清楚地说明本专利技术的技术方案，而不能以此来限制本专利技术的保护范围。一种微陀螺仪自适应分数阶滑模控制方法，包括如下步骤：步骤一，建立微陀螺仪的动力学模型。把微陀螺仪的驱动模态和检测模态，看作是一个“弹簧-质量-阻尼”的二阶系统。首先，建立动力学模型的转动坐标系；然后，基于转动坐标系建立微陀螺仪驱动模态和检测模态的基本动力学模型。本实施例中，X轴为微陀螺仪驱动振动的方向，Y轴为微陀螺仪检测振动的方向，Z轴为输入角速度的方向，微陀螺仪的基本动力学模型如式(1)、式(2)所示：式中，m为质量块的质量，x和y为质量块在驱动方向和检测方向的位置向量，是x的一阶导数，是x的二阶导数，是y的一阶导数，是y的二阶导数，dx为驱动方向的阻尼系数，dy为检测方向的阻尼系数，kx为驱动方向的刚度系数，ky为检测方向的刚度系数，ux为驱动方向的控制输入，uy为检测方向的控制输入，Ωz为z轴上的角速度，即输入方向的角速度，是Ωz的一阶导数。考虑到微陀螺仪的结构误差带来的影响，为提高控制精度，将式(1)、式(2)修正为：式中，dxx为修正后的驱动方向的阻尼系数，dyy为修正后的检测方向的阻尼系数，dxy为耦合阻尼系数，kxx为修正后的驱动方向的刚度系数，kyy为修正后的检测方向的刚度系数，kxy为耦合刚度系数。为减小控制器设计的复杂度，对动力学模型进行无量纲化处理，将本文档来自技高网...

【技术保护点】
1.一种微陀螺仪自适应分数阶滑模控制方法，其特征是，包括如下步骤：建立微陀螺仪的动力学模型，设计分数阶滑模面模型；基于动力学模型和分数阶滑模面模型设计分数阶滑模控制律，作为控制输入对微陀螺仪进行滑摸控制，所述控制律包括等效控制律和切换控制律；基于Lyapunov稳定性设计自适应控制算法，对控制律的系统未知参数进行实时更新，促使系统运动点的轨迹稳定跟踪动力学模型的轨迹。

【技术特征摘要】
1.一种微陀螺仪自适应分数阶滑模控制方法，其特征是，包括如下步骤：建立微陀螺仪的动力学模型，设计分数阶滑模面模型；基于动力学模型和分数阶滑模面模型设计分数阶滑模控制律，作为控制输入对微陀螺仪进行滑摸控制，所述控制律包括等效控制律和切换控制律；基于Lyapunov稳定性设计自适应控制算法，对控制律的系统未知参数进行实时更新，促使系统运动点的轨迹稳定跟踪动力学模型的轨迹。2.根据权利要求1所述的微陀螺仪自适应分数阶滑模控制方法，其特征是，建立微陀螺仪的动力学模型，包括：建立动力学模型的转动坐标系，所述转动坐标系包括对微陀螺仪驱动振动的方向、检测振动的方向、输入角速度的方向分别进行设定；基于转动坐标系建立微陀螺仪驱动模态和检测模态的基本动力学模型；对基本动力学模型进行结构误差修正；对进行结构误差修正后的动力学模型进行无量纲化处理；将进行无量纲化处理后的动力学模型改写为其向量形式；在改写为向量形式的动力学模型中引入若干变量，所述变量包括外界干扰、系统参数不确定性。3.根据权利要求2所述的微陀螺仪自适应分数阶滑模控制方法，其特征是，基于动力学模型和分数阶滑模面模型设计分数阶滑模控制律，包括：利用动力学模型中外界干扰和系统参数不确定性表征系统运动点趋近切换面的速率，获取切换控制律；对分数阶滑模面模型进行求导，将滑摸控制到达条件引入进行求导后的分数阶滑模面模型，获取等效控制律。4.根据权利要求2所述的微陀螺仪自适应分数阶滑模控制方法，其特征是，基于Lyapunov稳定性设计自适应控制算法，包括：利用自适应控制算法获取系统未知参数的估计值；将系统未知参数的估计值代入滑模控制律，获取估计的滑模控制律；设定系统未知参数估计值与真实值的差值，作为系统未知参数的估计误差；将估计误差和估计的滑模控制律代入引入若干变量的向量形式的动力学模型，获取估计的向量形式的动力学模型；将估计的向量形式的动力学模型化简后，代入预设Lyapunov函数关于时间的一阶导数，根据Lyapunov稳定性的原理设计系统未知参数的自适应控制算法。5.根据权利要求1至4中任一项所述的微陀螺仪自适应分数阶滑模控制方法，其特征是，对控制律的系统未知参数进行实时更新，促使系统运动点的轨迹稳定跟踪动力学模型的轨迹，包括：利用自适应控制算法获取系统未知参数的估计值；将系统未知参数的估计值代入滑模控制律，获取估计的滑模控制律；以估计的滑模控制律作为控制输入对微陀螺仪进行滑摸控制。6.根据权利要求4所述的微陀螺仪自适应分数阶滑模控制方法，其...

【专利技术属性】
技术研发人员：陈放，费峻涛，陈云，
申请(专利权)人：河海大学常州校区，
类型：发明
国别省市：江苏,32