CN107894713A - 一种无编码传感两轴惯性稳定平台的高精度控制方法 - Google Patents

一种无编码传感两轴惯性稳定平台的高精度控制方法 Download PDF

Info

Publication number
CN107894713A
CN107894713A CN201710981675.2A CN201710981675A CN107894713A CN 107894713 A CN107894713 A CN 107894713A CN 201710981675 A CN201710981675 A CN 201710981675A CN 107894713 A CN107894713 A CN 107894713A
Authority
CN
China
Prior art keywords
msub
mrow
mtd
mtr
mover
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
Application number
CN201710981675.2A
Other languages
English (en)
Other versions
CN107894713B (zh
Inventor
杨俊�
刘向阳
冒建亮
李奇
王翔宇
李世华
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Southeast University
Original Assignee
Southeast University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Southeast University filed Critical Southeast University
Priority to CN201710981675.2A priority Critical patent/CN107894713B/zh
Publication of CN107894713A publication Critical patent/CN107894713A/zh
Application granted granted Critical
Publication of CN107894713B publication Critical patent/CN107894713B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

本发明公开了一种无编码传感两轴惯性稳定平台的高精度控制方法。该方法通过建立两轴惯性稳定平台的状态空间模型,根据由内框上安装的俯仰和偏航角速率陀螺仪得到的惯性角速率信息,构建不确定性估计器,对平台中因交叉耦合力矩产生的不确定性进行重构,将得到的估计值与反馈线性化控制算法结合,设计复合控制器,使得在无需编码器测量内外框之间相对角度的情况下,内框上光学仪器的视轴仍可相对惯性空间保持稳定。该发明消除了惯性稳定平台在伺服运动过程中,轴系间交叉耦合效应对视轴稳定控制的影响,降低了系统软、硬件设计成本,提高了系统的控制精度。

Description

一种无编码传感两轴惯性稳定平台的高精度控制方法
技术领域
本发明涉及一种无编码传感两轴惯性稳定平台的高精度控制方法,属于惯性稳定平台高精度控制技术领域。
背景技术
光电跟踪系统是集光学、电气、机械、控制于一体的装置,被广泛地应用在军事和民用领域,当系统处于稳定模式时,要求搭载的光学仪器的视轴能相对惯性空间保持稳定。两轴惯性稳定平台能有效地隔离载体运动等扰动对光学仪器的视轴的影响,使其可以相对惯性空间保持稳定。
两轴惯性稳定平台具有强耦合、非线性、多源扰动等控制难点。载体运动通过框架耦合到外框和内框,进而干扰光学仪器的视轴相对惯性空间保持稳定;内框相对外框的运动改变内框和外框间的相对角度,使内框折合到外框的转动惯量发生改变,影响外框力矩电机的控制效果;外框的运动也会耦合到内框,增加了内框的控制难度。除了轴系间的交叉耦合力矩,两轴惯性平台还存在未建模动态等扰动。为了对平台进行高精度的控制,需要在内框上安装角速率陀螺仪以及在内框和外框之间安装编码器,通过获取传感器信息,对内、外框之间由相对运动产生的动态进行补偿。然而,在内框和外框之间安装编码器,不仅增加了平台的硬件成本,还降低了平台的容错性。
在现有无编码传感控制方法中,通常利用安装在内框的俯仰角速率陀螺和偏航角速率陀螺的反馈信息,对两轴惯性稳定平台进行PID控制。PID控制结构简单,鲁棒性强,提高了平台运行的容错性并且降低平台的硬件成本。但是,当系统中存在的载体扰动较大和未建模动态明显时,PID控制方法的控制效果比较差,不能实现高精度控制。
发明内容
为了解决上述存在的问题,本发明公开了一种无编码传感两轴惯性稳定平台的高精度控制方法,该方法通过构建不确定性估计器,并与反馈线性化算法结合,设计一种复合控制器,实现两轴惯性稳定平台搭载的光学仪器的视轴相对惯性空间保持高精度稳定,其具体技术方案如下:
一种无编码传感两轴惯性稳定平台的高精度控制方法,包括如下步骤:
步骤1,通过在内框上安装俯仰角速率陀螺仪和偏航角速率陀螺仪,分别获得内框的俯仰角速率fi和偏航角速率pi
步骤2,选定内框的俯仰角速率、偏航角速率分别为状态变量x1、x2,采用牛顿-欧拉动力学方程,建立考虑轴系交叉耦合力矩的两轴惯性稳定平台状态空间模型其中,x表示状态向量,u表示输入向量,Δ表示由交叉耦合力矩和未建模动态产生的不确定性向量,A表示系统矩阵,B表示输入矩阵;
步骤3,根据步骤2建立的两轴惯性稳定平台状态空间模型,构建不确定性估计器对模型中不确定性进行重构,得到不确定性向量Δ的估计值
步骤4,根据步骤3得到的估计值结合步骤1获得的fi和pi,基于反馈线性化算法设计复合控制器λ表示控制器参数。
所述步骤2中的状态空间模型中的x、u、Δ分别表示为:
其中,u1和u2分别表示内框力矩电机和外框力矩电机的控制量,Δ1和Δ2分别表示状态空间模型中x1和x2微分方程中的不确定性。
所述步骤2中的状态空间模型中A表示系统矩阵,B表示输入矩阵,分别为:
其中,Mt1、Me1、R1和Mt2、Me2、R2分别表示内框力矩电机和外框力矩电机的转矩系数、反电动势系数、电枢电阻,Jiy、Jiz、Jix和Joz分别表示内框在俯仰轴、偏航轴、横滚轴和外框在偏航轴的转动惯量。
所述步骤2中的不确定性Δ1和Δ2分别为:
其中,hi、ho、fo和pb分别表示内框横滚角速率、外框横滚角速率、外框俯仰角速率和基座偏航角速率,Di、Do分别表示状态空间模型中x1、x2微分方程中的未建模动态,v2表示内外框的相对角度。
所述步骤3中不确定性估计器中表示状态向量x的估计值,分别表示为:
其中,分别表示状态变量x1和x2的估计值,分别表示不确定性Δ1和Δ2的估计值。
所述步骤3中不确定性估计器中K1和K2分别为:
其中,分别表示x1和x2的估计误差,k11、k12、k21、k22表示不确定性估计器参数,满足:
所述步骤4中的复合控制器中λ表示控制器参数,具体表示为:
其中,λ1、λ2表示待设计的控制器参数,满足:λ1>0、λ2>0,用于调节系统状态收敛速率。
本发明的有益效果是:
1、本发明利用不确定性估计器对平台因交叉耦合力矩和未建模动态产生的不确定性进行估计,根据得到的重构信息,结合反馈线性化算法设计出无编码传感复合控制器,提高了两轴惯性稳定平台视轴稳定的控制精度。
2、本发明在保证系统高精度控制效果的基础上,无需通过在内、外框之间安装编码传感对相对运动产生的动态进行补偿,降低了平台的硬件成本,提高了平台的容错性,具有很好的应用价值。
附图说明
图1(a)是本发明两轴惯性稳定平台的连接状态示意图,
图1(b)是本发明两轴惯性稳定平台控制框图,
图2(a)是在相同不确定性下,有编码传感的FLC方法和无编码传感的STO方法对内框俯仰角速率的控制效果对比图,
图2(b)是在相同不确定性下,有编码传感的FLC方法和无编码传感的STO方法对内框偏航角速率的控制效果对比图,
图3(a)是在相同不确定性下,无编码传感的PID方法和无编码传感的STO方法对内框俯仰角速率的控制效果对比图,
图3(b)是在相同不确定性下,无编码传感的PID方法和无编码传感的STO方法对内框俯偏航速率的控制效果对比图。
具体实施方式
下面结合附图和具体实施方式,进一步阐明本发明。应理解下述具体实施方式仅用于说明本发明而不用于限制本发明的范围。
一种无编码传感两轴惯性稳定平台的高精度控制方法,具体步骤如下:
步骤1,通过在内框上安装俯仰角速率陀螺仪和偏航角速率陀螺仪,分别获得内框的俯仰角速率fi和偏航角速率pi
如图1(a)所示,光学仪器的视轴与内框的横滚轴重合,俯仰陀螺仪和偏航陀螺仪分别测量内框的俯仰角速率和偏航角速率,保持光学仪器的视轴相对惯性空间稳定,即保证内框的俯仰角速率和偏航角速率为零。通过内框力矩电机转动调节内框的俯仰角速率,通过外框力矩电机的转动间接调节内框的偏航角速率。基座固定在载体上,而两轴惯性稳定平台通过调节电机转动使得光学仪器隔离了载体的扰动。下面给出两轴惯性稳定平台的参数,内框和外框的力矩电机选用同种型号,Ji、Jo分别表示内框和外框标称惯量矩阵,ΔJi、ΔJo分别表示内框和外框惯量矩阵实际值与标称值的偏差。
力矩电机参数
内框和外框的标称惯量矩阵为:
由于内框和外框质量不平衡,假定内框和外框的惯量矩阵偏差为:
假设两轴惯性稳定平台未建模动态为:
其中,分别是外框力矩电机和内框力矩电机的转速。
假设载体的运动方程为:
rb=5×2π/360×sin(2πt)
fb=15×2π/360×sin(2πt)
pb=15×2π/360×cos(2πt)
步骤2:分别以内框的俯仰角速率、偏航角速率为状态变量,采用牛顿-欧拉动力学方程,考虑两轴惯性稳定平台交叉耦合力矩和未建模动态的影响,建立两轴惯性稳定平台状态空间模型:
其中,状态空间模型中的x表示状态向量,u表示输入向量,Δ表示由交叉耦合力矩和未建模动态产生的不确定性向量,分别表示为:
其中,u1和u2分别表示内框力矩电机和外框力矩电机的控制量,Δ1、Δ2分别表示状态空间模型中x1、x2微分方程中的不确定性。
状态空间模型中的系统矩阵A和输入矩阵B分别为:
其中,Mt1、Me1、R1和Mt2、Me2、R2分别表示内框力矩电机和外框力矩电机的转矩系数、反电动势系数、电枢电阻,Jiy、Jiz、Jix和Joz分别表示内框在俯仰轴、偏航轴、横滚轴和外框在偏航轴的转动惯量。
不确定性Δ1和Δ2分别为:
其中,hi、ho、fo和pb分别表示内框横滚角速率、外框横滚角速率、外框俯仰角速率和基座偏航角速率,Di、Do分别表示状态空间模型中x1、x2微分方程中的未建模动态,v2表示内外框的相对角度。
步骤3:根据步骤2建立的两轴惯性稳定平台状态空间模型,构建不确定性估计器对模型中不确定性进行重构,得到不确定性Δ的估计值
不确定估计器中为状态向量x的估计值,分别表示为:
其中,分别表示状态变量x1和x2的估计值,分别表示不确定性Δ1和Δ2的估计值。
不确定性估计器中K1和K2分别为:
其中,分别表示状态变量x1和x2的估计误差。
步骤4:根据步骤3得到的估计值结合步骤1得到的内框的俯仰角速率和偏航角速率,基于反馈线性化算法设计复合控制器
其中,复合控制器中控制器参数λ为:
该方法设计的不确定性估计器,可以估计两轴惯性稳定平台因交叉耦合力矩和未建模动态产生的不确定性,控制器补偿了不确定性,从而提高了平台的控制精度,附图中以STO表示该方法,附图中REF表示系统参考值。
以下为对比实验,说明本发明的有效性和优越性,为了体现对比实验的合理性,三种方法产生的控制量基本保持一致。
当内框和外框之间安装编码器,它们的相对角度v2可以获得,可以将状态空间模型中已知项补偿掉,采用反馈线性化算法设计控制器:
该方法在附图中用FLC表示。
在内框和外框之间没有安装编码器的情况下,利用安装在内框的俯仰角速率陀螺仪和偏航角速率陀螺仪的反馈信息,对两轴惯性稳定平台采用PID控制:
该方法在附图中用PID表示。
本发明方案所公开的技术手段不仅限于上述技术手段所公开的技术手段,还包括由以上技术特征任意组合所组成的技术方案。
以上述依据本发明的理想实施例为启示,通过上述的说明内容,相关工作人员完全可以在不偏离本项发明技术思想的范围内,进行多样的变更以及修改。本项发明的技术性范围并不局限于说明书上的内容,必须要根据权利要求范围来确定其技术性范围。

Claims (7)

1.一种无编码传感两轴惯性稳定平台的高精度控制方法,其特征在于包括如下步骤:
步骤1,通过在内框上安装俯仰角速率陀螺仪和偏航角速率陀螺仪,分别获得内框的俯仰角速率fi和偏航角速率pi
步骤2,选定内框的俯仰角速率、偏航角速率分别为状态变量x1、x2,采用牛顿-欧拉动力学方程,建立考虑轴系交叉耦合力矩的两轴惯性稳定平台状态空间模型其中,x表示状态向量,u表示输入向量,Δ表示由交叉耦合力矩和未建模动态产生的不确定性向量,A表示系统矩阵,B表示输入矩阵;
步骤3,根据步骤2建立的两轴惯性稳定平台状态空间模型,构建不确定性估计器对模型中不确定性进行重构,得到不确定性向量Δ的估计值
步骤4,根据步骤3得到的估计值结合步骤1获得的fi和pi,基于反馈线性化算法设计复合控制器λ表示控制器参数。
2.根据权利要求1所述一种无编码传感两轴惯性稳定平台的高精度控制方法,其特征在于所述步骤2中的状态空间模型中的x、u、Δ分别表示为:
<mrow> <mi>x</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>x</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>x</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> <mi>u</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>u</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>u</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> <mi>&amp;Delta;</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>&amp;Delta;</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>&amp;Delta;</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,u1和u2分别表示内框力矩电机和外框力矩电机的控制量,Δ1和Δ2分别表示状态空间模型中x1和x2微分方程中的不确定性。
3.根据权利要求2所述一种无编码传感两轴惯性稳定平台的高精度控制方法,其特征在于所述步骤2中的状态空间模型中A表示系统矩阵,B表示输入矩阵,分别为:
<mrow> <mi>A</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>M</mi> <mrow> <mi>t</mi> <mn>1</mn> </mrow> </msub> <msub> <mi>M</mi> <mrow> <mi>e</mi> <mn>1</mn> </mrow> </msub> </mrow> <mrow> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>y</mi> </mrow> </msub> <msub> <mi>R</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>M</mi> <mrow> <mi>t</mi> <mn>2</mn> </mrow> </msub> <msub> <mi>M</mi> <mrow> <mi>e</mi> <mn>2</mn> </mrow> </msub> </mrow> <mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>J</mi> <mrow> <mi>o</mi> <mi>z</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>z</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <msub> <mi>R</mi> <mn>2</mn> </msub> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> <mi>B</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mfrac> <msub> <mi>M</mi> <mrow> <mi>t</mi> <mn>1</mn> </mrow> </msub> <mrow> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>y</mi> </mrow> </msub> <msub> <mi>R</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <msub> <mi>M</mi> <mrow> <mi>t</mi> <mn>2</mn> </mrow> </msub> <mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>J</mi> <mrow> <mi>o</mi> <mi>z</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>z</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <msub> <mi>R</mi> <mn>2</mn> </msub> </mrow> </mfrac> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,Mt1、Me1、R1和Mt2、Me2、R2分别表示内框力矩电机和外框力矩电机的转矩系数、反电动势系数、电枢电阻,Jiy、Jiz、Jix和Joz分别表示内框在俯仰轴、偏航轴、横滚轴和外框在偏航轴的转动惯量。
4.根据权利要求3所述一种无编码传感两轴惯性稳定平台的高精度控制方法,其特征在于所述步骤2中的不确定性Δ1和Δ2分别为:
<mrow> <msub> <mi>&amp;Delta;</mi> <mn>1</mn> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>y</mi> </mrow> </msub> </mfrac> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>M</mi> <mrow> <mi>t</mi> <mn>1</mn> </mrow> </msub> <msub> <mi>M</mi> <mrow> <mi>e</mi> <mn>1</mn> </mrow> </msub> </mrow> <msub> <mi>R</mi> <mn>1</mn> </msub> </mfrac> <msub> <mi>f</mi> <mi>o</mi> </msub> <mo>+</mo> <msub> <mi>D</mi> <mi>i</mi> </msub> <mo>+</mo> <mo>(</mo> <mrow> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>z</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>x</mi> </mrow> </msub> </mrow> <mo>)</mo> <msub> <mi>h</mi> <mi>i</mi> </msub> <msub> <mi>p</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> </mrow>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;</mi> <mn>2</mn> </msub> <mo>=</mo> <msub> <mover> <mi>h</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>o</mi> </msub> <mi>sin</mi> <mi> </mi> <msub> <mi>v</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mover> <mi>v</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>2</mn> </msub> <msub> <mi>h</mi> <mi>i</mi> </msub> <mo>+</mo> <mfrac> <msub> <mi>M</mi> <mrow> <mi>t</mi> <mn>2</mn> </mrow> </msub> <mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>J</mi> <mrow> <mi>o</mi> <mi>z</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>z</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <msub> <mi>R</mi> <mn>2</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <mrow> <msub> <mi>M</mi> <mrow> <mi>e</mi> <mn>2</mn> </mrow> </msub> <msub> <mi>p</mi> <mi>i</mi> </msub> <mo>-</mo> <msub> <mi>u</mi> <mn>2</mn> </msub> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mfrac> <mrow> <mi>cos</mi> <mi> </mi> <msub> <mi>v</mi> <mn>2</mn> </msub> </mrow> <mrow> <msub> <mi>J</mi> <mrow> <mi>o</mi> <mi>z</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>x</mi> </mrow> </msub> <msup> <mi>sin</mi> <mn>2</mn> </msup> <msub> <mi>v</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>z</mi> </mrow> </msub> <msup> <mi>cos</mi> <mn>2</mn> </msup> <msub> <mi>v</mi> <mn>2</mn> </msub> </mrow> </mfrac> <mo>&amp;lsqb;</mo> <msub> <mi>D</mi> <mi>o</mi> </msub> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>y</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>z</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <msub> <mi>f</mi> <mi>i</mi> </msub> <msub> <mi>p</mi> <mi>i</mi> </msub> <mi>sin</mi> <mi> </mi> <msub> <mi>v</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mfrac> <msub> <mi>M</mi> <mrow> <mi>t</mi> <mn>2</mn> </mrow> </msub> <msub> <mi>R</mi> <mn>2</mn> </msub> </mfrac> <mrow> <mo>(</mo> <mrow> <msub> <mi>u</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>M</mi> <mrow> <mi>e</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>p</mi> <mi>b</mi> </msub> <mo>+</mo> <msub> <mi>h</mi> <mi>i</mi> </msub> <mi>sin</mi> <mi> </mi> <msub> <mi>v</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>p</mi> <mi>i</mi> </msub> <mi>cos</mi> <mi> </mi> <msub> <mi>v</mi> <mn>2</mn> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>J</mi> <mrow> <mi>i</mi> <mi>y</mi> </mrow> </msub> <msub> <mi>f</mi> <mi>i</mi> </msub> <msub> <mi>h</mi> <mi>i</mi> </msub> <mi>cos</mi> <mi> </mi> <msub> <mi>v</mi> <mn>2</mn> </msub> <mo>&amp;rsqb;</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>
其中,hi、ho、fo和pb分别表示内框横滚角速率、外框横滚角速率、外框俯仰角速率和基座偏航角速率,Di、Do分别表示状态空间模型中x1、x2微分方程中的未建模动态,v2表示内外框的相对角度。
5.根据权利要求1所述一种无编码传感两轴惯性稳定平台的高精度控制方法,其特征在于所述步骤3中不确定性估计器中表示状态向量x的估计值,分别表示为:
<mrow> <mover> <mi>x</mi> <mo>^</mo> </mover> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mover> <mi>x</mi> <mo>^</mo> </mover> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mover> <mi>x</mi> <mo>^</mo> </mover> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> <mover> <mi>&amp;Delta;</mi> <mo>^</mo> </mover> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mover> <mi>&amp;Delta;</mi> <mo>^</mo> </mover> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mover> <mi>&amp;Delta;</mi> <mo>^</mo> </mover> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,分别表示状态变量x1和x2的估计值,分别表示不确定性Δ1和Δ2的估计值。
6.根据权利要求5所述一种无编码传感两轴惯性稳定平台的高精度控制方法,其特征在于所述步骤3中不确定性估计器中K1和K2分别为:
<mrow> <msub> <mi>K</mi> <mn>1</mn> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>k</mi> <mn>11</mn> </msub> <mo>|</mo> <msub> <mover> <mi>x</mi> <mo>~</mo> </mover> <mn>1</mn> </msub> <msup> <mo>|</mo> <mrow> <mn>1</mn> <mo>/</mo> <mn>2</mn> </mrow> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mo>(</mo> <msub> <mover> <mi>x</mi> <mo>~</mo> </mover> <mn>1</mn> </msub> <mo>)</mo> </mtd> </mtr> <mtr> <mtd> <msub> <mi>k</mi> <mn>21</mn> </msub> <mo>|</mo> <msub> <mover> <mi>x</mi> <mo>~</mo> </mover> <mn>2</mn> </msub> <msup> <mo>|</mo> <mrow> <mn>1</mn> <mo>/</mo> <mn>2</mn> </mrow> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mo>(</mo> <msub> <mover> <mi>x</mi> <mo>~</mo> </mover> <mn>2</mn> </msub> <mo>)</mo> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> <msub> <mi>K</mi> <mn>2</mn> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>k</mi> <mn>12</mn> </msub> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mo>(</mo> <msub> <mover> <mi>x</mi> <mo>~</mo> </mover> <mn>1</mn> </msub> <mo>)</mo> </mtd> </mtr> <mtr> <mtd> <msub> <mi>k</mi> <mn>22</mn> </msub> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mo>(</mo> <msub> <mover> <mi>x</mi> <mo>~</mo> </mover> <mn>2</mn> </msub> <mo>)</mo> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,分别表示x1和x2的估计误差,k11、k12、k21、k22表示不确定性估计器参数,满足:
7.根据权利要求1所述一种无编码传感两轴惯性稳定平台的高精度控制方法,其特征在于所述步骤4中的复合控制器中λ表示控制器参数,具体表示为:
<mrow> <mi>&amp;lambda;</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>&amp;lambda;</mi> <mn>1</mn> </msub> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>&amp;lambda;</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,λ1、λ2表示待设计的控制器参数,满足:λ1>0、λ2>0,用于调节系统状态收敛速率。
CN201710981675.2A 2017-10-20 2017-10-20 一种无编码传感两轴惯性稳定平台的高精度控制方法 Active CN107894713B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710981675.2A CN107894713B (zh) 2017-10-20 2017-10-20 一种无编码传感两轴惯性稳定平台的高精度控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710981675.2A CN107894713B (zh) 2017-10-20 2017-10-20 一种无编码传感两轴惯性稳定平台的高精度控制方法

Publications (2)

Publication Number Publication Date
CN107894713A true CN107894713A (zh) 2018-04-10
CN107894713B CN107894713B (zh) 2020-11-06

Family

ID=61803772

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710981675.2A Active CN107894713B (zh) 2017-10-20 2017-10-20 一种无编码传感两轴惯性稳定平台的高精度控制方法

Country Status (1)

Country Link
CN (1) CN107894713B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109001726A (zh) * 2018-06-20 2018-12-14 北京惠风联合防务科技有限公司 空间稳定式光学3d雷达跟踪系统
CN110109343A (zh) * 2019-04-30 2019-08-09 东南大学 一种光电跟踪系统视觉测量时滞补偿方法
CN115182928A (zh) * 2022-03-28 2022-10-14 北方工业大学 一种复合轴视轴稳定设备的动力减摩方法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101301934A (zh) * 2008-04-22 2008-11-12 北京航空航天大学 一种双框架磁悬浮控制力矩陀螺控制系统
EP2400357A1 (en) * 2009-02-18 2011-12-28 Toyota Jidosha Kabushiki Kaisha State feedback control device, state feedback controller and state feedback control method
CN102298322A (zh) * 2011-06-21 2011-12-28 河海大学常州校区 基于模型参考自适应控制微陀螺仪的方法
CN102393201A (zh) * 2011-08-02 2012-03-28 北京航空航天大学 航空遥感用位置和姿态测量系统(pos)动态杆臂补偿方法
CN103401500A (zh) * 2013-08-20 2013-11-20 东南大学 一种基于重复控制器的高精度永磁同步电机交流伺服系统转速脉动抑制方法
CN103488081A (zh) * 2013-09-09 2014-01-01 广东电网公司电力科学研究院 惯性稳定平台控制方法
CN105785762A (zh) * 2016-03-17 2016-07-20 北京航空航天大学 一种基于自适应反步滑模的两轴惯性稳定平台高精度控制方法
CN106200383A (zh) * 2016-08-08 2016-12-07 北京宇鹰科技有限公司 一种基于模型参考自适应神经网络的三轴惯性稳定平台控制方法
WO2017143434A1 (en) * 2016-02-23 2017-08-31 Canadian Space Agency Energy-efficient motor drive with or without open-circuited phase

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101301934A (zh) * 2008-04-22 2008-11-12 北京航空航天大学 一种双框架磁悬浮控制力矩陀螺控制系统
EP2400357A1 (en) * 2009-02-18 2011-12-28 Toyota Jidosha Kabushiki Kaisha State feedback control device, state feedback controller and state feedback control method
CN102298322A (zh) * 2011-06-21 2011-12-28 河海大学常州校区 基于模型参考自适应控制微陀螺仪的方法
CN102393201A (zh) * 2011-08-02 2012-03-28 北京航空航天大学 航空遥感用位置和姿态测量系统(pos)动态杆臂补偿方法
CN103401500A (zh) * 2013-08-20 2013-11-20 东南大学 一种基于重复控制器的高精度永磁同步电机交流伺服系统转速脉动抑制方法
CN103488081A (zh) * 2013-09-09 2014-01-01 广东电网公司电力科学研究院 惯性稳定平台控制方法
WO2017143434A1 (en) * 2016-02-23 2017-08-31 Canadian Space Agency Energy-efficient motor drive with or without open-circuited phase
CN105785762A (zh) * 2016-03-17 2016-07-20 北京航空航天大学 一种基于自适应反步滑模的两轴惯性稳定平台高精度控制方法
CN106200383A (zh) * 2016-08-08 2016-12-07 北京宇鹰科技有限公司 一种基于模型参考自适应神经网络的三轴惯性稳定平台控制方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
JIANLIANGMAO等: "Output Feedback Stabilization of Inertial Stabilized Platform with Using Sliding Mode", 《SCIENCEDIRECT》 *
WEIJI等: "Cascade Servo Control for LOS Stabilization of Opto-electronic Tracking Platform Design and Self-tuning", 《INTERNATIONAL CONFERENCE ON INFORMATION AND AUTOMATION》 *
冒建亮等: "多源扰动下光电跟踪系统连续非奇异终端滑模控制", 《控制理论与应用》 *
吴逸民等: "一种基于两轴陀螺稳定平台速度补偿算法", 《机电技术》 *

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109001726A (zh) * 2018-06-20 2018-12-14 北京惠风联合防务科技有限公司 空间稳定式光学3d雷达跟踪系统
CN109001726B (zh) * 2018-06-20 2021-05-11 北京惠风联合防务科技有限公司 空间稳定式光学3d雷达跟踪系统
CN110109343A (zh) * 2019-04-30 2019-08-09 东南大学 一种光电跟踪系统视觉测量时滞补偿方法
WO2020220469A1 (zh) * 2019-04-30 2020-11-05 东南大学 一种光电跟踪系统视觉测量时滞补偿方法
CN110109343B (zh) * 2019-04-30 2021-09-10 东南大学 一种光电跟踪系统视觉测量时滞补偿方法
US11838636B2 (en) 2019-04-30 2023-12-05 Southeast University Method for compensating for visual-measurement time lag of electro-optical tracking system
CN115182928A (zh) * 2022-03-28 2022-10-14 北方工业大学 一种复合轴视轴稳定设备的动力减摩方法
CN115182928B (zh) * 2022-03-28 2023-08-11 北方工业大学 一种复合轴视轴稳定设备的动力减摩方法

Also Published As

Publication number Publication date
CN107894713B (zh) 2020-11-06

Similar Documents

Publication Publication Date Title
CN105116934B (zh) 基于自适应滑模补偿的双框架mscmg框架系统高精度控制方法
CN110780594B (zh) 一种智能车的路径跟踪方法及系统
Benallegue et al. High‐order sliding‐mode observer for a quadrotor UAV
CN102636995B (zh) 基于rbf神经网络滑模控制微陀螺仪的方法
CN105159083A (zh) 一种双框架磁悬浮cmg框架系统的高精度摩擦补偿控制方法
CN103175530B (zh) 一种航空遥感惯性稳定平台耦合力矩估计与补偿方法
CN103488081B (zh) 惯性稳定平台控制方法
CN107894713A (zh) 一种无编码传感两轴惯性稳定平台的高精度控制方法
CN106985139A (zh) 基于扩展状态观测与补偿的空间机器人自抗扰协调控制方法
CN102809377A (zh) 飞行器惯性/气动模型组合导航方法
CN104765272A (zh) 一种基于pid神经元网络控制(pidnn)的四旋翼飞行器控制方法
US20220306157A1 (en) Vehicle-mounted camera gimbal servo system and control method
CN111230868B (zh) 双足机器人在前进方向受到外部推力扰动时的步态规划与控制方法
CN103558857A (zh) 一种btt飞行器的分布式复合抗干扰姿态控制方法
Chen et al. An adaptive backstepping design for formation tracking motion in an unknown Eulerian specification flowfield
CN111880409A (zh) 一种基于数据驱动的自主水下航行器轨迹跟踪控制方法
Lamon et al. 3D position tracking in challenging terrain
Yamasaki et al. Integrated guidance and autopilot for a path-following UAV via high-order sliding modes
Huang et al. Homography-based visual servoing for underactuated VTOL UAVs tracking a 6-DOF moving ship
CN106292297A (zh) 基于pid控制器和l1自适应控制器的姿态控制方法
Dong et al. Real-time model predictive control for simultaneous drift and trajectory tracking of autonomous vehicles
Rigatos et al. Nonlinear optimal control for a spherical rolling robot
CN106326576B (zh) 一种任意基准系下的整星偏置角动量的偏航估计方法
CN110134135B (zh) 基于改进mpc-pid的四旋翼飞行器控制方法
Dong et al. Stabilizing Aerodynamic Dampers for Cooperative Transport of a Suspended Payload with Aerial Robots

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
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20180410

Assignee: Nanjing Keyuan Intelligent Technology Group Co.,Ltd.

Assignor: SOUTHEAST University

Contract record no.: X2022320000110

Denomination of invention: A high precision control method for two axis inertial stabilization platform without code sensing

Granted publication date: 20201106

License type: Common License

Record date: 20220615

EE01 Entry into force of recordation of patent licensing contract