CN110775299B - 一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法 - Google Patents
一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法 Download PDFInfo
- Publication number
- CN110775299B CN110775299B CN201910974453.7A CN201910974453A CN110775299B CN 110775299 B CN110775299 B CN 110775299B CN 201910974453 A CN201910974453 A CN 201910974453A CN 110775299 B CN110775299 B CN 110775299B
- Authority
- CN
- China
- Prior art keywords
- attitude
- time
- calculating
- current
- star
- 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
- 238000000034 method Methods 0.000 title claims abstract description 37
- 238000005259 measurement Methods 0.000 title claims abstract description 29
- 230000001629 suppression Effects 0.000 title claims abstract description 13
- 230000035945 sensitivity Effects 0.000 title claims description 14
- 230000001360 synchronised effect Effects 0.000 claims abstract description 7
- 238000013213 extrapolation Methods 0.000 claims description 6
- 238000001914 filtration Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012423 maintenance 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
-
- 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
-
- 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/36—Guiding or controlling apparatus, e.g. for attitude control using sensors, e.g. sun-sensors, horizon sensors
- B64G1/361—Guiding or controlling apparatus, e.g. for attitude control using sensors, e.g. sun-sensors, horizon sensors using star sensors
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法,步骤为:1)星敏感器接收控制计算机发出的同步信号,使得星敏测量数据的测量时刻与控制计算机的控制周期同步;2)根据当前控制周期有无新的星敏测量数据发送回来,获得当前时刻干扰力矩估计值Md,i;3)计算控制器的输出,得到控制力矩,完成航天器的姿态控制。本发明采用前馈补偿的方法,快速消除干扰对航天器姿态角速度的负面影响,保证姿态平稳,从而为星敏正常工作提供保障条件,保证了星敏数据的连续性。
Description
技术领域
本发明提出了一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法,适用于配置有星敏的航天器喷气控制。
背景技术
航天器控制系统一般用星敏感器获取航天器的惯性姿态信息,用陀螺获取姿态角速度信息,姿态信息和角速度信息用于姿态控制系统进行姿态机动和保持控制。当陀螺发生故障不能提供姿态角速度时,姿态控制系统就会失效,造成航天器失控无法使用。为避免陀螺故障产生的恶劣后果,一般采取多配置陀螺的方式,保证即便有部分陀螺失效,仍可使用备份陀螺进行正常工作。这种方法,增加系统需要配置的陀螺个数,造成系统复杂度增大、重量增加。
采用星敏的姿态测量信息进行角速度估计,是在系统缺少陀螺的直接角速度测量时的一种可选用方法。由于星敏不能够在航天器姿态角速度过大时稳定工作,这种方法的应用具有很大的局限性。当航天器控制系统中存在较大干扰时(如轨控发动机安装偏斜造成轨控时的姿态扰动),如果不能迅速消除干扰对姿态的扰动,航天器角速度在干扰作用下快速增大,星敏就无法正常输出姿态数据。一般来说,星敏可正常工作的单轴角速度需要保持在0.1~0.3度/秒以下。没有陀螺数据又失去星敏的姿态测量数据,航天器就会进入失控状态。因此,解决好干扰情况下的姿态控制方法,是仅应用星敏进行欠测量姿态控制的关键。特别是,在航天器执行轨道控制操作时。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提供了一种仅使用星敏测量数据进行喷气姿态控制的方法,解决了航天器没有陀螺测量数据,且存在较大姿控干扰力矩时,姿态角速度过大星敏不能正常输出测量数据,从而导致姿态控制失效的问题。
本发明的技术方案:一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法,步骤如下:
(1)星敏感器接收控制计算机发出的同步信号,使得星敏测量数据的测量时刻与控制计算机的控制周期同步;
(2)如果当前控制周期有新的星敏测量数据发送回来,则执行3a-3h;如果当前控制周期没有新的星敏测量数据发送回来,则执行4a-4c;
(3a)采用星敏测量的姿态四元素数据直接计算出航天器当前时刻t1的惯性姿态θi;
(3c)采用t2时刻的星敏测量的姿态四元素数据q2和t2时刻前的某一时刻t3的星敏测量的姿态四元素数据q3,计算次时刻t2的姿态角速度ω2;
(3d)计算t1时刻至t3时刻间的平均角速度ω;
(3e)计算t1时刻至t3时刻间的星体受到的力矩冲量dT;
(3f)计算t1时刻至t3时刻间的星体受到的干扰力矩冲量dMd;
(3g)计算得到干扰力矩Md;
(3h)采用α-β滤波对干扰力矩计算值进行滤波估计,获得当前时刻干扰力矩估计值Md,i;并转到步骤(5);
(4a)根据运动学方程,采用外推方法计算出航天器当前时刻t1惯性姿态角θi;
(4b)假设干扰力矩不变,得到当前时刻干扰力矩,即
Md,i=Md,i-1
其中Md,i-1是上一拍的干扰力矩估计值,Md,0=0;
(5)计算控制器的输出,得到控制力矩,完成航天器的姿态控制。
所述步骤(3b)中计算当前姿态平均角速度ω1的具体过程为:
计算得到姿态四元素数据q1和姿态四元素数据q2的误差四元数qe:
qe(1)=-q2(1)*q1(4)-q2(2)*q1(3)+q2(3)*q1(2)+q2(4)*q1(1)
qe(2)=q2(1)*q1(3)-q2(2)*q1(4)-q2(3)*q1(1)+q2(1)*q1(2)
qe(3)=-q2(1)*q1(2)+q2(2)*q1(1)-q2(3)*q1(4)+q2(4)*q1(3)
qe(4)=q2(1)*q1(1)+q2(2)*q1(2)+q2(3)*q1(3)+q2(4)*q1(4)
其中q(i),i=1,2,3,4,为四元素q的第i个元素,所述四元素q包括q1、q2和qe,则当前姿态平均角速度ω1
所述步骤(3c)中计算次时刻t2的姿态角速度ω2的具体方法为:
计算姿态四元素数据q2和姿态四元素数据q3的误差四元数qe1:
qe1(1)=-q3(1)*q2(4)-q3(2)*q2(3)+q3(3)*q2(2)+q3(4)*q2(1)
qe1(2)=q3(1)*q2(3)-q3(2)*q2(4)-q3(3)*q2(1)+q3(1)*q2(2)
qe1(3)=-q3(1)*q2(2)+q3(2)*q2(1)-q3(3)*q2(4)+q3(4)*q2(3)
qe1(4)=q3(1)*q2(1)+q3(2)*q2(2)+q3(3)*q2(3)+q3(4)*q2(4)
其中q(i),i=1,2,3,4,为四元素q的第i个元素,所述四元素q包括q3、q4和qe1
则姿态角速度ω2表示为
所述步骤(3d)中计算t1时刻至t3时刻间的平均角速度ω=(ω1×(t1-t2) +ω2×(t2-t3))/(t1-t3)。
所述步骤(3g)中干扰力矩Md=dMd/n/t。
所述步骤(3h)中获得当前时刻干扰力矩估计值Md,i=Md+(1- α)Md,i-1;其中α为滤波系数,Md,i-1是上一拍的干扰力矩估计值,Md,0=0。
所述步骤(5)中控制力矩公式为:
本发明的有益效果:
(1)本发明采用星敏数据直接计算的方法进行干扰力矩估计,显著提高了干扰估计的快速性。
(2)本发明采用前馈补偿的方法,快速消除干扰对航天器姿态角速度的负面影响,保证姿态平稳,从而为星敏正常工作提供保障条件,保证了星敏数据的连续性。
(3)实现了在缺少陀螺数据的欠测量条件下,仅使用星敏的测量数据进行姿态控制的目的。从而提高了航天器控制系统的可靠性,降低研制成本。
附图说明
图1为本发明的方法计算流程框图;
具体实施方式
如图1所示,本发明一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法,步骤如下:
(1)星敏感器接收控制计算机发出的同步信号,使得星敏测量数据的测量时刻与控制计算机的控制周期同步。
(2)如果当前控制周期有新的星敏测量数据发送回来,则执行3a-3h。如果当前控制周期没有新的星敏测量数据发送回来,则执行4a-4c。
(3a)采用星敏测量的姿态四元素数据直接计算出航天器当前时刻t1的惯性姿态θi;
计算得到姿态四元素数据q1和姿态四元素数据q2的误差四元数qe:
qe(1)=-q2(1)*q1(4)-q2(2)*q1(3)+q2(3)*q1(2)+q2(4)*q1(1)
qe(2)=q2(1)*q1(3)-q2(2)*q1(4)-q2(3)*q1(1)+q2(1)*q1(2)
qe(3)=-q2(1)*q1(2)+q2(2)*q1(1)-q2(3)*q1(4)+q2(4)*q1(3)
qe(4)=q2(1)*q1(1)+q2(2)*q1(2)+q2(3)*q1(3)+q2(4)*q1(4)
其中q(i),i=1,2,3,4,为四元素q的第i个元素,所述四元素q包括q1、q2和qe,则当前姿态平均角速度ω1
(3c)采用t2时刻的星敏测量的姿态四元素数据q2和t2时刻前的某一时刻t3的星敏测量的姿态四元素数据q3,计算次时刻t2的姿态角速度ω2。
计算姿态四元素数据q2和姿态四元素数据q3的误差四元数qe1:
qe1(1)=-q3(1)*q2(4)-q3(2)*q2(3)+q3(3)*q2(2)+q3(4)*q2(1)
qe1(2)=q3(1)*q2(3)-q3(2)*q2(4)-q3(3)*q2(1)+q3(1)*q2(2)
qe1(3)=-q3(1)*q2(2)+q3(2)*q2(1)-q3(3)*q2(4)+q3(4)*q2(3)
qe1(4)=q3(1)*q2(1)+q3(2)*q2(2)+q3(3)*q2(3)+q3(4)*q2(4)
其中q(i),i=1,2,3,4,为四元素q的第i个元素,所述四元素q包括q3、q4和qe1
则姿态角速度ω2表示为
(3d)计算t1时刻至t3时刻间的平均角速度ω。公式为:ω=(ω1×(t1-t2) +ω2×(t2-t3))/(t1-t3)。
(3e)计算t1时刻至t3时刻间的星体受到的力矩冲量dT。公式为:
其中ω(1)、ω(2)、ω(3)分别为平均角速度ω中的三个元素。
(3f)计算t1时刻至t3时刻间的星体受到的干扰力矩冲量dMd。公式为:
其中t是控制周期,n是t1时刻至t3时刻间的整周期数,Mci是t1时刻至 t3时刻间每周期的控制力矩。
(3g)计算干扰力矩,Md=dMd/n/t。
(3h)采用α-β滤波对干扰力矩计算值进行滤波估计,获得当前时刻干扰力矩估计值。公式为:Md,i=Md+(1-α)Md,i-1,α为滤波系数,Md,i-1是上一拍的干扰力矩估计值,Md,0=0;并转到步骤(5)
(4a)根据运动学方程
采用外推方法计算出航天器当前时刻t1惯性姿态角θi。
(4b)假设干扰力矩不变,得到当前时刻干扰力矩,即
Md,i=Md,i-1
(4c)根据动力学方程
(5)计算控制器的输出,得到控制力矩,完成航天器的姿态控制,控制力矩公式为:
Claims (7)
1.一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法,其特征在于步骤如下:
(1)星敏感器接收控制计算机发出的同步信号,使得星敏感器测量数据的测量时刻与控制计算机的控制周期同步;
(2)如果当前控制周期有新的星敏感器测量数据发送回来,则执行步骤(3a)-(3h);如果当前控制周期没有新的星敏感器测量数据发送回来,则执行步骤(4a)-(4c);
(3a)采用星敏感器测量的姿态四元素数据直接计算出航天器当前时刻t1的惯性姿态角θi;
(3c)采用t2时刻的星敏感器测量的姿态四元素数据q2和t2时刻前的某一时刻t3的星敏感器测量的姿态四元素数据q3,计算次时刻t2的姿态角速度ω2;
(3d)计算t1时刻至t3时刻间的平均角速度ω;
(3e)计算t1时刻至t3时刻间的星体受到的力矩冲量dT;
(3f)计算t1时刻至t3时刻间的星体受到的干扰力矩冲量dMd;
(3g)计算得到干扰力矩Md;
(3h)采用α-β滤波对干扰力矩计算值进行滤波估计,获得当前时刻干扰力矩估计值Md,i;并转到步骤(5);
(4a)根据运动学方程,采用外推方法计算出航天器当前时刻t1惯性姿态角θi;
(4b)假设干扰力矩不变,得到当前时刻干扰力矩,即
Md,i=Md,i-1
其中Md,i-1是上一拍的干扰力矩估计值,Md,0=0;
(5)计算控制器的输出,得到控制力矩,完成航天器的姿态控制。
2.根据权利要求1所述的一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法,其特征在于:所述步骤(3b)中计算当前姿态平均角速度ω1的具体过程为:
计算得到姿态四元素数据q1和姿态四元素数据q2的误差四元数qe:
qe(1)=-q2(1)*q1(4)-q2(2)*q1(3)+q2(3)*q1(2)+q2(4)*q1(1)
qe(2)=q2(1)*q1(3)-q2(2)*q1(4)-q2(3)*q1(1)+q2(1)*q1(2)
qe(3)=-q2(1)*q1(2)+q2(2)*q1(1)-q2(3)*q1(4)+q2(4)*q1(3)
qe(4)=q2(1)*q1(1)+q2(2)*q1(2)+q2(3)*q1(3)+q2(4)*q1(4)
其中q(i),i=1,2,3,4,为四元素q的第i个元素,所述四元素q包括q1、q2和qe,则当前姿态平均角速度ω1
3.根据权利要求1所述的一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法,其特征在于:所述步骤(3c)中计算次时刻t2的姿态角速度ω2的具体方法为:
计算姿态四元素数据q2和姿态四元素数据q3的误差四元数qe1:
qe1(1)=-q3(1)*q2(4)-q3(2)*q2(3)+q3(3)*q2(2)+q3(4)*q2(1)
qe1(2)=q3(1)*q2(3)-q3(2)*q2(4)-q3(3)*q2(1)+q3(1)*q2(2)
qe1(3)=-q3(1)*q2(2)+q3(2)*q2(1)-q3(3)*q2(4)+q3(4)*q2(3)
qe1(4)=q3(1)*q2(1)+q3(2)*q2(2)+q3(3)*q2(3)+q3(4)*q2(4)
其中q(i),i=1,2,3,4,为四元素q的第i个元素,所述四元素q包括q3、q4和qe1则姿态角速度ω2表示为
4.根据权利要求1所述的一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法,其特征在于:所述步骤(3d)中计算t1时刻至t3时刻间的平均角速度ω=(ω1×(t1-t2)+ω2×(t2-t3))/(t1-t3)。
7.根据权利要求1所述的一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法,其特征在于:所述步骤(3h)中获得当前时刻干扰力矩估计值Md,i=Md+(1-α)Md,i-1;其中α为滤波系数,Md,i-1是上一拍的干扰力矩估计值,Md,0=0。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910974453.7A CN110775299B (zh) | 2019-10-14 | 2019-10-14 | 一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910974453.7A CN110775299B (zh) | 2019-10-14 | 2019-10-14 | 一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110775299A CN110775299A (zh) | 2020-02-11 |
CN110775299B true CN110775299B (zh) | 2021-04-13 |
Family
ID=69385277
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910974453.7A Active CN110775299B (zh) | 2019-10-14 | 2019-10-14 | 一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110775299B (zh) |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6285927B1 (en) * | 1999-05-26 | 2001-09-04 | Hughes Electronics Corporation | Spacecraft attitude determination system and method |
US7260456B2 (en) * | 2004-01-05 | 2007-08-21 | The Boeing Company | Pixel-frequency slews and filters for star data measurements |
CN101209753B (zh) * | 2006-12-25 | 2011-06-15 | 北京控制工程研究所 | 星敏感器系统成像结构 |
DE102012111752A1 (de) * | 2012-12-04 | 2014-06-18 | Jena-Optronik Gmbh | Verfahren zur automatischen Korrektur von Ausrichtungsfehlern in Sternsensorsystemen |
US9365299B2 (en) * | 2014-06-09 | 2016-06-14 | Space Systems/Loral, Llc | Highly inclined elliptical orbit launch and orbit acquisition techniques |
CN106915477B (zh) * | 2017-03-06 | 2018-01-30 | 上海航天控制技术研究所 | 一种姿态控制方法 |
CN110209185B (zh) * | 2019-06-26 | 2022-02-01 | 北京控制工程研究所 | 一种利用星敏信息姿态重置的航天器姿态机动稳定方法 |
-
2019
- 2019-10-14 CN CN201910974453.7A patent/CN110775299B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110775299A (zh) | 2020-02-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2021057894A1 (zh) | 一种基于车辆零速检测的惯性导航误差修正方法 | |
CN107422639B (zh) | 一种基于时间延迟估计的双边遥操作控制方法 | |
CN109625335B (zh) | 一种基于角速度估计信息和太阳敏感器的捕获太阳方法 | |
CN107544466B (zh) | 一种单框架控制力矩陀螺低速框架故障诊断方法 | |
CN110567461B (zh) | 一种考虑无陀螺仪的非合作航天器姿态和参数估计方法 | |
CN108762069B (zh) | 刚性航天器姿控系统飞轮故障辨识与调节方法 | |
CN113291493B (zh) | 一种卫星多敏感器融合姿态确定方法和系统 | |
CN113203429B (zh) | 一种陀螺仪温度漂移误差的在线估计及补偿方法 | |
CN108871323B (zh) | 一种低成本惯性传感器在机动环境下的高精度导航方法 | |
CN112683269A (zh) | 一种附有运动加速度补偿的marg姿态计算方法 | |
CN104819717B (zh) | 一种基于mems惯性传感器组的多旋翼飞行器姿态检测方法 | |
CN111638654A (zh) | 一种故障自适应的运载火箭智能控制半实物仿真方法 | |
CN110658837A (zh) | 一种控制力矩陀螺故障情况下的平稳重构方法 | |
CN110775299B (zh) | 一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法 | |
JP4617990B2 (ja) | 自動飛行制御装置、自動飛行制御方法及び自動飛行制御プログラム | |
CN108750145B (zh) | 一种磁力矩器极性在轨检测方法 | |
CN112729332A (zh) | 一种基于旋转调制的对准方法 | |
CN109674480B (zh) | 一种基于改进互补滤波的人体运动姿态解算方法 | |
JP3375720B2 (ja) | 船舶の慣性航法装置 | |
JP3919911B2 (ja) | 方位姿勢基準装置 | |
JP2756554B2 (ja) | 慣性装置 | |
JP2012198057A6 (ja) | 姿勢推定装置 | |
JP2010202069A (ja) | 姿勢制御装置 | |
CN107869999B (zh) | 利用角速率估计信息的单套陀螺故障诊断方法 | |
CN111238536B (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 |