1.一种离线小波降噪快速初始对准方法,其特征在于按照如下步骤进行:步骤一、传感器数据获取,包括光纤陀螺仪和石英挠性加速度计数据;
步骤二、建立初始对准坐标系,包括初始载体坐标系、初始导航坐标系、初始地球坐标系、载体坐标系、导航坐标系、地球坐标系与惯性坐标系;
步骤三、建立重力视运动矢量模型,构造离线小波降噪算法;
步骤四、利用降噪滤波之后的重力视运动矢量,进行最优初始姿态的解算;
步骤五、利用计算得到的最优初始姿态四元数,结合姿态矩阵链式法则,实现快速初始对准过程。
2.根据权利要求1所述的离线小波降噪快速初始对准方法,其特征在于所述的步骤二中:所述的初始时刻载体坐标系,记为b0系;所述的初始导航坐标系,记为n0系;所述的初始地球坐标系,记为e0系;所述载体坐标系表示与惯性测量单元的体坐标系重合的坐标系,记为b系;所述的导航系表示载体所在位置的东-北-天坐标系,记为n系;所述的地球坐标系为与地球固连,相对惯性坐标系以地球自转角速度ωie旋转,记为e系;
所述的坐标系存在如下转换关系:
地球系与导航系方向余弦矩阵 表示为
式中:L表示载体所在纬度;
惯性系与地球系的转换矩阵 表示为
式中:ωie表示地球自转速率;Δt表示采样时间;
考虑载体在地球上处于无线运动状态,则初始导航系与导航系之间的转换矩阵可以表示为式中: 为 的转置; 为 的转置; 通过 即可得到导航系运动四元数初始载体系与载体系之间的转换四元数 表示为
式中: 表示四元数的微分; 表示载体相对惯性系的旋转角速率在载体系下的映射; 表示四元数乘法; 表示初始载体系与载体系之间的变换四元数。
3.根据权利要求1所述的离线小波降噪快速初始对准方法,其特征在于所述的步骤三中建立重力视运动矢量模型,构造离线小波降噪算法:(1)重力视运动矢量模型
所述的重力视运动矢量模型采用如下变换得到:
运动载体的比力方程可以由下式得到
式中: 表示导航系速度微分;fn表示导航系比力; 表示地球自转角速率在导航系上的投影; 表示导航系相对于地球系运动角速度在导航系上的投影;gn表示载体所在位置导航系重力;
由于载体处于静止状态,因此所述导航系速度vn与导航系速度微分 为0,则可以得到简化变换模型为式中: 表示初始载体系与载体系之间的变换四元数; 表示初始导航系与导航系之间的变换四元数; 表示初始载体系与初始导航系之间的变换四元数;gn表示载体所在位置导航系重力;*表示四元数取共轭运算;
由于实际加速度计与陀螺仪输出含有随机噪声,即式中: 表示加速度计量测加速度;fb表示真实载体系加速度; 表示加速度计测量零偏;∈b表示加速度计测量随机噪声; 表示陀螺仪测量角速度;ωb表示真实载体运动角速度;εb表示陀螺仪测量零偏;ηb表示陀螺仪测量随机噪声;
因此,所述的重力视运动矢量模型可以表示为
式中: 表示重力视运动矢量量测; 表示初始载体系与载体系之间的变换四元数;
表示误差四元数;fb表示真实载体系加速度; 表示加速度计测量零偏;εb表示加速度计测量随机噪声;*表示四元数取共轭运算;
对所述重力视运动矢量模型进行简化并忽略二阶噪声式中: 表示加速度计零偏在初始载体系上的投影;∈b0表示加速度计随机噪声在初始载体系上的投影;
(2)离线小波降噪
所述的离散小波降噪主要是实现对重力视运动矢量模型中的随机噪声进行降噪,从而提高重力视运动矢量的识别精度,加快粗对准过程;
对所述的重力视运动矢量模型 采用小波分解,其分解过程为式中, 表示视在重力矢量;c0,m表示系数权重;φ0,m(t)表示尺度函数;
由Mallat小波变换可知
式中,cj,l表示第j层离散平滑逼近;dj,l表示第j层离散细节信号;cj-1,m表示第j-1层离散平滑逼近;h0,m-2l和h1,m-2l分别表示线性组合权重,可由下式计算式中,φ0,m(t)和φ1,l(t)为尺度函数;ψ0,m(t)表示小波函数;
通过分解之后小波系数,结合相应的阈值压缩方法,可以得到小波重构系数为:式中, 表示重构之后的第j-1层离散平滑逼近; 表示重构之后的第j层离散平滑逼近; 表示重构之后第j层离散细节信号;h0,m-2l和h1,m-2l分别表示线性组合权重;
结合重构系数 降噪之后的视在重力矢量模型为
式中, 表示重构之后的视在重力矢量模型; 表示重构之后初始离散逼近平滑;
φ0,m(t)表示尺度函数。
4.根据权利要求1所述的离线小波降噪快速初始对准方法,其特征在于所述的步骤四中利用降噪滤波之后的重力视运动矢量,进行最优初始姿态的解算:所述的快速初始对准过程中,参考矢量和观测矢量可由下式计算式中,α表示参考矢量;β表示观测矢量;|| ||表示范数运算; 表示重构之后的视在重力矢量模型;gn0表示初始导航系下的重力矢量,可由下式计算式中, 是由当前导航系到初始导航系之间的旋转矩阵;gn为当地重力矢量;gn0表示初始导航系下的重力矢量;
对观测矢量和量测矢量离散化之后,构造filter-QUESTK-矩阵式中,
式中,βk表示离散化之后的观测矢量;αk表示离散化之后的参考矢量;
所述初始姿态四元数满足归一化条件
式中,T表示矢量转置; 表示初始姿态四元数;
由拉格朗日乘数法可得
式中,Kk表示迭代计算的K-矩阵;λmax表示最大特征值; 表示初始姿态四元数。
5.根据权利要求1所述的离线小波降噪快速初始对准方法,其特征在于所述的步骤五中利用计算得到的最优初始姿态四元数,结合姿态矩阵链式法则,实现快速初始对准过程:由旋转矩阵链式法则可得
式中, 可由迭代四元数 计算; 表示导航系与初始导航系之间得旋转矩阵;
可由初始姿态四元数 计算; 表示对准之后的旋转矩阵。
6.根据权利要求1所述的离线小波降噪快速初始对准方法,其特征在于:步骤2中,纬度L=31.64°,经度选为λ=120.74°,地球自转角速率ωie=15.0411°/hr,采样时间Δt=
0.005s。
7.根据权利要求1所述的离线小波降噪快速初始对准方法,其特征在于:步骤3和步骤4中,初始四元数 初始旋转矩阵
8.根据权利要求1所述的离线小波降噪快速初始对准方法,其特征在于:所用的光纤陀螺仪随机游走系数为 零偏为εb=0.02°/hr[1 1 1]T,石英挠性加速度计随机游走系数为 零偏为 所采
取的对准方式分为摇摆机座对准,其中动机座对准中,三轴摇摆幅度分别为横滚ρ=10°、俯仰 航向ψ=6°,摇摆频率为横滚0.2Hz、俯仰0.125Hz、、航向0.15Hz、。所用的小波函数为“sym4”,小波分解层数为6。