CN111220179A - 一种光学导航敏感器的惯性基准时空精确对准方法 - Google Patents
一种光学导航敏感器的惯性基准时空精确对准方法 Download PDFInfo
- Publication number
- CN111220179A CN111220179A CN202010108610.9A CN202010108610A CN111220179A CN 111220179 A CN111220179 A CN 111220179A CN 202010108610 A CN202010108610 A CN 202010108610A CN 111220179 A CN111220179 A CN 111220179A
- Authority
- CN
- China
- Prior art keywords
- star sensor
- calibration
- sensor
- attitude
- optical navigation
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Abstract
本发明涉及一种光学导航敏感器的惯性基准时空精确对准方法,属于火星环绕器光学导航敏感器惯性基准对准技术领域;步骤一、当存在正常工作的星敏感器时,进入步骤二;否则退出标定流程;步骤二、当星敏感器处于姿态测量模式时,进入步骤三;否则切换至姿态测量模式,进入步骤三;步骤三、计算各星敏感器与光学导航敏感器的姿态差xk;k为星敏感器序号;步骤四、采用标定算法,得到各星敏感器的标定姿态差yk;步骤五、当该星敏感器的标定姿态差yk完成标定,结束该星敏感器与光学导航敏感器的姿态差标定工作;否则对该星敏感器继续进行姿态差标定;本发明避开了安装测量误差以及热变形误差等误差源,提高了光学导航敏感器的在轨对准精度。
Description
技术领域
本发明属于火星环绕器光学导航敏感器惯性基准对准技术领域,涉及一种光学导航敏感器的惯性基准时空精确对准方法。
背景技术
火星环绕器在进行光学自主导航的过程中,需要知道光学导航敏感器相对于惯性系的姿态转换关系,以进行导航信息的预处理。
现有技术均是通过星敏感器的测量四元数,计算出火星环绕器相对于惯性系的姿态四元数,然后通过光学导航敏感器相对于火星环绕器的安装矩阵,进而求解出光学导航敏感器相对于惯性系的姿态四元数,这种方法需要精确知道星敏感器和光学导航敏感器的姿态四元数,然而受安装测量精度以及热变形等外部因素的影响,不可能得到精确的星敏感器以及光学导航敏感器的安装矩阵。此外,星敏感器输出姿态的曝光时刻与光学导航敏感器测量的曝光时刻不可能完全同步,因此,需要研究一种光学导航敏感器的惯性基准时空精确对准方法,以规避外部环境因素及曝光时差导致的姿态和导航误差。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提出光学导航敏感器的惯性基准时空精确对准方法,避开了安装测量误差以及热变形误差等误差源,提高了光学导航敏感器的在轨对准精度。
本发明解决技术的方案是:
一种光学导航敏感器的惯性基准时空精确对准方法,包括如下步骤:
步骤一、启动标定流程,判断当前周期T是否存在正常工作的星敏感器;当存在正常工作的星敏感器时,进入步骤二;否则退出标定流程;
步骤二、判导正常工作的星敏感器是否处于对火星探测器的姿态测量模式,当星敏感器处于对火星探测器的姿态测量模式时,进入步骤三;否则将正常工作的星敏感器切换至对火星探测器的姿态测量模式,进入步骤三;
步骤三、计算各星敏感器与火星探测器中的光学导航敏感器的姿态差xk;k为星敏感器序号;
步骤四、采用标定算法,对各星敏感器与光学导航敏感器的姿态差进行标定,得到各星敏感器的标定姿态差yk;
步骤五、判断各星敏感器的标定姿态差yk是否完成标定;当该星敏感器的标定姿态差yk完成标定,结束该星敏感器与光学导航敏感器的姿态差标定工作;否则对该星敏感器继续进行姿态差标定。
在上述的一种光学导航敏感器的惯性基准时空精确对准方法,所述步骤一中,判断星敏感器是否正常工作的方法为:
当该星敏感器的星敏基准模值为0.9-1.1时,认为该星敏感器正常工作;否则认为星敏感器为非正常工作。
在上述的一种光学导航敏感器的惯性基准时空精确对准方法,所述步骤三中,姿态差xk的计算方法为:
分别求各星敏感器到光学导航敏感器的姿态四元数,即为各星敏感器与光学导航敏感器的姿态差。
在上述的一种光学导航敏感器的惯性基准时空精确对准方法,所述姿态差包括4个姿态分量。
在上述的一种光学导航敏感器的惯性基准时空精确对准方法,所述步骤四中,标定姿态差yk的计算方法为:
式中,yk-1为上一周期该星敏感器与光学导航敏感器的标定姿态差;初始值为0;
τ为标定参数;
T为采样周期。
在上述的一种光学导航敏感器的惯性基准时空精确对准方法,所述τ为0.5;T为0.5s。
在上述的一种光学导航敏感器的惯性基准时空精确对准方法,所述步骤五中,各星敏感器的标定姿态差yk是否完成标定的判断方法为:
当在连续检测时长t内,该星敏感器各周期的标定姿态差yk中的4个姿态分量的标准差均小于0.00001时,认为该星敏感器的标定姿态差yk完成标定。
在上述的一种光学导航敏感器的惯性基准时空精确对准方法,所述连续检测时长t为10min。
在上述的一种光学导航敏感器的惯性基准时空精确对准方法,所述步骤五中,当该星敏感器的标定姿态差yk未完成标定时,延长连续检测时长t,重复步骤四至步骤五,对该星敏感器继续进行姿态差标定。
本发明与现有技术相比的有益效果是:
(1)本发明通过一种光学导航敏感器的惯性基准时空精确对准方法,避免星敏感器以及光学导航敏感器安装测量误差以及热变形误差等外部环境引起的姿态误差对火星环绕器自主光学导航的影响;
(2)本发明采用采用标定算法,对各星敏感器与光学导航敏感器的姿态差进行标定,得到各星敏感器的标定姿态差yk,得到精确的标定姿态差。
附图说明
图1为本发明惯性基准时空精确对准流程图。
具体实施方式
下面结合实施例对本发明作进一步阐述。
本发明提供一种光学导航敏感器的惯性基准时空精确对准方法,以规避外部环境因素及曝光时差导致的姿态和导航误差。
如图1所示,惯性基准时空精确对准方法主要包括如下步骤:
步骤一、启动标定流程,判断当前周期T是否存在正常工作的星敏感器;当存在正常工作的星敏感器时,进入步骤二;否则退出标定流程;判断星敏感器是否正常工作的方法为:当该星敏感器的星敏基准模值为0.9-1.1时,认为该星敏感器正常工作;否则认为星敏感器为非正常工作。
步骤二、判导正常工作的星敏感器是否处于对火星探测器的姿态测量模式,当星敏感器处于对火星探测器的姿态测量模式时,进入步骤三;否则将正常工作的星敏感器切换至对火星探测器的姿态测量模式,进入步骤三;
步骤三、计算各星敏感器与火星探测器中的光学导航敏感器的姿态差xk;k为星敏感器序号;姿态差xk的计算方法为:分别求各星敏感器到光学导航敏感器的姿态四元数,即为各星敏感器与光学导航敏感器的姿态差。姿态差包括4个姿态分量。
步骤四、采用标定算法,对各星敏感器与光学导航敏感器的姿态差进行标定,得到各星敏感器的标定姿态差yk;标定姿态差yk的计算方法为:
式中,yk-1为上一周期该星敏感器与光学导航敏感器的标定姿态差;初始值为0;
τ为标定参数;τ为0.5;
T为采样周期。T为0.5s。
步骤五、判断各星敏感器的标定姿态差yk是否完成标定;各星敏感器的标定姿态差yk是否完成标定的判断方法为:
当在连续检测时长t内,连续检测时长t为10min。该星敏感器各周期的标定姿态差yk中的4个姿态分量的标准差均小于0.00001时,认为该星敏感器的标定姿态差yk完成标定。当该星敏感器的标定姿态差yk完成标定,结束该星敏感器与光学导航敏感器的姿态差标定工作;否则对该星敏感器继续进行姿态差标定。当该星敏感器的标定姿态差yk未完成标定时,延长连续检测时长t,重复步骤四至步骤五,对该星敏感器继续进行姿态差标定。
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
Claims (9)
1.一种光学导航敏感器的惯性基准时空精确对准方法,其特征在于:包括如下步骤:
步骤一、启动标定流程,判断当前周期T是否存在正常工作的星敏感器;当存在正常工作的星敏感器时,进入步骤二;否则退出标定流程;
步骤二、判导正常工作的星敏感器是否处于对火星探测器的姿态测量模式,当星敏感器处于对火星探测器的姿态测量模式时,进入步骤三;否则将正常工作的星敏感器切换至对火星探测器的姿态测量模式,进入步骤三;
步骤三、计算各星敏感器与火星探测器中的光学导航敏感器的姿态差xk;k为星敏感器序号;
步骤四、采用标定算法,对各星敏感器与光学导航敏感器的姿态差进行标定,得到各星敏感器的标定姿态差yk;
步骤五、判断各星敏感器的标定姿态差yk是否完成标定;当该星敏感器的标定姿态差yk完成标定,结束该星敏感器与光学导航敏感器的姿态差标定工作;否则对该星敏感器继续进行姿态差标定。
2.根据权利要求1所述的一种光学导航敏感器的惯性基准时空精确对准方法,其特征在于:所述步骤一中,判断星敏感器是否正常工作的方法为:
当该星敏感器的星敏基准模值为0.9-1.1时,认为该星敏感器正常工作;否则认为星敏感器为非正常工作。
3.根据权利要求2所述的一种光学导航敏感器的惯性基准时空精确对准方法,其特征在于:所述步骤三中,姿态差xk的计算方法为:
分别求各星敏感器到光学导航敏感器的姿态四元数,即为各星敏感器与光学导航敏感器的姿态差。
4.根据权利要求3所述的一种光学导航敏感器的惯性基准时空精确对准方法,其特征在于:所述姿态差包括4个姿态分量。
6.根据权利要求5所述的一种光学导航敏感器的惯性基准时空精确对准方法,其特征在于:所述τ为0.5;T为0.5s。
7.根据权利要求6所述的一种光学导航敏感器的惯性基准时空精确对准方法,其特征在于:所述步骤五中,各星敏感器的标定姿态差yk是否完成标定的判断方法为:
当在连续检测时长t内,该星敏感器各周期的标定姿态差yk中的4个姿态分量的标准差均小于0.00001时,认为该星敏感器的标定姿态差yk完成标定。
8.根据权利要求7所述的一种光学导航敏感器的惯性基准时空精确对准方法,其特征在于:所述连续检测时长t为10min。
9.根据权利要求8所述的一种光学导航敏感器的惯性基准时空精确对准方法,其特征在于:所述步骤五中,当该星敏感器的标定姿态差yk未完成标定时,延长连续检测时长t,重复步骤四至步骤五,对该星敏感器继续进行姿态差标定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010108610.9A CN111220179B (zh) | 2020-02-21 | 2020-02-21 | 一种光学导航敏感器的惯性基准时空精确对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010108610.9A CN111220179B (zh) | 2020-02-21 | 2020-02-21 | 一种光学导航敏感器的惯性基准时空精确对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111220179A true CN111220179A (zh) | 2020-06-02 |
CN111220179B CN111220179B (zh) | 2021-07-13 |
Family
ID=70807588
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010108610.9A Active CN111220179B (zh) | 2020-02-21 | 2020-02-21 | 一种光学导航敏感器的惯性基准时空精确对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111220179B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112882483A (zh) * | 2021-01-12 | 2021-06-01 | 北京控制工程研究所 | 星敏感器在轨标定方法、装置和存储介质 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102168981A (zh) * | 2011-01-13 | 2011-08-31 | 北京航空航天大学 | 一种深空探测器火星捕获段自主天文导航方法 |
CN102879011A (zh) * | 2012-09-21 | 2013-01-16 | 北京控制工程研究所 | 一种基于星敏感器辅助的月面惯导对准方法 |
JP2013101128A (ja) * | 2012-12-21 | 2013-05-23 | Canon Inc | 情報処理装置、情報処理方法 |
CN103674063A (zh) * | 2013-12-05 | 2014-03-26 | 中国资源卫星应用中心 | 一种光学遥感相机在轨几何定标方法 |
CN106124170A (zh) * | 2016-08-26 | 2016-11-16 | 上海航天控制技术研究所 | 一种基于高精度姿态信息的相机光轴指向计算方法 |
CN107367275A (zh) * | 2017-06-19 | 2017-11-21 | 北京控制工程研究所 | 一种高轨卫星自主导航敏感器 |
CN107389098A (zh) * | 2017-08-22 | 2017-11-24 | 长光卫星技术有限公司 | 一种航天器星敏感器安装矩阵在轨标定方法 |
CN107806887A (zh) * | 2017-09-22 | 2018-03-16 | 上海卫星工程研究所 | 火星导航敏感器安装误差在轨定标方法 |
CN109059936A (zh) * | 2018-07-09 | 2018-12-21 | 上海卫星工程研究所 | 基于安装矩阵修正的火星接近段光学导航数据解算方法 |
-
2020
- 2020-02-21 CN CN202010108610.9A patent/CN111220179B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102168981A (zh) * | 2011-01-13 | 2011-08-31 | 北京航空航天大学 | 一种深空探测器火星捕获段自主天文导航方法 |
CN102879011A (zh) * | 2012-09-21 | 2013-01-16 | 北京控制工程研究所 | 一种基于星敏感器辅助的月面惯导对准方法 |
JP2013101128A (ja) * | 2012-12-21 | 2013-05-23 | Canon Inc | 情報処理装置、情報処理方法 |
CN103674063A (zh) * | 2013-12-05 | 2014-03-26 | 中国资源卫星应用中心 | 一种光学遥感相机在轨几何定标方法 |
CN106124170A (zh) * | 2016-08-26 | 2016-11-16 | 上海航天控制技术研究所 | 一种基于高精度姿态信息的相机光轴指向计算方法 |
CN107367275A (zh) * | 2017-06-19 | 2017-11-21 | 北京控制工程研究所 | 一种高轨卫星自主导航敏感器 |
CN107389098A (zh) * | 2017-08-22 | 2017-11-24 | 长光卫星技术有限公司 | 一种航天器星敏感器安装矩阵在轨标定方法 |
CN107806887A (zh) * | 2017-09-22 | 2018-03-16 | 上海卫星工程研究所 | 火星导航敏感器安装误差在轨定标方法 |
CN109059936A (zh) * | 2018-07-09 | 2018-12-21 | 上海卫星工程研究所 | 基于安装矩阵修正的火星接近段光学导航数据解算方法 |
Non-Patent Citations (3)
Title |
---|
MI WANG等: "On-orbit calibration approach for optical navigation camera in deep space exploration", 《OPTICS EXPRESS》 * |
徐超等: "基于线性协方差分析的接近天体在轨导航方法研究", 《空间控制技术与应用》 * |
王密等: "火星探测巡航段与捕获段光学自主导航方案与关键技术", 《武汉大学学报(信息科学版)》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112882483A (zh) * | 2021-01-12 | 2021-06-01 | 北京控制工程研究所 | 星敏感器在轨标定方法、装置和存储介质 |
CN112882483B (zh) * | 2021-01-12 | 2022-03-04 | 北京控制工程研究所 | 星敏感器在轨标定方法、装置和存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN111220179B (zh) | 2021-07-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111149002B (zh) | 用于校准磁力计的方法 | |
US20210041236A1 (en) | Method and system for calibration of structural parameters and construction of affine coordinate system of vision measurement system | |
US7359817B2 (en) | Method of and device for re-calibrating three-dimensional visual sensor in robot system | |
KR101783050B1 (ko) | 3축 자계 센서의 교정 방법 및 장치 | |
EP3491334B1 (en) | Method and system for calibrating components of an inertial measurement unit (imu) using scene-captured data | |
US9857172B1 (en) | Method for implementing high-precision orientation and evaluating orientation precision of large-scale dynamic photogrammetry system | |
CN101918792B (zh) | 用于校准坐标测量装置的方法及其坐标测量机 | |
CN111307293B (zh) | 一种红外人体测温系统及其测温方法 | |
US20150279016A1 (en) | Image processing method and apparatus for calibrating depth of depth sensor | |
US20110001663A1 (en) | Position calculation method and position calculation apparatus | |
US10746819B2 (en) | Correcting field distortion in electromagnetic position tracking systems | |
US20160063703A1 (en) | Operating device, operating method, and program therefor | |
CN110044377B (zh) | 一种基于Vicon的IMU离线标定方法 | |
CN111220179B (zh) | 一种光学导航敏感器的惯性基准时空精确对准方法 | |
KR20070043009A (ko) | 센서 시스템의 2개의 모션 센서들 간의 회전 관계를교정하는 방법 및 장치 | |
CN111443337A (zh) | 一种基于手眼标定的雷达-imu标定方法 | |
CN110553667B (zh) | 一种对星敏感器进行热变形补偿的方法 | |
CN113029394B (zh) | 一种测温模块温度校准方法及系统 | |
CN109108982B (zh) | 基于标准量具的多关节机器人几何尺寸精度校准装置及校准方法 | |
CN111157081B (zh) | 一种电子式燃气表的校准方法 | |
CN102654515B (zh) | 三轴加速度传感器的z敏感轴的校准方法 | |
JP2853500B2 (ja) | 座標測定機の温度補正装置 | |
KR20120069429A (ko) | 프로젝터와 에피폴라 기하학을 기반으로 한 카메라의 방사 왜곡 보정 시스템과 그 방법 | |
CN110674888A (zh) | 一种基于数据融合的头部姿态识别方法 | |
CN107228683B (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 |