维普资讯 http://www.cqvip.com 10 控制工程 2002年第3期 星敏感器测量模型及其在卫星姿态 确定系统中的应用 刘一武 陈义庆 北京控制工程研究所 摘要本文对星敏感器三轴姿态测量的误差性质进行研究,得到一些具有 实用意义的结果。在此基础上提出了改进的星敏感器测量模型,可以提高姿态确 定的精度。 主题词星敏感器姿态测量姿态确定 1 引 言 面阵CCD星敏感器是卫星常用的高精度姿态测量部件。典型的使用方法有两种:直接使 用恒星视线矢量的测量[1l,或者利用视场内多颗恒星矢量测量来确定敏感器测量坐标系三轴 姿态[ 。文献[2]对采用两个星敏感器光轴测量的姿态确定方法进行了研究,本文则进一步 研究星敏感器三轴测量误差的性质,选取新的测量量,提出改进的星敏感器测量模型,以获得 更精确的姿态确定。同时,本文方法又可地用于采用单个星敏感器的姿态确定系统。 2 利用星敏感器测量的姿态确定系统 高精度指向卫星广泛采用惯性基准单元(IRU)与星敏感器组成姿态确定系统L2],本节对 该系统进行简要介绍。 首先引入三个坐标系:地心惯性坐标系OEXYZ,X指向春分点,Z为地球自转轴,指向北 极;卫星本体坐标系(具体定义方式与本文讨论无关);面阵星敏感器测量坐标系O sysZs, Zs为星敏感器光轴,xsys位于星敏感器焦平面,xs为行扫描方向。 记As卜AsB分别是惯性系到测量系、本体系到测量系的转换矩阵。卫星本体相对惯性系的 姿态四元素记为 =[q1 q2 q3 q4]T q4是标量部分,q表示矢量部分,与 相对应的姿态 矩阵为A(虿), q的估计值分别记为 、口。 设卫星本体相对惯性系的角速度叫=[叫 OAy叫:]丁,则姿态运动方程为 J 1 知(£)=寺n(叫) (£) (1) 式中 0 ∞2 一叫 叫 一叫2 0 叫 ‘ n(叫): 一 0 2 一叫 一叫 一叫2 0 维普资讯 http://www.cqvip.com 控制工程 IRU测量卫星角速度 ,其输出为“ : “ : +b+叩1, 2 (2) (3) 其中b=[6 6 b ]T为陀螺漂移,相应的估计值记为6; l、 2是均值为零的白噪声,两者 不相关,方差E711 j’= 1,3 3,E,12,d= 2,3 3,,表示单位阵。 星敏感器光轴单位矢量Zs在惯性系的表示记为ZJ,星敏感器数据处理器对星象数据进行 处理后获得ZI的测量值,记为ZJ一,光轴矢量的测量模型为[ 】 ZI一 :ZJ+△ZJ (4) 假设E{△ZJ}:0,E{△zJ△z }= A,B区分,例如ZJA,ZJB) .{,一z,zT}。(对两个星敏感器A、B,相应的变量用下标 。记由=“ 一6。虿、b的预报值 、6由下列方程给出 d-㈩=吉n((a) ㈩ d t(£)=0 (5) (6) 在预测区间[t~At,t]离散化 弓(t)=@(t)弓(t—At) b(t)=b(t—At) (7) (8) 式中@(£)近似有[ 】 @㈩=c。s(A ̄/2)I ×4+ 定义状态估计误差 Ab=b——b n( ,△ =L尸㈤ 或△ = )△£) 两=弓 o虿(即A(虿):A(两)A(弓)) 设e1.Cl 分别是 的矢量与标量部分, q、 q4分别是art的矢量与标量部分,则有 虿: 虿 +.q4I+ k,6:6+△6 oT ’ ¨ 一(9) ‘9’ (如果式(9)的 q、△b分别用其滤波值替代,则得到姿态与陀螺漂移的修正方程),式中的矢量 带上标x表示该矢量的反对称阵,例如q 为 『0 一口s 口2] 口x:l口3l 0 一口1 l 口2 口。 0 J 一取曲、Ab为状态变量,则滤波器状态方程为(忽略高阶小量) 知=一面 一lAb— 1 -,(d ̄aq =0) d(10) (11) dAb:叩2 利用两个星敏感器的光轴测量时,滤波器观测方程取为 维普资讯 http://www.cqvip.com 12 星敏感器A: "z1,控制工程 星 A;碍,AA(弓) 一 ,A=一2 A曲+ I。A 敏 器 光 (12) ,7z2,A三《,AA( )Zx一 ,A=2嵋,A曲+ 2.A BA(弓)zr~ ,B=一2《.B 口+ I.B ]● ●一 一 ,一BA(弓)Zx一B=2踞,B 口+ 2.B (13) (14) (15) .星敏感器B: ,7z1,B三 ,轴 ,7z2B三 其中XB,A、yBA为星敏感器A的XS、yS在本体坐标系中的矢量表示,XBB、yB.B类同。式中 ,耙 磙磙例 删 们 们 一g_l g = E / △ A △ A 1●●●●JE [ ::] =E [ : ] =[:],E [ ::] -,A z,A =E [ :] -,B z,B = —...........,.L 可以验证,式(12)一(15)与文献[2]的观测方程等价,但形式更简捷。将式(12)一(15)联 立 = ——.............L B B 1●●J ,7z三[,7 1,A,,7 2,A,,7 1,B,, 2,B]T= 堰碹 一g r,__J B 0 0 矾 ll g 1,卜J斗 曲 .丁 H:2『-一XBA yB,A—XB,B △ ,△ L 0 0 0 B 1●●●●J观测噪声方差阵 B R= 4 4 (18) 下面进一步研究星敏感器测量模型,提出改进的滤波器观测方程。 3 星敏感器测量误差 , , 、,、," 设星敏感器视场内某恒星的星象中心在测量系的坐标为L=(P ,Py,f)T f为焦距,而 其测量值为L =L+AL,△L=(n ,n ,0)T不考虑系统误差,则n n 一般都假设为均值 为0的白噪声,设其方差均为 。 将L 单位化,得到该恒星视线单位矢量的测量 l l +Al 其中 l 三[z Y ]T=[ /f L f /f L f /f L f]T Al=( —U[)aL/l L f 这里l L f=√『 +P +f2。则误差矢量Al的方差为 .2 EAlAlT (卜llf ̄)di口g{1’1,o1(I—z ) (19) 维普资讯 http://www.cqvip.com 控制 工程 13 设某时刻星敏感器视场内有n个恒星视线,第i个恒星视线的单位矢量在惯性系的表示 记为zJ( ),可由星图识别结果查找星历表获得,记M=[zJ(1)…lJ(n)]T令ZJ :ZJ+△ZJ o是待求的敏感器光轴在惯性系的测量值,AZI是测量误差,敏感器X、Y轴有类似的定义采用 最小二乘法可以求解下述方程(20),得到该时刻敏感器坐标轴在惯性系的测量值ZI XI , 。,yJ [4】o z (1) MZI = Zs,MXI = 一 z (1) Xs,MYI = 一 z (1) Ys z (7/") (20) z (7"1) z (7"/) 记AR=[Al(1)…Al(71")]T,可得测量误差 △ZJ=(,一zSf)(MrM)一 MTARZs AXJ=(,一x )(MTM)一 MTARXs (21) △yJ=(,一yJ玎)(M丁M)I1MT△RyS 下面将ZJ ,XJ ,yJ 换算到测量系,在测量系中讨论其误差性质。 定义2s=AsZ1 ,文s=AsJxJ , s:AsJYI ,则 2S=Zs+AZs.AZs=A ZI s=Xs+AXs,AXs=AsJAXI s=Ys+AYs,AYs=AsJAYI 记N:[1 (1)…l (7/")]T,由式(21)不难得到 AZs=(,一zsZ )(N ) NTARZs AXs=(,一x )(NTN) NTARXs (22) AYs=(,一ys畦)(N ) NTARYs 利用各l (i)(实际应用中可用l (i)替代),可计算出三轴测量误差的统计特性,具体公 式为 E{AZsAZ ̄}=d 3L ∑{z;( 1一z (刚 (i)lT( )/I L( )J }L ,3 i=l i=l (23a) E laxsAx }=d;,lL ∑{[1一 ;( )(1+z;( ))]z (i)lT( )/J L( )I }L ,1(23b) E}△yS△畦}=d;,2L ∑{[1一 ;( )(1+z;( ))]z (i)lr( )/J L( )I }L ,2(23c) i=l E{AXsAZ ̄}=扫1L ∑{一Xs( )z (i)l ( )z ( )/I L( =1 i=l }L ,3(23d) (23e) E{△yS△ }=d;,2L ∑{一弘(i)z3(i)l (i)ff( )/I L( )J }L ,3 i=l E laxsAY }=d;,1L ∑{一Xs( )弘( )[1+z;( )]z (i)z ( )/J L( )J }L ,2(23f) 式中L =【-∑ls( )z ( )-1,,1=diag Io,1,1},,2=diag{1,0,1},,3=diag{1,1,0}。 虽然原理上,星上姿态滤波计算时可利用这些公式实时计算测量误差的方差,但是实用上 这些方差可近似处理为常值,于是,在卫星姿态确定的实际应用中,可采用常系数的稳态 维普资讯 http://www.cqvip.com 14 Kalman滤波器。 控制 工程 下面进一步对式(23)的性质进行研究。 4 测量误差性质 对式(23)的一般情况进行探讨比较困难。首先,我们将测量系投影到xSzs(或yszs)二 维平面,对测量误差性质建立感性认识;其次,我们考虑视场内1"1个恒星星图中心位置均匀分 布在XsYs平面以0s为圆心的圆上,式(23)的具体结果与性质。 如图,将测量系投影到xszs平面。恒星视线 z2与光轴zs的夹角分别为01、02(星敏感器视 场小,一般0l、02小于7。),对应的测量为zl 、Itm、、 Z2 测量误差A0l=COS一 <Zl,Zl >、ZXO2= 2 // /1 2m / , // ./ , ,COS <z2,z2 >为的均值为0的白噪声,设 方差均为 。 坐标轴的测量zs 相对zs的误差△ 、Xs 相对x 的误差△a可由最小二乘法求得,即让指 ’ 2 | / Xs 一 —— Xs 标∑[(z ,Zs>一(z , 一 )] ,∑[( ,xs)一(z Xs一 )] 最小,具体结果为 △ =垒 孝 ,△a:二 豸 』 ,譬≤EAi≤O2≤ 2≤ 一 它们的方差 EAO z:1:十+ = 譬 一( ctEAaAO :sin 201 cos 201 +s in2 02cos202一石 一 _coS2 z ‘≈一一 2 2相当),而当其中一视线在yszs平面 绕 : 2≈一 只有当f l f:J 2{,E△ 才有最小值 t72(与EA时,EAO 大致是EAa 的2倍。从三维测量系看,Zs。绕Ys轴旋转角误差,一般要比xsYs轴旋转角误差大,且两者的协方差近似等于后者的方差,因而选用Zs丁Xs(即 Zs )作为绕Ys轴旋转角的姿态测量,比选用XsTzs性能较佳。(且因两者协方差的 性质,将Zsrxs、 xf'zs都作为测量,并不能改进姿态确定精度)。同样,将测量系投影到yszs平面,同理可得,Zs绕xs轴旋转角误差,一般要比Ys绕 Xs轴旋转角误差大,且两者的协方差近似等于后者的方差,选用zsTys(即zs sJ yI)作 为绕Xs轴旋转角的姿态测量比选用ysWZs性能较佳。 下面回到三维情况,考察视场内n个恒星星图中心位置均匀分布在xsys平面以Os为圆 心的圆E.进一步验证上述结论。 维普资讯 http://www.cqvip.com 控制工程 设视线与光轴Zs的夹角为0,记 至= c。s4 ,可推导出(推导过程略) (24a) E{AZs△ } =2a 口g{1,1,0}0 E{△Xs△磙}=立cos2sin-2 一 1(1+cosZO) (24b) o0s一 口一 1 20 tg ̄O(1+ △ ) 一一 —...........................L1 2 2sin-2 一号(1+ ) E{△ys△磙}= cos20 0 o0s一 口一l + 1 + 2 (24c)0 1●● ●,●●,jtg20(1+O0 ) E{AXs△墨}=一 0(24d) 十 r 一 E{Ays△ }=一 ]●●●J△ (24e) E{△Xs△ ‘ 圭(1+ 。 一: ) 0 0 0 —...........................L(24f) 与式(4)比较易知 =2 ]一 r ,0 §I 一(25) ● 利用式(24),建立如下测量误差模型: AXs (26) 其中P , , ,叫 ,r(i 1,2)均为的白噪声,它们的统计性质 Ep :En = 至 Ew =0.5a ̄sin 0cos (1+COS2 )≈aZsin 0 Ev =aZsin 0cosI20(1+cos40)≈2a2sin 0 (27a) (27b) (27e) (27d) Er =0.5, ̄cos 0(1+coYO)≈ 至 为下文使用,记 2仃三aZsin_。0,一般地 Ⅱ=64~256a2。 至此,揭示了星敏感器三轴测量的误差性质(式(26)(27))。 5 改进的测量方程与在姿态确定系统中的应用 设Xs、ys、Zs在本体系的表示分别为XB、yB、ZB,对于单个星敏感器三轴测量,可以有如 下6个观测值, 维普资讯 http://www.cqvip.com 16 控制工程 m1三y (弓)zJ 。:y s J ,m 2三XTA(q)Zt =x slzJ , 3三 (弓)yJ 。= sJ yJ ,m 三ZTA(弓)xJ = s , m 5三x (弓)yJ 。=X ̄AstyJ ,m6三啦其中ASJ=A (弓)。 (弓)xJ =yTAs ̄XJ 。 根据第4节的分析结果,m 3的精度优于m ,(且两者协方差近似等于m 3的方差),m 的 精度优于m 2(两者协方差近似等于m 的方差),因此可以选择m3、m 、m 5、 6作为姿态滤波 的观测值。可导出具体的观测方程为(忽略高阶小量) f m 3=2 曲+ ̄rJ3, ̄03≈Zj A yJ= Ays 1l m 4=一2Y 曲+ 4, 4≈zl Axf=z AXs m 5:一2 + 口5≈xTaY,:耀△ys l m 6=2ZTgq+ 6,口6≈Y 7'△XJ=Y AXs 观测方程的方差阵可由式(23)计算,也可近似地根据式(26)(27)计算得出。 因此,采用单星敏感器时,姿态确定系统中式(16)一(18)由下式替代: (28) m三 H:22d]丁=Hl j 『 一y日一Z日 ] 三0 0 0 0 0 一(16a) (17a) (18a) 0 0 一 0 R= 0 0 2a2 叮 2a2 用两个星敏感器定姿时,虽然理论上可用两个星敏感器的 3、m 、m 5、m 6共8个量作为 观测值,但m 5、m6对姿态确定精度的改善非常小,实际上采用两个星敏感器的m3、m 共4个 观测值即可。因此,采用两个星敏感器时,姿态确定系统中式(16)一(18)由下式替代: m兰 .A, A,m 3,B ̄ =Hl j (16b) (17b) (18b) H:2fL- 一 U 0 0 一 U _]j R=d j_4 4={d 4 4比较式(18)(18b)可知,测量噪声方差为原来采用光轴测量的二分之一。 6 结 论 用星敏感器测量数据确定其测量坐标系的惯性指向时,利用视线矢量与最小二乘法所获 得的光轴矢量指向的确定精度,劣于另外两坐标轴的矢量测量所确定的光轴指向的精度(这一 (下转第25页) 维普资讯 http://www.cqvip.com 控制 工程 25 都不大,喷管改型对此连接处的强度影响很小; (4)随机响应分析显示,大、小喷管推力器加速度响应的功率谱密度曲线形状相似,但大喷 管推力器加速度响应的功率谱密度曲线在高频部分略高; (5)在喷管部分,大喷管推力器加速度响应的均方根值反而小于小喷管推力器对应位置的 数值; (6)在力学环境条件(鉴定级)给定的正弦激振条件下,系统的变形和应力都很小,应力值 远小于材料的强度极限(钛合金 =1010MPa,铌合金 =372MPa); (7)阻尼的影响主要体现在共振点附近,对其它频段的正弦响应影响很小; (8)沿推力器轴线方向的激振,由于远离对应的纵向振动模态,因此系统的响应很小; (9)燃烧室左端在给定的动力响应条件下,为高应力区。但大、小喷管推力器的最大应力 相差不大,大喷管推力器的最大应力比小喷管推力器的最大应力约大27%。 从动力分析的角度来看,改型设计对结构强度的影响不大,结构的动力响应形式、应力分 布情况相似。 参考文献 1 <MSC/NASTRAN User’s Guide—2BaSic Dynamic Analysis) (MSC/NASTRAN User’s Guide——Linear Static Analysis) 3 <MSC/NASTRAN Quick Refrence Guide) 4 <MSC.RANDOM User’s Guide) 5李德葆,张元润.振动测量与试验分析.机械工业出版社,1992 (上接第16页) 结论有别于通常的概念)。基于这一性质提出了改进的星敏感器测量方程,可进一步提高卫星 的姿态确定精度。同时本文方法适用于采用单个星敏感器的姿态确定系统。 参考文献 1 Gai E,Daly K,Harrison J,Lemos L.Star—Sensor—Based Satellite Attitude/Attitude Rate Estimator.J.Guidance,1985,8(5):560—565 2 Li J.Chen Y.Constant—gaininformationfilterfor attitude determination of precision pointing spacecraft.IAF一 96一A.5.08 3 Lefferts E J,Markley F L,Shuster M D.Kalman filtering for spacecraft attitude estimation.J.Guidance,1982,5 (5):417~429 4卢欣,方蓉初.星敏感器技术,北京控制工程研究所所庆四十五周年学术报告会论文集,2001:77—89