[发明专利]微陀螺仪的自适应迭代学习控制方法

摘要

本发明公开了一种微陀螺仪的自适应迭代学习控制方法，包括以下步骤1）建立微陀螺仪的无量纲动力学模型；2）参考轨迹模块输出微陀螺仪x和y轴振动的参考轨迹，包括位置、速度信号；3)自适应律模块接收参考轨迹及微陀螺仪系统的输出，利用自适应律估计出参数的增量；4)控制器模块接收新的参数估计，并和轨迹跟踪误差、速度跟踪误差共同作用产生自适应迭代学习控制方法的控制信号输出；5)接收控制器模块的输出信号，输出微陀螺仪振动部件的位置和速度信息；6)利用迭代方法重复步骤3)‑步骤5)，得到最终的微陀螺仪振动部件的位置和速度信息。本发明可以提高微陀螺仪系统对参考轨迹的跟踪性能。

主权项

微陀螺仪的自适应迭代学习控制方法，其特征在于，包括以下步骤：1)建立微陀螺仪的无量纲动力学模型；2)参考轨迹模块输出微陀螺仪x和y轴振动的参考轨迹，包括位置、速度信号；3)自适应律模块接收参考轨迹及微陀螺仪系统的输出，利用自适应律估计出参数的增量；4)控制器模块接收新的参数估计，并和轨迹跟踪误差、速度跟踪误差共同作用产生自适应迭代学习控制方法的控制信号输出；5)接收控制器模块的输出信号，输出微陀螺仪振动部件的位置和速度信息；6)利用迭代方法重复步骤3)‑步骤5)，得到最终的微陀螺仪振动部件的位置和速度信息；在所述步骤1)中，微陀螺仪的无量纲动力学模型为：在考虑外界干扰时，振动式微陀螺仪模型用式(6)表达：q··+(D+2Ω)q·+Kq=u+d---(6)]]>其中：d表示外界干扰；ux、uy表示沿x轴、y轴方向的驱动力；ωxy、和dxx、dyy、dxy分别表示x轴、y轴、x轴和y轴之间的弹簧系数和阻尼系数；m为质量；Ωz表示沿z轴方向的角速度；ω0为两轴的共振频率；分别是速度向量和加速度向量；在迭代控制过程中，式(6)表示为：q··k+(D+2Ω)q·k+Kqk=uk+dk---(7)]]>式中k为迭代次数，k为正整数，qk、uk、dk分别为q、u、d的第k次的加速度信号向量、速度信号向量、位置信号向量、输入控制向量、干扰向量；在所述步骤3)中，根据微陀螺仪的无量纲动力学模型进行自适应参数估计，自适应参数估计算法为：θ^k(t)=θ‾k+θ^k-1(t)---(9)]]>其中θ为由系统未知参数组成的向量，为θ的估计值，为θ估计值的初始值，为第k次迭代时θ的估计值的增量；矩阵Γ∈R8×8，Γ为正定对称矩阵，Γ＝diag(90,90,90,90,90,90,90,90)；β为正实数；为期望的速度信号。