CN115808164B - 旋转平台下偏流机构角速度测量及偏流角实时调整方法 - Google Patents
旋转平台下偏流机构角速度测量及偏流角实时调整方法 Download PDFInfo
- Publication number
- CN115808164B CN115808164B CN202211444801.8A CN202211444801A CN115808164B CN 115808164 B CN115808164 B CN 115808164B CN 202211444801 A CN202211444801 A CN 202211444801A CN 115808164 B CN115808164 B CN 115808164B
- Authority
- CN
- China
- Prior art keywords
- angular velocity
- drift
- interference
- coordinate system
- bias flow
- 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
- Gyroscopes (AREA)
Abstract
旋转平台下偏流机构角速度测量及偏流角实时调整方法,涉及遥感载荷偏流角实时控制领域,为解决传统空间遥感载荷偏流角调整方法无法有效处理旋转平台下高动态偏流角实时调整问题以及偏流角控制精度低等问题,本发明采用陀螺仪测量方法可获取高精度的角速度测量值,同时考虑到陀螺仪测量值中集总干扰信号模型的非线性、强耦合、高不确定性特性,通过参数辨识方法可有效提高集总干扰信号模型的逼近精度。本发明方法中采用PD型反馈控制器对偏流机构进行实时控制,与传统的反馈控制器相比,可提高偏流角的控制精度,同时改善了系统响应动态特性,有效增强了偏流角实时补偿性能。
Description
技术领域
本发明涉及遥感载荷偏流角实时控制领域,具体涉及一种旋转平台下偏流机构角速度测量及偏流角实时调整方法。
背景技术
空间遥感载荷在对地进行拍摄时,由于地球自转、卫星本身姿轨移动等原因,造成地面待成像目标投影到遥感载荷成像探测器上将表现为一个实时运动目标,即物点在像面上是移动的,称之为像移。像移的存在将导致成像模糊,是影响空间遥感载荷成像质量的重要因素之一。
目前,可以通过偏流机构自动调整偏流角,补偿像移对成像造成的影响,显著提高空间遥感载荷的成像质量。传统偏流机构控制策略基于获取偏流角信息,通过驱动器驱动偏流机构,实现偏流角的实时动态调整。如一种宽幅空间相机的分组偏流角实时调整方法(CN109672880B),测量获取的偏流角信息作为偏流机构控制系统的控制输入。但当像移速度较快时,该方法可能会存在系统响应速度较慢、偏流角跟踪误差超调大、跟踪延迟等问题。一种有效的控制方法是获取偏流机构转动的角速度,即偏流角角速度,进而设计PD型反馈控制策略,提高系统的响应速度、减小超调、改善系统的动态特性,从而增强偏流角的控制性能。其中,相较于偏流角,偏流角角速度不易测量,可以通过偏流角微分得到,但其信号存在较大噪声干扰,精确度低。因而,采用陀螺仪测角速度方案,是一种获取高精度偏流角角速度信息的有效解决途径。
发明内容
本发明为解决传统空间遥感载荷偏流角调整方法无法有效处理旋转平台下高动态偏流角实时调整问题以及偏流角控制精度低等问题。提供一种旋转平台下偏流机构角速度测量及偏流角实时调整方法,可获取偏流角及偏流角变化趋势,能够提高偏流角的实时调整精度。
旋转平台下偏流机构角速度测量及偏流角实时调整方法,该方法由以下步骤实现:
步骤一、根据地面标定的卫星各结构单元的安装信息,确定测量系统受到的各种外部干扰、结构安装误差等测量干扰因素。包括卫星平台姿态角速度、卫星绕地心运动角速度、旋转平台相对于卫星平台的相对旋转角速度、以及各个结构的安装偏差。
步骤二、基于步骤一中确定的空间坐标系及各测量干扰因素,确定陀螺仪测量数据中各干扰因素的空间传递路径,并建立集总干扰因素模型。通过将各个干扰因素经转移坐标矩阵投影至陀螺仪测量值中,即可得到集总干扰角速度的数学模型。
步骤三、基于步骤二中获取的集总干扰角速度的数学模型(1),采样多组陀螺仪测量数据,辨识集总干扰角速度通用公式待定参数。
步骤四、基于步骤三中确定的集总干扰角速度,从陀螺仪测量数据中实时分离出高准确度的偏流角角速度,结合由编码器提供的偏流角数据,设计PD型偏流角实时控制器。
本发明的有益效果:
一、相较于采用编码器微分方法获取的偏流角角速度信息,其存在信号波动大、准确度低等问题,本发明采用陀螺仪测量方法可获取高精度的角速度测量值,同时考虑到陀螺仪测量值中集总干扰信号模型的非线性、强耦合、高不确定性特性,通过参数辨识方法可有效提高集总干扰信号模型的逼近精度。
二、本发明方法中采用PD型反馈控制器对偏流机构进行实时控制,与传统的反馈控制器相比,可提高偏流角的控制精度,同时改善了系统响应动态特性,有效增强了偏流角实时补偿性能。
附图说明
图1为本发明所述的旋转平台下偏流机构角速度测量及偏流角实时调整方法中空间遥感载荷偏流机构安装结构图;
图2为本发明所述的旋转平台下偏流机构角速度测量及偏流角实时调整方法中空间坐标系定义图;
图3为本发明所述的旋转平台下偏流机构角速度测量及偏流角实时调整方法的原理框图。
图中:1、卫星平台,2、旋转转轴,3、旋转平台,4、载荷安装板,5、空间遥感载荷,6、偏流机构,7、陀螺仪。
P6为偏流机构坐标系到陀螺仪测量坐标系的转换矩阵,P5为遥感载荷坐标系到偏流机构坐标系的转换矩阵,P4为旋转平台坐标系到遥感载荷坐标系的转换矩阵,P3为卫星本体坐标系到旋转平台坐标系的转换矩阵,P2为轨道坐标系到卫星本体坐标系的转换矩阵,P1为惯性坐标系到轨道坐标系的转换矩阵。
具体实施方式
结合图1至图3说明本实施方式,旋转平台下偏流机构角速度测量及偏流角实时调整方法,该方法通过编码器获取偏流角信息;设计基于陀螺仪的偏流机构角速度测量方法,实现测量数据中集总干扰角速度的分离,获取高准确度偏流角角速度信息;设计基于PD(比例微分)控制器的偏流角控制算法实现偏流角的高精度实时调整。具体过程如下:
S1、根据地面标定的卫星各结构单元的安装信息,确定测量系统受到的各种外部干扰因素及各结构单元安装误差等测量干扰因素。如图1所示,空间遥感载荷5通过载荷安装板4安装于旋转平台3,所述旋转平台3通过旋转轴2与卫星平台1连接;陀螺仪7安装于偏流机构6上,与偏流机构6同步转动。编码器用于测量偏流机构6转动的角度(偏流角),陀螺仪7用于测量偏流机构6转动的角速度(偏流角角速度)。此时,陀螺仪7的测量值中包含偏流机构角速度与集总干扰角速度,需要将集总干扰角速度分离。
如图2所示,首先定义空间坐标系,描述各个结构之间的安装关系;基于所定义的空间坐标系,干扰角速度主要包括如下几个因素:1)卫星平台姿态角速度wstable(t),其是本体坐标系相对轨道坐标系的姿态变化,其值主要指卫星姿态的控制精度;2)卫星绕地心运动角速度wdynamic(t),其为卫星本体坐标系相对惯性坐标系的状态量;3)旋转平台相对于卫星平台的相对旋转角速度wrotate(t),空间遥感载荷5固定在旋转平台3上,旋转时,旋转平台坐标系相对卫星本体坐标系有旋转角速度;4)结构安装偏差,包括陀螺安装偏差、偏流机构安装偏差、相机安装偏差、旋转关节安装偏差。
S2、根据步骤S1确定的空间坐标系及各测量干扰因素,确定陀螺仪测量数据中各干扰因素的空间传递路径,并建立集总干扰因素模型。
S21、建立卫星本体坐标系到旋转平台坐标系。考虑到相对旋转角速度wrotate(t)=(ωx,0,0),则卫星本体坐标系到旋转平台坐标系的坐标转移矩阵P3为
其中,ω为x轴的旋转角速度,t为旋转时间,为初始旋转相位,可以测量确定。
S22、建立旋转平台坐标系到空间遥感载荷坐标系。空间遥感载荷5固定安装于旋转平台3上,其安装信息由地面标定。考虑到安装误差,根据安装信息,则建立旋转平台坐标系到空间遥感载荷坐标系的坐标转移矩阵为P4。
S23、建立空间遥感载荷坐标系到偏流机构坐标系。偏流机构6安装于空间遥感载荷5上,其安装信息由地面标定,且偏流机构6可由执行器驱动进行转动,即偏流角。考虑到偏流角和安装误差,根据安装信息,建立空间遥感载荷坐标系到偏流机构坐标系的坐标转移矩阵为P5。
S24、建立偏流机构坐标系到陀螺仪坐标系。陀螺仪7固定安装于偏流机构6上,其安装信息由地面标定。考虑到安装误差,根据安装信息,则偏流机构坐标系到陀螺仪坐标系的坐标转移矩阵为P6。
S25、建立轨道坐标系到卫星本体坐标系。正常工作时,卫星本体坐标系与轨道坐标系重合且固定不变。
各个干扰因素通过转移坐标矩阵投影到陀螺仪测量值中,则得到集总干扰角速度的数学模型:
ωd(t)=P6P5P4(ωrotate(t)+P3(ωstable(t)+ωdynamic(t)))(1)
其中,ωd(t)为集总干扰角速度,P6P5P4ωrotate为常量干扰信号分量,P6P5P4P3(ωstable+ωdynamic)为时变干扰信号分量。
S3、基于步骤S2中获取的集总干扰角速度的数学模型(1),采样多组陀螺仪测量数据,辨识集总干扰角速度通用公式待定参数。对于本实施方式中的空间遥感载荷偏流机构对象,考虑到不可测安装误差、姿态控制精度、转轴控制精度等不确定因素,在偏流机构未动作下,可以由式(1)得到通用表达式:
其中,a,ω,c为待辨识的量。
通过至少采样四组数据,即可辨识出待定参数a,ω,c,从而获取高精度的集总干扰角速度数学模型。
S4、基于步骤S3中确定的集总干扰角速度,从陀螺仪测量数据中实时分离出高准确度的偏流角角速度,结合由编码器提供的偏流角数据,设计PD型偏流角实时控制器。设偏流角期望值为θd(t),偏流角测量值θm(t),偏流角角速度期望值为偏流角角速度测量值/>得到跟踪误差:
其中,e(t)是偏流角跟踪误差,是偏流角角速度跟踪误差。
如图3所示,控制输入信号为由本实施方式测量获取的偏流角、偏流机构角速度与系统期望值的误差,PD控制器输出信号通过执行器驱动偏流机构,实现偏流角的实时调整。设计PD型反馈控制器为:
其中,Pi为比例增益,Pd为微分增益,u(t)为控制器输出。
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。
Claims (4)
1.旋转平台下偏流机构角速度测量及偏流角实时调整方法,其特征是:该方法由以下步骤实现:
步骤一、根据地面标定的卫星各结构单元的安装信息,确定空间坐标系及各测量干扰因素;
所述各测量干扰因素包括测量系统受到的外部干扰因素以及各结构单元安装误差的测量干扰因素;
所述外部干扰因素指的是干扰角度速的因素,包括卫星平台姿态角速度、卫星绕地心运动角速度以及旋转平台相对于卫星平台的相对旋转角速度;
步骤二、根据步骤一确定的空间坐标系及各测量干扰因素,确定陀螺仪测量数据中各干扰因素的空间传递路径,并建立集总干扰因素模型;
通过将各干扰因素经转移坐标矩阵投影至陀螺仪测量值中,获得集总干扰角速度的数学模型;用下式表示为:
ωd(t)=P6P5P4(ωrotate(t)+P3(ωstable(t)+ωdynamic(t)))
式中,ωd(t)为集总干扰角速度,wrotate(t)为旋转平台相对于卫星平台的相对旋转角速度,wstable(t)为卫星平台姿态角速度,wdynamic(t)为卫星绕地心运动角速度,P6P5P4ωrotate为常量干扰信号分量,P6P5P4P3(ωstable+ωdynamic)为时变干扰信号分量;
P6为偏流机构坐标系到陀螺仪测量坐标系的转换矩阵,P5为遥感载荷坐标系到偏流机构坐标系的转换矩阵,P4为旋转平台坐标系到遥感载荷坐标系的转换矩阵,P3为卫星本体坐标系到旋转平台坐标系的转换矩阵;
步骤三、根据步骤二获得的集总干扰角速度的数学模型,采样多组陀螺仪测量数据,辨识所述集总干扰角速度通用公式待定参数,确定集总干扰角速度;
步骤四、根据步骤三中确定的集总干扰角速度,将陀螺仪测量数据中实时分离出高准确度的偏流角角速度,结合由编码器提供的偏流角数据,设计PD型反馈控制器,实时控制偏流角。
2.根据权利要求1所述的旋转平台下偏流机构角速度测量及偏流角实时调整方法,其特征在于:步骤一中,各个结构的安装误差包括陀螺安装偏差、偏流机构安装偏差、相机安装偏差和旋转关节安装偏差。
3.根据权利要求1所述的旋转平台下偏流机构角速度测量及偏流角实时调整方法,其特征在于:步骤三中,所述集总干扰角速度通用公式为:
式中,a,ω,c为待辨识的量;通过至少采样四组陀螺仪测量数据,辨识出待定参数a,ω,/>c,获得集总干扰角速度。
4.根据权利要求1所述的旋转平台下偏流机构角速度测量及偏流角实时调整方法,其特征在于:步骤四中,设定偏流角期望值θd(t),偏流角测量值θm(t),偏流角角速度期望值偏流角角速度测量值/>获得偏流角跟踪误差以及偏流角角速度跟踪误差,设计PD型反馈控制器为:
式中,Pi为比例增益,e(t)为偏流角跟踪误差,Pd为微分增益,为偏流角角速度跟踪误差,u(t)为控制器输出。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211444801.8A CN115808164B (zh) | 2022-11-18 | 2022-11-18 | 旋转平台下偏流机构角速度测量及偏流角实时调整方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211444801.8A CN115808164B (zh) | 2022-11-18 | 2022-11-18 | 旋转平台下偏流机构角速度测量及偏流角实时调整方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115808164A CN115808164A (zh) | 2023-03-17 |
CN115808164B true CN115808164B (zh) | 2023-09-15 |
Family
ID=85483487
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211444801.8A Active CN115808164B (zh) | 2022-11-18 | 2022-11-18 | 旋转平台下偏流机构角速度测量及偏流角实时调整方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115808164B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2238521C1 (ru) * | 2003-05-14 | 2004-10-20 | Мамошин Владимир Романович | Способ определения векторов воздушной и земной скоростей, угла сноса летательного аппарата и комплексное лазерное устройство его реализации |
KR20040092865A (ko) * | 2003-04-29 | 2004-11-04 | 한국해양연구원 | 선박의 편류각을 고려한 자동항로 추적장치 및 그추적방법 |
CN105438499A (zh) * | 2015-11-17 | 2016-03-30 | 上海新跃仪表厂 | 绕空间轴的偏流角跟踪控制方法 |
CN105444781A (zh) * | 2015-11-30 | 2016-03-30 | 上海卫星工程研究所 | 星载自主引导成像地面验证方法 |
CN109018441A (zh) * | 2018-09-13 | 2018-12-18 | 上海航天控制技术研究所 | 一种卫星任意姿态机动过程偏流角跟踪控制方法 |
CN109672880A (zh) * | 2018-12-29 | 2019-04-23 | 中国科学院长春光学精密机械与物理研究所 | 一种宽幅空间相机的分组偏流角实时调整方法 |
-
2022
- 2022-11-18 CN CN202211444801.8A patent/CN115808164B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20040092865A (ko) * | 2003-04-29 | 2004-11-04 | 한국해양연구원 | 선박의 편류각을 고려한 자동항로 추적장치 및 그추적방법 |
RU2238521C1 (ru) * | 2003-05-14 | 2004-10-20 | Мамошин Владимир Романович | Способ определения векторов воздушной и земной скоростей, угла сноса летательного аппарата и комплексное лазерное устройство его реализации |
CN105438499A (zh) * | 2015-11-17 | 2016-03-30 | 上海新跃仪表厂 | 绕空间轴的偏流角跟踪控制方法 |
CN105444781A (zh) * | 2015-11-30 | 2016-03-30 | 上海卫星工程研究所 | 星载自主引导成像地面验证方法 |
CN109018441A (zh) * | 2018-09-13 | 2018-12-18 | 上海航天控制技术研究所 | 一种卫星任意姿态机动过程偏流角跟踪控制方法 |
CN109672880A (zh) * | 2018-12-29 | 2019-04-23 | 中国科学院长春光学精密机械与物理研究所 | 一种宽幅空间相机的分组偏流角实时调整方法 |
Non-Patent Citations (1)
Title |
---|
高分辨率空间相机实时偏流调整的误差分析及地面验证;王栋等;《仪器仪表学报》;第35卷(第9期);1955-1962 * |
Also Published As
Publication number | Publication date |
---|---|
CN115808164A (zh) | 2023-03-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2580832B2 (ja) | 移動体搭載アンテナ制御装置 | |
US7956806B2 (en) | Tracking arrangement for a communications system on a mobile platform | |
US8243142B2 (en) | Mobile object image tracking apparatus and method | |
US11448766B2 (en) | Actuated spinning sensor | |
EP0079288B2 (en) | Gyroscopic apparatus | |
CN116817896A (zh) | 一种基于扩展卡尔曼滤波的姿态解算方法 | |
CN115808164B (zh) | 旋转平台下偏流机构角速度测量及偏流角实时调整方法 | |
JP2000213934A (ja) | 傾斜センサ―及びその精度を調整する方法 | |
CN114003045A (zh) | 一种光电跟踪仪的目标跟踪方法、终端、可读存储介质 | |
CN114018254A (zh) | 一种激光雷达与旋转惯导一体化构架与信息融合的slam方法 | |
WO2023040689A1 (zh) | 基于图像传感器位移式的三轴光学防抖系统、方法和装置 | |
CN111964677A (zh) | 稳定遥感设备姿态及获取其外方位元素的装置及方法 | |
CN113776560B (zh) | 一种基于高精度三轴转台的陀螺标度因数测试方法 | |
KR20060030188A (ko) | 동적 장치 제어 방법 및 그 장치 | |
JPH11248456A (ja) | 3軸姿勢検出装置 | |
JP2965039B1 (ja) | 人工衛星の高帯域姿勢制御方法及び高帯域姿勢制御装置 | |
CN114646993A (zh) | 一种基于gnss、视觉以及imu进行精确定位的数据融合算法 | |
CN115717884B (zh) | 偏流机构的偏流角速度测量解算验证系统 | |
JP3433994B2 (ja) | カメラスタビライザ | |
CN116659481B (zh) | 基于rtk与里程计室外机器人航向角标定方法、系统及介质 | |
CN212539198U (zh) | 稳定遥感设备姿态及获取其外方位元素的装置 | |
CN114264317A (zh) | 伺服稳瞄产品中陀螺仪安装误差数字补偿方法 | |
CN114440870B (zh) | 一种基于自适应互补滤波的九轴磁罗盘姿态获取方法 | |
CN115077520B (zh) | 一种基于谐振惯导系统的姿态补偿方法 | |
CN116501096A (zh) | 一种光电探测设备组合陀螺反射镜稳定装置及方法 |
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 |