用于水下清洗机器人的高精度相对定位方法技术

本发明专利技术用于水下清洗机器人的高精度相对定位方法用于工作母船上的水下清洗机器人定位，在水下清洗机器人上装有第二同步声源，清洗船放置在工作母船附近的水中，在工作母船的船头或船尾侧壁上固定有第一同步声源，在清洗船上固定有第一短基阵元和第二短基阵元，第一短基线换能器和第二短基线换能器位于清洗船同一侧的相同水深处，第一短基线换能器和第二短基线换能器之间的垂直距离为a，计算出水下清洗机器人和第一同步声源在相对坐标系的坐标，画出水下清洗机器人的运动轨迹，本发明专利技术在同一周期内，可有效降低由海上风浪引起的清洗船只和工作明船晃动引起的基阵姿态和航向影响，满足海上复杂海况下实际作业测量需求。满足海上复杂海况下实际作业测量需求。满足海上复杂海况下实际作业测量需求。

【技术实现步骤摘要】
用于水下清洗机器人的高精度相对定位方法


[0001]本专利技术属于海洋工程
，涉及用于水下清洗机器人的高精度相对定位方法。

技术介绍

[0002]水下清洗机器人对船只进行海上船体外壳长时间连续清洗时，作业人员需要实时掌握水下机器人相对在清洗船只的具体位置点，以及航行轨迹，为水下机器人进行高精度人工操作和自动智能作业提供水下坐标参考，以达到高效清洗、降低运行成本的目的。
[0003]而现有水下清洗机器人吸附在清洗船只壳体水面以下长时间连续作业时，大多采用船载超短基线的定位方式，对水下清洗机器人进行水下坐标的定位，结合船载超短基线阵的空间绝对大地坐标，计算出水下清洗机器人在水下相对超短基线阵的空间绝对大地坐标，从而除了水声测量误差外，还不可避免会产生GPS定位误差，及水声测量坐标与大地绝对坐标转换误差，特别是在海上无GPS差分条件下，最终产生的水下目标实时定位精度的误差将在2米以上，难以达到水下清洗机器人对海上船体外壳无死角完全清理，会存在清理遗漏区域。
[0004]为解决该工程技术难题，本专利技术提出一种基于以船壳体自身结构尺寸，并设置船体固定声学位置参考点，结合作业船只船载同步式短基线定位系统，建立水下相对坐标空间系，消除了GPS测量误差和坐标转换误差，从而实现水下清洗机器人在水下长时间连续作业时，提供水下高精度定位导航技术支持。

技术实现思路

[0005]本申请的专利技术目的是解决在现有惯导技术，GPS与水声测量技术结合难以实现水下清洗机器人长时间连续高精度定位跟踪需求，基于同步式快捷船载段基线系统，提出一种基于在船体外壳上设置固定基准点的新型水下高精度相对定位方法，本申请可以消除GPS测量误差和坐标转换误差，无需惯导和GPS设备辅助，可在复杂海况下实现水下机器人达到厘米级高精度定位导航，提升水下作业效率，降低作业成本。
[0006]为了完成本申请的专利技术目的，本申请采用以下技术方案:
[0007]本专利技术的一种用于水下清洗机器人的高精度相对定位方法，该方法用于工作母船上的水下清洗机器人定位，水下清洗机器人附着在工作母船的侧壁上，用于清洗工作母船的侧壁，在水下清洗机器人上装有第二同步声源，清洗船放置在工作母船附近的水中，在工作母船的船头或船尾侧壁上固定有第一同步声源，在清洗船上固定有第一短基阵元和第二短基阵元，第一短基阵元包括：第一阵架和第一短基线换能器，第一短基线换能器固定在第一阵架底端，第一阵架固定在清洗船侧壁；第二短基阵元包括：第二阵架和第二短基线换能器，第二短基线换能器固定在第二阵架底端，第二阵架固定在清洗船侧壁；第一短基线换能器和第二短基线换能器位于清洗船同一侧的相同水深处，第一短基线换能器和第二短基线换能器之间的垂直距离为a，其中：
[0008]用于水下清洗机器人的高精度相对定位方法包括：
[0009](a)、计算出水下清洗机器人和第一同步声源在相对坐标系的坐标
[0010]以第一短基线换能器和第二短基线换能器的连线为X轴，以第一短基线换能器为原点，以垂直于X轴并且平行于水面的轴为Y轴，建立X轴和Y轴的相对坐标系，在该相对坐标系中，第一短基线换能器的坐标A1为(0，0)，第二短基线换能器的坐标A2为(a,0)，第一同步声源坐标α(x1,y1)分别到第一短基线换能器和第二短基线换能器的距离为ct1和ct2，其中c为声波在水中的传播速度，t1和t2分别为第一同声源发出的声波达到第一短基线阵元和第二短基线阵元的时间差，用以下公式实时计算第一同步声源的坐标α(x1,y1)，同时第一同步声源向第一短基线换能器和第二短基线换能器以信标编码方式发出第一同步声源的深度z1；
[0011][0012]第二同步声源的坐标β(x2,y2)分别到第一短基线换能器和第二短基线换能器的距离为ct3和ct4，其中c为声波在水中的传播速度，t3和t4分别为第二同步声源发出的声波达到第一短基线换能器和第二短基线换能器的时间差，用以下公式实时计算出第二同步声源的坐标β(x2,y2)，同时第二同步声源向第一短基线换能器和第二短基线换能器以信标编码方式发出第二同步声源的深度z2；
[0013][0014](b)、画出水下清洗机器人的运动轨迹
[0015]以第一同步声源α(x1,y
1，
z1)为原点，以通过上述原点并且平行于相对坐标系X轴的轴线为X
’
轴，以通过上述原点并且平行于相对坐标系Y轴的轴线为Y
’
轴,以垂直于上述X
’
和Y
’
平面的轴为Z
’
轴，建立X
’
、Y
’
和Z
’
绝对坐标系，实时计算出水下清洗机器人在绝对坐标系中的坐标β(x2‑
x1,y2‑
y
1，
z2‑
z1),在上述绝对坐标系中画出水下清洗机器人的运动轨迹。
[0016]本专利技术的用于水下清洗机器人的高精度相对定位方法，其中：所述第一短基阵元和第二短基阵元固定在工作母船和清洗船之间的清洗船侧壁上。
[0017]本专利技术的用于水下清洗机器人的高精度相对定位方法，其中：所述第一同步声源通过其磁性底座固定在工作母船的船艏或船尾壳体上。
[0018]基于固定在清洗船只壳体两个信标位置点(基准点)不变的情况下，结合清洗船只吃水深度、长度和宽度，建立水下清洗机器人在清洗船只外壳船体上相对两个固定信标位置(基准点)的相对坐标位置。可得到出每个测量周期时，水下清洗机器人在水下清洗外壳船体相对两个固定信标位置(基准点)的三维空间位置，通过水下长时间测量周期的相对于工作母船位置汇总统计，即可获得水下洗机器人相对于的空间实时位置变化，同时显示记录水下清洗机器人在工作母船壳体上清洗轨迹。
[0019]本专利技术的用于水下清洗机器人的高精度相对定位方法与传统的水下声学定位+GPS方式相比，具有以下技术和工程优势：
[0020](1)、该方案利用清洗船上的固定点(基准点)作为基准，对水下清洗机器人进行定
位，结合已工作母船结构尺寸建立的相对坐标体系，参考固定基准点进行相对坐标系和绝对坐标系的转换。实现对水下清洗机器人相对清洗船的2个基准位置点进行相对定位和航迹标注，可消除传统测量方式的GPS，消除了测量固有误差和水下与水面坐标转换误差，提升系统定位精度。
[0021](2)、该方案利用简易式同步式短基线2元定位+相对基准位置原理，除了安装结构简单，可快速布放回收和成本较低工程应用优势外，在同一周期内，可有效降低由海上风浪引起的清洗船只和工作明船晃动引起的基阵姿态和航向影响，可满足海上复杂海况下实际作业测量需求。
附图说明
[0022]图1为在本申请的用于水下清洗机器人的高精度相对定位方法中，工作母船、水下清洗机器人和清洗船之间关系的俯向示意图，在图中，X和Y为相对坐标系，X
’
、Y
’
和Z
’
为J绝对坐标系；
[0023本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于水下清洗机器人的高精度相对定位方法，该方法用于工作母船(5)上的水下清洗机器人(3)定位，水下清洗机器人(3)附着在工作母船(5)的侧壁上，用于清洗工作母船(5)的侧壁，在水下清洗机器人(3)上装有第二同步声源(2)，清洗船(4)放置在工作母船(5)附近的水中，在工作母船(5)的船头或船尾侧壁上固定有第一同步声源(1)，在清洗船(4)上固定有第一短基阵元(6)和第二短基阵元(7)，第一短基阵元(6)包括：第一阵架(61)和第一短基线换能器(62)，第一短基线换能器(62)固定在第一阵架(61)底端，第一阵架(61)固定在清洗船(4)侧壁；第二短基阵元(7)包括：第二阵架(71)和第二短基线换能器(72)，第二短基线换能器(72)固定在第二阵架(71)底端，第二阵架(71)固定在清洗船(4)侧壁；第一短基线换能器(62)和第二短基线换能器(72)位于清洗船(4)同一侧的相同水深处，第一短基线换能器(62)和第二短基线换能器(72)之间的垂直距离为a，其特征在于：用于水下清洗机器人的高精度相对定位方法包括：(a)、计算出水下清洗机器人(3)和第一同步声源(1)在相对坐标系的坐标以第一短基线换能器(62)和第二短基线换能器(72)的连线为X轴，以第一短基线换能器(62)为原点，以垂直于X轴并且平行于水面的轴为Y轴，建立X轴和Y轴的相对坐标系，在该相对坐标系中，第一短基线换能器(62)的坐标A1为(0，0)，第二短基线换能器(72)的坐标A2为(a,0)，第一同步声源(1)坐标α(x1,y1)分别到第一短基线换能器(62)和第二短基线换能器(72)的距离为ct1和ct2，其中c为声波在水中的传播速度，t1和t2分别为第一同声源(1)发出的声波达到第一短基线阵元(62)和第二短基线阵元(72)的时间差，用以下公式(1)实时计算第一同步声源(1)的坐标α(x1,y1)，同时第一同步声源(1)向第一短基线...

【专利技术属性】
技术研发人员：范赞，刘庆，匡彪，付传宝，要庆生，
申请(专利权)人：中国船舶重工集团公司七五零试验场，
类型：发明
国别省市：