专利名称：：基于简化自适应滤波的磁测微小卫星姿态确定方法
技术领域：
：本发明涉及一种磁测微小卫星姿态确定方法，尤其涉及一种基于简化自适应滤波的磁测微小卫星姿态确定方法。
背景技术：
：微小卫星技术是当前国际空间技术研究的热点。微小卫星发射灵活，成本低、功能密度高、研制周期短，具有独特的优势，发达国家在该
技术领域：
走在了前列，民用与军用领域都从中受益。地磁场是中、低轨道环境中的特殊自然资源，三轴磁强计具有体积小、重量轻、成本低、性能可靠、没有视场限制的优点，并能够提供全天侯、实时连续的自主导航信息，与地磁相互作用实现星体控制的磁力矩器也具有成熟可靠、成本低功耗小等特点。磁强计和磁力矩器是目前国内外发射的低轨小卫星上的最基本配置。目前，地磁场已有相当好的磁场模型，采用高斯球谐函数来描述地磁场模型，这样磁场的强度和方向是位置的函数。当确定了卫星轨道参数，就可求得地磁场矢量在地理坐标系的投影，利用地理坐标系与轨道坐标系的转换关系，得到地磁矢量在轨道坐标系的分量，进一步借助姿态方向余弦矩阵给出地磁矢量在星体坐标系的分量，将其与三轴磁强计敏感到的地磁矢量的分量进行比较，就建立起三轴磁强计与卫星姿态动力学的数学关系，采用卡尔曼滤波器递推可以得到卫星姿态角。考虑到小卫星的性价比需求，要求尽可能使用较低的成本来实现小卫星自主导航系统设计，因此，利用丰富的地磁场资源，并结合磁强计测量信息进行低轨小卫星自主轨道确定，将能有效降低微小卫星自主导航系统研制成本，满足小卫星自主导航系统的基本需求。但是，鉴于地磁场的可变性及磁强计本身精度的限制，以及星载计算机的性能限制，使用单磁强计进行卫星自主导航的定轨精度普遍较低，耗时较长。因此需要开展磁定姿技术研究，研究出复杂度适中，适合星上计算的磁导航数学模型与滤波处理方法，以节约星上计算资源。
发明内容本发明目的是针对现有技术存在的缺陷提供一种基于简化自适应滤波的磁测微小卫星姿态确定方法。本发明为实现上述目的，采用如下技术方案本发明基于简化自适应滤波的磁测微小卫星姿态确定方法，包括如下步骤第一步建立卫星姿态运动模型四元素运动学微分方程为(1)q=[qiq2q3q4]T为四元素，上标T表示转置，《为星体坐标系相对轨道坐标系的角速率，$表示q的微分；求导，并忽略二阶小量可得泌为《估计值，Ao=[AOjAo2Ao3]To误差，6q=[66q26q3Sq4]T为四元素误差，Sq13=[Sqi6q2Sq3]T，上标表示微分；卫星在外力矩的作用下，发生姿态的改变，外力矩-间扰动力矩；-般包括卫星的控制力矩与空其中二为(0的微分，Nt为空间扰动力矩，Nr为控制力矩，《为d道坐标系的角速率，J为星体惯量矩阵，h星体偏置动量；相应的误差小量方程为K本坐标系相对轨由式(2)、⑷联合构成状态方程，系统状态量为X=[86q26q3AcoAco2Aco3]T；第二步改进磁强计量测模型量测模型为em=(BmXBb)+(Bm-Bb)(5)其中为磁场误差，Bffl为磁强计测量值，Bb=臥B2B3]t为本体磁矢量估计值，同时为磁强计量测噪声；磁强计测量残差为Bffl=Bb+vffl(6)则量测噪声为v'm=vmXBb+vm当状态量为X时，量测阵为H=[H'第三步量测噪声模型的自适应修正_]v'ffl=vfflXBb+vffl磁强计测量噪声vm为均值Y(nT)白噪声，则。3*3]3*6Diag表示对角矩阵，ir22分别表示观测噪声方差阵及=Diag量测噪声方差阵对角线元素；[r:r2r3]T=_(BbX)[YYY]T+[YYY]T，Y为vm均值，nT表示噪声单位纳特；5第四步滤波解算采用卡尔曼滤波算法进行滤波解算确定卫星姿态。本发明利用三轴磁强计量测的地磁场矢量在仪表坐标系中的分量，通过卡尔曼滤波器可以确定低轨道卫星的姿态。本文提出了一种基于简化滤波算法的磁控微小卫星姿态确定算法。对磁强计量测模型做出了分析和改进，在此基础上简化了滤波增益阵的计算。在不明显影响精度的情况下，使得计算量得到了显著降低，数学仿真表明算法是有效的，三轴磁强计定姿方案可以满足中等姿态精度要求。具有良好的工程意义和应用前景。图1:滚动角曲线；图2:俯仰角曲线；图3:偏航角曲线。具体实施例方式下面结合附图对发明的技术方案进行详细说明本发明中，磁强计作为基本姿态器件，提供长期的低精度姿态信息；当卫星上能源紧张或处在某种不安全状态下，磁强计提供基本信息，维持卫星的生命。1.磁测微小卫星轨道计算微小卫星采用GPS作为轨道信息的唯一来源，全天时提供高精度轨道信息。GPS的输出频率为1Hz，由于姿态输出频率高达10Hz，或者GPS由于可见星不够而不可用时，需要对轨道信息进行预测，预测考虑J2摄动项，以保证足够的精度；由于GPS输出位置和速度信息，为运算方便，轨道参数选择位置速度参数。2.磁强计姿态确定2.1卫星姿态运动模型四元素运动学微分方程为q=[qiq2q3q4]T为四元素，上标T表示转置，《为星体坐标系相对轨道坐标系的角速率…表示q的微分。对式(1)进行求导，并忽略二阶小量可得1为“估计值，Ao=[AOjAo2Ao3]To误差，6q=[66q26q3Sq4]T为四元素误差，Sq13=[Sqi6q2Sq3]T，上标.表示微分。卫星在外力矩的作用下，发生姿态的改变。外力矩一般包括卫星的控制力矩与空间扰动力矩。}(3)其中二为(0的微分，Nt为空间扰动力矩；为控制力矩，《为(道坐标系的角速率，J为星体惯量矩阵，h星体偏置动量。相应的误差小量方程为A0)=J1{[(J+x]-(Sx)jjAco+J'1Nt(4)(2)、(4)联合构成状态方程的话，系统状态量为X=[66q26q3AcoAco2Aco3]T2.2改进磁强计测量模型定义量测模型为K本坐标系相对轨e=(BfflXBb)+(B-Bb)(5)其中em为磁场误差，Bffl为磁强计测量值，Bb=臥B2B3]t为本体磁矢量估计值，同时定义为磁强计量测噪声。磁强计测量残差为Bffl=Bb+vffl(6)则effl=((2(BbX)6q13+Bb+vffl)XBb)+((2(BbX)5q13+Bb+vffl)_Bb)=-2[(BbX)(BbX)]Sq13+vmXBb+2(BbX)6q13+vm=H'8q13+v'量测噪声为v'm=vmXBb+vm当状态量为X时，量测阵为H=[H'03]3。2.3观测噪声模型的自适应修正v'ffl=vfflXBb+vffl假设磁强计测量噪声vm为均值Y(nT)白噪声。则Diag表示对角矩阵”2分别表示量测噪声方差阵及=量测噪声方差阵对角线元素；[r:r2r3]T=_(BbX)[YYY]T+[YYY]T，Y为vm均值，nT表示噪声单位纳特；2.4滤波解算卡尔曼滤波算法在建立系统方程、量测方程以后，就是按部就班的常规算法。本申请中，系统量测噪声方差阵为自适应计算，系统状态噪声方差阵则根据系统实际情况取常值就可以，并没有特别算法。采用扩展卡尔曼滤波器进行滤波，建立离散的扩展卡尔曼滤波方程为式中之.表示tk时刻的状态对tk+1时刻的状态的最优预测估计值；Pk+l|k表示最优预测估值误差协方差阵；之+1|t+1表示tk+1时刻的状态的最优实时估计值；Pk+l|k+1表示最优滤波误差协方差阵沖k+1|k表示状态矢量X从tk时间转移到tk+1时刻的状态转移矩阵；T表示采样周期；Hk+1表示tk+1时刻观测矢量Zk+1与tk+1时刻的状态矢量Xk+1间的量测系数矩阵；Qk表示系统状态噪声方差阵；&+1表示量测噪声方差阵。解算后令只保留对角线元素，K阵简化为对角阵，滤波无矩阵求逆运算。仿真结果假设微小卫星为太阳同步轨道卫星，轨道高度约500km，姿态控制系统由星载计算机、三轴磁强计、偏置动量轮及三轴磁力矩器等构成。轨道测量位置误差优于10km、速度误差优于2ms。卫星的剩磁矩为0.3Am2，在各个轴上的分量是diagAm2。其余干扰力矩设为白噪声，量级为5e-7Nm，滤波时噪声参数调整为5e-6Nm。卫星的三轴转动惯量为diag[1.031.051.01]kgm2。磁强计的测量精度为300nT(1o)，输出频率0.5Hz。由图1图3与相关数据分析可得，三轴指向精度滚动角优于2.0°，俯仰角优于2.0°，偏航角优于2.0°。权利要求一种基于简化自适应滤波的磁测微小卫星姿态确定方法，其特征在于包括如下步骤第一步建立卫星姿态运动模型四元素运动学微分方程为<mrow><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mfrac><mn>1</mn><mn>2</mn></mfrac><mo>[</mo><mi>q</mi><mo>&times;</mo><mo>]</mo><mi>&omega;</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>q＝[q1q2q3q4]T为四元素，上标T表示转置，ω为星体坐标系相对轨道坐标系的角速率，上标·表示微分，下同；对式(1)进行求导，并忽略二阶小量可得<mrow><mfencedopen='{'close=''><mtable><mtr><mtd><mi>&delta;</mi><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mn>13</mn></msub><mo>=</mo><mo>-</mo><mo>[</mo><mover><mi>&omega;</mi><mo>^</mo></mover><mo>&times;</mo><mo>]</mo><mi>&delta;</mi><msub><mi>q</mi><mn>13</mn></msub><mo>+</mo><mfrac><mn>1</mn><mn>2</mn></mfrac><mi>&Delta;&omega;</mi></mtd></mtr><mtr><mtd><mi>&delta;</mi><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mn>4</mn></msub><mo>=</mo><mn>0</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>为ω估计值，Δω＝[Δω1Δω2Δω3]T为ω误差，δq＝[δq1δq2δq3δq4]T为四元素误差，δq13＝[δq1δq2δq3]T；卫星在外力矩的作用下，发生姿态的改变，外力矩包括卫星的控制力矩Nr与空间扰动力矩Nτ；<mrow><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mo>=</mo><msup><mi>J</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>{</mo><msub><mi>N</mi><mi>r</mi></msub><mo>-</mo><mi>&omega;</mi><mo>&times;</mo><mrow><mo>(</mo><mi>J&omega;</mi><mo>+</mo><mi>h</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>N</mi><mi>&tau;</mi></msub><mo>}</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>其中J为星体惯量矩阵，h星体偏置动量；星体坐标系相对轨道坐标系的角速率相应的误差小量方程为<mrow><mi>&Delta;</mi><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mo>=</mo><msup><mi>J</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>{</mo><mo>[</mo><mrow><mo>(</mo><mi>J</mi><mover><mi>&omega;</mi><mo>^</mo></mover><mo>+</mo><mi>h</mi><mo>)</mo></mrow><mo>&times;</mo><mo>]</mo><mo>-</mo><mrow><mo>(</mo><mover><mi>&omega;</mi><mo>^</mo></mover><mo>&times;</mo><mo>)</mo></mrow><mi>J</mi><mo>}</mo><mo>&CenterDot;</mo><mi>&Delta;&omega;</mi><mo>+</mo><msup><mi>J</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>&CenterDot;</mo><msub><mi>N</mi><mi>&tau;</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>由式(2)、(4)联合构成状态方程，系统状态量为X＝[δq1δq2δq3Δω1Δω2Δω3]T；第二步改进磁强计量测模型量测模型为em＝(Bm×Bb)+(Bm-Bb)(5)其中em为磁场误差，Bm为磁强计测量值，Bb＝[B1B2B3]T为本体磁矢量估计值，同时vm为磁强计量测噪声；磁强计测量残差为Bm＝Bb+vm(6)则em＝((2(Bb×)δq13+Bb+vm)×Bb)+((2(Bb×)δq13+Bb+vm)-Bb)＝-2[(Bb×)(Bb×)]δq13+vm×Bb+2(Bb×)δq13+vm＝H′δq13+v′m<mrow><msup><mi>H</mi><mo>&prime;</mo></msup><mo>=</mo><mo>-</mo><mn>2</mn><mfencedopen='['close=']'><mtable><mtr><mtd><mo>-</mo><mrow><mo>(</mo><msubsup><mi>B</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>B</mi><mn>3</mn><mn>2</mn></msubsup><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mrow><mo>(</mo><msubsup><mi>B</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>B</mi><mn>3</mn><mn>2</mn></msubsup><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mrow><mo>(</mo><msubsup><mi>B</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>B</mi><mn>2</mn><mn>2</mn></msubsup><mo>)</mo></mrow></mtd></mtr></mtable></mfenced></mrow>量测噪声为v′m＝vm×Bb+vm当状态量为X时，量测阵为H＝[H′03*3]3*6；第三步量测噪声模型的自适应修正v′m＝vm×Bb+vm磁强计测量噪声vm为均值Y(nT)白噪声，则量测噪声方差阵Diag表示对角矩阵，分别表示量测噪声方差阵对角线元素；[r1r2r3]T＝-(Bb×)[YYY]T+[YYY]T，Y为vm均值，nT表示噪声单位纳特；第四步滤波解算采用卡尔曼滤波算法进行滤波解算确定卫星姿态。FSA00000155810600013.tif,FSA00000155810600022.tif,FSA00000155810600023.tif全文摘要本发明公布了一种基于简化自适应滤波的磁测微小卫星姿态确定方法，包括如下步骤第一步建立卫星姿态运动模型，第二步改进磁强计测量模型，第三步量测噪声模型的自适应修正，第四步滤波解算。本发明对磁强计量测模型做出了分析和改进，在此基础上简化了滤波增益阵的计算。在不明显影响精度的情况下，使得计算量得到了显著降低，数学仿真表明算法是有效的，三轴磁强计定姿方案可以满足中等姿态精度要求。具有良好的工程意义和应用前景。文档编号G01C21/00GK101852605SQ20101019785公开日2010年10月6日申请日期2010年6月10日优先权日2010年6月10日发明者华冰,康国华,熊智,程月华,郁丰申请人:南京航空航天大学