[发明专利]一种基于速度加姿态匹配的传递对准时间延迟估计与补偿方法

摘要

一种基于速度加姿态匹配的传递对准时间延迟估计与补偿方法，该方法有四大步骤一、利用已经对准好的主惯导系统信息，完成子惯导系统的粗对准及导航信息的初始化；二、主、子惯导系统分别进行导航解算，主惯导的速度、姿态信息传输到子惯导的导航计算机；三、在子惯导的导航计算机中，基于常用的速度/姿态匹配模式推导滤波器观测模型，建立含时间延迟的观测方程，进行标准离散卡尔曼滤迭代解算；四、滤波结束后，得到时间延迟的估计值及经过补偿过后的其他状态量的估计值。本发明通过滤波方法可以准确估计时间延迟误差，同时能有效抑制时间延迟对传递对准及惯性器件误差估计精度影响。

主权项

一种基于速度加姿态匹配的传递对准时间延迟估计与补偿方法，其特征在于：该方法具体步骤如下：步骤一：利用已经对准好的主惯导系统信息，完成子惯导系统的粗对准及导航信息的初始化；步骤二：主、子惯导系统分别进行导航解算，主惯导的速度、姿态信息传输到子惯导的导航计算机；步骤三：在子惯导的导航计算机中，基于常用的速度/姿态匹配模式推导滤波器观测模型，建立含时间延迟的观测方程，进行标准离散卡尔曼滤迭代解算；取游动自由方位系为子惯导的导航坐标系，所采用子惯导误差模型为：δv·x=2Ωzδvy-(ρy+2Ωy)δvz-fzψy+fyψz+▿xδv·y=-2Ωzδvx+(ρx+2Ωx)δvz+fzψx-fxψz+▿yδv·z=(ωy+Ωy)δvx-(ωx+Ωx)δvy-fyψx+fxψy+▿zψ·x=Ωzψy-ωyψz-ϵxψ·y=-Ωzψy+ωxψz-ϵyψ·z=ωyψx-ωxψy-ϵzη·x=-1τηxη·y=-1τηyη·z=-1τηzκ·=-1τκ]]>其中δvx、δvy、δvz为速度误差，ρx、ρy、ρz为载体运动角速率矢量分量，Ωx、Ωy、Ωz为地球自转角速率矢量分量,ω表示ρ+Ω；▽x、▽y、▽z为加速度计偏置，f为导航坐标系下载体感受的比力矢量；ψx、ψy、ψz为姿态误差，εx、εy、εz为陀螺漂移；ηx、ηy、ηz为主惯导相对子惯导的安装角误差在主惯导坐标系下的投影分量，τηx、τηy、τηz分别为三轴向相对安装角误差的相关时间；κ为主惯导相对子惯导的延迟时间误差，τκ为延迟时间误差的相关时间；子惯导器件误差模型：陀螺的误差模型为Bx、By、Bz为陀螺的零位误差项；Sgx、Sgy、Sgz为陀螺的标度误差项，Cij(i,j＝1,2,3)为系统子惯导捷联矩阵中的第i行j列元素；加速度计的误差模型为其中Ax、Ay、Az为加速度计的零位误差项；Sax、Say、Saz为加速度计的标度误差项；所选系统状态变量为：X(t)＝[δvx δvy δvz ψx ψy ψz ηx ηy ηz κ Bx By Bz Sgx Sgy Sgz Ax Ay Az Sax Say Saz]T对应的系统状态方程为：其中wax,way,waz为加速度计零偏随机白噪声，wεx,wεy,wεz为陀螺仪漂移随机白噪声；式中F11=02Ωz-(ρy+2Ωy)-2Ωz0ρx+2Ωxρy+2Ωy-(ρx+2Ωx)0F12=0-fzfyfz0-fx-fyfx0]]>F13=Cbn=C11C12C13C21C22C23C31C32C33F14=fx000fy000fz]]>系统观测量：Z＝[δvx δvy δvz M23 ‑M13 M12]T其中子惯导t时刻速度为此时主惯导速度采样有时间延迟κ，速度为主、子惯导速度之差子惯导t时刻捷联矩阵为导航坐标系相对于惯导本体坐标系的角速率在导航坐标系下的投影为此时主惯导姿态采样有时间延迟κ，捷联矩阵为取二者之乘积式中其他类推；观测方程为Z＝HX+V其中时间延迟量测值计算方法考虑到闭环卡尔曼滤波能减少模型线性化误差的影响、准确估计系统状态变量，将上述时间延迟量测值计算过程进行改进，设子惯导t时刻时间延迟估计值为相对安装角误差估计值为1)速度量测值2)姿态量测值步骤四：滤波结束后，得到时间延迟的估计值及经过补偿过后的其他状态量的估计值。