CN103175530B - 一种航空遥感惯性稳定平台耦合力矩估计与补偿方法 - Google Patents
一种航空遥感惯性稳定平台耦合力矩估计与补偿方法 Download PDFInfo
- Publication number
- CN103175530B CN103175530B CN201310068184.0A CN201310068184A CN103175530B CN 103175530 B CN103175530 B CN 103175530B CN 201310068184 A CN201310068184 A CN 201310068184A CN 103175530 B CN103175530 B CN 103175530B
- Authority
- CN
- China
- Prior art keywords
- omega
- coupling torque
- value
- roll
- torque
- 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.)
- Active
Links
Landscapes
- Navigation (AREA)
Abstract
一种航空遥感惯性稳定平台耦合力矩估计与补偿方法,通过建立三轴惯性稳定平台动力学模型,根据POS、横滚/俯仰陀螺、方位码盘实时测出的信息,估算出基座及框架间耦合力矩,然后计算出抵消此耦合力矩所需的力矩电机电流值,并将此电流值补偿到电流环的电流给定输入值中,使电机输出与耦合力矩大小相等、方向相反的力矩,补偿平台耦合力矩干扰,提高平台稳定精度。本发明实现了耦合力矩的实时估算与补偿,提高了稳定精度,适用于具有基座及框架间耦合力矩的航空遥感惯性稳定平台。
Description
技术领域
本发明涉及一种航空遥感惯性稳定平台耦合力矩估计与补偿方法,可用于各种中、高精度的航空遥感用惯性稳定平台载体及框架间耦合力矩的补偿,特别适用于具有较大和较高频率姿态角运动的飞行平台。
背景技术
航空遥感系统在机动性、实时性、可重复观测性、遥感设备可更换性、获取高分辨率遥感数据能力、经济成本以及立体观测等很多方面,都具独特的优势。因此,在西方发达国家,用于城市规划和基本地图测绘大约65%以上的高分辨率空间数据是依靠航空遥感系统来保证的。高分辨率对地观测是航空遥感系统发展的重要方向,但是由于大气紊流和载机自身因素的影响,载机机体无法保持平稳,造成安装在载机上的成像载荷视轴摇晃,成像质量下降。惯性稳定平台组成的高分辨率航空遥感平台是解决这个问题的有效措施。惯性稳定平台用于隔离载机的角运动,跟踪当地地理水平,消除干扰力矩对成像载荷的影响,使成像载荷稳定成像。稳定精度是惯性稳定平台的主要技术指标之一,反映了稳定平台对干扰力矩的抑制能力。
惯性稳定平台通常采用三轴框架结构,隔离的主要扰动是飞机的姿态角度变化,由外到内依次为飞机的横滚、俯仰和方位角,最终实现安装在最内框架(方位框)上相机视轴的对地垂直稳定和对航迹的跟踪稳定。三轴惯性稳定平台框架运动角速度和角加速度较大时,各框架之间的动力学耦合就比较严重,若不采取有效的解耦补偿措施将很难保证系统的精度和动态跟踪性能,严重时还会影响到系统的稳定性。而通常采用的PID控制方法由于没有考虑耦合因素导致精度下降。因此,在进行稳定平台控制系统设计时,必须针对三个框架之间动力学耦合问题采用有效的解耦控制方法,提高稳定平台的控制精度和动态性能。
发明内容
本发明需要解决的技术问题是:克服常规反馈控制对载体及框架间耦合力矩抑制能力不足的缺陷,提供一种航空遥感惯性稳定平台耦合力矩估计与补偿方法,用以提高系统稳定精度。
本发明的技术解决方案是:一种航空遥感惯性稳定平台耦合力矩估计与补偿方法,基于建立的三轴动力学方程,根据POS、陀螺、码盘测量值估算耦合力矩值,进一步计算补偿电流值,具体包括以下步骤:
(1)针对航空遥感三轴惯性稳定平台建立动基座下简化动力学模型,如下:
①方位框绕方位轴的动力学方程为:
②俯仰框组件绕俯仰轴的动力学方程简化为:
③横滚框组件绕横滚轴方向动力学方程简化为:
其中定义:Jax、Jay、Jaz分别为方位框架在x、y、z轴的转动惯量;Jfx、Jfy、Jfz分别为俯仰框架在x、y、z轴的转动惯量;Jrx、Jry、Jrz分别为横滚框架在x、y、z轴的转动惯量;为基座相对惯性空间的角速度在基座坐标系的表达,其在x、y、z轴上的投影分别记为为俯仰框架相对惯性空间的角速度在俯仰框坐标系的表达,其在x、y、z轴上的投影分别记为为俯仰框架相对惯性空间的角加速度在俯仰框坐标系的表达在z轴的投影;θa为方位框架相对俯仰框架转角,为方位框架相对俯仰框架转角角速度;为方位框架相对俯仰框架转角角加速度;Mx为俯仰框组件沿x轴受到的综合力矩,My为横滚框组件沿y轴受到的综合力矩,Mz为方位框架沿z轴受到的综合力矩;
(2)利用安装于基座的POS测量和利用安装于俯仰框架的横滚和俯仰陀螺测量和利用安装于方位框架的码盘测量θa,间接计算
(3)根据步骤(2)中直接测量值或间接计算值θa和计算横滚框耦合力矩值Mcouple_y和俯仰框耦合力矩值Mcouple_x;
(4)根据步骤(3)中计算得到的横滚框耦合力矩值Mcouple_y和俯仰框耦合力矩值Mcouple_x,进一步计算出抵消横滚框耦合力矩Mcouple_y所需的力矩电机电流值Icom_y,抵消俯仰框耦合力矩Mcouple_x所需的力矩电机电流值Icom_x,并将计算出的电流值补偿到电流环的电流给定输入值中,电机输出与耦合力矩大小相等、方向相反的力矩,补偿惯性平台耦合干扰力矩。
所述步骤(3)中根据步骤(2)中直接测量值或间接计算值计算俯仰框耦合力矩值Mcouple_x、横滚框耦合力矩值Mcouple_y,具体如下:
所述步骤(4)中抵消耦合力矩所需的力矩电机电流值步骤如下:
(41)根据估算的耦合力矩值计算出抵消此耦合力矩所需的力矩电机电流值,如下:
①抵消俯仰框耦合力矩Mcouple_x所需的力矩电机电流值其中Kt_x为俯仰电机力矩系数,从电机说明书中得到;
②抵消横滚框耦合力矩Mcouple_y所需的力矩电机电流值其中Kt_y为横滚电机力矩系数,从电机说明书中得到;
(42)将步骤(41)中电流值Icom_x、Icom_y分别前馈补偿到俯仰、横滚控制系统电流环的电流给定输入值中,电机输出与耦合力矩大小相等、方向相反的力矩,补偿平台耦合干扰力矩。
本发明的原理是:针对航空遥感三轴惯性稳定平台建立动基座下简化动力学模型,方位框、俯仰框、横滚框所受综合外力矩分别用Mz、Mf、Mr表示;
由动力学方程得出方位框不受耦合力矩影响,只需针对横滚、俯仰框架进行耦合力矩补偿。利用安装于基座的POS测量利用安装于俯仰框架的横滚、俯仰陀螺测量利用安装于方位框架的码盘测量θa,间接计算根据以上直接测量值或间接计算值计算横滚框耦合力矩值Mcouple_y、俯仰框耦合力矩值Mcouple_x;进一步计算出抵消横滚框耦合力矩Mcouple_y所需的力矩电机电流值Icom_y,抵消俯仰框耦合力矩Mcouple_x所需的力矩电机电流值Icom_x,并将计算出的电流值补偿到电流环的电流给定输入值中,电机输出与耦合力矩大小相等、方向相反的力矩,补偿平台耦合干扰力矩;
本发明与现有技术相比的优点在于:
(1)本发明由于对基座与框架间耦合力矩实时估计和补偿,克服了PID控制的不足,使得平台稳定精度提高;
(2)本发明的补偿原理明晰,补偿算法简洁,易于在DSP中编程实现;
(3)本发明利用惯性传感器测量值作为补偿参数,相比软件设计状态观测器控制方法更直观和容易实现。
附图说明
图1为本发明中的解耦控制方法流程图;
图2为本发明中的航空遥感三轴惯性稳定平台工作原理图;
图3为本发明中的解耦控制方法原理图;
图4为本发明中的建立三轴惯性稳定平台坐标系示意图。
具体实施方式
如图1和图3所示,本发明的具体实施方法如下:
(1)建立动基座下简化动力学模型步骤如下:
(11)基于刚体动力学特性和空间矢量叠加原理,建立三轴惯性稳定平台坐标系:基座坐标系、横滚框坐标系、俯仰框坐标系、方位框坐标系;如图4所示,其中基座坐标系Oxbybzb:xb、yb、zb分别指向飞行载体的右、前、上;横滚框坐标系Oxryrzr:横滚轴yr与yb同向,Oxryrzr相对Oxbybzb系绕yb轴旋转,产生横滚角θr;俯仰框坐标系Oxfyfzf:俯仰轴xf与xr同向,Oxfyfzf相对Oxryrzr系绕xr轴旋转,产生俯仰角θf;方位框坐标系Oxayaza:方位轴za与zf同向,Oxayaza相对Oxfyfzf系绕zf轴旋转,产生方位角θa。并定义 分别为基座到横滚框、横滚框到俯仰框、俯仰框到方位框的方向余弦矩阵,根据坐标系关系,令转角θr、θf、θa逆时针为正,可推导出各矩阵如下:
(12)定义为基座相对惯性空间的角速度在Oxbybzb系的表示,其在x、y、z轴上的投影分别记为为横滚框架相对惯性空间的角速度在Oxryrzr系的表示,其在x、y、z轴上的投影分别记为为俯仰框架相对惯性空间的角速度在Oxfyfzf系的表示,其在x、y、z轴上的投影分别记为为方位框架相对惯性空间的角速度在Oxayaza系的表示,其在x、y、z轴上的投影分别记为 为俯仰框架相对横滚框架转角角速度、为横滚框架相对基座转角角速度、为方位框架相对俯仰框架转角角速度。建立三轴角速度关系方程,如下:
①横滚框架相对惯性空间的角速度在横滚框坐标系的投影为:
②俯仰框架相对惯性空间的角速度在俯仰框坐标系的投影为:
③方位框相对惯性空间的角速度在方位框坐标系的投影为:
(13)定义Jax、Jay、Jaz分别为方位框架在x、y、z轴的转动惯量;Jfx、Jfy、Jfz分别为俯仰框架在x、y、z轴的转动惯量;Jrx、Jry、Jrz分别为横滚框架在x、y、z轴的转动惯量;利用Newton-Euler动力学方程及矢量叠加原理,推导平台动力学方程,如下:
①方位框绕方位轴的动力学方程:
②俯仰框组件绕俯仰轴的动力学方程为:
③横滚框组件绕横滚轴的动力学方程为:
(14)实际惯性稳定平台横滚转角≤±8°、俯仰转角≤±8°,因此对系统动力学方程进行小角度线性化处理,获得简化动力学方程,如下:
①俯仰框组件绕俯仰轴的动力学方程简化为:
②横滚框组件绕横滚轴方向动力学方程可简化为:
(2)POS、横滚/俯仰陀螺、方位码盘等传感器信息获取步骤如下:
(21)安装于基座的POS测量
(22)安装于俯仰框架的横滚、俯仰陀螺测量
(23)安装于方位框架的码盘测量θa,间接计算
(3)根据以上直接测量值或间接计算值计算俯仰框耦合力矩值Mcouple_x、横滚框耦合力矩值Mcouple_y如下:
(4)抵消(3)中耦合力矩所需的力矩电机电流值步骤如下:
(41)根据估算的耦合力矩值计算出抵消此耦合力矩所需的力矩电机电流值,如下:
①抵消俯仰框耦合力矩Mcouple_x所需的力矩电机电流值其中Kt_x为俯仰电机力矩系数,可从电机说明书中得到;
②抵消横滚框耦合力矩Mcouple_y所需的力矩电机电流值其中Kt_y为横滚电机力矩系数,可从电机说明书中得到;
(42)并将(41)中电流值Icom_x、Icom_y分别前馈补偿到俯仰、横滚控制系统电流环的电流给定输入值中,电机输出与耦合力矩大小相等、方向相反的力矩,补偿平台耦合干扰力矩。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (2)
1.一种航空遥感惯性稳定平台耦合力矩估计与补偿方法,其特征在于:基于建立的三轴动力学方程,根据POS、陀螺、码盘测量值估算耦合力矩值,进一步计算补偿电流值,具体包括以下步骤:
(1)针对航空遥感三轴惯性稳定平台建立动基座下简化动力学模型,如下:
①方位框绕方位轴的动力学方程为:
②俯仰框组件绕俯仰轴的动力学方程简化为:
③横滚框组件绕横滚轴方向动力学方程简化为:
其中定义:Jax、Jay、Jaz分别为方位框架在x、y、z轴的转动惯量;Jfx、Jfy、Jfz分别为俯仰框架在x、y、z轴的转动惯量;Jrx、Jry、Jrz分别为横滚框架在x、y、z轴的转动惯量;为基座相对惯性空间的角速度在基座坐标系的表达,其在x、y、z轴上的投影分别记为为俯仰框架相对惯性空间的角速度在俯仰框坐标系的表达,其在x、y、z轴上的投影分别记为 为俯仰框架相对惯性空间的角加速度在俯仰框坐标系的表达在z轴的投影;θa为方位框架相对俯仰框架转角,为方位框架相对俯仰框架转角角速度;为方位框架相对俯仰框架转角角加速度;Mx为俯仰框组件沿x轴受到的综合力矩,My为横滚框组件沿y轴受到的综合力矩,Mz为方位框架沿z轴受到的综合力矩;
(2)利用安装于基座的POS测量和利用安装于俯仰框架的横滚和俯仰陀螺测量和利用安装于方位框架的码盘测量θa,间接计算
(3)根据步骤(2)中直接测量值或间接计算值θa和计算横滚框耦合力矩值Mcouple_y和俯仰框耦合力矩值Mcouple_x;
(4)根据步骤(3)中计算得到的横滚框耦合力矩值Mcouple_y和俯仰框耦合力矩值Mcouple_x,进一步计算出抵消横滚框耦合力矩Mcouple_y所需的力矩电机电流值Icom_y,抵消俯仰框耦合力矩Mcouple_x所需的力矩电机电流值Icom_x,并将计算出的电流值补偿到电流环的电流给定输入值中,电机输出与耦合力矩大小相等、方向相反的力矩,补偿惯性平台耦合干扰力矩;
所述步骤(3)中根据步骤(2)中直接测量值或间接计算值计算俯仰框耦合力矩值Mcouple_x、横滚框耦合力矩值Mcouple_y,具体如下:
2.根据权利要求1所述的一种航空遥感惯性稳定平台耦合力矩估计与补偿方法,其特征在于:所述步骤(4)中抵消耦合力矩所需的力矩电机电流值步骤如下:
(1)根据估算的耦合力矩值计算出抵消此耦合力矩所需的力矩电机电流值,如下:
①抵消俯仰框耦合力矩Mcouple_x所需的力矩电机电流值其中Kt_x为俯仰电机力矩系数,从电机说明书中得到;
②抵消横滚框耦合力矩Mcouple_y所需的力矩电机电流值其中Kt_y为横滚电机力矩系数,从电机说明书中得到;
(2)将步骤(1)中电流值Icom_x、Icom_y分别前馈补偿到俯仰、横滚控制系统电流环的电流给定输入值中,电机输出与耦合力矩大小相等、方向相反的力矩,补偿平台耦合干扰力矩。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310068184.0A CN103175530B (zh) | 2013-03-04 | 2013-03-04 | 一种航空遥感惯性稳定平台耦合力矩估计与补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310068184.0A CN103175530B (zh) | 2013-03-04 | 2013-03-04 | 一种航空遥感惯性稳定平台耦合力矩估计与补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103175530A CN103175530A (zh) | 2013-06-26 |
CN103175530B true CN103175530B (zh) | 2015-04-08 |
Family
ID=48635558
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310068184.0A Active CN103175530B (zh) | 2013-03-04 | 2013-03-04 | 一种航空遥感惯性稳定平台耦合力矩估计与补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103175530B (zh) |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103425146B (zh) * | 2013-08-01 | 2016-01-20 | 北京航空航天大学 | 一种基于角加速度的惯性稳定平台干扰观测器设计方法 |
CN103488081B (zh) * | 2013-09-09 | 2016-02-24 | 广东电网公司电力科学研究院 | 惯性稳定平台控制方法 |
CN105004341B (zh) * | 2015-07-06 | 2018-04-10 | 北京航天控制仪器研究所 | 一种四轴惯性稳定平台系统的台体控制参数计算方法 |
CN105043414B (zh) * | 2015-07-06 | 2018-01-05 | 北京航天控制仪器研究所 | 一种三轴惯性稳定平台系统的台体控制参数计算方法 |
CN105021195A (zh) * | 2015-07-06 | 2015-11-04 | 北京航天控制仪器研究所 | 一种四轴惯性稳定平台系统的伺服回路解耦方法 |
CN105180936B (zh) * | 2015-08-25 | 2017-12-22 | 北京航天控制仪器研究所 | 一种四轴惯性稳定平台系统的伺服回路解耦方法 |
CN105115503B (zh) * | 2015-08-25 | 2017-11-28 | 北京航天控制仪器研究所 | 一种三轴稳定平台系统的伺服回路解耦方法 |
CN105115505B (zh) * | 2015-09-08 | 2018-02-09 | 北京航天控制仪器研究所 | 一种四轴惯性稳定平台系统的二阶动态干扰力矩补偿方法 |
CN105277212B (zh) * | 2015-09-08 | 2018-07-24 | 北京航天控制仪器研究所 | 一种三轴惯性稳定平台系统的二阶动态干扰力矩补偿方法 |
CN105607639A (zh) * | 2015-12-21 | 2016-05-25 | 河北汉光重工有限责任公司 | 一种三轴稳定伺服平台的姿态解算及补偿方法 |
CN108955680B (zh) * | 2018-04-04 | 2022-12-02 | 天津航天中为数据系统科技有限公司 | 一种陀螺稳定平台与姿态基准的集成设计方法 |
CN108724195B (zh) * | 2018-07-04 | 2021-10-19 | 天津大学 | 一种针对机器人的耦合前馈控制方法 |
CN109708661B (zh) * | 2018-11-13 | 2022-07-29 | 河北汉光重工有限责任公司 | 一种具有两轴框架的惯性稳定设备的视轴惯性稳定方法 |
CN111750896B (zh) * | 2019-03-28 | 2022-08-05 | 杭州海康机器人技术有限公司 | 云台标定方法、装置、电子设备及存储介质 |
CN110244774B (zh) * | 2019-04-12 | 2022-07-12 | 北京航天发射技术研究所 | 一种动基座起竖回转装置瞄准的解耦方法和装置 |
CN114235005B (zh) * | 2021-11-23 | 2023-08-29 | 北京航天控制仪器研究所 | 一种适用于长期加电下快速更新六项陀螺仪诸元方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000213953A (ja) * | 1999-01-25 | 2000-08-04 | Mitsubishi Electric Corp | 飛しょう体の航法装置 |
US6145790A (en) * | 1998-09-22 | 2000-11-14 | Hughes Electronics Corporation | Attitude determination system and method |
CN102436262A (zh) * | 2011-09-26 | 2012-05-02 | 北京航空航天大学 | 高精度大负载航空遥感三轴惯性稳定平台控制系统及方法 |
-
2013
- 2013-03-04 CN CN201310068184.0A patent/CN103175530B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6145790A (en) * | 1998-09-22 | 2000-11-14 | Hughes Electronics Corporation | Attitude determination system and method |
JP2000213953A (ja) * | 1999-01-25 | 2000-08-04 | Mitsubishi Electric Corp | 飛しょう体の航法装置 |
CN102436262A (zh) * | 2011-09-26 | 2012-05-02 | 北京航空航天大学 | 高精度大负载航空遥感三轴惯性稳定平台控制系统及方法 |
Non-Patent Citations (2)
Title |
---|
房建成等.航空遥感用三轴惯性稳定平台不平衡力矩前馈补偿方法.《中国惯性学报》.2010,第18卷(第1期), * |
魏彤等.双框架磁悬浮控制力矩陀螺动框架效应补偿方法.《机械工程学报》.2010,第46卷(第2期), * |
Also Published As
Publication number | Publication date |
---|---|
CN103175530A (zh) | 2013-06-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103175530B (zh) | 一种航空遥感惯性稳定平台耦合力矩估计与补偿方法 | |
CN101706281B (zh) | 惯性/天文/卫星高精度组合导航系统及其导航方法 | |
CN104848859B (zh) | 一种三轴惯性稳定平台及其自定位定向的控制方法 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN105157705B (zh) | 一种半捷联雷达导引头视线角速度提取方法 | |
CN101709975A (zh) | 一种航空遥感惯性稳定平台不平衡力矩估计与补偿方法 | |
CN103323026A (zh) | 星敏感器和有效载荷的姿态基准偏差估计与修正方法 | |
CN105929836B (zh) | 用于四旋翼飞行器的控制方法 | |
CN106507770B (zh) | 一种用无拖曳技术实现重力梯度卫星姿轨控的方法 | |
CN105737858A (zh) | 一种机载惯导系统姿态参数校准方法与装置 | |
CN104698486A (zh) | 一种分布式pos用数据处理计算机系统实时导航方法 | |
CN103488081B (zh) | 惯性稳定平台控制方法 | |
CN103335651B (zh) | 一种航空遥感惯性稳定平台双速度环控制方法 | |
CN109084760B (zh) | 一种楼宇间导航系统 | |
CN104166345A (zh) | 一种磁悬浮控制力矩陀螺转子系统解耦和扰动抑制方法 | |
CN105928515A (zh) | 一种无人机导航系统 | |
CN103925930A (zh) | 一种重力仪双轴陀螺稳定平台航向误差效应的补偿方法 | |
CN103033197B (zh) | 一种mems陀螺零位漂移的校正方法 | |
CN109649691A (zh) | 一种偏置动量卫星单飞轮与磁联合控制方法和系统 | |
Xiang et al. | A SINS/GNSS/2D-LDV integrated navigation scheme for unmanned ground vehicles | |
Gong et al. | An innovative distributed filter for airborne distributed position and orientation system | |
Weibel et al. | Small unmanned aerial system attitude estimation for flight in wind | |
CN103950555A (zh) | 超近距离的高精度相对位置保持控制方法 | |
Kornfeld et al. | The impact of GPS velocity based flight control on flight instrumentation architecture | |
CN106681346B (zh) | 基于pos数据与框架角联合解算的姿态控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |