CN106052678A - 一种聚合式星敏感器及其卫星姿态确定方法 - Google Patents

一种聚合式星敏感器及其卫星姿态确定方法 Download PDF

Info

Publication number
CN106052678A
CN106052678A CN201610346316.5A CN201610346316A CN106052678A CN 106052678 A CN106052678 A CN 106052678A CN 201610346316 A CN201610346316 A CN 201610346316A CN 106052678 A CN106052678 A CN 106052678A
Authority
CN
China
Prior art keywords
attitude
node
value
micro
matrix
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
Application number
CN201610346316.5A
Other languages
English (en)
Other versions
CN106052678B (zh
Inventor
张南
范春石
孟子阳
刘晓韵
王晓初
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China Academy of Space Technology CAST
Original Assignee
China Academy of Space Technology CAST
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by China Academy of Space Technology CAST filed Critical China Academy of Space Technology CAST
Priority to CN201610346316.5A priority Critical patent/CN106052678B/zh
Publication of CN106052678A publication Critical patent/CN106052678A/zh
Application granted granted Critical
Publication of CN106052678B publication Critical patent/CN106052678B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/02Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Astronomy & Astrophysics (AREA)
  • Navigation (AREA)
  • Gyroscopes (AREA)

Abstract

本发明公开了一种聚合式微型星敏感器及一种基于四元数估计和聚合式微型星敏感器的卫星姿态确定方法;一种聚合式微型星敏感器,包括至少一个微型星敏感器单元,微型星敏感器单元至少为四面体结构,包括一个孔径面(3),其余面均为接口面(4),接口面(4)相互呈非90°夹角;光学系统(1)和遮光罩位于孔径面(3)中部;微型星敏感器单元之间、微型星敏感器单元与卫星之间通过机械接口(6)连接;微型光学系统(1)、陀螺(2)均与电信接口(5)连接,与外界进行数据通信并获得供电。本发明使用多个低成本分布式微型敏感单元,通过网络互联与信息交互融合,实现聚弱成强,获得增强的姿态确定精度,并且增加了系统鲁棒性。

Description

一种聚合式星敏感器及其卫星姿态确定方法
技术领域
本发明涉及一种聚合式星敏感器以及一种卫星姿态确定方法。
背景技术
随着智能微系统技术的发展,作为导航系统基本配置的星敏感器和陀螺仪日益实现微小型化。目前,基于星敏感器-陀螺的姿态敏感系统质量已经从常规系统的数公斤降低到百克级,能够装配在<5kg级别的微纳卫星上,并且有望支持小批量量产,实现低成本的姿态测定,其精度大大优于目前微纳卫星常用的磁强计-太阳敏姿态敏感系统。
2005年开始提出了一种集成了星敏感器和陀螺于一体的设备,极大的有利于卫星的小型化。瑞尔森大学课题“Custom Optics vs Modified COTS for Small Spacecraft”,提出了一种高集成度的微型星敏感器。然而,这种微型星敏感器的精度(典型值<0.3°)与常规星敏感器的精度(典型值<10″)相比尚较低。而且不支持拼接组网,无法实现高精度数据获取。
为实现增强的任务能力,需要发展一种新型的星敏感器,一方面能够继承微型星敏感器的低成本小型化优势,另一方面能够实现更高的姿态确定精度。
发明内容
本发明所要解决的技术问题是:克服现有技术的不足,本发明公开了一种聚合式微型星敏感器及一种基于四元数估计和聚合式微型星敏感器的卫星姿态确定方法,使用多个低成本分布式微型敏感单元,通过网络互联与信息交互融合,实现聚弱成强,获得增强的姿态确定精度,并且增加了系统鲁棒性。
本发明所采用的技术方案是:一种聚合式微型星敏感器,包括至少两个微型星敏感器单元,微型星敏感器单元包括光学系统、陀螺、孔径面、接口面;微型星敏感器单元为N面体结构,N大于等于4,包括一个孔径面,其余面均为接口面,接口面相互呈非90°夹角;光学系统位于孔径面中部,安装在微型星敏感器单元内部;接口面上布置有至少一个电信接口和至少一个机械接口,陀螺安装在微型星敏感器单元内;微型星敏感器单元之间、微型星敏感器单元与卫星之间通过机械接口连接;各微型星敏感器单元中的光学系统、陀螺均通过电信接口与外界进行数据通信并获得供电。
所述的N=10,孔径面为正方形,四个长方形的接口面分别与孔径面四个边连接形成长方体结构,另五个梯形的接口面形成梯形锥台,梯形锥台倒置后底面与长方体结构相连,形成十面体结构。
一种基于四元数估计和聚合式微型星敏感器的卫星姿态确定方法,包括步骤如下:
I.获得节点i的姿态四元数测量值经过滤波处理,得到节点i的姿态估计值获得节点j的姿态四元数测量值经过滤波处理,得到节点j的姿态估计值
其中,节点j、节点i分别为独立的微型星敏感器单元,i为正整数,j为正整数,i≠j;k为离散时间,k为非负整数,ξ为姿态四元数一致性迭代次数,ξ为正整数;
II.对节点i的姿态估计值与节点j的姿态估计值进行一致性处理,获得节点i的姿态估计值与节点j的姿态估计值的姿态信息差值
III.将节点i与除节点i外的其他全部节点的姿态信息差值δk(j,ξ)叠加获得姿态信息差值修正值ρk(i,ξ):其中,dk为调谐参数,aij,k(i,j)为临近矩阵,δk(j,ξ)为的矢量部分;dk=n,n为节点个数,为正整数;如果节点i和节点j能连通,aij,k(i,j)=1;如果节点i和节点j不能连通,aij,k(i,j)=0;
IV.使用节点i姿态信息差值修正值ρk(i,ξ)修正节点i的姿态估计值获得节点i修正后的四元数估计值 q ^ k ( i , &xi; + 1 ) = q ^ k ( i , &xi; ) &CircleTimes; &lsqb; q ( &rho; k ( i , &xi; ) ) &rsqb; - 1 ;
V.重复步骤I到步骤IV得到各节点第ξ+1次迭代后的姿态四元数估计值
VI.重复步骤I到步骤V,ξ=l时,得到各节点在经过l次一致性处理后的姿态四元数估计值其中,l为正整数;
VII.将步骤VI得到的节点i的经过l次一致性处理后的姿态四元数估计值进行滤波处理,并根据滤波结果得到陀螺漂移估计值 通过公式得到节点i的角速度估计值
其中,为陀螺的角速度测量值, 为陀螺漂移一步状态更新矩阵,Δbk(i)为陀螺漂移误差矩阵,为k-1时刻的陀螺漂移估计值;δρk(i)为的矢量部分;为增益矩阵, 为姿态四元数一步状态更新矩阵,Φk-1(i)为姿态四元数状态转移矩阵,为在k-1时刻节点i的经过l次一致性处理后的姿态四元数估计值;
VIII.重复步骤VII,获得各节点的角速度估计值
IX.对各节点的角速度估计值进行一致性处理,得到各节点经过一致性处理后的角速度估计值 n为节点个数,为正整数,选取某节点的经过一致性处理后的角速度估计值作为最终的卫星角速度估计值;
X.选取某节点的经过l次一致性处理后的姿态四元数估计值作为最终的卫星姿态四元数估计值,利用最终的姿态四元数估计值和最终的角速度估计值确定卫星姿态。
所述的滤波处理为乘性扩展卡尔曼滤波处理,包括步骤如下:
i、通过状态转移矩阵将k-1时刻的状态量估计值包括姿态四元数估计值和陀螺漂移估计值传播到k时刻得到一步状态更新矩阵
其中,Φk-1为姿态四元数状态转移矩阵;为姿态四元数一步状态更新矩阵、为陀螺漂移一步状态更新矩阵;
ii、通过乘性测量新息矩阵Zk对步骤i中得到的进行状态更新,得到k时刻的姿态四元数估计值陀螺漂移估计值
q ^ k b ^ k = q ^ k / k - 1 &CircleTimes; &delta;q k b ^ k / k - 1 + &Delta;b k
其中,δqk为Ka,z·Zk的矢量部分,Δbk=Kb,z·Zk,Zk的矢量部分,为k时刻的姿态四元数测量值,为卡尔曼增益矩阵。
所述微型星敏感器单元包括光学系统、陀螺、孔径面、接口面;微型星敏感器单元为N面体结构,N大于等于4,包括一个孔径面,其余面均为接口面,接口面相互呈非90°夹角;光学系统和遮光罩位于孔径面中部,安装在微型星敏感器单元壳体内,光学系统的镜头上安装遮光罩;接口面上布置有至少一个电信接口和至少一个机械接口,陀螺安装在微型星敏感器单元内;微型星敏感器单元之间、微型星敏感器单元与卫星之间通过机械接口连接;各微型星敏感器单元中的光学系统、陀螺均通过电信接口与外界进行数据通信并获得供电。
所述的N=10,孔径面为正方形,四个长方形的接口面分别与孔径面四个边连接形成长方体结构,另五个梯形的接口面形成梯形锥台,梯形锥台倒置后底面与长方体结构相连,形成十面体结构。
本发明与现有技术相比的优点在于:
(1)本发明的每个微型星敏感器单元具有独立获取数据能力,使用网络化的方式提高数据精度,部分微型星敏感器单元失效,仍有其他微型星敏感器单元可正常工作,整个网络的有效性能得到保证,提高了系统的鲁棒性。
(2)本发明的微型星敏感器单元可以任意拼接组合组成聚合式星敏感器,聚合式星敏感器网络具有更高布局灵活性,同时便于实现微型星敏感器单元数量的增减,标准化敏感单元可批量量产,具有一定成本优势。
(3)本发明具有多角度视场的聚合式星敏感器网络,具有更好对日、地、月视场遮挡的鲁棒性,采用阵列式的星敏感单元聚合体,与同等精度的单体星敏感器相比,所需要的遮光罩和光学系统尺寸大大降低,可实现紧凑的扁平化结构。
(4)本发明的方法提出的基于乘性四元数的一致性处理方法,有效克服数值计算问题,并且解决了陀螺漂移这个无法直接观测的局部参数对角速度以及姿态四元数的估计带来的影响。
(5)本发明提出的卫星姿态确定方法与不具有网络信息交互的孤立节点姿态滤波方法相比,如经典MEKF滤波姿态确定方法,具有更快的估计收敛速度和更好的稳态估计精度。
附图说明
图1为本发明聚合式星敏感器微型敏感单元示意图;
图2为本发明聚合式星敏感器网络示意图;
图3为本发明多个微型星敏感器单元的阵列式聚合体布局示意图;
图4为本发明多个微型星敏感器单元的多视场聚合体布局示意图;
图5为本发明基于乘性扩展卡尔曼滤波和聚合式微型星敏感器的卫星姿态确定方法流程图。
具体实施方式
下面对本发明的具体实施方式进行进一步的详细描述。
本发明公开了一种聚合式微型星敏感器,包括至少两个微型星敏感器单元,微型星敏感器单元包括光学系统1、陀螺2、孔径面3、接口面4;微型星敏感器单元为N面体结构,N大于等于4,包括一个孔径面3,其余面均为接口面4,接口面4相互呈非90°夹角,使微型星敏感器单元可以按不同角度安装。
光学系统1和遮光罩位于孔径面3中部,安装在微型星敏感器单元壳体内,孔径面3作为星敏感器的视窗,光学系统1的镜头上可以集成遮光罩。接口面4上布置有数个电信接口5及机械接口6,机械接口6用于与另外一个微型星敏感器单元拼接,电信接口5用于给微型星敏感器单元供电并负责通信;陀螺2安装在微型星敏感器单元内。微型星敏感器单元之间、微型星敏感器单元与卫星之间通过接口面4实现连接。光学系统1镜头通过孔径面3取得视场,各微型星敏感器单元中的光学系统1、陀螺2均通过电信接口5与外界进行数据通信并获得供电。
在本实施例中,如图1所示,微型星敏感器单元有10个面,孔径面3为正方形,四个长方形的接口面4分别与孔径面3四个边连接形成长方体结构,另五个梯形的接口面4形成梯形锥台,梯形锥台倒置后底面与长方体结构相连,形成十面体结构。
两个微型星敏感单元的任意两个接口面4,都可以通过机械接口6快速对装实现互连,组成聚合式微型星敏感器。也可以通过接口面4机械接口6将微型星敏感单元安装集成到卫星结构上。电信接口5可以用来支持聚合式微型星敏感器网络的数据通信。多个微型星敏感单元构成的聚合式微型星敏感器网络,每个节点为一个微型星敏感器单元,相邻的节点的连接是两个微型星敏感单元通过电信接口5连接通信。每个节点都具有独立获取数据及处理数据的能力,多个节点的获取的姿态数据,通过网络进行数据融合处理,分析姿态的一致性即可得到增强精度的数据。
微型星敏感器单元具备一个独立的星敏感器-陀螺的姿态敏感系统功能。可以单独工作获取姿态数据,但主要优势在于多个微型星敏感器单元组成聚合式微型星敏感器网络,获取高精度的姿态数据。如图2所示,敏感器网络上的每个节点为一个微型星敏感器单元,通过电信接口5相互连接通信。这种工作方式可以获取高精度的姿态数据,同时提高系统的鲁棒性,且结构灵活多变。例如,可以拼接成具有多角度视场的聚合式微型星敏感器,如图4所示,提高对日、地、月视场遮挡的鲁棒性。也可以将多个微型星敏感器单元拼接成阵列,如图3,与同等精度的单体星敏感器相比,所需要的遮光罩和光学系统尺寸大大降低,可实现扁平化的结构。
针对聚合式微型星敏感器网络的工作方式,本发明提供一种基于乘性扩展卡尔曼滤波和聚合式微型星敏感器的卫星姿态确定方法,如图5所示。这种方法将陀螺的角速度估计和星敏感器的姿态四元数估计分步进行,以解决在一致性处理中对陀螺漂移处理和角速度的一致性更新处理与姿态四元数的一致性更新处理是不同步,导致对姿态估计的偏差的问题。聚合式星敏感器网络中每个节点都有独立跟踪恒星遥感和嵌入式处理能力,每个节点首先独立进行乘性扩展卡尔曼滤波(MEKF)估计自身姿态数据,然后进行一致性处理。即每个节点信息可以通过网络通信来共享融合,与可以交换数据的所有节点做比较,修正自身姿态信息。叠加多次一致性处理结果之后获取高精度的四元数姿态数据。然后把获得的高精度四元数姿态数据再进行测量更新处理获得角速度数据,并进行一致性处理,从而获取高精度角速度数据。
乘性扩展卡尔曼滤波(MEKF)简介如下:
经典的扩展卡尔曼滤波(EKF)对于误差状态和误差协方差矩阵的计算是加性的,而姿态四元数受到模为1的限制,EKF对于姿态四元数的估计问题不适用,因此在本文提出的方法中,使用乘性扩展卡尔曼滤波(MEKF),以解决状态估计问题,获得姿态四元数陀螺漂移量和角速度估计值步骤如下:
(1)状态传播:通过状态转移矩阵将k-1时刻的状态量估计值包括姿态四元数估计值和陀螺漂移估计值传播到k时刻得到一步状态更新矩阵
其中,Φk-1为姿态四元数状态转移矩阵;为姿态四元数一步状态更新矩阵、为陀螺漂移一步状态更新矩阵;
(2)测量更新,在步骤(2)中得到的的基础上,通过乘性测量新息矩阵Zk进行测量更新,得到k时刻的姿态四元数估计值陀螺漂移估计值
q ^ k b ^ k = q ^ k / k - 1 &CircleTimes; &delta;q k b ^ k / k - 1 + &Delta;b k
其中,δqk为Ka,z·Zk的矢量部分,Δbk=Kb,z·Zk,Zk的矢量部分,为星敏感器的k时刻的姿态四元数测量值,为卡尔曼增益矩阵。
一种基于乘性扩展卡尔曼滤波和聚合式微型星敏感器的卫星姿态确定方法,具体步骤如下:
(1)获得节点i的姿态四元数测量值经过乘性扩展卡尔曼滤波(MEKF)处理,得到节点i的姿态估计值获得节点j的姿态四元数测量值经过乘性扩展卡尔曼滤波(MEKF)处理,得到节点j的姿态估计值其中,节点j、节点i分别为独立的微型星敏感器单元,i为正整数,j为正整数,i≠j;k为非负整数,ξ为姿态四元数一致性迭代次数,ξ为正整数;
(2)对节点i的姿态估计值与节点j的姿态估计值进行一致性处理,获得节点i的姿态估计值与节点j的姿态估计值的姿态信息差值
(3)将节点i与其他全部节点的姿态信息差值δk(j,ξ)叠加获得姿态信息差值修正值ρk(i,ξ):
其中,dk为调谐参数,aij,k(i,j)为临近矩阵,δk(j,ξ)为的矢量部分;dk=n,n为节点个数,为正整数;如果节点i和节点j能连通,aij,k(i,j)=1;如果节点i和节点j不能连通,aij,k(i,j)=0;
(4)使用节点i姿态信息差值修正值ρk(i,ξ)修正节点i的姿态估计值获得节点i修正后的四元数估计值
q ^ k ( i , &xi; + 1 ) = q ^ k ( i , &xi; ) &CircleTimes; &lsqb; q ( &rho; k ( i , &xi; ) ) &rsqb; - 1 ;
(5)重复步骤(1)到步骤(4)得到各节点第ξ+1次迭代后的姿态四元数估计值
(6)重复步骤(1)到步骤(5),进行多次一致性处理,叠加l次之后,即ξ=l时,l为正整数,得到各节点在经过l次一致性处理后的姿态四元数估计值
(7)将步骤(6)得到的节点i的姿态四元数估计值进行乘性扩展卡尔曼滤波(MEKF)处理得到陀螺漂移估计值 通过得到节点i的角速度估计值
其中,为陀螺的角速度测量值, 为陀螺漂移一步状态更新矩阵,Δbk(i)为陀螺漂移误差矩阵,为k-1时刻的陀螺漂移估计值;δρk(i)为的矢量部分;为增益矩阵, 为姿态四元数一步状态更新矩阵,Φk-1(i)为姿态四元数状态转移矩阵,为在k-1时刻节点i的经过l次一致性处理后的姿态四元数估计值;
(8)重复步骤(7),获得各节点的陀螺漂移估计值和角速度估计值
(9)对节点i的角速度估计值进行一致性处理,得到节点i的高精度角速度估计值n为节点个数,为正整数;
&omega; ^ k C ( i ) = 1 n &Sigma; i = 1 n &omega; ^ k ( i )
(10)重复步骤(9),获得所有节点的高精度角速度估计值各节点的角速度估计值会趋于一致,选取某节点的高精度角速度估计值作为最终的卫星角速度估计值;
(11)选取某节点的经过l次一致性处理后的姿态四元数估计值作为最终的卫星姿态四元数估计值,利用最终的姿态四元数估计值和最终的角速度估计值确定卫星姿态。
经过仿真验证表明,本发明能够使用多个低精度星敏感器组网实现高精度的姿态估计,有效地保障了卫星姿态控制操作的准确性。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。

Claims (6)

1.一种聚合式微型星敏感器,其特征在于,包括至少两个微型星敏感器单元,微型星敏感器单元包括光学系统(1)、陀螺(2)、孔径面(3)、接口面(4);微型星敏感器单元为N面体结构,N大于等于4,包括一个孔径面(3),其余面均为接口面(4),接口面(4)相互呈非90°夹角;光学系统(1)位于孔径面(3)中部,安装在微型星敏感器单元内部;接口面(4)上布置有至少一个电信接口(5)和至少一个机械接口(6),陀螺(2)安装在微型星敏感器单元内;微型星敏感器单元之间、微型星敏感器单元与卫星之间通过机械接口(6)连接;各微型星敏感器单元中的光学系统(1)、陀螺(2)均通过电信接口(5)与外界进行数据通信并获得供电。
2.根据权利要求1所述的一种聚合式微型星敏感器,其特征在于:所述的N=10,孔径面(3)为正方形,四个长方形的接口面(4)分别与孔径面(3)四个边连接形成长方体结构,另五个梯形的接口面(4)形成梯形锥台,梯形锥台倒置后底面与长方体结构相连,形成十面体结构。
3.一种基于四元数估计和聚合式微型星敏感器的卫星姿态确定方法,其特征在于,包括步骤如下:
I.获得节点i的姿态四元数测量值经过滤波处理,得到节点i的姿态估计值获得节点j的姿态四元数测量值经过滤波处理,得到节点j的姿态估计值
其中,节点j、节点i分别为独立的微型星敏感器单元,i为正整数,j为正整数,i≠j;k为离散时间,k为非负整数,ξ为姿态四元数一致性迭代次数,ξ为正整数;
II.对节点i的姿态估计值与节点j的姿态估计值进行一致性处理,获得节点i的姿态估计值与节点j的姿态估计值的姿态信息差值
III.将节点i与除节点i外的其他全部节点的姿态信息差值δk(j,ξ)叠加获得姿态信息差值修正值ρk(i,ξ):其中,dk为调谐参数,aij,k(i,j)为临近矩阵,的矢量部分;dk=n,n为节点个数,为正整数;如果节点i和节点j能连通,aij,k(i,j)=1;如果节点i和节点j不能连通,aij,k(i,j)=0;
IV.使用节点i姿态信息差值修正值ρk(i,ξ)修正节点i的姿态估计值获得节点i修正后的四元数估计值
q ^ k ( i , &xi; + 1 ) = q ^ k ( i , &xi; ) &CircleTimes; &lsqb; q ( &rho; k ( i , &xi; ) ) &rsqb; - 1 ;
V.重复步骤I到步骤IV得到各节点第ξ+1次迭代后的姿态四元数估计值
VI.重复步骤I到步骤V,ξ=l时,得到各节点在经过l次一致性处理后的姿态四元数估计值其中,l为正整数;
VII.将步骤VI得到的节点i的经过l次一致性处理后的姿态四元数估计值进行滤波处理,并根据滤波结果得到陀螺漂移估计值 通过公式得到节点i的角速度估计值
其中,为陀螺的角速度测量值,为陀螺漂移一步状态更新矩阵,Δbk(i)为陀螺漂移误差矩阵,为k-1时刻的陀螺漂移估计值;的矢量部分;为增益矩阵,为姿态四元数一步状态更新矩阵,Φk-1(i)为姿态四元数状态转移矩阵,为在k-1时刻节点i的经过l次一致性处理后的姿态四元数估计值;
VIII.重复步骤VII,获得各节点的角速度估计值
IX.对各节点的角速度估计值进行一致性处理,得到各节点经过一致性处理后的角速度估计值n为节点个数,为正整数,选取某节点的经过一致性处理后的角速度估计值作为最终的卫星角速度估计值;
X.选取某节点的经过l次一致性处理后的姿态四元数估计值作为最终的卫星姿态四元数估计值,利用最终的姿态四元数估计值和最终的角速度估计值确定卫星姿态。
4.根据权利要求3所述的一种基于四元数估计和聚合式微型星敏感器的卫星姿态确定方法,其特征在于:所述的滤波处理为乘性扩展卡尔曼滤波处理,包括步骤如下:
i、通过状态转移矩阵将k-1时刻的状态量估计值包括姿态四元数估计值和陀螺漂移估计值传播到k时刻得到一步状态更新矩阵
其中,Φk-1为姿态四元数状态转移矩阵;为姿态四元数一步状态更新矩阵、为陀螺漂移一步状态更新矩阵;
ii、通过乘性测量新息矩阵Zk对步骤i中得到的进行状态更新,得到k时刻的姿态四元数估计值陀螺漂移估计值
q ^ k b ^ k = q ^ k / k - 1 &CircleTimes; &delta;q k b ^ k / k - 1 + &Delta;b k
其中,δqk为Ka,z·Zk的矢量部分,Δbk=Kb,z·Zk,Zk的矢量部分,为k时刻的姿态四元数测量值,为卡尔曼增益矩阵。
5.根据权利要求3或4所述的一种基于四元数估计和聚合式微型星敏感器的卫星姿态确定方法,其特征在于:所述微型星敏感器单元包括光学系统(1)、陀螺(2)、孔径面(3)、接口面(4);微型星敏感器单元为N面体结构,N大于等于4,包括一个孔径面(3),其余面均为接口面(4),接口面(4)相互呈非90°夹角;光学系统(1)和遮光罩位于孔径面(3)中部,安装在微型星敏感器单元壳体内,光学系统(1)的镜头上安装遮光罩;接口面(4)上布置有至少一个电信接口(5)和至少一个机械接口(6),陀螺(2)安装在微型星敏感器单元内;微型星敏感器单元之间、微型星敏感器单元与卫星之间通过机械接口(6)连接;各微型星敏感器单元中的光学系统(1)、陀螺(2)均通过电信接口(5)与外界进行数据通信并获得供电。
6.根据权利要求5所述的一种基于四元数估计和聚合式微型星敏感器的卫星姿态确定方法,其特征在于:所述的N=10,孔径面(3)为正方形,四个长方形的接口面(4)分别与孔径面(3)四个边连接形成长方体结构,另五个梯形的接口面(4)形成梯形锥台,梯形锥台倒置后底面与长方体结构相连,形成十面体结构。
CN201610346316.5A 2016-05-23 2016-05-23 一种聚合式星敏感器及其卫星姿态确定方法 Active CN106052678B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610346316.5A CN106052678B (zh) 2016-05-23 2016-05-23 一种聚合式星敏感器及其卫星姿态确定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610346316.5A CN106052678B (zh) 2016-05-23 2016-05-23 一种聚合式星敏感器及其卫星姿态确定方法

Publications (2)

Publication Number Publication Date
CN106052678A true CN106052678A (zh) 2016-10-26
CN106052678B CN106052678B (zh) 2019-05-24

Family

ID=57174219

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610346316.5A Active CN106052678B (zh) 2016-05-23 2016-05-23 一种聚合式星敏感器及其卫星姿态确定方法

Country Status (1)

Country Link
CN (1) CN106052678B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111207772A (zh) * 2020-01-14 2020-05-29 上海卫星工程研究所 一种多头星敏感器光路和极性的测试方法
CN112461511A (zh) * 2020-11-10 2021-03-09 中国科学院长春光学精密机械与物理研究所 浮空平台望远镜指向获取方法、装置、设备及存储介质
CN114413883A (zh) * 2021-12-23 2022-04-29 上海航天控制技术研究所 卫星姿态确定精度的提升方法、存储介质和电子设备
CN115930971A (zh) * 2023-02-01 2023-04-07 七腾机器人有限公司 一种机器人定位与建图的数据融合处理方法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002131078A (ja) * 2000-10-26 2002-05-09 Mitsubishi Electric Corp スターセンサシステム
CN102538825A (zh) * 2011-12-29 2012-07-04 北京控制工程研究所 一种星敏感器探头组合体光轴指向标定方法
US8265804B1 (en) * 2009-05-29 2012-09-11 The Boeing Company Method and system for controlling a vehicle
CN103148853A (zh) * 2013-03-20 2013-06-12 清华大学 基于星敏感器的卫星姿态确定方法及系统
CN103591963A (zh) * 2013-10-22 2014-02-19 浙江大学 一种微型化星敏感器及其实现方法
CN103723286A (zh) * 2013-12-19 2014-04-16 上海卫星工程研究所 多敏感器与多执行机构的视场总体分析方法
CN104296751A (zh) * 2014-10-23 2015-01-21 航天东方红卫星有限公司 一种多星敏感器构型布局设计方法
CN104406583A (zh) * 2014-12-05 2015-03-11 中国人民解放军63680部队 双星敏感器联合确定载体姿态方法
CN105136150A (zh) * 2015-08-18 2015-12-09 北京控制工程研究所 一种基于多次星敏感器测量信息融合的姿态确定方法

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002131078A (ja) * 2000-10-26 2002-05-09 Mitsubishi Electric Corp スターセンサシステム
US8265804B1 (en) * 2009-05-29 2012-09-11 The Boeing Company Method and system for controlling a vehicle
CN102538825A (zh) * 2011-12-29 2012-07-04 北京控制工程研究所 一种星敏感器探头组合体光轴指向标定方法
CN103148853A (zh) * 2013-03-20 2013-06-12 清华大学 基于星敏感器的卫星姿态确定方法及系统
CN103591963A (zh) * 2013-10-22 2014-02-19 浙江大学 一种微型化星敏感器及其实现方法
CN103723286A (zh) * 2013-12-19 2014-04-16 上海卫星工程研究所 多敏感器与多执行机构的视场总体分析方法
CN104296751A (zh) * 2014-10-23 2015-01-21 航天东方红卫星有限公司 一种多星敏感器构型布局设计方法
CN104406583A (zh) * 2014-12-05 2015-03-11 中国人民解放军63680部队 双星敏感器联合确定载体姿态方法
CN105136150A (zh) * 2015-08-18 2015-12-09 北京控制工程研究所 一种基于多次星敏感器测量信息融合的姿态确定方法

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111207772A (zh) * 2020-01-14 2020-05-29 上海卫星工程研究所 一种多头星敏感器光路和极性的测试方法
CN112461511A (zh) * 2020-11-10 2021-03-09 中国科学院长春光学精密机械与物理研究所 浮空平台望远镜指向获取方法、装置、设备及存储介质
CN112461511B (zh) * 2020-11-10 2022-03-25 中国科学院长春光学精密机械与物理研究所 浮空平台望远镜指向获取方法、装置、设备及存储介质
CN114413883A (zh) * 2021-12-23 2022-04-29 上海航天控制技术研究所 卫星姿态确定精度的提升方法、存储介质和电子设备
CN114413883B (zh) * 2021-12-23 2023-09-05 上海航天控制技术研究所 卫星姿态确定精度的提升方法、存储介质和电子设备
CN115930971A (zh) * 2023-02-01 2023-04-07 七腾机器人有限公司 一种机器人定位与建图的数据融合处理方法
CN115930971B (zh) * 2023-02-01 2023-09-19 七腾机器人有限公司 一种机器人定位与建图的数据融合处理方法

Also Published As

Publication number Publication date
CN106052678B (zh) 2019-05-24

Similar Documents

Publication Publication Date Title
CN106052678A (zh) 一种聚合式星敏感器及其卫星姿态确定方法
CN109099913B (zh) 一种基于mems惯性器件的穿戴式导航装置和方法
Eckenhoff et al. MIMC-VINS: A versatile and resilient multi-IMU multi-camera visual-inertial navigation system
CN105300379B (zh) 一种基于加速度的卡尔曼滤波姿态估计方法及系统
CN103776446B (zh) 一种基于双mems-imu的行人自主导航解算算法
Indelman et al. Factor graph based incremental smoothing in inertial navigation systems
CN107516326B (zh) 融合单目视觉和编码器信息的机器人定位方法和系统
Forster et al. On-manifold preintegration theory for fast and accurate visual-inertial navigation
CN109459019A (zh) 一种基于级联自适应鲁棒联邦滤波的车载导航计算方法
CN106123900B (zh) 基于改进型互补滤波的室内行人导航磁航向解算方法
CN108225337A (zh) 基于sr-ukf滤波的星敏感器和陀螺组合定姿方法
CN106197408A (zh) 一种基于因子图的多源导航信息融合方法
CN109931955B (zh) 基于状态相关李群滤波的捷联惯性导航系统初始对准方法
Eckenhoff et al. High-accuracy preintegration for visual-inertial navigation
CN108490433A (zh) 基于序贯滤波的空时偏差联合估计与补偿方法及系统
CN103148853B (zh) 基于星敏感器的卫星姿态确定方法及系统
CN105300384A (zh) 一种用于卫星姿态确定的交互式滤波方法
CN106772524A (zh) 一种基于秩滤波的农业机器人组合导航信息融合方法
CN104066179A (zh) 一种改进的自适应迭代ukf的wsn节点定位方法
Zhang et al. Improved calibration method for dynamic traffic assignment models: constrained extended Kalman filter
CN104020671B (zh) 一种量测干扰下用于飞行器姿态估计的鲁棒递推滤波方法
CN104748727B (zh) 阵列式高速视觉里程计及其实现方法
Li et al. Cooperative visual-range-inertial navigation for multiple unmanned aerial vehicles
CN111207734B (zh) 一种基于ekf的无人机组合导航方法
Ashkar et al. A low-cost shoe-mounted inertial navigation system with magnetic disturbance compensation

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