CN103279127A - 一种仅用角度信息的geo轨道卫星自主控制方法 - Google Patents
一种仅用角度信息的geo轨道卫星自主控制方法 Download PDFInfo
- Publication number
- CN103279127A CN103279127A CN2013101937445A CN201310193744A CN103279127A CN 103279127 A CN103279127 A CN 103279127A CN 2013101937445 A CN2013101937445 A CN 2013101937445A CN 201310193744 A CN201310193744 A CN 201310193744A CN 103279127 A CN103279127 A CN 103279127A
- Authority
- CN
- China
- Prior art keywords
- satellite
- earth
- autonomous
- formula
- attitude
- 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
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
本发明提供了一种仅用角度信息的GEO轨道卫星自主控制方法,步骤:修正星敏感器、红外地球敏感器的在轨偏差;计算地心单位矢量在惯性赤道坐标系中的投影;计算当前卫星与理想定点之间的经纬度偏差,将结果作为滤波观测量。将C_W方程作为系统方程,利用卡尔曼递推办法估计出卫星的赤经赤纬;利用结果将确定卫星当前姿态控制的基准坐标系。再次利用星敏感器信息,计算卫星的姿态偏差,作为系统控制输入。重复上述步骤,实现卫星的自主连续导航和自主姿态控制。本发明仅通过星上敏感器观测,进行航天器位置自主星上解算和自主姿态控制,解决因无法全球布设测控网络和测控成本高的问题,从而实现卫星的自主运行,提高卫星的生存力。
Description
技术领域
本发明涉及星上自主导航和自主控制技术,是地球同步轨道(GEO轨道)卫星的自主控制技术,具体地,涉及一种仅用角度信息的GEO轨道卫星自主控制方法。
背景技术
高轨道卫星主要为静止轨道卫星,此类卫星在同步轨道阶段,通常需要地面进行多次测轨确定卫星轨道,并上注轨道参数,才能实现星上姿态控制。该种导航一直依赖地面测定轨技术,此方法的缺点在于对地面依赖性较大,若要实现高精度轨道预报,需要多个地面站,长期观测,随着我国空间技术的发展,高轨道卫星的数目迅速增加,尤其是境外GEO卫星,这对地面站的要求越来越高,要求实现快速定位,因而对高轨道卫星的自主定位并实现自主姿态控制的需求越来越多。
发明内容
针对现有技术存在的不足,本发明解决的技术问题是提供一种仅用角度信息的GEO轨道卫星自主控制方法,它仅用当前卫星上所拥有的星敏感器和红外地球敏感器实现GEO轨道卫星的自主定点,自主姿态控制,降低卫星对地面站的定位需求,提高卫星自主能力。
为解决上述技术问题,本发明采用了以下的技术方案:
一种仅用姿态信息的GEO轨道卫星的自主控制方法,具体包括如下步骤:
①修正星敏感器、红外地球敏感器的在轨偏差;
②利用红外地球敏感器确定的地心方向单位矢量在卫星本体坐标系下的投影,结合通过星敏感器测量信息,计算得到的本体系与惯性系之间转换关系,计算地心单位矢量在惯性赤道坐标系中的投影;
③利用地心矢量在惯性赤道坐标系中的投影,计算卫星的赤经赤纬,结合星上时间,计算当前卫星与理想定点之间的经纬度偏差,将结果作为滤波观测量。
④将C_W方程作为系统方程,利用卡尔曼递推办法估计出卫星的赤经赤纬;利用结果确定卫星当前姿态控制的基准坐标系。
⑤再次利用星敏感器信息,计算卫星的姿态偏差,作为系统控制输入。
⑥重复上述步骤,实现卫星的自主连续导航和自主姿态控制。
与现有技术相比,本发明具有如下的有益效果:
本发明技术仅通过星上敏感器观测,进行航天器位置自主星上解算和自主姿态控制,解决因无法全球布设测控网络和测控成本高的问题,从而实现卫星的自主运行,提高卫星的生存力。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点将会变得更明显:
图1为本发明的方法流程图。
具体实施方式
下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明,但不以任何形式限制本发明。应当指出的是,对本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进。这些都属于本发明的保护范围。
如图1所示,本实施例提供一种仅用角度信息的GEO轨道卫星自主控制方法,具体步骤如下:
1、修正星敏感器、红外地球敏感器的在轨偏差;
本步骤通过在可测轨阶段,对卫星星上敏感器进行标定,包含星敏感器误差修正和红外地球敏感器误差修正。
星敏感器误差修正:采集星敏感器的输出四元素,修正安装偏差As,表示为安装四元素形式QA,星敏感器安装误差矩阵修正公式如下:
QA为星敏感器的安装矩阵;
红外地球敏感器误差修正:修正红外地球敏感器误差矩阵为Ce,则地心修正公式如下:
reb'=Cereb
式中:Ce为安装矩阵;reb′为修正后地心单位矢量。
2、利用红外地球敏感器确定的地心方向单位矢量在卫星本体坐标系下的投影,结合通过星敏感器测量信息,计算得到的本体系与惯性系之间转换关系,计算地心单位矢量在惯性赤道坐标系中的投影;
本步骤计算惯性系下的地心矢量,其中:
姿态矩阵计算:由星敏感器输出的从J2000系到卫星本体坐标系的旋转四元数 ,计算卫星本体坐标系到地心赤道惯性系的转换阵Cib为:
式中:Cib为卫星本体坐标系到地心赤道惯性系的转换阵;
q0为四元素标量部分,q1,q2,q3为四元素矢量部分;
惯性系下地心矢量解算:将地心矢量表示转换到惯性系中,计算公式如下:
rei=Cibreb
式中:rei为惯性系下地心单位矢量。
3、利用地心矢量在惯性赤道坐标系中的投影,计算卫星的赤经赤纬,结合星上时间,计算当前卫星与理想定点之间的经纬度偏差,将结果作为滤波观测量;
卫星当前赤经和赤纬计算:
α=arctan(rei(2),rei(1))
δ=arcsin(rei(3))
GEO卫星参考点赤经以地球自转角速度的变化,即g0+ωet,纬度为0°,GEO卫星真实的赤经和赤纬相对该定点经纬度的变化关系如下
△α=α-g0-ωet
△δ=δ
4、将C_W方程作为系统方程,利用卡尔曼递推办法估计出卫星的赤经赤纬;利用结果确定卫星当前姿态控制的基准坐标系;
本步骤利用卡尔曼滤波方法估计赤经赤纬。
GEO卫星相对定点的相对运动方程(C_W方程)为
其中n为地球自转角速度。
线性动力学线性化即计算Φ阵:
式中:T为滤波周期,根据星载计算机周期确定;
一步预测值计算:计算一步预测值,取 :
Xk+1/k=ΦXk
式中:Xk+1/k为一步预测值;
Xk为当前时刻状态值;
观测方程:具体公式如下:
z=h[Xk]+vk=HXk+vk
vk为伪距所有误差的总和。
其中
EKF计算:公式如下:
式中:Φk+1,k为t时刻的一步转移矩阵,Hk为量测矩阵;Kk+1为滤波增益;Pk+1/k为一步预测均方误差;Pk+1/k+1为估计均方误差。
经过滤波得到连续稳定的卫星经纬度偏差△α,△δ,计算卫星赤经赤纬:
α=△α+g0+ωet
δ=△δ
5、建立姿态控制基准
利用卫星的赤经赤纬建立卫星姿态控制基准,从惯性系到东南地坐标系的转换关系如下
Aei=Rx(-δ-π/2)Rz(α+π/2)
其中
6、解算卫星控制姿态
利用星敏数据和卫星姿态基准数据计算卫星当前姿态与姿态基准之间的偏差 。
θ=arctan(-Abe(1,3)/Abe(3,3))
ψ=arctan(-Abe(2,1)/Abe(2,2))
重复上述步骤,实现卫星的自主连续导航和自主姿态控制。本发明可以解决因无法全球布设测控网络和测控成本高的问题,从而实现卫星的自主运行,提高卫星的生存力。
以上对本发明的具体实施例进行了描述。需要理解的是,本发明并不局限于上述特定实施方式,本领域技术人员可以在权利要求的范围内做出各种变形或修改,这并不影响本发明的实质内容。
Claims (7)
1.一种仅用角度信息的GEO轨道卫星自主控制方法,其特征在于包括如下步骤:
①修正星敏感器、红外地球敏感器的在轨偏差;
②利用红外地球敏感器确定的地心方向单位矢量在卫星本体坐标系下的投影,结合通过星敏感器测量信息,计算得到的本体系与惯性系之间转换关系,计算地心单位矢量在惯性赤道坐标系中的投影;
③利用地心矢量在惯性赤道坐标系中的投影,计算卫星的赤经赤纬,结合星上时间,计算当前卫星与理想定点之间的经纬度偏差,将结果作为滤波观测量;
④将C_W方程作为系统方程,利用卡尔曼递推办法估计出卫星的赤经赤纬;利用结果确定卫星当前姿态控制的基准坐标系;
⑤再次利用星敏感器信息,计算卫星的姿态偏差,作为系统控制输入;
⑥重复上述步骤,实现卫星的自主连续导航和自主姿态控制。
4.根据权利要求1-3任一项所述的仅用角度信息的GEO轨道卫星自主控制方法,其特征在于:所述步骤③中,计算卫星相对定点的经纬度偏差,其中:
卫星当前赤经α和赤纬δ计算:
α=arctan(rei(2),rei(1))
δ=arcsin(rei(3))
式中:rei为惯性系下地心单位矢量;
GEO卫星参考点赤经以地球自转角速度的变化,即g0+ωet,纬度为0°,GEO卫星真实的赤经和赤纬相对该定点经纬度的变化关系如下:
△α=α-g0-ωet
△δ=δ。
5.根据权利要求4所述的仅用角度信息的GEO轨道卫星自主控制方法,其特征在于:所述步骤④中,利用基于C_W方程的卡尔曼滤波进行赤经计算,过程如下:
线性动力学线性化即计算Φ阵:
式中:n为地球自转角速度;T为滤波周期,根据星载计算机周期确定;
Xk+1/k=ΦXk
式中:Xk+1/k为一步预测值;Xk为当前时刻状态值;
z=h[Xk]+vk=HXk+vk
vk为伪距所有误差的总和;其中
;
卡尔曼滤波计算公式如下:
式中:Φk+1,k为t时刻的一步转移矩阵,Hk为量测矩阵;Kk+1为滤波增益;Pk+1/k为一步预测均方误差;Pk+1/k+1为估计均方误差;
经过滤波得到连续稳定的卫星经纬度偏差△α,△δ,计算卫星赤经赤纬:
α=△α+g0+ωet
δ=△δ。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310193744.5A CN103279127B (zh) | 2013-05-22 | 2013-05-22 | 一种仅用角度信息的geo轨道卫星自主控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310193744.5A CN103279127B (zh) | 2013-05-22 | 2013-05-22 | 一种仅用角度信息的geo轨道卫星自主控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103279127A true CN103279127A (zh) | 2013-09-04 |
CN103279127B CN103279127B (zh) | 2016-06-22 |
Family
ID=49061690
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310193744.5A Active CN103279127B (zh) | 2013-05-22 | 2013-05-22 | 一种仅用角度信息的geo轨道卫星自主控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103279127B (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103630109A (zh) * | 2013-12-08 | 2014-03-12 | 北京航空航天大学 | 一种基于星光折射确定地心矢量的方法 |
CN104714554A (zh) * | 2015-03-17 | 2015-06-17 | 北京航空航天大学 | 一种共位式卫星编队的构造方法 |
CN106897962A (zh) * | 2016-12-26 | 2017-06-27 | 中国科学院长春光学精密机械与物理研究所 | 大视场空间对地观测图像的圆盘投影和拼接方法 |
CN108681617A (zh) * | 2018-03-29 | 2018-10-19 | 北京空间飞行器总体设计部 | 一种航天器多星敏感器布局优化设计方法 |
CN109059936A (zh) * | 2018-07-09 | 2018-12-21 | 上海卫星工程研究所 | 基于安装矩阵修正的火星接近段光学导航数据解算方法 |
CN110702096A (zh) * | 2019-09-19 | 2020-01-17 | 北京控制工程研究所 | 一种太阳敏感器的高阶误差补偿方法 |
CN111428365A (zh) * | 2020-03-24 | 2020-07-17 | 中国人民解放军32035部队 | 利用天文测量数据判别geo目标的方法 |
CN111591472A (zh) * | 2020-05-15 | 2020-08-28 | 北京世冠金洋科技发展有限公司 | 一种调整卫星姿态的方法和相关装置 |
CN113739772A (zh) * | 2021-08-30 | 2021-12-03 | 北京控制工程研究所 | 一种火点敏感器经纬度测定方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110141275A1 (en) * | 2009-12-15 | 2011-06-16 | Casio Computer Co., Ltd. | Positioning device, positioning method, storage medium and image capturing device |
CN102162731A (zh) * | 2011-01-12 | 2011-08-24 | 哈尔滨工业大学 | 基于日地月集成敏感器脉冲数据的卫星高精度自主导航方法 |
CN102878995A (zh) * | 2012-10-24 | 2013-01-16 | 北京控制工程研究所 | 一种静止轨道卫星自主导航方法 |
-
2013
- 2013-05-22 CN CN201310193744.5A patent/CN103279127B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110141275A1 (en) * | 2009-12-15 | 2011-06-16 | Casio Computer Co., Ltd. | Positioning device, positioning method, storage medium and image capturing device |
CN102162731A (zh) * | 2011-01-12 | 2011-08-24 | 哈尔滨工业大学 | 基于日地月集成敏感器脉冲数据的卫星高精度自主导航方法 |
CN102878995A (zh) * | 2012-10-24 | 2013-01-16 | 北京控制工程研究所 | 一种静止轨道卫星自主导航方法 |
Non-Patent Citations (2)
Title |
---|
王素娟: "基于恒星敏感器的风云四号气象卫星姿态确定方法研究及实现", 《中国博士学位论文全文数据库》, no. 09, 15 September 2009 (2009-09-15) * |
郭建新 等: "基于姿态敏感器的地球同步轨道卫星自主导航研究", 《航天控制》, no. 4, 31 December 2003 (2003-12-31), pages 1 - 6 * |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103630109A (zh) * | 2013-12-08 | 2014-03-12 | 北京航空航天大学 | 一种基于星光折射确定地心矢量的方法 |
CN104714554B (zh) * | 2015-03-17 | 2017-07-28 | 北京航空航天大学 | 一种共位式卫星编队的构造方法 |
CN104714554A (zh) * | 2015-03-17 | 2015-06-17 | 北京航空航天大学 | 一种共位式卫星编队的构造方法 |
CN106897962B (zh) * | 2016-12-26 | 2019-06-25 | 中国科学院长春光学精密机械与物理研究所 | 大视场空间对地观测图像的圆盘投影和拼接方法 |
CN106897962A (zh) * | 2016-12-26 | 2017-06-27 | 中国科学院长春光学精密机械与物理研究所 | 大视场空间对地观测图像的圆盘投影和拼接方法 |
CN108681617A (zh) * | 2018-03-29 | 2018-10-19 | 北京空间飞行器总体设计部 | 一种航天器多星敏感器布局优化设计方法 |
CN109059936A (zh) * | 2018-07-09 | 2018-12-21 | 上海卫星工程研究所 | 基于安装矩阵修正的火星接近段光学导航数据解算方法 |
CN110702096A (zh) * | 2019-09-19 | 2020-01-17 | 北京控制工程研究所 | 一种太阳敏感器的高阶误差补偿方法 |
CN110702096B (zh) * | 2019-09-19 | 2021-02-09 | 北京控制工程研究所 | 一种太阳敏感器的高阶误差补偿方法 |
CN111428365A (zh) * | 2020-03-24 | 2020-07-17 | 中国人民解放军32035部队 | 利用天文测量数据判别geo目标的方法 |
CN111428365B (zh) * | 2020-03-24 | 2021-12-28 | 中国人民解放军32035部队 | 利用天文测量数据判别geo目标的方法 |
CN111591472A (zh) * | 2020-05-15 | 2020-08-28 | 北京世冠金洋科技发展有限公司 | 一种调整卫星姿态的方法和相关装置 |
CN113739772A (zh) * | 2021-08-30 | 2021-12-03 | 北京控制工程研究所 | 一种火点敏感器经纬度测定方法 |
CN113739772B (zh) * | 2021-08-30 | 2023-09-29 | 北京控制工程研究所 | 一种火点敏感器经纬度测定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103279127B (zh) | 2016-06-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103279127A (zh) | 一种仅用角度信息的geo轨道卫星自主控制方法 | |
CN102878995B (zh) | 一种静止轨道卫星自主导航方法 | |
CN103424114B (zh) | 一种视觉导航/惯性导航的全组合方法 | |
CN100501331C (zh) | 基于x射线脉冲星的导航卫星自主导航系统与方法 | |
CN104332707B (zh) | 一种用于低轨星载天线跟踪地面站的方法 | |
CN103630137B (zh) | 一种用于导航系统的姿态及航向角的校正方法 | |
CN103217159B (zh) | 一种sins/gps/偏振光组合导航系统建模及动基座初始对准方法 | |
CN106292677B (zh) | 基于恒星时角的姿态控制方法和系统 | |
CN104567930A (zh) | 一种能够估计和补偿机翼挠曲变形的传递对准方法 | |
TR201801964A2 (zh) | ||
US8321076B2 (en) | On-line inertia estimation for use in controlling an aerospace vehicle | |
CN103017760B (zh) | 一种大椭圆轨道火星探测器自主对火定向方法 | |
CN102519485B (zh) | 一种引入陀螺信息的二位置捷联惯性导航系统初始对准方法 | |
CN103344259A (zh) | 一种基于杆臂估计的ins/gps组合导航系统反馈校正方法 | |
CN103499348B (zh) | Ahrs高精度姿态数据计算方法 | |
CN105184002A (zh) | 一种数传天线指向角度的仿真分析方法 | |
CN103335654B (zh) | 一种行星动力下降段的自主导航方法 | |
CN110779532B (zh) | 一种应用于近地轨道卫星的地磁导航系统及方法 | |
CN103900608A (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN107132542A (zh) | 一种基于光学和多普勒雷达的小天体软着陆自主导航方法 | |
Li et al. | MER Spirit rover localization: Comparison of ground image–and orbital image–based methods and science applications | |
CN105300404A (zh) | 一种舰船基准惯性导航系统标校方法 | |
CN110058288A (zh) | 无人机ins/gnss组合导航系统航向误差修正方法及系统 | |
CN103674059A (zh) | 一种基于外测速度信息的sins水平姿态误差修正方法 | |
CN105444762A (zh) | 一种用于机载动中通的惯导误差快速修正方法 |
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 |