一种惯性平台调平瞄准误差的自检测方法技术

本发明专利技术公开了一种惯性平台调平瞄准误差的自检测方法，在惯性平台结束了调平瞄准后，令其进入断调平状态，通过此种状态下惯性平台在一段时间内的测量信息来计算惯性平台相对当地的实时姿态，再结合断调平后的时间差将台体姿态推算至调平瞄准结束时刻，进而实现了通过自身测量值来检验惯性平台本次调平瞄准误差的方法，具有操作简单，能够实现精确的调平瞄准误差检测的优点。

【技术实现步骤摘要】
一种惯性平台调平瞄准误差的自检测方法
本专利技术涉及一种惯性平台调平瞄准误差的自检测方法。
技术介绍
惯性平台是一种常用的精密导航仪器，广泛的应用于海军舰艇、战略导弹、飞机、卫星等需要高精度自主导航、制导的高科技领域中。惯性平台的调平瞄准是其进行精确惯性导航制导的前提。惯性平台的调平瞄准误差是影响其惯性导航精度的重要因素，惯性平台的调平瞄准误差会直接影响相应运载体的惯性导航精度，对于战略导弹等军事应用背景而言，过量的调平瞄准误差会引起极其严重的后果。因此，调平瞄准误差的检测是重要的一个环节。惯性平台的调平瞄准误差在试验室环境下是可以通过光学测量来进行检验的。然而在其实际工作过程中，由于惯性平台的台体和载体的运动被完全隔离，且台体与外界之间存在框架和外壳的光学遮挡。这两方面问题的存在使得惯性平台的调平瞄准误差很难在工作过程中进行检测。目前的主要检测手段是在调平瞄准后对惯性平台的加速度计输出信息进行人工判读，以此来粗略判断惯性平台本次工作的调平精度。此种方式不仅使过程复杂化，且仍然无法实现精确的调平瞄准误差检测。
技术实现思路
本专利技术所要解决的技术问题是：针对现有技术的不足，提供一种操作简单、精度高的惯性平台调平瞄准误差的自检测方法。本专利技术包括如下技术方案：一种惯性平台调平瞄准误差的自检测方法，包括如下步骤：步骤1、将经过调平瞄准的惯性平台断调平，记录调平瞄准结果以及断调平时刻tdtp，初始化惯性平台的计算参数，初始化数学平台罗经对准参数；调平瞄准结果包括不水平度θx0、θz0和方位角Ax0；惯性平台的计算参数包括数学平台姿态矩阵及其对应的姿态四元数Q，地理纬度L和经度λ，三轴漂移角以及惯性平台误差系数；数学平台罗经对准参数包括网络状态变量dN、dE、da、db、dc以及网络参数k1、k2、kE、kN、kU；步骤2、保持惯性平台断调平状态，采集惯性平台加速度计测量的比力经过工具误差补偿计算得到平台坐标系比力fp以及平台漂移角速率步骤3、根据步骤2中的平台坐标系比力fp进行数学平台罗经回路对准网络计算得到数学平台罗经回路调整指令角速率步骤4、根据步骤2计算出的平台漂移角速率以及步骤3中所计算的数学平台罗经回路调整指令角速率计算平台坐标系相对地理坐标系的角速率在平台坐标系上的投影角速率步骤5、根据步骤4中的角速率更新计算数学平台的姿态四元数Q，并进一步计算数学平台姿态矩阵步骤6、计算当前时刻t与断调平时刻tdtp的差值获得断调平后的时间Δt，利用当地地理纬度和断调平后的时间Δt计算断调平后地理坐标系变化矩阵步骤7、利用步骤2中的平台漂移角速率计算断调平时间段内平台的姿态变化矩阵步骤8、利用步骤5所计算的数学平台姿态矩阵步骤6所计算的地理坐标系变化矩阵和步骤7所计算的姿态变化矩阵推算出断调平时刻的平台相对地理坐标系的姿态矩阵步骤9、判断Δt是否小于时间预设值，如果小于时间预设值，返回步骤2；如果大于等于时间预设值，转入步骤10；步骤10、将步骤8所计算的断调平时刻的平台相对地理坐标系的姿态矩阵转化为惯性平台的不水平度检测值θx、θz和方位角检测值Ax，将惯性平台的不水平度检测值θx、θz和方位角检测值Ax分别与调平对准结果的不水平度θx0、θz0和方位角Ax0作差获得惯性平台调平瞄准误差，惯性平台调平瞄准误差包括不水平度误差Δθx、Δθz和方位角误差ΔAx。所述步骤1中根据调平瞄准结果初始化矩阵具体计算公式为：所述惯性平台误差系数包括三个方向陀螺的零次项误差D0x、D0y、D0z以及三个方向加速度计的零次项误差k0x、k0y、k0z；为三个方向加速度计的测量值；所述步骤2中fp的计算公式为：的计算公式为：所述步骤3中数学平台罗经回路调整指令角速率的计算过程为：步骤3a、将步骤2中的平台坐标系比力fp转化到地理坐标系上的比力fn；步骤3b、以fn为网络计算输入来计算数学平台罗经回路调整指令角速率网络计算状态方程如下：其中，分别表示fn在地理坐标系x轴、z轴上的投影值；输出方程如下：其中，分别表示在地理坐标系x、y、z轴上的投影值。所述步骤4中的计算公式为：为地球自转角速率在当地地理坐标系上的投影，表示地理坐标系到平台坐标系的方向余弦矩阵，ωe为地球自转角速率。所述步骤6中，断调平后地理坐标系变化矩阵的计算公式如下：ωe为地球自转角速率。姿态变化量矩阵的计算包括如下步骤：步骤7a、利用步骤2中的平台漂移角速率更新计算三轴漂移角步骤7b、利用三轴漂移角更新计算姿态变化量矩阵所述步骤9中θx的计算公式为：θz的计算公式为：Ax的计算公式为：本专利技术与现有技术相比具有如下优点：在惯性平台结束了调平瞄准后，令其进入断调平状态，通过此种状态下惯性平台在一段时间内的测量信息来计算惯性平台相对当地的实时姿态，再结合断调平后的时间差将台体姿态推算至调平瞄准结束时刻，进而实现了通过自身测量值来检验惯性平台本次调平瞄准误差的方法，具有操作简单，能够实现精确的调平瞄准误差检测的优点。本专利技术采用一种适用于转动基座的捷联惯组初始对准算法，以平台漂移量为角速率信息、加速度计测量值为比力信息来对惯性平台进行动基座对准计算。进一步将平台姿态信息推算至断调平时刻，与调平瞄准结果进行比较检验，实现对惯性平台调平瞄准误差的检验。附图说明图1为本专利技术惯性平台调平瞄准误差的自检测方法的流程图。图2为本专利技术中数学平台罗经回路对准网络方案图。图3至图5为使用专利技术方法进行仿真试验的结果分析图。具体实施方式下面就结合附图对本专利技术做进一步介绍。惯性平台的调平瞄准结果是台体相对当地地理坐标系的一个姿态结果，对其的检测就是借助各种信息来得到台体相对当地地理坐标系的真实姿态。根据惯性平台坐标系统的工作特点可知，在断调平情况下台体相对惯性空间的角运动和比力信息能够通过漂移量和加速度计测量所获得，采用适当的计算方法即可在此种状态下实时计算出台体相对当地的姿态信息，为惯性平台的调平瞄准误差检测提供基础。在此基础上进一步通过断调平后的时间与平台漂移量信息即可将平台台体姿态信息推算至调平瞄准结束时刻，实现对调平瞄准误差的检测。下面结合附图1对本专利技术做更详细地描述：结合图1，本专利技术惯性平台调平瞄准误差的自检测方法包括如下步骤：步骤1、将经过调平瞄准的惯性平台断调平，记录调平瞄准结果以及断调平时刻的时间tdtp，初始化惯性平台的各计算参数，初始化数学平台罗经对准网络参数，当地地理坐标系选用北天东地理坐标系，即地理坐标系x轴指向北、y轴指向天、z轴指向东。调平瞄准结果包括不水平度θx0、θz0和方位角Ax0；惯性平台的计算参数包括数学平台姿态矩阵及其对应的姿态四元数Q，地理纬度L和经度λ，三轴漂移角三个方向陀螺的零次项误差D0x、D0y、D0z以及三个方向加速度计的零次项误差k0x、k0y、k0z；数学平台罗经对准参数包括网络状态变量dN、dE、da、db、dc以及网络参数k1、k2、kE、kN、kU；其中，数学平台姿态矩阵为平台坐标系到地理坐标系的方向余弦矩阵。所述步骤1中，初始化惯性平台的计算参数，初始化数学平台罗经对准网络参数的过程为：步骤1a、初始化平台坐标系到地理坐标系的方向余弦矩阵及其对应的姿态四元数Q：将调平瞄准结果(不水平度、方位角)转化为平台坐标系到地理坐标系的方向本文档来自技高网...

【技术保护点】
一种惯性平台调平瞄准误差的自检测方法，其特征在于，包括如下步骤：步骤1、将经过调平瞄准的惯性平台断调平，记录调平瞄准结果以及断调平时刻tdtp，初始化惯性平台的计算参数，初始化数学平台罗经对准参数；调平瞄准结果包括不水平度θx0、θz0和方位角Ax0；惯性平台的计算参数包括数学平台姿态矩阵及其对应的姿态四元数Q，地理纬度L和经度λ，三轴漂移角以及惯性平台误差系数；数学平台罗经对准参数包括网络状态变量dN、dE、da、db、dc以及网络参数k1、k2、kE、kN、kU；步骤2、保持惯性平台断调平状态，采集惯性平台加速度计测量的比力经过工具误差补偿计算得到平台坐标系比力fp以及平台漂移角速率步骤3、根据步骤2中的平台坐标系比力fp进行数学平台罗经回路对准网络计算得到数学平台罗经回路调整指令角速率步骤4、根据步骤2计算出的平台漂移角速率以及步骤3中所计算的数学平台罗经回路调整指令角速率计算平台坐标系相对地理坐标系的角速率在平台坐标系上的投影角速率步骤5、根据步骤4中的角速率更新计算数学平台的姿态四元数Q，并进一步计算数学平台姿态矩阵步骤6、计算当前时刻t与断调平时刻tdtp的差值获得断调平后的时间Δt，利用当地地理纬度和断调平后的时间Δt计算断调平后地理坐标系变化矩阵步骤7、利用步骤2中的平台漂移角速率计算断调平时间段内平台的姿态变化矩阵步骤8、利用步骤5所计算的数学平台姿态矩阵步骤6所计算的地理坐标系变化矩阵和步骤7所计算的姿态变化矩阵推算出断调平时刻的平台相对地理坐标系的姿态矩阵步骤9、判断Δt是否小于时间预设值，如果小于时间预设值，返回步骤2；如果大于等于时间预设值，转入步骤10；步骤10、将步骤8所计算的断调平时刻的平台相对地理坐标系的姿态矩阵转化为惯性平台的不水平度检测值θx、θz和方位角检测值Ax，将惯性平台的不水平度检测值θx、θz和方位角检测值Ax分别与调平对准结果的不水平度θx0、θz0和方位角Ax0作差获得惯性平台调平瞄准误差，惯性平台调平瞄准误差包括不水平度误差Δθx、Δθz和方位角误差ΔAx。...

【技术特征摘要】
1.一种惯性平台调平瞄准误差的自检测方法，其特征在于，包括如下步骤：步骤1、将经过调平瞄准的惯性平台断调平，记录调平瞄准结果以及断调平时刻tdtp，初始化惯性平台的计算参数，初始化数学平台罗经对准参数；调平瞄准结果包括不水平度θx0、θz0和方位角Ax0；惯性平台的计算参数包括数学平台姿态矩阵及其对应的姿态四元数Q，地理纬度L和经度λ，三轴漂移角以及惯性平台误差系数；数学平台罗经对准参数包括网络状态变量dN、dE、da、db、dc以及网络参数k1、k2、kE、kN、kU；步骤2、保持惯性平台断调平状态，采集惯性平台加速度计测量的比力经过工具误差补偿计算得到平台坐标系比力fp以及平台漂移角速率步骤3、根据步骤2中的平台坐标系比力fp进行数学平台罗经回路对准网络计算得到数学平台罗经回路调整指令角速率步骤4、根据步骤2计算出的平台漂移角速率以及步骤3中所计算的数学平台罗经回路调整指令角速率计算平台坐标系相对地理坐标系的角速率在平台坐标系上的投影角速率步骤5、根据步骤4中的角速率更新计算数学平台的姿态四元数Q，并进一步计算数学平台姿态矩阵步骤6、计算当前时刻t与断调平时刻tdtp的差值获得断调平后的时间Δt，利用当地地理纬度和断调平后的时间Δt计算断调平后地理坐标系变化矩阵步骤7、利用步骤2中的平台漂移角速率计算断调平时间段内平台的姿态变化矩阵步骤8、利用步骤5所计算的数学平台姿态矩阵步骤6所计算的地理坐标系变化矩阵和步骤7所计算的姿态变化矩阵推算出断调平时刻的平台相对地理坐标系的姿态矩阵步骤9、判断Δt是否小于时间预设值，如果小于时间预设值，返回步骤2；如果大于等于时间预设值，转入步骤10；步骤10、将步骤8所计算的断调平时刻的平台相对地理坐标系的姿态矩阵转化为惯性平台的不水平度检测值θx、θz和方位角检测值Ax，将惯性平台的不水平度检测值θx、θz和方位角检测值Ax分别与调平对准结果的不水平度θx0、θz0和方位角Ax0作差获得惯性平台调平瞄准误差，惯性平台调平瞄准误差包括不水平度误差Δθx、Δθz和方位角误差ΔAx。2.如权利要求1所述的一种惯性平台调平瞄准误差的自检测方法，其特征在于：所述步骤1中根据调平瞄...

【专利技术属性】
技术研发人员：张义，宋维军，董纯，韩利军，尚腾，
申请(专利权)人：北京航天自动控制研究所，中国运载火箭技术研究院，
类型：发明
国别省市：北京;11