CN106441282B - 一种星敏感器星跟踪方法 - Google Patents
一种星敏感器星跟踪方法 Download PDFInfo
- Publication number
- CN106441282B CN106441282B CN201610830034.2A CN201610830034A CN106441282B CN 106441282 B CN106441282 B CN 106441282B CN 201610830034 A CN201610830034 A CN 201610830034A CN 106441282 B CN106441282 B CN 106441282B
- Authority
- CN
- China
- Prior art keywords
- star
- angular rate
- calculating
- vector
- tracking method
- 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 36
- 239000013598 vector Substances 0.000 claims abstract description 36
- 238000001914 filtration Methods 0.000 claims abstract description 9
- 238000005259 measurement Methods 0.000 claims description 15
- 230000007704 transition Effects 0.000 claims description 9
- 239000011159 matrix material Substances 0.000 claims description 6
- 238000003384 imaging method Methods 0.000 claims description 4
- 101000802640 Homo sapiens Lactosylceramide 4-alpha-galactosyltransferase Proteins 0.000 claims description 3
- 102100035838 Lactosylceramide 4-alpha-galactosyltransferase Human genes 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 239000013589 supplement Substances 0.000 abstract description 3
- 230000001133 acceleration Effects 0.000 description 4
- 238000011160 research Methods 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/02—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
- G01C21/025—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means with the use of startrackers
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Astronomy & Astrophysics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Image Analysis (AREA)
- Gyroscopes (AREA)
- Navigation (AREA)
Abstract
一种星敏感器星跟踪方法,先进行角速率估计,在进行角速率滤波,然后进行星矢量预测,接着将星矢量转化为星点,最后在以预测星点为中心的波门中提取星点。本发明不依赖姿态信息,只需要对每一帧的星点的星矢量进行整体建模,由星矢量及星敏感器参数得到星点预测值,模型简单,计算量小,易于实现,可直接基于恒星矢量差分计算角速率,进行恒星矢量递推,进而实现星跟踪,有别于已有的基于四元数差分计算角速率和递推并且利用导航星表的星跟踪方法,可作为现有星跟踪方法的有效补充。
Description
技术领域
本发明涉及一种星敏感器星跟踪方法,尤其涉及一种基于恒星矢量差分的星敏感器星跟踪方法。
背景技术
星敏感器是当前精度最高的姿态敏感器,在卫星姿态确定中被广泛运用。在全天捕获成功后,星敏感器主要工作在星跟踪模式。星跟踪方法中首先进行星点预测,以预测的星点位置为中心形成一定大小的波门,图像处理软件在该波门中提取星点位置信息,显著减小了图像处理的时间,提高了方法效率。当星点预测误差大时,波门必须相应增大,一方面增加了计算量,另一方面由于波门内包含虚假目标的概率增大,星点提取方法误识别的可能性也增大,所以提高星点预测精度十分重要。
星点预测方法分为两类,一类是利用外部信息的星点预测方法,包括姿态信息,星图信息,这类方法的研究已经比较充分。主流方法是利用当前帧和前一帧的瞬时姿态预测下一帧的姿态,根据预测的姿态和星表信息计算出下一帧的星点信息。有些方法还使用了陀螺输出的角加速度积分推算下一时刻的星敏姿态信息,再利用该姿态信息和星表信息计算出下一帧的星点信息。此方法除了姿态信息外还依赖陀螺的角加速度信息。第二类方法不依赖外部信息进行星点预测,此类方法的研究较少,主要是星点运动轨迹建模。这类方法专注于对星点轨迹的建模,在自主星跟踪的同时滤除星点成像瞬时噪声。该方法存在两个不足之处:第一,在对星点轨迹的建模中需要星点机动频率和随机加速度方差等难以得到的先验信息,事实上在探测器不同位置,星轨迹的形态并不相同,星点加速度并不一样,这在在大视场星敏感器和多头星敏感器中尤为明显,所以难以对所有的星轨迹精确建模;第二,对于每一颗恒星在探测器上的轨迹要在x方向和y方向分别建立三维运动模型,在该模型的基础上进行星点预测和滤波,实际运用中平均每帧星图要利用15颗星点进行定姿,所以要对15条星轨迹模型分别进行递推和滤波,计算量大。
发明内容
本发明提供一种星敏感器星跟踪方法,不依赖姿态信息,只需要对每一帧的星点的星矢量进行整体建模,由星矢量及星敏感器参数得到星点预测值,模型简单,计算量小,易于实现。
为了达到上述目的,本发明提供一种星敏感器星跟踪方法,包含以下步骤:
步骤S1、角速率估计;
步骤S2、角速率滤波;
步骤S3、星矢量预测;
步骤S4、星矢量转化为星点;
步骤S5、在以预测星点为中心的波门中提取星点。
所述的步骤S1具体包含以下步骤:
由当前时刻k提取的n颗跟踪恒星的星点信息计算得到n个帧的星矢量:
其中,(xi(k),yi(k))为k时刻第i颗星在星敏探测器上的成像点坐标,(x0,y0)为星敏感器主点坐标,f为星敏感器焦距;
根据当前帧和上一帧的星矢量计算角速率估计值
其中,
所述的步骤S2具体包含以下步骤:
将角速率估计值作为当前角速率测量值Z(k)输入卡尔曼滤波器,得到角速率滤波值ω(k);
步骤S2.1、计算角速率测量值:
步骤S2.2、根据上一帧的角速率估计值进行地面标定,得到角速率与测量误差的关系,从而计算得到测量误差方差σ;;
步骤S2.3、计算测量噪声的方差R(k):
其中,
步骤S2.4、计算系统转移误差:
P(k|k-1)=P(k-1)+Q (8)
步骤S2.5、计算卡尔曼滤波器的增益:
Kg(k)=P(k|k-1)/(P(k|k-1)+R(k)) (9)
步骤S2.6、计算角速率滤波值ω(k):
ω(k)=ω(k-1)+Kg(k)(Z(k)-ω(k-1)) (10)
步骤S2.7、计算协方差阵的更新值P(k):
P(k)=(I-Kg(k))P(k|k-1) (11)。
所述的步骤S2中,卡尔曼滤波器的状态方程为:
ω(k|k-1)=ω(k-1)+u(k) (4)
其中,u(k)是状态转移噪声;
卡尔曼滤波器的状态转移方程为:
Z(k)=ω(k)+v(k) (5)
其中,v(k)是测量噪声;
卡尔曼滤波器的初始状态为:角速率ω(0)=[0;0;0],初始协方差阵P(0)=I3*3,测量噪声方差初始值R(0)=I3*3,状态转移噪声的方差Q=0.001I3×3。
所述的步骤S3包含以下步骤:
根据角速率滤波值ω(k)以及当前帧的星矢量计算下一帧星矢量的预测值:
si(k+1)=Δt*[si(k)×]ω(k)+si(k) (12)。
所述的步骤S4包含以下步骤:
根据星矢量预测值和星敏感器内方位元素(f,x0,y0)计算下一帧的星点位置:
s=si(k+1)
xi(k+1)=-f·s(1)/s(3)+x0 (13)。
yi(k+1)=-f·s(2)/s(3)+y0
本发明可直接基于恒星矢量差分计算角速率,进行恒星矢量递推,进而实现星跟踪,有别于已有的基于四元数差分计算角速率和递推并且利用导航星表的星跟踪方法,可作为现有星跟踪方法的有效补充。
附图说明
图1是本发明提供的一种星敏感器星跟踪方法的流程图。
具体实施方式
以下根据图1具体说明本发明的较佳实施例。
如图1所示,本发明提供一种星敏感器星跟踪方法,包含以下步骤:
步骤S1、角速率估计;
由当前时刻k提取的n颗跟踪恒星的星点信息计算得到n个帧的星矢量:
其中,(xi(k),yi(k))为k时刻第i颗星在星敏探测器上的成像点坐标,(x0,y0)为星敏感器主点坐标,f为星敏感器焦距;
根据当前帧和上一帧的星矢量计算角速率估计值
其中,
步骤S2、角速率滤波;
将角速率估计值作为当前角速率测量值Z(k)输入卡尔曼滤波器,得到角速率滤波值ω(k);
卡尔曼滤波器的状态方程为:
ω(k|k-1)=ω(k-1)+u(k) (4)
其中,u(k)是状态转移噪声;
卡尔曼滤波器的状态转移方程为:
Z(k)=ω(k)+v(k) (5)
其中,v(k)是测量噪声;
卡尔曼滤波器的初始状态为:角速率ω(0)=[0;0;0],初始协方差阵P(0)=I3*3,测量噪声方差初始值R(0)=I3*3,状态转移噪声的方差Q=0.001I3×3;
步骤S2.1、计算角速率测量值:
步骤S2.2、根据上一帧的角速率估计值进行地面标定,得到角速率与测量误差的关系,从而计算得到测量误差方差σ;
步骤S2.3、计算测量噪声的方差R(k):
其中,
步骤S2.4、计算系统转移误差:
P(k|k-1)=P(k-1)+Q (8)
步骤S2.5、计算卡尔曼滤波器的增益:
Kg(k)=P(k|k-1)/(P(k|k-1)+R(k)) (9)
步骤S2.6、计算角速率滤波值ω(k):
ω(k)=ω(k-1)+Kg(k)(Z(k)-ω(k-1)) (10)
步骤S2.7、计算协方差阵的更新值P(k):
P(k)=(I-Kg(k))P(k|k-1) (11)
步骤S3、星矢量预测;
根据角速率滤波值ω(k)以及当前帧的星矢量计算下一帧星矢量的预测值:
si(k+1)=Δt*[si(k)×]ω(k)+si(k) (12)
步骤S4、星矢量转化为星点;
根据星矢量预测值和星敏感器内方位元素(f,x0,y0)计算下一帧的星点位置(即为星点预测值):
s=si(k+1)
xi(k+1)=-f·s(1)/s(3)+x0 (13)
yi(k+1)=-f·s(2)/s(3)+y0
步骤S5、在以预测星点为中心的波门中提取星点。
本发明不依赖姿态信息,只需要对每一帧的星点的星矢量进行整体建模,由星矢量及星敏感器参数得到星点预测值,模型简单,计算量小,易于实现,可直接基于恒星矢量差分计算角速率,进行恒星矢量递推,进而实现星跟踪,有别于已有的基于四元数差分计算角速率和递推并且利用导航星表的星跟踪方法,可作为现有星跟踪方法的有效补充。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (6)
1.一种星敏感器星跟踪方法,其特征在于,包含以下步骤:
步骤S1、角速率估计;
步骤S2、角速率滤波;
步骤S3、星矢量预测;
步骤S4、星矢量转化为星点;
步骤S5、在以预测星点为中心的波门中提取星点。
2.如权利要求1所述的星敏感器星跟踪方法,其特征在于,所述的步骤S1具体包含以下步骤:
由当前时刻k提取的n颗跟踪恒星的星点信息计算得到n个帧的星矢量:
其中,(xi(k),yi(k))为k时刻第i颗星在星敏感器上的成像点坐标,(x0,y0)为星敏感器主点坐标,f为星敏感器焦距;
根据当前帧和上一帧的星矢量计算角速率估计值
r=si(k-1)
其中,
3.如权利要求2所述的星敏感器星跟踪方法,其特征在于,所述的步骤S2具体包含以下步骤:
将角速率估计值作为当前角速率测量值Z(k)输入卡尔曼滤波器,得到角速率滤波值ω(k);
步骤S2.1、计算角速率测量值:
步骤S2.2、根据上一帧的角速率估计值进行地面标定,得到角速率与测量误差的关系,从而计算得到测量误差方差σ;
步骤S2.3、计算测量噪声的方差R(k):
其中,
步骤S2.4、计算系统转移误差:
P(k|k-1)=P(k-1)+Q (8)
步骤S2.5、计算卡尔曼滤波器的增益:
Kg(k)=P(k|k-1)/(P(k|k-1)+R(k)) (9)
步骤S2.6、计算角速率滤波值ω(k):
ω(k)=ω(k-1)+Kg(k)(Z(k)-ω(k-1)) (10)
步骤S2.7、计算协方差阵的更新值P(k):
P(k)=(I-Kg(k))P(k|k-1) (11)。
4.如权利要求3所述的星敏感器星跟踪方法,其特征在于,所述的步骤S2中,卡尔曼滤波器的状态方程为:
ω(k|k-1)=ω(k-1)+u(k) (4)
其中,u(k)是状态转移噪声;
卡尔曼滤波器的状态转移方程为:
Z(k)=ω(k)+v(k) (5)
其中,v(k)是测量噪声;
卡尔曼滤波器的初始状态为:角速率ω(0)=[0;0;0],初始协方差阵P(0)=I3*3,测量噪声方差初始值R(0)=I3*3,状态转移噪声的方差Q=0.001I3×3。
5.如权利要求4所述的星敏感器星跟踪方法,其特征在于,所述的步骤S3包含以下步骤:
根据角速率滤波值ω(k)以及当前帧的星矢量计算下一帧星矢量的预测值:
si(k+1)=Δt*[si(k)×]ω(k)+si(k) (12)。
6.如权利要求5所述的星敏感器星跟踪方法,其特征在于,所述的步骤S4包含以下步骤:
根据星矢量预测值和星敏感器内方位元素(f,x0,y0)计算下一帧的星点位置:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610830034.2A CN106441282B (zh) | 2016-09-19 | 2016-09-19 | 一种星敏感器星跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610830034.2A CN106441282B (zh) | 2016-09-19 | 2016-09-19 | 一种星敏感器星跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106441282A CN106441282A (zh) | 2017-02-22 |
CN106441282B true CN106441282B (zh) | 2019-07-09 |
Family
ID=58168643
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610830034.2A Active CN106441282B (zh) | 2016-09-19 | 2016-09-19 | 一种星敏感器星跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106441282B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107507123B (zh) * | 2017-06-20 | 2018-10-02 | 上海航天控制技术研究所 | 星敏感器快速波门图像处理系统及方法 |
CN109682369A (zh) * | 2018-12-13 | 2019-04-26 | 上海航天控制技术研究所 | 基于异步曝光的高精度星敏感器数据融合方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101435704B (zh) * | 2008-12-04 | 2010-06-16 | 哈尔滨工业大学 | 一种星敏感器高动态下的星跟踪方法 |
CN102288175B (zh) * | 2011-05-10 | 2012-11-28 | 哈尔滨工业大学 | 一种适用于星敏感器的自主预报方法 |
CN102435763B (zh) * | 2011-09-16 | 2013-10-09 | 中国人民解放军国防科学技术大学 | 一种基于星敏感器的航天器姿态角速度测量方法 |
US9073648B2 (en) * | 2013-02-15 | 2015-07-07 | The Boeing Company | Star tracker rate estimation with kalman filter enhancement |
CN103217544B (zh) * | 2013-03-21 | 2015-06-03 | 上海新跃仪表厂 | 用星敏感器星点位置变化估算星体角速度的方法及系统 |
CN103674023B (zh) * | 2013-12-26 | 2014-10-15 | 中国人民解放军国防科学技术大学 | 一种基于陀螺精确角度关联的星敏感器动态测姿方法 |
-
2016
- 2016-09-19 CN CN201610830034.2A patent/CN106441282B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN106441282A (zh) | 2017-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109991636B (zh) | 基于gps、imu以及双目视觉的地图构建方法及系统 | |
Panahandeh et al. | Vision-aided inertial navigation based on ground plane feature detection | |
JP5838758B2 (ja) | キャリブレーション方法、情報処理装置及びキャリブレーションプログラム | |
US10247556B2 (en) | Method for processing feature measurements in vision-aided inertial navigation | |
CN105953796A (zh) | 智能手机单目和imu融合的稳定运动跟踪方法和装置 | |
KR102226846B1 (ko) | Imu 센서와 카메라를 이용한 하이브리드 실내 측위 시스템 | |
CN108036785A (zh) | 一种基于直接法与惯导融合的飞行器位姿估计方法 | |
US11181379B2 (en) | System and method for enhancing non-inertial tracking system with inertial constraints | |
CN109059907B (zh) | 轨迹数据处理方法、装置、计算机设备和存储介质 | |
CN107490378B (zh) | 一种基于mpu6050与智能手机的室内定位与导航的方法 | |
CN112815939B (zh) | 移动机器人的位姿估计方法及计算机可读存储介质 | |
US20180075614A1 (en) | Method of Depth Estimation Using a Camera and Inertial Sensor | |
CN111723624B (zh) | 一种头部运动跟踪方法和系统 | |
Zhang et al. | Vision-aided localization for ground robots | |
KR101985344B1 (ko) | 관성 및 단일 광학 센서를 이용한 슬라이딩 윈도우 기반 비-구조 위치 인식 방법, 이를 수행하기 위한 기록 매체 및 장치 | |
KR101737950B1 (ko) | 지형참조항법에서 영상 기반 항법해 추정 시스템 및 방법 | |
CN107990901B (zh) | 一种基于传感器的用户方向定位方法 | |
CN107402005A (zh) | 一种基于惯性/里程计/rfid的高精度组合导航方法 | |
WO2016198933A1 (en) | Determining sensor orientation in indoor navigation | |
CN107942090B (zh) | 一种基于模糊星图提取光流信息的航天器角速度估计方法 | |
CN113763549A (zh) | 融合激光雷达和imu的同时定位建图方法、装置和存储介质 | |
EP3227634B1 (en) | Method and system for estimating relative angle between headings | |
JP2014240266A (ja) | センサドリフト量推定装置及びプログラム | |
CN106441282B (zh) | 一种星敏感器星跟踪方法 | |
WO2016165336A1 (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |