SINS/DVL组合导航系统安装误差结构补偿方法技术方案

本发明专利技术公开了一种SINS/DVL组合导航系统安装误差结构补偿方法，属于导航技术领域，其特征在于，包括如下步骤：S1：安装误差相关坐标系映射结构设计；S2：工业CT扫描标定；利用工业CT对装配完成的DVL内部不同材质之间几何尺寸进行扫描分析，从而计算安装误差相关各坐标系间的对应关系，通过工业CT扫描，复测四个换能器垂向轴与DVL坐标系之间的安装误差，并在方案软件中补偿，由于SINS安装面与DVL安装面的平行度较高，所以忽略二者之间的横摇角和纵摇角安装误差；步骤3：标定结果补偿，本发明专利技术采用基于换能器的安装误差补偿方案，在保证Janus配置优势的前提下，实现安装误差的精确补偿。

Compensation method for installation error structure of SINS / DVL integrated navigation system

【技术实现步骤摘要】
SINS/DVL组合导航系统安装误差结构补偿方法
本专利技术属于导航
，具体涉及一种SINS/DVL组合导航系统安装误差结构补偿方法。
技术介绍
在水下载体应用(各类AUV、ROV及水中兵器)中大多采用DVL的速度信息辅助SINS，构成SINS/DVL组合导航系统，为水下载体提供导航控制信息。在DVL能够提供对地(测底工作模式)速度的情况下，可以大大抑制SINS误差的发散。因此SINS/DVL组合几乎是装备中等(定位精度1nm/h)及以下精度惯导设备的水下载体标准的导航配置。SINS和DVL在水下载体传统的使用方式为各自独立安装，为了取得理想的组合导航效果，必须对安装在载体不同位置的SINS和DVL之间的安装误差角进行标定。安装误差角是指DVL与SINS之间的安装姿态关系。DVL测量相对于DVL坐标系下速度，SINS测量相对于SINS坐标系下的向与水平姿态，为了能够获得载体地理系下的定位信息，必须要求DVL定义的坐标系与SINS定义的坐标系在方向上是完全一致的，或者两者不一致时，也需要知道两者的安装偏角关系并进行补偿，否则会导致组合导航的失效。简单起见，假设DVL坐标系d系与载体坐标系b系之间的变换矩阵为载体坐标系b系与地理坐标系n系之间的姿态变换矩阵为选择地理坐标系为导航坐标系，则DVL相对于自身测量坐标系的速度在导航坐标系n系下的投影为：式中——DVL测得的实际速度，包含纵向速度、横向速度及垂向速度；——载体在地理坐标系下的速度(东向速度、北向速度及垂向速度)。>设DVL标度因数误差为(忽略垂向标度因数误差)，则实际的DVL输出速度为：设DVL与载体系之间的安装误差角向量为η＝[αβγ]T，由于实际的工程应用中，认为η是常值小量。则计算过程中使用的从d系到b系的姿态转移矩阵为：其中η×为安装误差角向量的反对称阵：根据式(1)，在实际计算过程中DVL输出的速度在导航坐标系下的投影可以表示为：式中——计算用姿态矩阵:其中为SINS姿态误差角向量的反对称阵。将(2)、(3)式代入(4)式，可得：展开后忽略二阶小量，进一步可得DVL测速误差在n系下的表示：其中为载体地理系下速度向量的反对称阵。(7)式即为DVL测速误差模型，可见安装误差通过载体姿态矩阵及载体速度对DVL的测速误差产生影响，必须在解算过程中给予补偿。通常使用外部观测信息(例如精确的GNSS位置信息)标定SINS/DVL之间的安装误差，标定过程繁琐，且重新安装SINS或DVL后需要重新进行标定，费时费力。将SINS与DVL设计为结构一体化的组合导航系统，可在设计阶段保证二者之间的安装关系一致，并将安装误差限定在小角度量的范围内，同时可在系统装配后通过工业CT扫描的方法进行安装误差角的精确复核，产品交付用户后可直接使用，无需再进行安装误差标定，降低用户时间和标定成本。
技术实现思路
本专利技术为解决公知技术中存在的技术问题而提供一种SINS/DVL组合导航系统安装误差结构补偿方法，其中DVL采用四波束詹纳斯(Janus)配置，给出了换能器坐标系、DVL坐标系、SINS坐标系及载体坐标系一致性设计及安装误差机械标定及补偿方法。在设计过程中考虑各坐标系之间的对应关系并设计机械结构，将SINS/DVL之间的安装误差限定在可忽略的范围内，同时整个系统装配完成后，通过工业CT扫描仪对装配后的安装误差残差进行精确测定并在软件中补偿，采用基于换能器的安装误差补偿方案，在保证Janus配置优势的前提下，实现安装误差的精确补偿。本专利技术的目的是提供一种SINS/DVL组合导航系统安装误差结构补偿方法，DVL采用四波束詹纳斯配置，包括如下步骤：S1：安装误差相关坐标系映射结构设计；S2：工业CT扫描标定；利用工业CT对装配完成的DVL内部不同材质之间几何尺寸进行扫描分析，从而计算安装误差相关各坐标系间的对应关系，通过工业CT扫描，复测四个换能器垂向轴与DVL坐标系之间的安装误差，并在方案软件中补偿，由于SINS安装面与DVL安装面的平行度较高，所以忽略二者之间的横摇角和纵摇角安装误差；步骤3：标定结果补偿，具体为：DVL四个换能器所测的载体水平速度如下式所示：Vd＝CdbVb其中：Vd为四个换能器测量速度，Vd包含四个速度分量；Vy1,Vy2为艏艉向换能器测量速度；Vx1,Vx2为左右向换能器测量速度；Cdb为DVL坐标系到载体系安装误差补偿矩阵；α1为DVL艏向换能器与SINS的Y轴正向安装误差角，α1为锐角，Y轴右侧为正；α2为DVL艉向换能器与SINS的Y轴负向安装误差角，α2为锐角，Y轴右侧为正；β1为DVL左向换能器与SINS的X轴正向安装误差角，β1为锐角，X轴上侧为正；β2为DVL右向换能器与SINS的X轴负向安装误差角，β2为锐角，X轴上侧为正；Vb为载体实际速度矢量，Vy,Vx为载体Y向和X向实际速度；按上式补偿的安装误差考虑到了不同换能器安装误差不同的影响，同时设计过程保证了航向安装误差角均为小角度。进一步：所述S1具体为：将DVL坐标系与SINS坐标系映射至实体结构之中，与SINS/DVL安装误差相关的坐标系包括：换能器坐标系、DVL坐标系、SINS坐标系；在载体实际导航过程中，通过在DVL坐标系映射的安装面上设计DVL水平基准与载体系ObZb轴垂直，DVL方位基准与载体系ObXbYb面平行，保证载体坐标系与DVL坐标系一致；SINS坐标系通过SINS水平基准面和SINS方位基准映射至SINS结构体，其中SINS方位基准所确定平面的法线方向为SINS艏向，SINS水平基准面代表了OsXSYs确定的平面；SINS坐标系与DVL坐标系的一致性通过与DVL坐标系对应的SINS安装面实现，通过结构约束使得SINS方位基准与DVL方位基准保持空间方向的一致性，SINS水平基准与DVL水平基准保持空间方向的一致性。进一步：工业CT扫描复测步骤如下：d)标定前将装配好的带有DVL基准、SINS基准及四个换能器的结构组件在工业CT扫描仪台面上固定好；e)以SINS水平基准面及方位基准面为坐标基准，使用工业CT扫描仪复合陶瓷换能器，并计算出其垂向轴的矢量方向OtZti(i＝1,2,3,4)；计算四个换能器矢量轴OtZti在DVL水平基准上的投影与DVL水平坐标轴正向(ObYb，ObXb)之间的夹角α1,α2,β1,β2。本专利技术具有的优点和积极效果是：通过采用上述技术方案，本专利技术中的DVL采用四波束詹纳斯(Janus)配置，给出了换能器坐标系、DVL坐标系、SINS坐标系及载体坐标系一致性设计及安装误差机械标定及补偿方法。在设计过程中考虑各坐标系之间的对应关系并设计机械结本文档来自技高网...

【技术保护点】
1.一种SINS/DVL组合导航系统安装误差结构补偿方法，其特征在于，DVL采用四波束詹纳斯配置，包括如下步骤：/nS1：安装误差相关坐标系映射结构设计；/nS2：工业CT扫描标定；/n利用工业CT对装配完成的DVL内部不同材质之间几何尺寸进行扫描分析，从而计算安装误差相关各坐标系间的对应关系，通过工业CT扫描，复测四个换能器垂向轴与DVL坐标系之间的安装误差，并在方案软件中补偿，由于SINS安装面与DVL安装面的平行度较高，所以忽略二者之间的横摇角和纵摇角安装误差；/n步骤3：标定结果补偿，具体为：/nDVL四个换能器所测的载体水平速度如下式所示：/nV

【技术特征摘要】
1.一种SINS/DVL组合导航系统安装误差结构补偿方法，其特征在于，DVL采用四波束詹纳斯配置，包括如下步骤：
S1：安装误差相关坐标系映射结构设计；
S2：工业CT扫描标定；
利用工业CT对装配完成的DVL内部不同材质之间几何尺寸进行扫描分析，从而计算安装误差相关各坐标系间的对应关系，通过工业CT扫描，复测四个换能器垂向轴与DVL坐标系之间的安装误差，并在方案软件中补偿，由于SINS安装面与DVL安装面的平行度较高，所以忽略二者之间的横摇角和纵摇角安装误差；
步骤3：标定结果补偿，具体为：
DVL四个换能器所测的载体水平速度如下式所示：
Vd＝CdbVb
其中：
Vd为四个换能器测量速度，Vd包含四个速度分量；



Vy1,Vy2为艏艉向换能器测量速度；
Vx1,Vx2为左右向换能器测量速度；
Cdb为DVL坐标系到载体系安装误差补偿矩阵；



α1为DVL艏向换能器与SINS的Y轴正向安装误差角，α1为锐角，Y轴右侧为正；
α2为DVL艉向换能器与SINS的Y轴负向安装误差角，α2为锐角，Y轴右侧为正；
β1为DVL左向换能器与SINS的X轴正向安装误差角，β1为锐角，X轴上侧为正；
β2为DVL右向换能器与SINS的X轴负向安装误差角，β2为锐角，X轴上侧为正；
Vb为载体实际速度矢量，
Vy,Vx为载体Y向和X向实际速度；



按上式补偿的安装误差考虑到了不同换能器安装误差不同的影响，同时设计过程保证了航向...

【专利技术属性】
技术研发人员：王彦国，夏雨，何春海，宫京，王海鹏，
申请(专利权)人：中国船舶重工集团公司第七零七研究所，
类型：发明
国别省市：天津;12