本发明涉及卫星姿态传感器测量技术领域,更具体的说是涉及一种基于星敏感器辅助的陀螺误差参数在轨快速标定方法。
背景技术:
随着对卫星观测任务的精确度、复杂度需求的提高,人们对卫星姿态确定的精度要求越来越高。提高定姿传感器测量精度是实现高精度的卫星姿态确定的最重要的方法之一。目前,由星敏感器和陀螺组合作为定姿传感器是高精度定姿系统的首选。陀螺自主性良好,可靠性强,但测量误差会随时间增加不断累积。影响陀螺测量精度的主要误差项有常值偏差、安装误差、刻度因子误差等,尽管通过地面标校的方法进行这些参数补偿处理,但是受到在卫星发射过程中的振动、温度和磁场等空间复杂环境因素的影响,标定参数不可避免的会发生变化,为此就必须对陀螺的误差参数在轨进行快速、准确、有效、可靠的标定和补偿,来确保其使用精度。星敏感器作为星载定姿系统的另一重要传感器,虽易受动态环境的影响,但其精度较高,误差不随时间发散,长期运行条件下精度良好。用星敏感器测量来实现对陀螺相关误差参数的标定和补偿,是提高卫星定姿精度的有效途径。
常用的陀螺误差参数标定方法有两类:一类是基于状态估计的方法,如扩展卡尔曼滤波、无迹滤波等滤波方法,该类方法在建立陀螺误差参数的动态模型的基础上,将其增广为状态向量的一部分,再利用滤波方法在估计姿态参数的同时在线递推估计陀螺误差参数,被估误差参数需要一定的时间才能稳定收敛;与此同时,还需要星敏感器作为姿态参考,要能够提供满足数量和精度要求的有效测量信息。为了保证陀螺误差参数具备可观测性,能被有效估计,卫星需要执行姿态机动。但是,星敏感器受到动态性能约束,只能在缓慢机动条件下才能提供有效输出,这使得基于状态估计的方法难以满足快速性要求,且估计精度也会受到系统模型及噪声参数的准确程度的影响。另一类是基于参数估计的方法,如常用的最小二乘方法,仅需建立关于被估的陀螺误差参数与系统测量量之间的测量模型,利用最小二乘准则来获得误差参数的估计值,该方法对测量噪声的统计特性无特定要求,但需要星敏感器在标定过程中提供满足最小二乘求解的有效输出。
因此,如何实现星敏感器对陀螺误差参数的在轨精确、快速标定是本领域技术人员亟需解决的问题。
技术实现要素:
有鉴于此,本发明提供了一种基于星敏感器辅助的陀螺误差参数在轨快速标定方法,根据卫星系统限制角速度和限制角加速度,规划机动角速度和角加速度,设置机动策略;根据卫星姿态运动学方程、陀螺输出方程、星敏感器输出方程,基于高阶毕卡逼近解算方法,建立线性近似的陀螺误差参数标定模型;根据建立的陀螺误差标定模型,结合机动过程中的陀螺和星敏感器的测量数据,利用最小二乘方法,进行误差参数标定,获得参数估计值;根据线性化展开点对精度影响效果,将参数估计作为新的线性化展开点,对估计参数残差进行迭代补偿,直至残差向量平方和不再减少或估计参数误差的变化小于给定的门限或迭代次数超过预设的限制次数。从解决在轨应用时保证标定过程的快速性问题出发,将最小二乘参数估计思想与快速机动策略设计相结合,实现了一种利用星敏感器测量,在卫星进行快速姿态机动的情况下,进行陀螺误差参数标定的方法,大幅减少了标定过程的耗时,解决了由于受到星敏感器在高动态情况下无有效输出限制而难以实现陀螺误差参数在轨快速标定的问题;同时通过建立关于陀螺误差参数的准确标定模型,利用星敏感器和陀螺的测量输出,采用参数迭代估计策略,改善了线性化处理过程带来的模型精度损失对参数估计精度的影响,提高了陀螺误差参数估计的精度。
为了实现上述目的,本发明采用如下技术方案:
一种基于星敏感器辅助的陀螺误差参数在轨快速标定方法,具体步骤包括:
步骤1:根据卫星系统参数设置卫星姿态机动策略,所述卫星依据所述卫星姿态机动策略实施姿态机动;
根据卫星姿态机动策略原则设计所述卫星姿态机动策略,可采用梯形或三角函数形或三角形或样条函数的所述卫星姿态机动策略,所述卫星绕卫星的三个惯性主轴依次进行若干轮机动;
步骤2:根据卫星姿态运动学方程、陀螺输出方程、星敏感器输出方程,在建立非线性陀螺误差参数标定模型基础上,基于高阶毕卡逼近解算方法建立线性近似的陀螺误差参数标定模型;
所述步骤2中所述陀螺输出方程为:
其中,ωg表示陀螺输出角速度向量
动坐标系相对参考坐标系的方位,等效于动坐标系绕某一个等效转轴转动一个角度;定义描述某两坐标系之间转动关系的四元数为q=[q0q1q2q3]t,其中,标量部分为q0,矢量部分为[q1q2q3]t;设en为等效转轴方向的单位向量,
以四元数形式输出的所述星敏感器输出方程为:
其中,qst表示星敏感器输出的姿态四元数,也即星敏感器坐标系相对于惯性系的四元数;
卫星姿态运动学方程可用姿态四元数描述如下:
由以上方程,可推得所述陀螺误差参数标定模型,所述陀螺误差参数标定模型线性化后获得的线性化标定模型可表示为z=hx+v;其中,z为由所述陀螺测量输出、所述星敏测量输出构造的线性化标定模型观测量;
步骤3:根据所述陀螺误差参数标定模型,结合所述卫星姿态机动过程中的陀螺测量数据和星敏感器测量数据,采用最小二乘方法,进行误差参数标定,获得陀螺误差参数估计值,并计算残差向量平方和;
采集所述卫星按照所述卫星姿态机动策略机动过程中的星敏感器测量数据和陀螺测量数据,提取机动时间段内的所述陀螺和所述星敏感器的有效测量数据,基于最小二乘准则,通过令实际线性化标定模型观测量z和由所述陀螺误差参数估计值
步骤4:利用所述陀螺误差参数估计值计算补偿后陀螺测量值和所述残差向量平方和;
利用所述陀螺误差参数估计值
根据所述补偿后陀螺测量值和卫星姿态四元数计算t时刻的残差向量:
由于[t+kδt,t+(k+1)δt]时间间隔内的角速度基本保持恒定,则在所述时间间隔内有
则所述机动过程中的所述残差向量平方和为:
将所述残差向量平方和作为评估误差参数估计质量的指标;
步骤5:根据所述补偿后陀螺测量值建立陀螺误差参数线性化标定模型,并利用最小二乘估计方法计算出陀螺误差参数修正量;
步骤6:根据所述陀螺误差参数修正量对所述陀螺误差参数估计值进行修正,获得修正后陀螺误差参数估计值,并计算修正后的所述残差向量平方和;当所述残差向量平方和不再减少或所述陀螺误差参数估计值变化小于设定门限或迭代次数超过预设限制次数,则将所述修正后陀螺误差参数估计值作为陀螺误差参数最终标定结果;否则将所述修正后陀螺误差参数估计值作为所述陀螺误差参数估计值,并进入所述步骤4。
经由上述的技术方案可知,与现有技术相比,本发明公开提供了一种基于星敏感器辅助的陀螺误差参数在轨快速标定方法,通过规划的姿态机动策略激发陀螺测量模型中误差参数的可观性;通过对卫星姿态运动学方程的分析,构建出高精度的陀螺误差参数标定模型;然后利用陀螺误差参数标定模型结合基于最小二乘准则的标定算法,使用陀螺和星敏感器的测量数据,对陀螺误差参数进行初步估计;最后利用陀螺误差参数的初步估计结果对陀螺测量误差进行补偿,并以此作为更精准的线性化展开点,对陀螺误差参数进行进一步的迭代估计,进而获取更准确的参数估计值。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图。
图1附图为本发明提供的基于星敏感器辅助的陀螺误差参数在轨快速标定方法流程图;
图2附图为本发明提供的单轮机动曲线及星敏感器采样对照图;
图3附图为本发明提供的卫星姿态机动示意图;
图4附图为本发明提供的残差向量平方和变化曲线示意图;
图5附图为本发明提供的常值偏差估计参数变化曲线示意图;
图6附图为本发明提供的安装误差估计参数变化曲线示意图;
图7附图为本发明提供的刻度因子误差估计参数变化曲线示意图;
图8附图为本发明提供的最终标定误差百分比示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例公开了一种基于星敏感器辅助的陀螺误差参数在轨快速标定方法,根据卫星系统限制角速度和限制角加速度,规划机动角速度和角加速度,设置姿态机动策略;根据卫星姿态运动学方程、陀螺输出方程、星敏感器输出方程,基于高阶毕卡逼近解算方法,建立线性近似的陀螺误差参数标定模型;根据建立的陀螺误差标定模型,结合机动过程中的陀螺和星敏感器的测量数据,利用最小二乘方法,进行误差参数标定,获得参数估计值;根据线性化展开点对精度影响效果,将参数估计作为新的线性化展开点,对估计参数残差进行迭代补偿,直至估计参数误差的变化小于给定的门限或迭代次数超过预设的限制次数。具体的实现过程如下:
s1:姿态机动策略的设定;
在卫星稳定运行条件下实施姿态机动,根据卫星的实际运动参数情况,从保障标定快速性和参数估计有效性角度出发,本发明设定满足以下原则的卫星姿态机动策略:
1.根据卫星系统最大角度、最大角速度、最大角加速度等参数、设置目标姿态机动的相关参数;
2.绕卫星的三个惯性主轴均进行姿态机动,机动进行数轮;
3.不同轮次采用不同的机动角速度,且在目标机动的参数限制下,设置出各轮次机动角速度,若对安装误差和刻度因子误差的标定精度要求较高,机动角速度可在满足限制的条件下尽量取大;
4.根据星敏感器的动态性能,在设计机动时保留可使星敏感器获得有效输出的时间区间,即在机动过程中有使星敏感器输出的时间;
5.在姿态机动结束后,卫星恢复到保证正常工作的姿态;
6.机动易实施;
根据上述原则,可以采用梯形、三角函数形、三角形、样条函数等机动角速度的变化形式;机动绕卫星的三个惯性主轴依次进行,机动顺序不限;重复进行若干轮机动。
按照上述原则,本实施例中展示一种三角形的机动策略如下:
根据卫星系统的卫星最大角速度χmax,确定机动最大角速度χm,可取机动最大角速度小于或等于卫星最大角速度χm≤χmax;根据卫星系统最大角加速度
卫星绕三轴分别进行姿态机动,每个轴向的机动过程分为六个阶段,分为正向机动加速阶段、正向机动减速阶段、正向平稳运行阶段、反向机动加速阶段、反向机动减速阶段、反向平稳运行阶段;三轴机动的轴向顺序为x-y-z;共进行三轮机动,每轮机动的最大角速度χi,m满足
计算机动过程的特征时间:设机动开始时刻为t0;正向加速阶段时间为
则单轮每个轴向的机动时间
单轮机动曲线图及星敏感器采样示意图如图2所示,三个单轮机动曲线横轴均表示时间,纵轴分别表示三轴方向上的机动角速度;
在卫星系统中机动实例如上所述。在本发明实际应用过程中,只需根据实际情况,在满足设定原则下进行机动策略设定,其设定不受固定机动形式约束;
s2:建立陀螺误差参数标定模型;
陀螺输出方程为:
上式中,ωg表示陀螺输出角速度向量
记
假定陀螺的敏感轴均沿机体轴安装,则陀螺安装矩阵
ωb≈(i-[δ×]+λ)(ωg-b-η)(5)
将描述两个坐标系之间的转动关系的四元数定义为q=[q0q1q2q3]t,标量部分为q0,且||q||=1。用四元数形式描述的星敏感器输出方程为:
在上式星敏感器输出方程中,
一般地,星敏感器在实际系统中的安装矩阵已知,由此经过转换星敏感器可以输出卫星本体系相对于惯性系的姿态,为简化模型推导设
由于
其中,δ=χ+λ+ξ,则由式(6)可得如下方程:
卫星姿态运动学方程可用姿态四元数描述如下:
其中,
采用毕卡逼近法,上述四元数微分方程的解为:
考虑到陀螺的输出频率通常比较高,而卫星姿态变化相对稳定,假定在[t,t+nδt]时间段内,星敏感器连续两次输出的时间间隔为nδt,而陀螺的输出时间间隔为δt,设在δt内的角速度基本保持恒定,即该时间间隔内
令
将式(7)代入上式(10)中,可得:
由四元数乘法法则,有:
将式(12)代入式(11),经过整理可推得:
将式(13)右端取三阶近似,可得:
其中,δθ=[δθxδθyδθz]t,
根据四元数与角速度叉乘关系,可知
χ(ωb)(qst)t=m((qst)t)ωb(16)
其中,
根据式(5),可得:
其中,
δθ2=δt2|ωb|2=δt2(|ωg|2+w)(19)
其中,w为模型近似处理带来的误差;
将式(18)、式(19)代入式(17),忽略关于误差参数的高阶项,有:
令
将(21)代入(20),可得:
设待标定陀螺误差参数向量为
zt=htx+vt(23)
其中,
vt为由陀螺和星敏感器的测量误差、线性化过程中近似误差等引起的线性化标定模型等效噪声;
对整个姿态机动区间,按照上述方法,利用相邻两次星敏感器的测量以及两次测量间隔内的陀螺测量数据,建立多组标定方程,将它们组合在一起,得到整体的误差参数标定方程即陀螺误差参数线性化标定模型如下:
z=hx+v
其中,z为在姿态机动过程中由陀螺测量输出、星敏测量输出构造的线性化标定模型观测量
s3:基于最小二乘准则的参数估计;
在噪声v统计特性未知的情况下,基于最小二乘准则,通过使估计测量与实际测量的误差平方和最小,得到待定的陀螺误差参数的估计:
s4:评价陀螺误差参数的估计效果;
在算得
由[tj,tj+1]时间间隔内各时刻补偿后的陀螺测量可以计算残差向量:
由于[t+kδt,t+(k+1)δt]时间间隔内的角速度基本保持恒定,则在所述时间间隔内有
并可以进一步计算机动过程中的所有残差向量的平方和
将其作为评价误差参数估计质量的指标;
s5:陀螺误差参数的迭代估计
由于在s2建立线性化的陀螺误差参数标定模型的过程中,舍去高阶小等近似处理带来了模型误差,接下来采用最小二乘迭代估计的方法,来进一步逼近陀螺误差参数的真值。
采用s2基于毕卡逼近解算建立线性化的陀螺误差参数标定模型的方法,利用补偿后的陀螺测量
再采用s4中计算残差向量平方和的方法计算此时的残差ε1;不断重复以上迭代过程,直到满足以下任意条件,迭代终止;
(1)第m步迭代的残差平方和εm不再减少,即εm≥εm-1;
(2)陀螺误差参数修正量的估计
(3)m>ma,ma为最大迭代次数;
此时,迭代终止,陀螺误差参数的最终标定结果为:
实施例
以低轨卫星为应用对象进行仿真。假设卫星限制角速度为3°/s,一直处于平稳运行状态;假设卫星星敏感器的输出频率为1hz,在整秒时刻输出,星敏感器的敏感轴均沿机体轴安装,低频误差具有三个频点,周期分别6000s、400s、3000s,幅值分别为5.0”、0.5”、0.2”,随机测量噪声误差标准差为1”;假设陀螺的输出频率为50hz,敏感轴均沿机体轴安装,角速率随机噪声标准差为0.05°/h;根据卫星系统实际情况,取常值偏差为0.6°/h、0.6°/h、-0.6°/h,安装误差为60”、60”、60”,刻度因子误差量级为1000ppm,即取为0.001、0.001、-0.001。已知待标定参数由常值偏差、安装误差、刻度因子误差依次组成,则待标定陀螺误差参数向量的真值为
xreal=[btrealδtrealstreal]t
其中
breal=[0.60.6-0.6]t°/h
δreal=[6060-60]t”
sreal=[1.0e-31.0e-3-1.0e-3]t
设置最大迭代次数ma=10,误差参数修正系数α=e-5。
设置机动开始时刻为仿真第2700s,单轮每个轴向单阶段机动时间为1s,则机动结束时刻为仿真第2754s,机动示意图如图3,横轴表示时间,纵轴分别表示三轴方向上的机动角速度。对卫星实施该机动。
取仿真第2690s至第2764s时间段内的星敏感器和陀螺的测量数据,代入误差参数标定模型获得56组zt和ht,由此构成陀螺误差参数标定方程组。
根据最小二乘估计法求出保留六位有效数字的陀螺误差参数估计值为
其中
求得残差向量平方和为ε0=2.354693642931023e-9。
将
其中
则修正后的参数估计值
其中
求得残差平方和ε1=2.354688737897910e-7。此时,ε1<ε0,估计参数修正量不满足
将
其中
修正后的参数估计值
其中
求得残差平方和ε2=2.354688732056278e-7。此时,ε2>ε1,估计参数修正量不满足
将
其中
修正后的参数估计值
其中
求得残差平方和ε3=2.354688731978770e-7。此时,ε3<ε2,残差向量平方和仍有略微减小;迭代次数m<ma;但估计参数修正量
估计误差为参数估计值
η=[4.618.376.774.947.038.096.023.570.603]t
迭代过程中的残差向量平方和变化曲线如图4,常值偏差估计参数变化曲线如图5所示,安装误差估计参数变化曲线如图6所示,刻度因子误差估计参数变化曲线如图7所示,横轴均表示迭代次数;最终标定误差百分比如图8所示,纵轴表示误差百分比,横轴表示对应的误差参数。
本发明的有益效果:
1、本发明提供的陀螺误差参数在轨标定方法具有快速性;
2、不受星敏感器测量时对卫星角运动的动态条件的限制,可在卫星以较大的角速度进行机动时应用;
3、通过多轮次的姿态机动,采用变角速度的机动策略,提高陀螺误差参数估计的精度;
4、采用高阶模型近似建立的陀螺误差参数估计的线性化模型精度高,获得良好的标定性能;
5、采用迭代求解方法,保证陀螺误差参数的标定精度;
6、本发明实现简单,不仅适用于卫星,也可以扩展到其他领域。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的装置而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。