CN114987802A - 基于运动部件信息的角动量前馈补偿控制方法 - Google Patents
基于运动部件信息的角动量前馈补偿控制方法 Download PDFInfo
- Publication number
- CN114987802A CN114987802A CN202210694780.9A CN202210694780A CN114987802A CN 114987802 A CN114987802 A CN 114987802A CN 202210694780 A CN202210694780 A CN 202210694780A CN 114987802 A CN114987802 A CN 114987802A
- Authority
- CN
- China
- Prior art keywords
- compensation
- moving part
- satellite
- time
- control
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 79
- 238000004364 calculation method Methods 0.000 claims abstract description 20
- 238000006243 chemical reaction Methods 0.000 claims abstract description 12
- 230000008569 process Effects 0.000 claims description 28
- 230000000694 effects Effects 0.000 claims description 13
- 238000013461 design Methods 0.000 claims description 12
- 238000005259 measurement Methods 0.000 claims description 8
- 230000008859 change Effects 0.000 claims description 5
- FFBHFFJDDLITSX-UHFFFAOYSA-N benzyl N-[2-hydroxy-4-(3-oxomorpholin-4-yl)phenyl]carbamate Chemical compound OC1=C(NC(=O)OCC2=CC=CC=C2)C=CC(=C1)N1CCOCC1=O FFBHFFJDDLITSX-UHFFFAOYSA-N 0.000 claims description 3
- 230000001629 suppression Effects 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 12
- 238000012360 testing method Methods 0.000 description 9
- 230000001133 acceleration Effects 0.000 description 8
- 230000008878 coupling Effects 0.000 description 5
- 238000010168 coupling process Methods 0.000 description 5
- 238000005859 coupling reaction Methods 0.000 description 5
- 238000004088 simulation Methods 0.000 description 5
- 238000012545 processing Methods 0.000 description 3
- 238000007667 floating Methods 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 238000012795 verification Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000001934 delay Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 230000036544 posture Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000010200 validation analysis Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
- B64G1/245—Attitude control algorithms for spacecraft attitude control
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供了一种基于运动部件信息的角动量前馈补偿控制方法,包括:针对按特定规律运动的运动部件的干扰影响,采用运动部件的广播的运动角度和角速度信息,替代运动部件的换向时刻信息,作为补偿力矩的计算依据;利用前馈以及卫星姿态控制PID计算获得叠加的力矩作为星载反作用轮的控制输入,利用卫星的姿态控制反作用轮进行摆镜的前馈补偿和姿态控制,以替代单独的平衡补偿轮或补偿轮轮组;设计的角度参数、角速度参数和补偿力矩参数通过地面指令修改,以增加控制系统的灵活性,且当评估星载软件各项时延后,修改角度参数、角速度参数和补偿力矩参数以提高卫星平台的控制稳定度。
Description
技术领域
本发明涉及航天器姿态控制技术领域,特别涉及一种基于运动部件信息的角动量前馈补偿控制方法。
背景技术
遥感卫星上往往带有运动部件,如扫描镜、摆镜、转台等,星上运动部件的运动会影响卫星的姿态控制的精度和稳定度,进而影响运动部件和载荷的指向精度和指向稳定度。
针对按特定规律运动的运动部件的干扰,典型如扫描镜和摆镜按照某一设计的运动曲线进行周期性往返运动,可以采用的方法有运动部件运动补偿、前馈力矩补偿等。
现有的运动部件补偿需要额外增加平衡轮或专用的力矩补偿轮组,增加了卫星研制的成本,且由于运动部件控制频率高(50~500Hz),而卫星的姿态控制输出频率一般为1~10Hz,因此运动部件的补偿轮补偿控制需要额外设计和硬件投入,也增加卫星研制的时间和资金投入。
现有的前馈力矩补偿控制主要利用运动部件换向时刻的信息进行计算前馈补偿控制力矩,该方式需要严格输出运动部件的换向时刻,对硬件底层的要求较高,再利用换向时刻进行角动量补偿计算,计算相应的补偿力矩进行输出,当换向时刻信息不准确时对补偿的效果影响较大。
发明内容
本发明的目的在于提供一种基于运动部件信息的角动量前馈补偿控制方法,以解决现有的消除星上运动部件对卫星姿态影响的控制方法难度大的问题。
为解决上述技术问题,本发明提供一种基于运动部件信息的角动量前馈补偿控制方法,包括:
针对按特定规律运动的运动部件的干扰影响,采用运动部件的广播的运动角度和角速度信息,替代运动部件的换向时刻信息,作为补偿力矩的计算依据;
利用前馈以及卫星姿态控制PID计算获得叠加的力矩作为星载反作用轮的控制输入,利用卫星的姿态控制反作用轮进行摆镜的前馈补偿和姿态控制,以替代单独的平衡补偿轮或补偿轮轮组;
设计的角度参数、角速度参数和补偿力矩参数通过地面指令修改,以增加控制系统的灵活性,且当评估星载软件各项时延后,修改角度参数、角速度参数和补偿力矩参数以提高卫星平台的控制稳定度。
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,还包括:
前馈补偿力矩模块根据星上运动部件的运动规律和干扰特性,设置前馈补偿力矩,计算提前补偿时间;
阈值补偿角动量模块实时读取星上运动部件的角度和角速度信息,在换向过程结束时刻往前提前dt+2T1时,对卫星施加所述前馈补偿力矩并持续至第一阈值时间,以使卫星获得阈值补偿角动量;
dt为提前补偿的时间,T1为第二阈值时间,所述阈值补偿角动量与所述星上运动部件换向过程中产生的干扰角动量大小相等。
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,星上运动部件的运动规律包括运动部件运动周期内的角速度变化过程,在每个T1时间区间内运动部件进行半正弦加速或减速到某一角速度ω0或-ω0,运动部件的换向时间为2×T1;
在前半个周期的T2时间区间内,运动部件按照角速度ω0进行运动,在后半个周期的T2时间区间内,运动部件按照角速度-ω0进行运动。
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,运动部件工作前馈补偿设计包括:引入运动部件角度信息的干扰抑制控制,通过实时读取运动部件的角度和角速度信息,选取运动部件角度和角速度,在运动部件即将到达运动边界,也即换向过程结束时刻,提前实施固定大小的前馈补偿力矩,并持续一定时间,使得产生的补偿角动量与运动部件换向产生的干扰角动量大小相当,两者在大部分时间内相互抵消,从而减小运动部件换向对卫星稳定性的影响。
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,当提前补偿的时间dt和补偿力矩大小Mcompensate确定后,根据运动部件的运动角度曲线选取α1和α2,根据运动角速度曲线选取ω1和ω2;
考虑到运动部件的控制效果存在控制误差,ω1不等于-ω0,ω1>-ω0,ω2不等于ω0,ω2<ω0;
在ω1和ω2给定的情况下,分别在其相应的时刻向前取dt+2T1的时刻对应的运动部件旋转角度α1和α2。
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,当运动部件的测量采集及处理到姿控进程计算补偿力矩的时延确定后,在换向结束时刻对应的角速度作为ω1和ω2,再重新确定α1和α2。
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,
卫星姿态控制系统控制周期不高于T1的一半,卫星姿态控制器的设计根据控制系统的带宽与帆板振动频率、运动部件干扰频率的关系,优化控制器带宽设计以及增加结构滤波器,以避免激发卫星与帆板、卫星与运动部件的共振影响。
根据星上运动部件的运动规律和干扰特性,设置前馈补偿力矩,计算提前补偿时间;根据星上运动部件的运动规律,获取所述星上运动部件的换向过程结束时刻;根据所述星上运动部件的换向过程结束时刻、提前补偿时间和理论运动曲线选取前馈补偿力矩角速度结束阈值和角度开始阈值。
实时读取所述星上运动部件的角度和角速度信息,在到达所述减速时刻时,对卫星施加所述前馈补偿力矩并持续至第一阈值时间,以使卫星获得阈值补偿角动量;
所述阈值补偿角动量与所述星上运动部件换向过程中产生的干扰角动量大小相等。
实时读取所述星上运动部件的角度和角速度信息,当满足所述角度和角速度阈值时,对卫星施加相应的前馈补偿力矩,以使卫星获得补偿角动量。理想情况下,所述补偿角动量与所述星上运动部件换向过程中产生的干扰角动量大小相等。
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,所述星上运动部件的运动规律包括:
所述星上运动部件在一个运动周期内依次经过角速度加速阶段、角速度恒定阶段和角速度减速阶段、角速度反向加速阶段、角速度反向恒定阶段和角速度反向减速阶段;
所述角速度加速阶段、所述角速度减速阶段、所述角速度反向加速阶段和所述角速度反向减速阶段均持续第二阈值时间;
所述角速度恒定阶段和所述角速度反向恒定阶段持续第三阈值时间;
所述星上运动部件换向过程定义为角速度减速阶段与相邻角速度反向加速阶段之和或者角速度加速阶段与相邻角速度反向减速阶段之和,该过程持续的时间定义为换向时间。
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,所述星上运动部件的运动规律还包括:
设置卫星惯量为JSat,星上运动部件转轴惯量为JMove,第二阈值时间为T1,则星上运动部件换向过程中,引起卫星平台的最大角速度改变量为:
星上运动部件换向过程中产生的干扰角动量变化为:
△H=JMove·2ω0;
星上运动部件换向过程中平均干扰力矩为:
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,获取所述星上运动部件的提前补偿时间包括:
使所述星上运动部件换向过程结束时刻与前馈补偿力矩的结束时刻对齐,设置前馈补偿力矩假设为Mcompensate,计算星上运动部件前馈补偿力矩提前补偿的时间为:
这里dt具体为相对换向过程提前补偿的时间,满足的约束条件为:
且dt<T2,其中T2为第三时间阈值;
相对换向过程结束时刻提前补偿的时间为:
△T=dt+2T1。
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,计算前馈补偿力矩包括:
当提前补偿的时间dt已知,则前馈补偿力矩的大小为:
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,还包括:
根据提前补偿的时间dt和前馈补偿力矩的大小Mcompensate,以及所述星上运动部件的运动角速度曲线选取第一补偿结束角速度阈值与第二补偿结束角速度阈值;
根据提前补偿的时间dt和前馈补偿力矩的大小Mcompensate,以及所述星上运动部件的运动角度曲线计算第一补偿开始角度阈值和第二补偿开始角度阈值。
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,还包括:根据所述星上运动部件自身的控制误差,第一补偿结束角速度阈值ω1应接近并小于第一恒定角速度-ω0,第二补偿结束角速度阈值ω2应接近并小于第二恒定角速度ω0;
分别在第一补偿结束角速度阈值ω1和第二补偿结束角速度阈值ω2所对应的时刻提前dt+2T1,获取该时刻对应的星上运动部件的理论运动曲线对应的旋转角度,作为第一补偿开始角度阈值α1和第二补偿开始角度阈值α2。
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,在α1和α2以及ω1和ω2确定的情况下,当星上运动部件极性方向与卫星某一轴方向一致时,该轴对应的前馈补偿力矩计算方式为:
可选的,在所述的基于运动部件信息的角动量前馈补偿控制方法中,还包括:
星上运动部件以固定频率向卫星姿态控制系统广播其自身的运动角度及运动角速度,
所述卫星姿态控制系统按照常规姿态控制方法计算PID控制力矩,
所述卫星姿态控制系统利用测量采集到星上运动部件的最新时刻角度和角速度信息计算前馈补偿力矩,两者叠加作为星载反作用轮组的力矩指令输入。
本发明还提供一种卫星姿态控制系统,包括:
前馈补偿力矩模块,被配置为根据星上运动部件的运动规律和干扰特性,设置前馈补偿力矩,计算提前补偿时间;根据星上运动部件的运动规律,获取所述星上运动部件的换向过程结束时刻;根据所述星上运动部件的换向过程的结束时刻、提前补偿时间和理论运动曲线选取前馈补偿力矩角速度结束阈值和角度开始阈值。
补偿角动量模块,被配置为实时读取所述星上运动部件的角度和角速度信息,当满足所述角度和角速度阈值时,对卫星施加相应的前馈补偿力矩,以使卫星获得补偿角动量,在不考虑运动部件存在采样时延和卫星姿态控制输出频率有限的理想情况下,所述补偿角动量与所述星上运动部件换向过程中产生的干扰角动量大小相等。
在本发明提供的基于运动部件信息的角动量前馈补偿控制方法中,针对按特定规律运动的星上运动部件的干扰,提出一种基于运动部件信息的角动量前馈补偿控制方法,该方法不需要单独的平衡补偿轮,不需要运动部件的换向时刻信息,仅需要运动部件运动角度和角速度信息和卫星常规姿控反作用轮组进行运动部件角动量补偿,最终提高卫星姿态控制的稳定度,且在补偿过程中无需力矩输出时刻与理论输出时刻严格对齐,工程上实现较为简单易行。
附图说明
图1是本发明一实施例的基于运动部件信息的角动量前馈补偿控制方法星上运动部件运动曲线示意图;
图2是本发明一实施例的基于运动部件信息的角动量前馈补偿控制方法引入星上运动部件角度信息的干扰补偿控制示意图;
图3是本发明一实施例的卫星姿态控制系统引入运动部件前馈补偿控制示意图;
图4是本发明一实施例的星上运动部件理论运动曲线示意图;
图5是本发明一实施例的星上运动部件实际运动曲线示意图;
图6是本发明一实施例的卫星三轴姿态角控制曲线示意图;
图7是本发明一实施例的卫星三轴姿态角速度控制曲线示意图;
图8是本发明一实施例的地面单轴气浮台试验验证示意图;
图9是本发明一实施例的耦合试验引入补偿和取消补偿稳定度控制效果示意图;
图10是本发明一实施例的耦合试验引入补偿和取消补偿角度控制效果示意图。
具体实施方式
以下结合附图和具体实施例对本发明提出的基于运动部件信息的角动量前馈补偿控制方法作进一步详细说明。根据下面说明和权利要求书,本发明的优点和特征将更清楚。需说明的是,附图均采用非常简化的形式且均使用非精准的比例,仅用以方便、明晰地辅助说明本发明实施例的目的。
另外,除非另行说明,本发明的不同实施例中的特征可以相互组合。例如,可以用第二实施例中的某特征替换第一实施例中相对应或功能相同或相似的特征,所得到的实施例同样落入本申请的公开范围或记载范围。
本发明的核心思想在于提供一种基于运动部件信息的角动量前馈补偿控制方法,以解决现有的消除星上运动部件对卫星姿态影响的控制方法难度大的问题。
为实现上述思想,本发明提供了一种基于运动部件信息的角动量前馈补偿控制方法,包括:前馈补偿力矩模块,被配置为根据星上运动部件的运动规律和干扰特性,设置前馈补偿力矩,计算提前补偿时间;阈值补偿角动量模块,被配置为实时读取所述星上运动部件的角度和角速度信息,在所述换向过程结束时刻往前提前dt+2T1时,对卫星施加所述前馈补偿力矩并持续至第一阈值时间,以使卫星获得阈值补偿角动量;其中:所述阈值补偿角动量与所述星上运动部件换向过程中产生的干扰角动量大小基本相等。
星上运动部件典型的运动规律如图1所示。图1为1个运动部件运动周期内的角速度变化过程,在每个T1时间区间内运动部件进行半正弦加速或减速到某一角速度ω0或-ω0(有的运动部件按照匀加速或匀减速进行运动),也即运动部件的换向时间为2×T1;在前半个周期的T2时间区间内,运动部件按照角速度ω0进行运动,在后半个周期的T2时间区间内,运动部件按照角速度-ω0进行运动。
卫星惯量考虑为JSat,运动部件转轴惯量为JMove,则运动部件引起卫星平台的最大角速度改变量(2×T1内)为:
2×T1内引起的角动量变化为:△H=JMove·2ω0
运动部件工作前馈补偿设计包括:引入运动部件角度信息的干扰抑制控制方案示意图如图2所示,通过实时读取运动部件的角度和角速度信息,运动部件角度和角速度的选取如图2下半部分所示,在运动部件即将到达运动边界,也即换向过程结束时刻,提前实施固定大小的前馈补偿力矩,并持续一定时间,使得产生的补偿角动量与运动部件换向产生的干扰角动量大小相当,两者在大部分时间内相互抵消,从而可以减小运动部件换向对卫星稳定性的影响。
如图2所示,可将运动部件作用力矩的结束时刻与补偿力矩的结束时刻基本对齐,这里补偿力矩假设设置为Mcompensate,则可以计算出运动部件补偿力矩应提前进行补偿的时间为:
相对换向过程结束时刻提前补偿的时间为:
△T=dt+2T1
反之,若已知提前补偿的时间为dt,则补偿力矩的大小计算为:
考虑到运动部件补偿时间的选取可以根据以下原则进行选取:
这里的比值不宜过小或过大,由于存在测量部件的测量采样时间存在时间延迟,卫星姿态敏感器数据测量及处理时间存在时间延迟、飞轮轮组响应、以及PID控制计算输出等因素,在比值过小或过大情况会降低力矩前馈补偿效果。
dt+2T1还应满足约束条件:
dt+2T1<T2+2T1,也即dt<T2。
如图2所示,当提前补偿的时间dt和补偿力矩大小Mcompensate确定后,根据运动部件的运动角度曲线选取α1和α2,根据运动角速度曲线选取ω1和ω2。
考虑到运动部件的控制效果存在一定的控制误差,ω1的选取应不等于-ω0,但应与之接近,也即需ω1>-ω0,同理ω2的选取应不等于ω0,但应与之接近,也即需ω2<ω0;
在ω1和ω2给定的情况下,分别在其相应的时刻向前取dt+2T1的时刻对应的运动部件旋转角度α1和α2。
在α1和α2以及ω1和ω2确定的情况下,根据以下原则计算前馈补偿力矩(考虑运动部件极性方向与卫星某一轴方向一致时):
当运动部件的测量采集及处理到姿控进程计算补偿力矩的时延(Tdelay,一般为一个范围)确定后,可在换向结束时刻-Tdelay的时刻时对应的角速度作为ω1和ω2,再重新确定α1和α2。
卫星姿态控制前馈补偿包括:运动部件以某一固定频率(50~500Hz)向卫星姿态控制系统广播其自身的运动角度、运动角速度等信息,卫星姿态控制系统一方面按照常规姿态控制方法计算PID控制力矩,另一方面根据如前所述的利用测量采集到运动部件的最新时刻角度和角速度信息计算前馈补偿力矩,两者叠加作为星载反作用轮组的力矩指令输入。前馈补偿控制的结构框图如图3所示。
卫星姿态控制系统控制周期不宜高于T1的一半,高于此值时,补偿力矩存在较大的时延,会影响力矩补偿的控制效果,此外卫星姿态控制器的设计还应考虑控制系统的带宽与帆板振动频率、运动部件干扰频率的关系,优化控制器带宽设计以及增加结构滤波器,以避免激发卫星与帆板、卫星与运动部件的共振影响。
本发明的实施例还提供了仿真验证,具体包括:
某在研卫星星载运动部件(摆镜)的理论运动曲线和实际运动曲线分别如图4和图5所示。运动部件安装在卫星X轴。其主要影响如下:
运动部件的最大角加速度:29.7°/s2;
理论最大干扰力矩:31mNm;
对卫星平台的干扰力矩分析:
卫星惯量(x轴)考虑为430kgm2,运动部件惯量为0.065kgm2,则运动部件引起卫星平台的最大角速度改变量(0.58s内)为:dw=0.065*5.48/430*2=0.0017°/s。
0.58s内平均干扰力矩为:0.065*5.48*pi/180/0.29=0.0214Nm;
0.58s内平均冲量为:0.065*5.48*pi/180*2=0.0124Nms;
仿真参数设置:
卫星惯量:[430 346 559 -2 -3 37]kgm2;
初始对地姿态角:[0 0 0]°;
初始对地姿态角速度:[0 0 0]°/s;
卫星姿控频率:8Hz(控制周期125ms);
运动部件控制频率:100Hz;
运动部件角度角速度信息广播频率:100Hz;
运动部件测量采集时延100ms;
星敏陀螺测量采集时延100ms;
补偿力矩大小:0.015Nm;
运动部件影响采用实际运动干扰作为输入。
卫星对地姿态指向精度的控制仿真的结果如图6所示,卫星对地姿态稳定度的控制仿真的结果如图7所示。
仿真结果表明:在运动部件对卫星影响情况下,采用本文提出的前馈补偿方法,卫星姿态控制的稳定度优于0.00065°/s,取消前馈补偿后,卫星姿态控制的稳定度恶化到0.0017°/s。引入前馈控制控制效果较引入前改善了约62%。
气浮台耦合试验验证包括:某在研卫星基于本发明提出的前馈补偿控制方法进行气浮台与运动部件(摆镜)耦合控制试验,试验场地的布局如图8所示,耦合试验结果如图9和图10所示。
测试结果表明,气浮台引入补偿时的稳定度控制精度优于0.0012°/s,气浮台的惯量测试平均值为280kgm2,等效于在轨卫星的稳定度控制精度为0.00105*280/430=0.00068°/s,取消补偿后的稳定度控制精度优于0.0025°/s,等效于在轨卫星的稳定度控制精度为0.0026*280/430=0.0017°/s。引入前馈控制控制效果较引入前改善了约60%。
针对按特定规律运动的运动部件的干扰影响,本发明采用以下的方法克服上述现有技术的不足、并达成所述技术效果的:
采用运动部件的广播的运动角度和角速度信息作为补偿力矩的计算依据,而不是利用运动部件的换向时刻信息作为补偿力矩的计算依据,对硬件底层和相对时间计算的要求较低,无需力矩输出与理论输出时刻严格对齐,允许存在一定的时延。
利用前馈以及卫星姿态控制PID计算获得叠加的力矩作为星载反作用轮的控制输入,仅利用卫星的姿态控制反作用轮进行摆镜的前馈补偿和姿态控制,无需单独的平衡补偿轮或补偿轮轮组。
针对按特定规律运动的运动部件的干扰影响,本发明具有以下优点:
采用运动部件的广播的运动角度和角速度信息作为补偿力矩的计算依据,而不是利用运动部件的换向时刻信息作为补偿力矩的计算依据,对硬件底层和相对时间计算的要求较低。
利用前馈以及卫星姿态控制PID计算获得叠加的力矩作为星载反作用轮的控制输入,无需单独的平衡补偿轮或补偿轮轮组。
设计的角度参数、角速度参数和补偿力矩参数可以通过地面指令修改,增加控制系统的灵活性,且当评估星载软件各项时延后,可以适当修改角度参数、角速度参数和补偿力矩参数提高卫星平台的控制稳定度。
本发明提出的方案,从另外一种方式(利用角度、角速度信息)进行补偿力矩计算,扩展了现有星载运动部件补偿的方法,已经成功应用于某科学对地观测卫星的姿态控制设计中,并作为其关键技术之一。
综上,上述实施例对基于运动部件信息的角动量前馈补偿控制方法的不同构型进行了详细说明,当然,本发明包括但不局限于上述实施中所列举的构型,任何在上述实施例提供的构型基础上进行变换的内容,均属于本发明所保护的范围。本领域技术人员可以根据上述实施例的内容举一反三。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的系统而言,由于与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
上述描述仅是对本发明较佳实施例的描述,并非对本发明范围的任何限定,本发明领域的普通技术人员根据上述揭示内容做的任何变更、修饰,均属于权利要求书的保护范围。
Claims (7)
1.一种基于运动部件信息的角动量前馈补偿控制方法,其特征在于,包括:
针对按特定规律运动的运动部件的干扰影响,采用运动部件的广播的运动角度和角速度信息,替代运动部件的换向时刻信息,作为补偿力矩的计算依据;
利用前馈以及卫星姿态控制PID计算获得叠加的力矩作为星载反作用轮的控制输入,利用卫星的姿态控制反作用轮进行摆镜的前馈补偿和姿态控制,以替代单独的平衡补偿轮或补偿轮轮组;
设计的角度参数、角速度参数和补偿力矩参数通过地面指令修改,以增加控制系统的灵活性,且当评估星载软件各项时延后,修改角度参数、角速度参数和补偿力矩参数以提高卫星平台的控制稳定度。
2.如权利要求1所述的基于运动部件信息的角动量前馈补偿控制方法,其特征在于,还包括:
前馈补偿力矩模块根据星上运动部件的运动规律和干扰特性,设置前馈补偿力矩,计算提前补偿时间;
阈值补偿角动量模块实时读取星上运动部件的角度和角速度信息,在换向过程结束时刻往前提前dt+2T1时,对卫星施加所述前馈补偿力矩并持续至第一阈值时间,以使卫星获得阈值补偿角动量;
dt为提前补偿的时间,T1为第二阈值时间,所述阈值补偿角动量与所述星上运动部件换向过程中产生的干扰角动量大小相等。
3.如权利要求2所述的基于运动部件信息的角动量前馈补偿控制方法,其特征在于,
星上运动部件的运动规律包括运动部件运动周期内的角速度变化过程,在每个T1时间区间内运动部件进行半正弦加速或减速到某一角速度ω0或-ω0,运动部件的换向时间为2×T1;
在前半个周期的T2时间区间内,运动部件按照角速度ω0进行运动,在后半个周期的T2时间区间内,运动部件按照角速度-ω0进行运动。
4.如权利要求3所述的基于运动部件信息的角动量前馈补偿控制方法,其特征在于,
运动部件工作前馈补偿设计包括:引入运动部件角度信息的干扰抑制控制,通过实时读取运动部件的角度和角速度信息,选取运动部件角度和角速度,在运动部件即将到达运动边界,也即换向过程结束时刻,提前实施固定大小的前馈补偿力矩,并持续一定时间,使得产生的补偿角动量与运动部件换向产生的干扰角动量大小相当,两者在大部分时间内相互抵消,从而减小运动部件换向对卫星稳定性的影响。
5.如权利要求4所述的基于运动部件信息的角动量前馈补偿控制方法,其特征在于,
当提前补偿的时间dt和补偿力矩大小Mcompensate确定后,根据运动部件的运动角度曲线选取α1和α2,根据运动角速度曲线选取ω1和ω2;
考虑到运动部件的控制效果存在控制误差,ω1不等于-ω0,ω1>-ω0,ω2不等于ω0,ω2<ω0;
在ω1和ω2给定的情况下,分别在其相应的时刻向前取dt+2T1的时刻对应的运动部件旋转角度α1和α2。
6.如权利要求5所述的基于运动部件信息的角动量前馈补偿控制方法,其特征在于,
当运动部件的测量采集及处理到姿控进程计算补偿力矩的时延确定后,在换向结束时刻对应的角速度作为ω1和ω2,再重新确定α1和α2。
7.如权利要求6所述的基于运动部件信息的角动量前馈补偿控制方法,其特征在于,
卫星姿态控制系统控制周期不高于T1的一半,卫星姿态控制器的设计根据控制系统的带宽与帆板振动频率、运动部件干扰频率的关系,优化控制器带宽设计以及增加结构滤波器,以避免激发卫星与帆板、卫星与运动部件的共振影响。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210694780.9A CN114987802B (zh) | 2020-12-08 | 2020-12-08 | 基于运动部件信息的角动量前馈补偿控制方法 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210694780.9A CN114987802B (zh) | 2020-12-08 | 2020-12-08 | 基于运动部件信息的角动量前馈补偿控制方法 |
CN202011422303.4A CN112537463B (zh) | 2020-12-08 | 2020-12-08 | 卫星姿态控制方法及系统 |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011422303.4A Division CN112537463B (zh) | 2020-12-08 | 2020-12-08 | 卫星姿态控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114987802A true CN114987802A (zh) | 2022-09-02 |
CN114987802B CN114987802B (zh) | 2024-09-10 |
Family
ID=75018657
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210694780.9A Active CN114987802B (zh) | 2020-12-08 | 2020-12-08 | 基于运动部件信息的角动量前馈补偿控制方法 |
CN202011422303.4A Active CN112537463B (zh) | 2020-12-08 | 2020-12-08 | 卫星姿态控制方法及系统 |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011422303.4A Active CN112537463B (zh) | 2020-12-08 | 2020-12-08 | 卫星姿态控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (2) | CN114987802B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118067220A (zh) * | 2024-02-20 | 2024-05-24 | 中国科学院青藏高原研究所 | 一种水深透视探测稳定方法、系统及平台 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115764303B (zh) * | 2022-12-05 | 2024-02-20 | 迪泰(浙江)通信技术有限公司 | 双惯导的卫星移动终端天线两轴稳定三轴动态跟踪方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0717496A (ja) * | 1993-07-07 | 1995-01-20 | Fujitsu Ltd | 人工衛星の姿勢制御方式 |
EP1103464A2 (en) * | 1999-11-26 | 2001-05-30 | Space Systems / Loral, Inc. | Spacecraft and appendage stepping methods that improve spacecraft attitude pointing and cancel solar array slew disturbances |
JP2009298345A (ja) * | 2008-06-16 | 2009-12-24 | Mitsubishi Electric Corp | 姿勢制御装置および位置制御装置 |
CN103274059A (zh) * | 2013-05-30 | 2013-09-04 | 北京控制工程研究所 | 一种带运动有效载荷卫星的前馈力矩补偿方法 |
WO2017000396A1 (zh) * | 2015-06-30 | 2017-01-05 | 中国空间技术研究院 | 基于多体分析试验的桁架天线反射器展开动力学建模方法 |
CN106586034A (zh) * | 2016-12-20 | 2017-04-26 | 上海微小卫星工程中心 | 卫星旋转部件动静不平衡干扰力矩自补偿方法 |
CN110450982A (zh) * | 2019-08-14 | 2019-11-15 | 上海卫星工程研究所 | 空间扫描机构的角动量前馈补偿方法及补偿系统 |
CN110481816A (zh) * | 2019-08-14 | 2019-11-22 | 上海卫星工程研究所 | 星上前馈力矩补偿的多系统同步方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2669887B1 (fr) * | 1990-11-30 | 1995-06-02 | Aerospatiale | Procede de controle d'attitude en tangage d'un satellite grace a la pression de radiation solaire et satellite adapte a sa mise en óoeuvre. |
CN104097791B (zh) * | 2014-06-24 | 2016-06-15 | 上海微小卫星工程中心 | 一种基于磁敏感器和星敏感器的全姿态捕获方法及其装置 |
JP6373496B2 (ja) * | 2015-06-22 | 2018-08-15 | 三菱電機株式会社 | 宇宙機の姿勢制御装置およびcmgのジンバル角演算方法 |
CN108614571B (zh) * | 2018-04-28 | 2021-03-02 | 上海微小卫星工程中心 | 一种基于光学敏感器的卫星姿态控制试验方法 |
CN109533396B (zh) * | 2019-01-16 | 2020-07-17 | 上海微小卫星工程中心 | 一种基于磁测磁控的卫星自旋定向方法 |
-
2020
- 2020-12-08 CN CN202210694780.9A patent/CN114987802B/zh active Active
- 2020-12-08 CN CN202011422303.4A patent/CN112537463B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0717496A (ja) * | 1993-07-07 | 1995-01-20 | Fujitsu Ltd | 人工衛星の姿勢制御方式 |
EP1103464A2 (en) * | 1999-11-26 | 2001-05-30 | Space Systems / Loral, Inc. | Spacecraft and appendage stepping methods that improve spacecraft attitude pointing and cancel solar array slew disturbances |
JP2009298345A (ja) * | 2008-06-16 | 2009-12-24 | Mitsubishi Electric Corp | 姿勢制御装置および位置制御装置 |
CN103274059A (zh) * | 2013-05-30 | 2013-09-04 | 北京控制工程研究所 | 一种带运动有效载荷卫星的前馈力矩补偿方法 |
WO2017000396A1 (zh) * | 2015-06-30 | 2017-01-05 | 中国空间技术研究院 | 基于多体分析试验的桁架天线反射器展开动力学建模方法 |
CN106586034A (zh) * | 2016-12-20 | 2017-04-26 | 上海微小卫星工程中心 | 卫星旋转部件动静不平衡干扰力矩自补偿方法 |
CN110450982A (zh) * | 2019-08-14 | 2019-11-15 | 上海卫星工程研究所 | 空间扫描机构的角动量前馈补偿方法及补偿系统 |
CN110481816A (zh) * | 2019-08-14 | 2019-11-22 | 上海卫星工程研究所 | 星上前馈力矩补偿的多系统同步方法 |
Non-Patent Citations (1)
Title |
---|
刘付成;朱东方;宋婷;张志伟;黄静;孙俊;: "带大惯量运动部件卫星姿态高精度复合控制研究", 上海航天, no. 06, 25 December 2016 (2016-12-25), pages 53 - 60 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118067220A (zh) * | 2024-02-20 | 2024-05-24 | 中国科学院青藏高原研究所 | 一种水深透视探测稳定方法、系统及平台 |
Also Published As
Publication number | Publication date |
---|---|
CN112537463A (zh) | 2021-03-23 |
CN114987802B (zh) | 2024-09-10 |
CN112537463B (zh) | 2022-06-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109573105B (zh) | 末子级留轨应用子系统姿态控制方法 | |
CN104932510B (zh) | 一种针对飞轮低速摩擦的挠性航天器姿态控制系统与方法 | |
CN112537463B (zh) | 卫星姿态控制方法及系统 | |
CN104570742B (zh) | 基于前馈pid控制的异面交叉快变轨道快速高精度相对指向控制方法 | |
CN109625334B (zh) | 卫星动量轮在轨姿态无偏差起旋和消旋的控制方法 | |
JP4679439B2 (ja) | 人工衛星の姿勢制御装置 | |
Zhang et al. | Active damping control of flexible appendages for spacecraft | |
US20080272240A1 (en) | Active vibration damping (AVD) system for precision pointing spacecraft | |
CN106114910B (zh) | 一种航天器飞行轨道滚动时域控制方法 | |
CN106354147B (zh) | 一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统与方法 | |
CN1010710B (zh) | 空间飞行器加速度计自动校准 | |
CN113859589B (zh) | 一种基于模型预测控制与滑模控制的航天器姿态控制方法 | |
CN111638643B (zh) | 一种位移模式无拖曳控制动力学协调条件确定方法 | |
CN105807780A (zh) | 一种基于飞轮输出偏差的抗干扰姿态控制方法及验证装置 | |
CN110816897A (zh) | 一种基于cmg系统的多模式转换控制方法 | |
CN113031668A (zh) | 一种非对称旋转扫描载荷所致干扰力矩估计方法和系统 | |
JPS61287899A (ja) | 静止衛星の章動の制御方法および装置 | |
CN112231831A (zh) | 固体运载火箭强耦合条件下终端多约束能量管理方法 | |
CN103274059B (zh) | 一种带运动有效载荷卫星的前馈力矩补偿方法 | |
CN107499536B (zh) | 一种偏置动量卫星高精度跟踪控制偏流角的方法 | |
CN110597274B (zh) | 一种适应姿态重定向的sgcmg动态框架角速度确定方法 | |
CN110955255B (zh) | 基于cmg的高精度轨控姿态维持方法、系统及介质 | |
US6311929B1 (en) | Spacecraft and appendage stepping methods that improve spacecraft attitude pointing and cancel solar array slew disturbances | |
CN115993777A (zh) | 基于轨道摄动模型反演的径切联控解耦迭代标定方法 | |
US6339734B1 (en) | Method and apparatus for reducing spacecraft instrument induced jitter via multifrequency cancellation |
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 |