一种成像式地球敏感器地球扁率修正方法

文档序号:5843675阅读:207来源:国知局

专利名称::一种成像式地球敏感器地球扁率修正方法
技术领域
:本发明涉及一种星载地球敏感器成像时对地球扁率进行修正的方法,可以用于提高敏感器的测量精度。
背景技术
:地球敏感器通过对地心矢量的测量,可以确定航天器的滚动和俯仰姿态;地心矢量和其它天体矢量(如恒星矢量)结合,还可以确定航天器的速度和位置,因此地球敏感器是未来航天器姿态轨道控制系统所不可缺少的。地球敏感器由光学头部、传感器和信号处理等部分组成,有些还包括机械扫描部件。按照是否含有机械扫描部件,可以分为动态扫描式和静态成像式两种。动态扫描地球敏感器利用运动机械部件,带动一个或者多个视场扫过地平圆,由探测器信号确定地球的宽度和相位,计算地平圆的位置,从而获得地心矢量。静态成像式地球敏感器采用探测器,通过探测投影在其焦平面上的地球图像来计算地心矢量,和动态扫描地球敏感器相比具有质量轻、功耗低、可靠性强等优点,并可以通过适当的算法对大气模型的误差进行修正,从而提高地心方向矢量的精度。地球敏感器的测量模型中地球是标准的球体,而地球的实际形状近似为小扁率的椭球体,地球扁率的存在使地球敏感器引入系统误差。目前,针对动态扫描式地球敏感器的地球扁率修正方法较多,但对于静态成像式地球敏感器的地球扁率修正方法研究较少,而且静态成像式地球敏感器与动态扫描式地球敏感器的修正方法有很大的不同,不能替用。北京控制工程研究所的郝云彩在航天控制第23巻第1期上发表的《紫外月球敏感器的几个关键问题》中首次提出了采用矢量法确定月心矢量,该方法具有实现简单、计算量小、鲁棒性强等特点。但由于月球是一个标准的球形,不存在扁率问题,因此将该文中的矢量法应用于地心矢量计算时,虽然可以得到地心矢量的计算值,但是其精度受到较大的影响。
发明内容本发明的技术解决问题是克服现有技术的不足,提供了一种操作简单、能够有效克服地球扁率对成像式地球敏感器的影响,从而提高地心矢量测量精度的方法。本发明的技术解决方案是一种成像式地球敏感器地球扁率修正方法,步骤如下(1)提取地球轮廓点在敏感器光电探测器上的像点坐标,计算像点在航天器本体系中的单位矢量;(2)假设地球为标准球形,计算地心矢量VEB,并根据地心矢量VEB得到航天器的滚—cos—sinp;cospcos^动角和俯仰角e(3)根据前一时刻航天器的姿态预估当前时刻航天器的偏航角V,同时从航天器姿态轨道控制系统获取航天器的当前位置以及坐标系转换矩阵,计算地球轮廓点的方位角o,计算公式为EiG=[xyz]t=CGACAICI0C0BEiB其中EiB为地球轮廓点在航天器本体系中的单位矢量,Eie为地球轮廓点在地理坐标系中的单位矢量,C。B为航天器本体系到轨道坐标系的转换矩阵,且Q^=,CIQ为轨道坐标系到惯性坐标系的转换矩阵,且Cw=C^,CAI为惯性坐标系到零经度辅助坐标系的转换矩阵,且c^=cL,ceA为零经度辅助坐标系到地理坐标系的转换矩阵,且c^=c^;co+f,cos0cosy-sinpsin0siny一cospsi哮sin^cosy+sinpcosPsin^cos^sinw+sinpsinPcos^/—cospsin0cospcosysinpsinPsin^/—sinpcos^cosycos^>cosS—01o一cost/sinf/O画_100_cosQsinQ0L。/00_1一sint/cost/00cos/sin/一sinQcosQ0_1000010—sin/cos/001i为航天器的轨道倾角、Q为升交点赤径、"为近地点幅角、f为真近点角,且ucos《sin《0CM=—sin《cos《0001^4为地心到春分点的矢量与地心到零经度方向矢量的夹角,厂=—cos义sin^—sin义一sin义sin3cos义cos50-cosAcos3-sinAcos5一sin^入为航天器所在位置的经度,S为地平平面法线方向与赤道平面的夹角,=arctan(三)少J、a=180十arctan(—)少;;<0乂o"-360"+arctan(二),x<0,>^0少(4)根据地球轮廓点的方位角o计算其对应的视角半径n,计算公式为cosn=cosn。[l+eF(4>o)]5及2FOcr)=^~~^|"sin2^+-^~cos2^sin2cr+2.^-^cos^sin^sincr];、vrV-《)ie2iee为地球的扁率,Re为地球的赤道半径,r为航天器到地心的距离,小为航天器所在位置的纬度;(5)利用地球轮廓点的视角半径n消除地球扁率的影响,获得修正后的地心矢所述敏感器坐标系的原点位于等效光学镜头的中心,x轴沿探测器像素的行方向,y轴沿探测器像素的列方向,z轴构成正交坐标系。=[eix为所述步骤(2)中计算地心矢量VEB时的方法为,以X=[ExEyEJ作为观测量,&eiyeiz],Z=[11…1],采用最小二乘法,得到X的估计值为i=(//r//)-cos;7cos;7cos/7所述步骤(5)中计算修正后的地心矢量V^时的方法为,以X二[ExEyEJ作为观[eixeiyeiz],Z=[cosi^cosn2'"cosnn],应用最小二乘法,得到X的估计值其中Veb二[ExEyEJT,EiB=[eixeiyeiz]T为地球轮廓点的像点在航天器本体系中的表示,ni为各地球轮廓点对应的视角半径。本发明与现有技术相比的优点在于本发明采用二次计算的方法来修正地球扁率对地心矢量测量的影响,将地心矢量的测量分为两个步骤,第一步不需要航天器姿态轨道控制系统提供任何当前时刻的姿态估计值,直接获得地心矢量的测量值,或者是航天器的滚动角和俯仰角,可以作为航天器的初始姿态敏感器;第二步根据第一步获得的航天器滚动角和俯仰角,结合航天器姿态轨道控制系统提供的当前时刻偏航角估计值,以及坐标系之间的转换矩阵,计算地球轮廓点的视角半径,从而修正地球扁率对地心矢量测量的影响,操作简单,可以提供更为精确的地心矢量。图1为将地球表面取为旋转椭球时的地球轮廓和地平面示意图;图2为将地球表面取为旋转椭球时的地平轮廓圆示意图;图3为本发明方法的流程框图;图4为本发明实施例中采用传统矢量法时航天器滚动角和俯仰角误差随纬度幅角变化曲线;图5为本发明实施例中采用本发明方法,航天器姿态轨道控制系统提供先验偏航信息条件下修正后航天器滚动角和俯仰角误差随纬度幅角变化曲线;图6为本发明实施例中采用本发明方法,航天器姿态轨道控制系统未提供先验偏航信息条件下修正后航天器滚动角和俯仰角误差随纬度幅角变化曲线。具体实施例方式本发明方法适用于静态成像式地球敏感器。地球的形状不是理想球体,而是近似球体的不规则几何形状。本发明以旋转椭球作为成像式地球敏感器的成像模型,其它成像模型可以根据本发明提供的思路作相应的更改。本发明的主要思路是基于旋转椭球模型的成像式地球敏感器信息处理算法,提出了一种地心矢量二次确定以消除地球扁率带来的误差,提高地心矢量确定精度的方法,第一次确定不考虑地球扁率,以球型模型计算卫星的粗姿态和粗略轨道位置信息;再根据卫星的粗略位置和粗姿态信息,结合所建立的旋转椭球模型,消除扁率影响,实现更高精度的地心矢量确定。—、地球边缘线的数学模型如图1所示,将地球表面取为旋转椭球,记作E,&为赤道半径,Rp为极半径,以地心0为原点,在零经度辅助坐标系F,。(原点位于地心,Z,。轴指向北极,X,。轴和YA。轴在赤道平面内,X^轴指向零经度点,YA。轴完成正交)中,考虑地球扁率情况下E的球面方程为=凡(1-e)2其中,e为地球扁率,且e=(Re-Rp)/Re。卫星所在位置为S,经度为A,纬度为小,与地心的距离为r。在卫星上看到的地球边缘称为地平轮廓线,地平轮廓线上的称为地球轮廓点,地平轮廓线所在的平面称为地平平面n,卫星与地心的连线与椭球面E相交于s',与地平平面相交于S^设3*与地心的距离为D,由于0、S'和3*共线,则S*0=D(nnad)其中,n^为SO的单位矢量。由于S*的坐标满足地平平面方程,可求得<formula>formulaseeoriginaldocumentpage7</formula>S*P,p与YA的夹角为方位角o(")2从S*向地平轮廓线上任意一点P引矢量P根据坐标关系,在零经度辅助坐标系FA。下0/>|Fa。=OS*+/|F;i。如图2所示,以Sf为原点,在地平平面上建立地理坐标系Fe,Xe和YA沿地平平面,Xe沿子午线方向向北,YA沿纬线方向向东,从f向地平轮廓线上任意一点P引矢量P=S*P,P与Y,的夹角为方位角o。在Fe中,<formula>formulaseeoriginaldocumentpage7</formula>将^绕^轴旋转-(9(T+S)得到Fg,Fg到F》的转换矩阵为一cos义sin3—sin义一cosAcos^一sin义sin3cos义一sin义cos3cos50-sin^其中S为地平平面法线方向与赤道平面的夹角,且sin^L义Gcos<5=-sin2^(1—e)2sin2^(1—e)4(1-W可得OP在零经度辅助坐标系FA。中的坐标■Dcos义cos^+sinAcoscr_cosAsincrsin3)£)sin义cos^+p(cosAcoscr-sinAsincrsin5)£)sin^+sincrcos3由于P在椭球表面上,所以其坐标满足椭球面方程E,可得「一一「'(i—。OPF义。2.2(1—e)2cos2^+sin^coscr+smcrr尺rcos^+sin^=0(1—e)4cos2^+sin2^对三角形SPS*应用余弦定理可得「一,Sp2+然"一介2COS77=-——其中,n为地球相对卫星的半张角或天底角,也称为从卫星上所看到的视角半径c将S、P和S*的坐标带入公式,并忽略地球扁率的高阶影响,计算结果可简化为cos11=cosn0[l+eF(4>o)]式中n。为忽略地球扁率时的视角半径值,且cos="51-F(小o)称为地球扁率误差修正函数,并且,,a)=凡4具体推导过程见2002年西北工业大学钱勇的博士学位论文《高精度三轴稳定卫星姿态确定和控制系统研究》第三章。二、球形模型下地心矢量估计算法静态成像式地球敏感器,其原理是通过地球轮廓点在敏感器光电探测器上像点的集合,来确定地心矢量VE在航天器本体坐标系中的表达VFB。<formula>formulaseeoriginaldocumentpage9</formula>航天器按照3-1-2的旋转顺序分别旋转V、p、9,则轨道坐标系到航天器本体坐标系的转换矩阵Ce。为cos0cosy—sinpsin^sinycos0siny+sinpsinPcosy一cos^sinycospcosysin夕cosy+sinpcos夕sinysinPsiny—sinpcos0cosy其中v为航天器的偏航角,p为航天器的滚动角,e为航天器的俯仰角标系下,地心矢量可以表示为—cos—n夕cospcosP轨道坐VE0=T航天器本体坐标系下,地心矢量可以表示为vEB=cB0VE0则—cospsinScospcos0_在不考虑地球扁率的条件下,每个地平轮廓点对应的视角半径相同,每个点到透镜中心的矢量集合所围成的面是一个圆锥面,圆锥的中轴矢量正是地心矢量,这一性质不随姿态角的变化而变化。因此,地心矢量的求解可描述为已知部分圆锥母线矢量来拟合圆锥中轴的问题。假设某地平轮廓点在探测器上的像点坐标为(xy),根据理想光学系统成像模型(敏感器坐标系的原点位于等效光学镜头的中心,x轴沿探测器像素的行方向,y轴沿探测器像素的列方向),该像点在敏感器坐标系下的坐标为(xy-focus),它与敏感器坐标系原点的连线定义为边缘点矢量,其单位矢量表示为+_y2+_/bcw其中f0CUS为光学系统的等效焦距;地心矢量在敏感器坐标中的三轴坐标设定为P^=,地心矢量和边缘点矢:9的点乘积为EiBVEEiB*VEeixEx+eiyEv+eizEz圆锥的半顶角即为视角半径n,即COSn在探测器选取边缘点矢量,组成如下的方程组eu.A+^.A+elz.五2=cos"e2x.五x+e2r.五>+e2z.五z=COS"选择非单位的地心矢3E力,.,,*E,,+e,.以X=[ExEyEJ作为观法,得到X的估计值为J^(/T/f)-1/^三、椭球模型下的地心矢jM.^+e,^+ez.£z=cos"凍达模式=1则—cosp-sinScos77五,,=cos;7瓦=cos^cosPcos77=[eixeiyeiz],Z=[11…1],应用最小二乘:补偿算法由公式COST/o=一一义c0s;7二cos77。[l+e-i^cr)]可知,球形模型下,地平轮廓点的视角半径只与地球半径和航天器的轨道高度有关,而椭球模型下,每个地平轮廓点的视角半径并不相同,其大小由地球扁率、地球半径、航天器的轨道高度、所处的位置,以及这个点在地平平面的位置决定。因此,地球廓点视角半径的测量,是消除地球扁率影响的关键。地球的半径非常大,而扁率又非常小,在以星下点Sf为中心的地理坐标系中,视角半径n随方位角o的增大变化非常缓慢。计算表明,卫星在赤经0。,赤纬45°,地心距离6878km(等效轨道高度500km)时,地平轮廓线上点,当方位角o从0°增大到180°,其视角半径n的变化值an=o.18°。由地心矢量计算航天器的滚动角^和俯仰角e,以及航天器姿态轨道控制系统提供的偏航角V,可以获得航天器完整的姿态信息,即轨道坐标系到本体系的转换矩阵Ce。10=4ocos6*0—sinP100cos^si,00100cospsinp—sinycosy0sin6*0cos610—sinpcosp—001航天器的轨道六要素分别为轨道倾角i、近地点幅角"、升交点赤径Q、轨道半长轴a、偏心率e和过近地点时刻tp。惯性坐标系绕0Z轴旋转Q,得到坐标系;坐标系绕OX!轴旋转i,得到坐标系0X2Y2Z2;坐标系0X2Y2Z2绕0Z2轴旋转U(U="+f),得到轨道坐标系,则惯性坐标系到轨道坐标系的转换矩阵CQI:國oi0_cost/sint/0—100cosQsinQ0二00—1cost/00cos/sin/—sinQcosQ0—l000010—sinz'cos/001c=假设某一轨道时刻,地心到春分点的矢量与地心到零经度方向矢量的夹角为4,则零经度辅助坐标系绕0Z,。旋转;得到惯性坐标系,则零经度辅助坐标系到惯性坐标系的转换矩阵Cn:cos4"sin《0—sin《cos《0001而地理坐标系到零经度辅助坐标系的转换矩阵CAe如前面所示—cos义sin^—sin义一cos义cos^一sin义sin^cos义一sin义cos^cos^0—sin^由前面所述,对探测器进行图像处理,可以获得地球轮廓点在探测器平面上的像点坐标,再根据敏感器光学系统的焦距,以及敏感器在航天器本体的安装矩阵,可以获得该像点在航天器本体系中的单位矢量EiB,EiB经过如下矩阵变化,即为EiB在地理坐标系中的单位矢量Eie:其中C。B为航天器本体系到轨道坐标系的转换矩阵,且Q^=C'cIQ为轨道坐标系到惯性坐标系的转换矩阵,且c^=c(cAI为惯性坐标系到零经度辅助坐标系的转换矩阵,且c,,=cceA为零经度辅助坐标系到地理坐标系的转换矩阵,且Q^=c由单位矢量EiJ、cr=arctan(—),少=[XyZ]T,计算该像点对应的地球轮廓线上点的方位角o:,x、<r=180+arctan(—)少<0<T=360°+arctan(—),x<0,y20少由方位角o,以及航天器提供的位置信息(距地心距离r,赤纬小),以及地球半径R。扁率e,由公式cosn=cosn。[l+eF(4)o)]可以确定地球轮廓点对应的视角半径n。根据以上计算获得的视角半径,重新构建最小二乘法EiBVEB=eixEx+eiyEy+eizEz=cosni以X二[ExEyEJ作为观测量,&=[eixeiyeiz],Z=[cosn!cosn2'"cosnn],应用最小二乘法,得到X的估计值为f-(/^i/)-1/^上述流程如图3所示。实施例为了更清楚的表明本方法的优点,建立地球的椭球仿真模型,将扁率修正后的结果与矢量法的结果进行对比。设某卫星的轨道高度为500km,轨道倾角80°,地球半径Re=6378.14km,地球扁率e=3.292X10—3。地球敏感器的安装矩阵为单位阵,安装角lx=ly=Iz=0°。轨道周期的某一时刻,假定航天器姿态,按照理想成像方式,将地球轮廓圆上的点投影在探测器平面上,确定其理想的平面坐标,以这些平面坐标作为输入,首先以圆球模型按照矢量法计算航天器的滚动和俯仰姿态,并与真实姿态对比;再按照椭球模型,对圆球模型的姿态进行修正,并与真实姿态对比。图4是不考虑地球扁率条件下,采用矢量法确定的航天器滚动角和俯仰角误差随纬度幅角变化曲线,可以看出,地球扁率引起的滚动角误差可以达到O.16°。图5是采用本发明方法,在航天器姿态轨道控制系统提供先验偏航信息条件下,航天器滚动角和俯仰角误差随纬度幅角的变化曲线,可以看出,采用本方法后地球扁率引起的误差减小到10—^。图6是采用本发明方法,在航天器姿态轨道控制系统不能提供先验偏航信息的条件下,航天器滚动角和俯仰角误差随纬度幅角的变化曲线,可以看出,采用本发明方法后地球扁率引起的误差减小到io—r以下。本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。1权利要求一种成像式地球敏感器地球扁率修正方法,其特征在于步骤如下(1)提取地球轮廓点在敏感器光电探测器上的像点坐标,计算像点在航天器本体系中的单位矢量;(2)假设地球为标准球形,计算地心矢量VEB,并根据地心矢量VEB得到航天器的滚动角和俯仰角θ,(3)根据前一时刻航天器的姿态预估当前时刻航天器的偏航角ψ,同时从航天器姿态轨道控制系统获取航天器的当前位置以及坐标系转换矩阵,计算地球轮廓点的方位角σ,计算公式为EiG=[xyz]T=CGλCλICIOCOBEiB其中EiB为地球轮廓点在航天器本体系中的单位矢量,EiG为地球轮廓点在地理坐标系中的单位矢量,COB为航天器本体系到轨道坐标系的转换矩阵,且<mrow><msub><mi>C</mi><mi>OB</mi></msub><mo>=</mo><msubsup><mi>C</mi><mi>BO</mi><mi>T</mi></msubsup><mo>,</mo></mrow>CIO为轨道坐标系到惯性坐标系的转换矩阵,且<mrow><msub><mi>C</mi><mi>IO</mi></msub><mo>=</mo><msubsup><mi>C</mi><mi>OI</mi><mi>T</mi></msubsup><mo>,</mo></mrow>CλI为惯性坐标系到零经度辅助坐标系的转换矩阵,且<mrow><msub><mi>C</mi><mi>&lambda;I</mi></msub><mo>=</mo><msubsup><mi>C</mi><mi>I&lambda;</mi><mi>T</mi></msubsup><mo>,</mo></mrow>CGλ为零经度辅助坐标系到地理坐标系的转换矩阵,且<mrow><msub><mi>C</mi><mi>G&lambda;</mi></msub><mo>=</mo><msubsup><mi>C</mi><mi>&lambda;G</mi><mi>T</mi></msubsup><mo>;</mo></mrow><mrow><msub><mi>C</mi><mi>OI</mi></msub><mo>=</mo><mfencedopen='['close=']'><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mn>1</mn></mtd></mtr><mtr><mtd><mo>-</mo><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mfencedopen='['close=']'><mtable><mtr><mtd><mi>cos</mi><mi>U</mi></mtd><mtd><mi>sin</mi><mi>U</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><mi>U</mi></mtd><mtd><mi>cos</mi><mi>U</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mfencedopen='['close=']'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>cos</mi><mi>i</mi></mtd><mtd><mi>sin</mi><mi>i</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>sin</mi><mi>i</mi></mtd><mtd><mi>cos</mi><mi>i</mi></mtd></mtr></mtable></mfenced><mfencedopen='['close=']'><mtable><mtr><mtd><mi>cos</mi><mi>&Omega;</mi></mtd><mtd><mi>sin</mi><mi>&Omega;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><mi>&Omega;</mi></mtd><mtd><mi>cos</mi><mi>&Omega;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mrow>i为航天器的轨道倾角、Ω为升交点赤径、ω为近地点幅角、f为真近点角,且U=ω+f,<mrow><msub><mi>C</mi><mi>I&lambda;</mi></msub><mo>=</mo><mfencedopen='['close=']'><mtable><mtr><mtd><mi>cos</mi><mi>&zeta;</mi></mtd><mtd><mi>sin</mi><mi>&zeta;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><mi>&zeta;</mi></mtd><mtd><mi>cos</mi><mi>&zeta;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mrow>ζ为地心到春分点的矢量与地心到零经度方向矢量的夹角,<mrow><msub><mi>C</mi><mi>&lambda;G</mi></msub><mo>=</mo><mfencedopen='['close=']'><mtable><mtr><mtd><mo>-</mo><mi>cos</mi><mi></mi><mi>&lambda;</mi><mi>sin</mi><mi>&delta;</mi></mtd><mtd><mo>-</mo><mi>sin</mi><mi>&lambda;</mi></mtd><mtd><mo>-</mo><mi>cos</mi><mi></mi><mi>&lambda;</mi><mi>cos</mi><mi>&delta;</mi></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><mi></mi><mi>&lambda;</mi><mi>sin</mi><mi>&delta;</mi></mtd><mtd><mi>cos</mi><mi>&lambda;</mi></mtd><mtd><mo>-</mo><mi>sin</mi><mi></mi><mi>&lambda;</mi><mi>cos</mi><mi>&delta;</mi></mtd></mtr><mtr><mtd><mi>cos</mi><mi>&delta;</mi></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>sin</mi><mi>&delta;</mi></mtd></mtr></mtable></mfenced></mrow>λ为航天器所在位置的经度,δ为地平平面法线方向与赤道平面的夹角,<mrow><mi>&sigma;</mi><mo>=</mo><mi>arctan</mi><mrow><mo>(</mo><mfrac><mi>x</mi><mi>y</mi></mfrac><mo>)</mo></mrow><mo>,</mo><mi>x</mi><mo>&GreaterEqual;</mo><mn>0</mn><mo>,</mo><mi>y</mi><mo>&GreaterEqual;</mo><mn>0</mn></mrow>(4)根据地球轮廓点的方位角σ计算其对应的视角半径η,计算公式为cosη=cosη0[1+e·F(φσ)]<mrow><mi>F</mi><mrow><mo>(</mo><mi>&phi;&sigma;</mi><mo>)</mo></mrow><mo>=</mo><mfrac><msubsup><mi>R</mi><mi>e</mi><mn>4</mn></msubsup><mrow><msup><mi>r</mi><mn>2</mn></msup><mrow><mo>(</mo><msup><mi>r</mi><mn>2</mn></msup><mo>-</mo><msubsup><mi>R</mi><mi>e</mi><mn>2</mn></msubsup><mo>)</mo></mrow></mrow></mfrac><mo>[</mo><msup><mi>sin</mi><mn>2</mn></msup><mi>&phi;</mi><mo>+</mo><mfrac><mrow><msup><mi>r</mi><mn>2</mn></msup><mo>-</mo><msubsup><mi>R</mi><mi>e</mi><mn>2</mn></msubsup></mrow><msubsup><mi>R</mi><mi>e</mi><mn>2</mn></msubsup></mfrac><msup><mi>cos</mi><mn>2</mn></msup><mi>&phi;</mi><msup><mi>sin</mi><mn>2</mn></msup><mi>&sigma;</mi><mo>+</mo><mn>2</mn><mo>&CenterDot;</mo><mfrac><msqrt><msup><mi>r</mi><mn>2</mn></msup><mo>-</mo><msubsup><mi>R</mi><mi>e</mi><mn>2</mn></msubsup></msqrt><msub><mi>R</mi><mi>e</mi></msub></mfrac><mi>cos</mi><mi>&phi;</mi><mi>sin</mi><mi></mi><mi>&phi;</mi><mi>sin</mi><mi>&sigma;</mi><mo>]</mo><mo>;</mo></mrow>e为地球的扁率,Re为地球的赤道半径,r为航天器到地心的距离,φ为航天器所在位置的纬度;(5)利用地球轮廓点的视角半径η消除地球扁率的影响,获得修正后的地心矢量。F2009102432795C00011.tif,F2009102432795C00012.tif,F2009102432795C00017.tif,F2009102432795C00023.tif,F2009102432795C00024.tif2.根据权利要求1所述的一种成像式地球敏感器地球扁率修正方法,其特征在于所述敏感器坐标系的原点位于等效光学镜头的中心,x轴沿探测器像素的行方向,y轴沿探测器像素的列方向,z轴构成正交坐标系。3.根据权利要求1所述的一种成像式地球敏感器地球扁率修正方法,其特征在于所述步骤(2)中计算地心矢量VEB时的方法为,以X=[ExEyEz]作为观测量,&=[eixeiyeiz],Z=[11…1],采用最小二乘法,得到X的估计值为<formula>formulaseeoriginaldocumentpage3</formula>4.根据权利要求1所述的一种成像式地球敏感器地球扁率修正方法,其特征在于所述步骤(5)中计算修正后的地心矢量veb时的方法为,以X二[ExEyEz]作为观领U量,Hi=[eixeiyeiz],Z=[cosi^cosn2'"cosnn],应用最小二乘法,得到X的估计值为其中Veb二[ExEyEjT,EiB=[ei^iyeiJT为地球轮廓点的像点在航天器本体系中的表示,1为各地球轮廓点对应的视角半径。全文摘要一种成像式地球敏感器地球扁率修正方法,首先提取地球轮廓点在敏感器光电探测器上的像点坐标,计算像点在航天器本体系中的单位矢量;然后假设地球为标准球形,计算地心矢量VEB,并根据地心矢量VEB得到航天器的滚动角和俯仰角θ;根据前一时刻航天器的姿态预估当前时刻航天器的偏航角ψ,同时从航天器姿态轨道控制系统获取航天器的当前位置以及坐标系转换矩阵,计算地球轮廓点的方位角σ;再根据地球轮廓点的方位角σ计算其对应的视角半径η;最后利用地球轮廓点的视角半径η消除地球扁率的影响,获得修正后的地心矢量。本发明方法操作简单,可以提供更为精确的地心矢量。文档编号G01C21/24GK101750067SQ200910243279公开日2010年6月23日申请日期2009年12月30日优先权日2009年12月30日发明者应磊,郝云彩申请人:北京控制工程研究所
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1