一种基于多信标的超短基线标定系统及标定方法技术方案

本发明专利技术公开了一种基于多信标的超短基线标定系统，包括换能器、姿态仪、全站仪、声速计、消声试验水池以及多个信标；多个信标布置在消声试验水池的池底；换能器和姿态仪，两者固定连接且两者的艏向相近，两者均浸入消声试验水池的水中；消声试验水池外设有两个已知坐标的控制点；全站仪以控制点作为坐标参考点对每个信标、换能器和姿态仪进行三维坐标测量；声速计测量水池内的声速剖面，对换能器的坐标测量结果进行声线弯曲修正。本发明专利技术还提供一种基于多信标的超短基线标定方法。本发明专利技术通过一体化安装的超短基线换能器和姿态仪，在室内水池通过多信标进行精确标定，节约时间，在海上应急救捞施工中，极大地提高水下定位的工作效率。

A multi-beacon based ultra-short baseline calibration system and its calibration method

【技术实现步骤摘要】
一种基于多信标的超短基线标定系统及标定方法
本专利技术涉及一种超短基线标定系统及标定方法，特别涉及一种基于多信标的超短基线标定系统及标定方法。
技术介绍
目前，超短基线水下定位时，需要GPS、姿态仪、声速计等辅助设备才能得到信标的绝对位置。实际工作中，各种设备所在的坐标系并不能保证在同一坐标下，各设备所在的坐标系之间存在位置偏差和角度偏差，如GPS天线和换能器中心点存在位置偏差，换能器和姿态仪之间会存在三轴的角度偏差等。GPS天线和换能器通过测杆刚性连接在一起后，其位置偏差可以通过全站仪精确测得；水下声学定位时的声线弯曲，可以通过声速计精确测得；而换能器和姿态仪之间的三轴角度偏差，即艏向Heading偏差、纵摇Pitch偏差和横摇Roll偏差却很难直接得到。传统方法是将所有设备安装到船上后，使船舶沿特定线路运行，通过迭代计算得到安装的角度偏差值，但这种方法极大的影响实际工程效率，其准确性也难以保证。
技术实现思路
本专利技术为解决公知技术中存在的技术问题而提供一种高效的基于多信标的超短基线标定系统及标定方法。本专利技术为解决公知技术中存在的技术问题所采取的技术方案是：一种基于多信标的超短基线标定系统，包括换能器、姿态仪、全站仪、声速计、消声试验水池以及多个信标；所述多个信标布置在所述消声试验水池的池底；所述换能器和所述姿态仪，两者固定连接且两者的艏向相近，两者均浸入所述消声试验水池的水中；所述消声试验水池外设有两个已知坐标的控制点；所述全站仪以所述控制点作为坐标参考点对每个所述信标、所述换能器和所述姿态仪进行三维坐标测量；所述声速计测量水池内的声速剖面，对所述换能器的坐标测量结果进行声线弯曲修正。进一步地，所述信标为五个，其中四个所述信标布设在正方形的四个角点，一个所述信标布设在正方形的中心点。进一步地，所述消声试验水池的水深≥6m，所述中心点至所述角点距离为3～5m。进一步地，还包括一对法兰；所述换能器和所述姿态仪，两者并排接入该对法兰之间，且两者的同侧端面均与该对法兰的其中一个法兰固接。进一步地，所述控制点坐标系为CGCS2000坐标系下的空间直角坐标。本专利技术还提供了一种基于多信标的超短基线标定方法，该方法为：设置消声试验水池，将多个信标布设在池底，将相互固定连接且艏向相近的换能器和姿态仪均浸入消声试验水池的水中，在消声试验水池外设有两个已知坐标的控制点；采用全站仪以控制点作为坐标参考点对每个信标、换能器和姿态仪进行三维坐标测量；采用声速计测量水池内的声速剖面，对换能器的坐标测量结果进行声线弯曲修正；换能器以一定的频率重复测量信标位置并得到多个观测值，根据测量平差原理列出观测值的误差方程式，求解方程得到换能器角度值，将计算得出的换能器角度值与姿态仪实际测量值之间的差值作为标定值。进一步地，将姿态仪的数据输入到换能器中，同时按照计算的校准值对其姿态数据进行修正，启动换能器测量信标的位置，将换能器测量值与全站仪的观测值进行比较，以检验标定值的准确性。进一步地，采用五个信标，在正方形的四个角点各布设一个信标，作为公共点；在正方形的中心点布设一个信标，作为检查点。进一步地，由全站仪测量得到信标、换能器和姿态仪的坐标均为CGCS2000坐标，由换能器测量并经声线弯曲修正得到的信标坐标是以换能器中心点为原点的相对坐标，经过坐标转换后，列出观测值的误差方程式。进一步地，设CGCS2000坐标系为O-XCGCSYCGCSZCGCS，设以换能器中心点为原点的相对坐标系为O-XUSBLYUSBLZUSBL，列出观测值的误差方程式的具体步骤为：步骤一，保持OZUSBL轴不动，将O-XUSBL轴和O-YUSBL轴旋转角度H，旋转后的坐标轴设为OX′、OY′、OZ′，则有：式中：X′为绕O-XUSBL和O-YUSBL轴旋转角度H后X坐标；Y′为绕O-XUSBL和O-YUSBL轴旋转角度H后Y坐标；Z′为绕O-XUSBL和O-YUSBL轴旋转角度H后Z坐标；XUSBL为换能器坐标系下的X坐标；YUSBL为换能器坐标系下的Y坐标；ZUSBL为换能器坐标系下的Z坐标；H为Z轴旋转角度；步骤二，保持OY′轴不动，将OX′轴和OZ′轴旋转角度R，旋转后的坐标轴设为OX″、OY″、OZ″，则有：式中：X′为绕O-XUSBL和O-YUSBL轴旋转角度H后X坐标；Y′为绕O-XUSBL和O-YUSBL轴旋转角度H后Y坐标；Z′为绕O-XUSBL和O-YUSBL轴旋转角度H后Z坐标；X″为绕OX′和OZ′轴旋转角度R后的X坐标；Y″为绕OX′和OZ′轴旋转角度R后的Y坐标；Z″为绕OX′和OZ′轴旋转角度R后的Z坐标；R为Y轴旋转角度；步骤三，保持OX″轴不动，将OY″轴和OZ″轴旋转角度P，旋转后的坐标轴设为OXCGCS、OYCGCS、OZCGCS，则有：式中：XCGCS为信标的CGCS2000坐标系下的X坐标；YCGCS为信标的CGCS2000坐标系下的Y坐标；ZCGCS为信标的CGCS2000坐标系下的Z坐标；X″为绕OX′和OZ′轴旋转角度R后的X坐标；Y″为绕OX′和OZ′轴旋转角度R后的Y坐标；Z″为绕OX′和OZ′轴旋转角度R后的Z坐标；P为X轴旋转角度；步骤四，将式1-1代入式1-2，再代入式1-3，换能器中心点在CGCS2000坐标系及以换能器中心点为原点的相对坐标系中的坐标差值即为全站仪测量得到的换能器中心点的CGCS2000坐标，设其为(XT，YT，ZT)，则有：其中：r1,1＝cosHcosR；r1,2＝cosHsinRsinP+sinHcosP；r1,3＝sinHsinP-cosHsinRcosP；r2,1＝-sinHcosR；r2,2＝cosHcosP-sinHsinRsinP；r2,3＝sinHsinRcosP+cosHsinP；r3,1＝sinR；r3,2＝-cosRsinP；r3,3＝cosRcosP；式中：XCGCS为信标的CGCS2000坐标系下的X坐标；YCGCS为信标的CGCS2000坐标系下的Y坐标；ZCGCS为信标的CGCS2000坐标系下的Z坐标；XUSBL为换能器坐标系下的X坐标；YUSBL为换能器坐标系下的Y坐标；ZUSBL为换能器坐标系下的Z坐标；r1,1为矩阵第1行第1列的数值；r1,2为矩阵第1行第2列的数值；r1,3为矩阵第1行第3列的数值；r2,1为矩阵第2行第1列的数值；r2,2为矩阵第2行第2列的数值；r2,3为矩阵第2行第3列的数值；r3,1为矩阵第3行第1列的数值；r3,2为矩阵第3行第2列的数值；r3,3为矩阵第3行第3列的数值；H为Z轴旋转角度；P为X轴旋转角度；R为Y轴旋转角度；XT为换能器中心点的CGCS2000坐标系下的X坐标；YT为换能器中心点的CGCS2000坐标系下的Y坐标；ZT为换能器中心点的CGCS2000坐标系下的Z坐标；步骤五，设旋转矩阵对式1-4进行泰勒级数展开，忽略二次项及其以上项，可得：其中其中：T11＝-sinRcosPdR-cosRsinHdH；T12＝(-sinPsinH+cosPsinRcosH)dP+(cosPcosH-sinPsinRsinH)dH+sinPcosRcosHdR；T13＝(cosPsinH+sinPsinRcosH)本文档来自技高网...

【技术保护点】
1.一种基于多信标的超短基线标定系统，其特征在于，包括换能器、姿态仪、全站仪、声速计、消声试验水池以及多个信标；所述多个信标布置在所述消声试验水池的池底；所述换能器和所述姿态仪，两者固定连接且两者的艏向相近，两者均浸入所述消声试验水池的水中；所述消声试验水池外设有两个已知坐标的控制点；所述全站仪以所述控制点作为坐标参考点对每个所述信标、所述换能器和所述姿态仪进行三维坐标测量；所述声速计测量水池内的声速剖面，对所述换能器的坐标测量结果进行声线弯曲修正。

【技术特征摘要】
1.一种基于多信标的超短基线标定系统，其特征在于，包括换能器、姿态仪、全站仪、声速计、消声试验水池以及多个信标；所述多个信标布置在所述消声试验水池的池底；所述换能器和所述姿态仪，两者固定连接且两者的艏向相近，两者均浸入所述消声试验水池的水中；所述消声试验水池外设有两个已知坐标的控制点；所述全站仪以所述控制点作为坐标参考点对每个所述信标、所述换能器和所述姿态仪进行三维坐标测量；所述声速计测量水池内的声速剖面，对所述换能器的坐标测量结果进行声线弯曲修正。2.根据权利要求1所述的基于多信标的超短基线标定系统，其特征在于，所述信标为五个，其中四个所述信标布设在正方形的四个角点，一个所述信标布设在正方形的中心点。3.根据权利要求2所述的基于多信标的超短基线标定系统，其特征在于，所述消声试验水池的水深≥6m，所述中心点至所述角点距离为3～5m。4.根据权利要求1所述的基于多信标的超短基线标定系统，其特征在于，还包括一对法兰；所述换能器和所述姿态仪，两者并排接入该对法兰之间，且两者的同侧端面均与该对法兰的其中一个法兰固接。5.根据权利要求1所述的基于多信标的超短基线标定系统，其特征在于，所述控制点坐标系为CGCS2000坐标系下的空间直角坐标。6.一种基于多信标的超短基线标定方法，其特征在于，设置消声试验水池，将多个信标布设在池底，将相互固定连接且艏向相近的换能器和姿态仪均浸入消声试验水池的水中，在消声试验水池外设有两个已知坐标的控制点；采用全站仪以控制点作为坐标参考点对每个信标、换能器和姿态仪进行三维坐标测量；采用声速计测量水池内的声速剖面，对换能器的坐标测量结果进行声线弯曲修正；换能器以一定的频率重复测量信标位置并得到多个观测值，根据测量平差原理列出观测值的误差方程式，求解方程得到换能器角度值，将计算得出的换能器角度值与姿态仪实际测量值之间的差值作为标定值。7.根据权利要求6所述的基于多信标的超短基线标定方法，其特征在于，将姿态仪的数据输入到换能器中，同时按照计算的校准值对其姿态数据进行修正，启动换能器测量信标的位置，将换能器测量值与全站仪的观测值进行比较，以检验标定值的准确性。8.根据权利要求6所述的基于多信标的超短基线标定方法，其特征在于，采用五个信标，在正方形的四个角点各布设一个信标，作为公共点；在正方形的中心点布设一个信标，作为检查点。9.根据权利要求6所述的基于多信标的超短基线标定方法，其特征在于，由全站仪测量得到信标、换能器和姿态仪的坐标均为CGCS2000坐标，由换能器测量并经声线弯曲修正得到的信标坐标是以换能器中心点为原点的相对坐标，经过坐标转换后，列出观测值的误差方程式。10.根据权利要求9所述的基于多信标的超短基线标定方法，其特征在于，设CGCS2000坐标系为O-XCGCSYCGCSZCGCS，设以换能器中心点为原点的相对坐标系为O-XUSBLYUSBLZUSBL，列出观测值的误差方程式的具体步骤为：步骤一，保持OZUSBL轴不动，将O-XUSBL轴和O-YUSBL轴旋转角度H，旋转后的坐标轴设为OX′、OY′、OZ′，则有：式中：X′为绕O-XUSBL和O-YUSBL轴旋转角度H后X坐标；Y′为绕O-XUSBL和O-YUSBL轴旋转角度H后Y坐标；Z′为绕O-XUSBL和O-YUSBL轴旋转角度H后Z坐标；XUSBL为换能器坐标系下的X坐标；YUSBL为换能器坐标系下的Y坐标；ZUSBL为换能器坐标系下的Z坐标；H为Z轴旋转角度；步骤二，保持OY′轴不动，将OX′轴和OZ′轴旋转角度R，旋转后的坐标轴设为OX″、OY″、OZ″，则有：式中：X′为绕O-XUSBL和O-YUSBL轴旋转角度H后X坐标；Y′为绕O-XUSBL和O-YUSBL轴旋转角度H后Y坐标；Z′为绕O-XUSBL和O-YUSBL轴旋转角度H后Z坐标；X″为绕OX′和OZ′轴旋转角度R后的X坐标；Y″为绕OX′和OZ′轴旋转角度R后的Y坐标；Z″为绕OX′和OZ′轴旋转角度R后的Z坐标；R为Y轴旋转角度；步骤三，保持OX″轴不动，将OY″轴和OZ″轴旋转角度P，旋转后的坐标轴设为OXCGCS、OYCGCS、OZCGCS，则有：式中：XCGCS为信标的CGCS2000坐标系下的X坐标；YCGCS为信标的CGCS2000坐标系下的Y坐标；ZCGCS为信标的CGCS2000坐标系下的Z坐标；X″为绕OX′和OZ′轴旋转角度R后的X坐标；Y″为绕OX′和OZ′轴旋转角度R后的Y坐标；Z″为绕OX′和OZ′轴旋转角度R后的Z坐标；P为X轴旋转角度；步骤四，将式1-1代入式1-2，再代入式1-3，换能器中心点在CGCS2000坐标系及以换能器中心点为原点的相对坐标系中的坐标差值即为全站仪测量得到的换能器中心点的CGCS2000坐标，设其为(XT，YT，ZT)，则有：其中：r1,1＝cosHcosR；r1,2＝cosHsinRsinP+sinHcosP；r1,3＝sinHsinP-cosHsinRcosP；r2,1＝-sinHcosR；r2,2＝cosHcosP-sinHsinRsinP；r2,3＝sinHsinRcosP+cosHsinP；r3,1＝sinR；r3,2＝-cosRsinP；r3,3＝cosRcosP；式中：XCGCS为信标的CGCS2000坐标系下的X坐标；YCGCS为信标的CGCS2000坐标系下的Y坐标；ZCGCS为信标的CGCS2000坐标系下的Z坐标；XUSBL为换能器坐标系下的X坐标；YUSBL为换能器坐标系下的Y坐标；ZUSBL为换能器坐标系下的Z坐标；r1,1为矩阵第1行第1列的数值；r1,2为矩阵第1行第2列的数值；r1,3为矩阵第1行第3列的数值；r2,1为矩阵第2行第1列的数值；r2,2为矩阵第2行第2列的数值；r2,3为矩阵第2行第3列的数值；r3,1为矩阵第3行第1列的数值；r...

【专利技术属性】
技术研发人员：隋海琛，王崇明，雷鹏，杨鲲，田春和，张彦昌，杨海忠，吴昊，王晓进，秦建，张楠，安永宁，王永强，马深，杨丽丽，
申请(专利权)人：交通运输部天津水运工程科学研究所，天津水运工程勘察设计院，
类型：发明
国别省市：天津,12