CN110412583B - 基于多rov协同的水下不明运动目标侦测系统 - Google Patents

基于多rov协同的水下不明运动目标侦测系统 Download PDF

Info

Publication number
CN110412583B
CN110412583B CN201910659969.2A CN201910659969A CN110412583B CN 110412583 B CN110412583 B CN 110412583B CN 201910659969 A CN201910659969 A CN 201910659969A CN 110412583 B CN110412583 B CN 110412583B
Authority
CN
China
Prior art keywords
rov
uwuo
underwater
sonar
control center
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910659969.2A
Other languages
English (en)
Other versions
CN110412583A (zh
Inventor
吴青
罗松涛
段文杰
汪洋
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuhan University of Technology WUT
Original Assignee
Wuhan University of Technology WUT
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Wuhan University of Technology WUT filed Critical Wuhan University of Technology WUT
Priority to CN201910659969.2A priority Critical patent/CN110412583B/zh
Publication of CN110412583A publication Critical patent/CN110412583A/zh
Application granted granted Critical
Publication of CN110412583B publication Critical patent/CN110412583B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
    • G01S15/50—Systems of measurement, based on relative movement of the target
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/66—Sonar tracking systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Acoustics & Sound (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)

Abstract

本发明提供一种基于多ROV协同的水下不明运动目标侦测系统，声呐基阵对水下不明物UWUO进行实时侦测；目标识别系统客户端根据声呐基阵的声波信号和反射信号以及结合从控制中心接受的ROV信息确定的ROV位置，通过算法计算UWUO的位置并预测UWUO的路径；控制中心接收UWUO的位置以及预测的UWUO的路径，对ROV路径跟踪单元发出拦截指令，ROV基座接收ROV路径跟踪单元的拦截指令，由工作人员控制对应的ROV执行拦截任务，光学摄像机将拍摄的视频按拦截指令的接收路径原路返回到控制中心并进行显示。本发明通过声呐阵列和ROV结合的方式，对水下环境进行侦测，提高了水下侦测的效果，从而加强海事监管水域水下安全防卫能力。

Description

基于多ROV协同的水下不明运动目标侦测系统
技术领域
本发明属于海事水下监管领域，具体涉及一种基于多ROV协同的水下不明运动目标侦测系统。
背景技术
目前声呐装置已广泛应用于水下科学考察、海事监管、水下勘探和海事应急救援等领域，因此声呐装置的研发和应用已成为水下科学研究的重中之重。它对于水下环境的监测具有重要的实际意义和明确的应用背景。
遥控无人潜水器(ROV)的核心部件是水下推进器和水下摄像系统，有时辅以导航、深度传感器等常规传感器。本体尺寸和重量较小，负荷较低。成本较低。目前已广泛应用与军队、海岸警卫、海事、海关、核电、水电、海洋石油、渔业、海上救助、管线探测和海洋科学研究等各个领域。
由于水下环境复杂，光信号衰减严重，水质浑浊、水流速度等因素导致水下环境可见度低而不能采用光学设备远距离实时监控水下环境，应用声呐设备监测水下环境成为行之有效的方法。但声呐设备不能获取水下物体的真实形态和水下环境真实场景的缺陷。
发明内容
本发明要解决的技术问题是：提供一种基于多ROV协同的水下不明运动目标侦测系统，能够加强海事监管水域水下安全防卫能力。
本发明为解决上述技术问题所采取的技术方案为：一种基于多ROV协同的水下不明运动目标侦测系统，其特征在于：它包括水下固定声呐装置、目标识别系统客户端、ROV控制系统和证据数据库；其中，
水下固定声呐装置包括水下固定基座，水下固定基座上固定有声呐基阵；声呐基阵用于发射一定频率声波信号和接收自身发出声波的反射信号，从而对水下不明物UWUO的位置进行实时侦测；
所述的目标识别系统客户端设置在水上，通过水密电缆与声呐基阵连接，用于根据声呐基阵的声波信号和反射信号以及结合从控制中心接收的ROV信息确定的ROV位置，通过算法计算UWUO的位置并预测UWUO的路径；
ROV控制系统包括控制中心、ROV路径跟踪单元、光学摄像机、ROV基座和遥控水下机器人ROV，ROV路径跟踪单元、光学摄像机、ROV基座和ROV的数量相等，且光学摄像机设置在ROV上用于拍摄ROV执行任务时水下环境的视频；控制中心用于接收UWUO的位置以及预测的UWUO的路径，对若干个ROV路径跟踪单元发出拦截指令，ROV基座接收ROV路径跟踪单元的拦截指令，由工作人员控制对应的ROV执行拦截任务，光学摄像机将拍摄的视频按拦截指令的接收路径原路返回到控制中心并进行显示；同时控制中心将ROV的位置发送给所述的目标识别系统客户端；
证据数据库用于存储ROV编号以及与之对应的光学摄像机拍摄的视频和声呐探测信息，供用户通过数据库操作界面进行提取和存储。
按上述系统，所述的目标识别系统客户端包括声呐信息处理单元、目标识别系统和声呐信息显示装置；其中，声呐信息处理单元用于利用卡尔曼滤波算法计算UWUO的位置并预测UWUO下一个时间节点的位置；目标识别系统将UWUO的历史路径和ROV的位置发送到声呐信息显示装置进行显示，同时将UWUO的位置和UWUO下一个时间节点的具体位置发送至ROV控制系统的控制中心。
按上述系统，所述的水下固定基座上还设有用于采集环境参数的传感器组，通过水密电缆与所述的目标识别系统客户端连接。
按上述系统，所述的传感器组包括流速计、温度计和高度计。
按上述系统，所述的声呐信息处理单元具体按以下方法进行侦测：
将水下固定基座设为三维坐标原点建立数学模型，水下固定基座坐标S(0，0，0)；ROV分别均匀分布于两岸，坐标分别为P1(X1，Y1，Z1)、P2(X2，Y2，Z2)、P3(X3，Y3，Z3)…Pi(Xi，Yi，Zi)；声呐阵列全向发射一定频率的声波信号，侦测得到的信息传输至声呐信息处理单元；
利用声呐在前t时段获取UWUO在的卡尔曼滤波方程在三个方向X、Y、Z的初始值Vx、Vy、Vz，建立卡尔曼滤波方程，通过卡尔曼滤波算法预测下一时刻UWUO的水下位置坐标P0(X0，Y0，Z0)；其中，系统的状态方程：
X(k)＝φk,k-1·X(k-1)+Γk-1w(k-1)
系统观测方程：
Z(k)＝Hk·X(k)+v(k)
X(k)和X(k-1)为在K时刻和k-1时刻UWUO的状态，包括位置信息和X、Y、Z方向的速度信息；φk,k-1为状态转移矩阵；Γk-1为噪声驱动阵；w(k-1)为过程噪声；Z(k)为k时刻设备测得的UWUO实际状态信息；Hk为观测矩阵；v(k)为测量噪声；
状态的一步预测方程：
Figure BDA0002138201330000031
均方误差的一步预测：
Figure BDA0002138201330000032
滤波增益方程：
Figure BDA0002138201330000033
滤波估计方程：
Figure BDA0002138201330000034
均方误差更新矩阵：
Figure BDA0002138201330000035
Figure BDA0002138201330000036
和
Figure BDA0002138201330000037
为UWUO在k时刻和k-1时刻状态最终估计值；
Figure BDA0002138201330000038
表示k时刻的理论估计值；Pk为k时刻的最优均方误差；
Figure BDA0002138201330000039
为k-1时刻的最优均方误差通过方程估计出的k时刻均方误差；Kk为滤波增益；Rk为测量噪声的协方差；Qk-1为过程噪声的协方差；
通过声呐侦测到的UWUO在前t时间段内各个时刻的坐标，估计出测量噪声，利用已得到的数据对UWUO进行模拟，对的下一t时间段到达的坐标进行预测，得到下一时刻UWUO的水下位置坐标P0(X0，Y0，Z0)。
按上述系统，所述的控制中心按以下步骤指定拦截策略，从而得到拦截指令：
控制ROV下潜至与下一时刻UWUO的水下位置坐标相同深度位置Z0；
根据下一时刻UWUO的水下位置坐标P0(X0，Y0，Z0)和各个ROV起始坐标Pi(Xi，Yi，Zi)，确定ROV前往预测坐标的拦截速度和与河岸的角度：
Figure BDA00021382013300000310
其中，∠θ表示ROV初始位置时刻与河岸的夹角；i表示ROV的编号；ROV沿着控制中心制定的路径按规定速度前往指定坐标执行拦截任务。
按上述系统，所述的目标识别系统更新UWUO的实时坐标并发送至控制中心，计算ROV与UWUO的距离L，若L处于[m，n]范围内时控制ROV保持当前位置，其中L通过如下公式得到：
Figure BDA00021382013300000311
所述的n为根据光学摄像机的性能和水的透明度将ROV保持当前位置的最远可见距离；所述的m为ROV与UWUO最短安全距离。
按上述系统，所述的控制中心根据ROV与UWUO的距离L，得到ROV的执行策略如下：
(1)当ROV与UWUO之间的距离L在[m，n]内，ROV得到与UWUO的方位并保持当前方位对UWUO进行拍摄；
(2)当ROV与UWUO之间的距离L不足m米时，ROV得到与UWUO的方位并保持当前方位远离UWUO方向运动，确保在安全距离之内；
(3)当ROV与UWUO之间的距离L超过n米时，ROV得到与UWUO的方位并保持当前方位追踪UWUO，确保在安全距离之内进行拍摄；
控制中心控制ROV前往下一个预测点坐标就位，实时反馈UWUO水下画面，达到跟踪的目的；
若拦截失败则反馈管理员，管理员安排海事监管人员根据UWUO当前的位置进行人工拦截。
本发明的有益效果为：通过声呐阵列和ROV结合的方式，对水下环境进行侦测，提高了水下侦测的效果，从而加强海事监管水域水下安全防卫能力。
附图说明
图1为本发明一实施例的数据流图。
图2为本发明一实施例的系统架构图。
图3为本发明一实施例的路径分析流程图。
图4为本发明一实施例的路径预测流程图。
图5为本发明一实施例的ROV拦截流程图。
图6为本发明一实施例的UWUO跟踪流程图。
具体实施方式 ROV(Remote Operated Vehicle)
下面结合具体实例和附图对本发明做进一步说明。
本发明提供一种基于多ROV协同的水下不明运动目标侦测系统，如图1和图2所示，它包括水下固定声呐装置、目标识别系统客户端、ROV控制系统和证据数据库。
水下固定声呐装置包括水下固定基座，水下固定基座上固定有声呐基阵；声呐基阵用于发射一定频率声波信号和接收自身发出声波的反射信号，从而对水下不明物UWUO(Under Water Unidentified Object)的位置进行实时侦测。所述的水下固定基座上还设有用于采集环境参数的传感器组，通过水密电缆与所述的目标识别系统客户端连接。传感器组包括流速计、温度计和高度计。
所述的目标识别系统客户端设置在水上，通过水密电缆与声呐基阵连接，用于根据声呐基阵的声波信号和反射信号以及结合从控制中心接收的ROV信息确定的ROV位置，通过算法计算UWUO的位置并预测UWUO的路径。目标识别系统客户端包括声呐信息处理单元、目标识别系统和声呐信息显示装置；其中，声呐信息处理单元用于利用卡尔曼滤波算法计算UWUO的位置并预测UWUO下一个时间节点的位置；目标识别系统将UWUO的历史路径和ROV的位置发送到声呐信息显示装置进行显示，同时将UWUO的位置和UWUO下一个时间节点的具体位置发送至ROV控制系统的控制中心。声呐显示屏实时动态显示UWUO和ROV的运动情况，以及当前时刻水流速度、温度和高度信息。声呐探测出的ROV在未确认前均看做UWUO，只有在结合从控制中心接收的ROV信息后，才能将ROV与实际的UWUO区分开来。
ROV控制系统包括控制中心、ROV路径跟踪单元、光学摄像机、ROV基座和遥控水下机器人ROV，ROV路径跟踪单元、光学摄像机、ROV基座和ROV的数量相等，且光学摄像机设置在ROV上用于拍摄ROV执行任务时水下环境的视频；控制中心用于接收UWUO的位置以及预测的UWUO的路径，对若干个ROV路径跟踪单元发出拦截指令，ROV基座接收ROV路径跟踪单元的拦截指令，由工作人员控制对应的ROV执行拦截任务，光学摄像机将拍摄的视频按拦截指令的接收路径原路返回到控制中心并进行显示；同时控制中心将ROV的位置发送给所述的目标识别系统客户端。
证据数据库用于存储ROV编号以及与之对应的光学摄像机拍摄的视频和声呐探测信息，供用户通过数据库操作界面进行提取和存储。
证据数据库主要包括如下三个功能：
存储功能：存储记录中包括ROV的编号及其运动/姿态、ROV在水下拍摄的视频信息以及水下声呐在监测范围内扫测的的声呐图像，数据将分别配置特定的时间戳，并同时存储在相应的文件记录分块中；
检索功能：①按照ROV编号检索出指定ROV所拍摄到的视频信息；②输入时间区间，按照时间检索出相应时间区间的各种存储信息；③针对ROV编号和时间的组合检索，查找特定时间段内特定ROV相应的存储记录；
播放功能：根据检索的结果，能够实现：①提取光学摄像机在特定时间段的视频信息和对应时间段的水下声呐图像扫测信息；②视频播放功能包括快进、慢进、快退等重播和回放功能，可根据特定的需求调整播放模式。
如图3和图4所示，所述的声呐信息处理单元具体按以下方法进行侦测：
将水下固定基座设为三维坐标原点建立数学模型，水下固定基座坐标S(0，0，0)；ROV分别均匀分布于两岸，坐标分别为P1(X1，Y1，Z1)、P2(X2，Y2，Z2)、P3(X3，Y3，Z3)…Pi(Xi，Yi，Zi)；声呐阵列全向发射一定频率的声波信号，侦测得到的信息传输至声呐信息处理单元。
本实施例中，初始坐标分布如下：
声呐基阵S ROV1 ROV2 ROV3 ROV4
(0,0,0) (-50,100,30) (50,100,30) (-50,-100,30) (50,-100,30)
利用声呐在前t时段获取UWUO在的卡尔曼滤波方程在三个方向X、Y、Z的初始值Vx、Vy、Vz。本实施例中，利用声呐发现UWUO3分钟后发现Vx＝-1.5m/s，Vy＝-3.5m/s，Vz＝0.9m/s。
建立卡尔曼滤波方程，通过卡尔曼滤波算法预测下一时刻UWUO的水下位置坐标P0(X0，Y0，Z0)。本实施例设定ROV的搜索半径为500米，ROV可调速度范围为0到10m/s。其中，系统的状态方程：
X(k)＝φk,k-1·X(k-1)+Γk-1w(k-1)
系统观测方程：
Z(k)＝Hk·X(k)+v(k)
X(k)和X(k-1)为在K时刻和k-1时刻UWUO的状态，包括位置信息和X、Y、Z方向的速度信息；φk,k-1为状态转移矩阵；Γk-1为噪声驱动阵；w(k-1)为过程噪声；Z(k)为k时刻设备测得的UWUO实际状态信息；Hk为观测矩阵；v(k)为测量噪声；
状态的一步预测方程：
Figure BDA0002138201330000061
均方误差的一步预测：
Figure BDA0002138201330000062
滤波增益方程(权重)：
Figure BDA0002138201330000063
滤波估计方程(K时刻的最优值)：
Figure BDA0002138201330000064
均方误差更新矩阵(K时刻的最优均方误差)：
Figure BDA0002138201330000065
Figure BDA0002138201330000071
和
Figure BDA0002138201330000072
为UWUO在k时刻和k-1时刻状态最终估计值；
Figure BDA0002138201330000073
表示k时刻的理论估计值；Pk为k时刻的最优均方误差；
Figure BDA0002138201330000074
为k-1时刻的最优均方误差通过方程估计出的k时刻均方误差；Kk为滤波增益；Rk为测量噪声的协方差；Qk-1为过程噪声的协方差；UWUO运动规律表示为：
Figure BDA0002138201330000075
通过声呐装置得到的测量矩阵得到UWUO的三维位置可以表示为：
Figure BDA0002138201330000076
通过声呐侦测到的UWUO在前t时间段内各个时刻的坐标，估计出测量噪声v(k)，初始化处理噪声矩阵P：
Figure BDA0002138201330000077
利用已得到的数据对UWUO进行模拟，对的下一t时间段到达的坐标进行预测，得到下一时刻UWUO的水下位置坐标P0(X0，Y0，Z0)。本实施例得到P0(0，50，15)。
如图5所示，所述的控制中心按以下步骤指定拦截策略，从而得到拦截指令：
控制ROV下潜至与下一时刻UWUO的水下位置坐标相同深度位置Z0；
根据下一时刻UWUO的水下位置坐标P0(X0，Y0，Z0)和各个ROV起始坐标Pi(Xi，Yi，Zi)，确定ROV前往预测坐标的拦截速度和与河岸的角度：
Figure BDA0002138201330000081
其中，∠θ表示ROV初始位置时刻与河岸的夹角；i表示ROV的编号；ROV沿着控制中心制定的路径按规定速度前往指定坐标执行拦截任务。本实施例，得到各辆ROV的角度如下表所示：
ROV序号 1 2 3 4
离岸角度 135° 135° 18.4376° 18.4376°
如图6所示，所述的目标识别系统更新UWUO的实时坐标并发送至控制中心，计算ROV与UWUO的距离L，若L处于[m，n]范围内时控制ROV保持当前位置，其中L通过如下公式得到：
Figure BDA0002138201330000082
所述的n为根据光学摄像机的性能和水的透明度将ROV保持当前位置的最远可见距离；所述的m为ROV与UWUO最短安全距离，本实施例中m＝0.5m。设定UWUO与ROV最短安全距离的目的是防止UWUO故意靠近ROV进而破坏ROV；通过设定最短安全距离，增加ROV自我防护功能，设定ROV与UWUO之间的最远安全距离，确保ROV跟踪UWUO并获取清晰的水下画面。
所述的控制中心根据ROV与UWUO的距离L，得到ROV的执行策略如下：
(1)当ROV与UWUO之间的距离L在[m，n]内，ROV得到与UWUO的方位并保持当前方位对UWUO进行拍摄；
(2)当ROV与UWUO之间的距离L不足m米时，ROV得到与UWUO的方位并保持当前方位远离UWUO方向运动，确保在安全距离之内；
(3)当ROV与UWUO之间的距离L超过n米时，ROV得到与UWUO的方位并保持当前方位追踪UWUO，确保在安全距离之内进行拍摄；
控制中心控制ROV前往下一个预测点坐标就位，实时反馈UWUO水下画面，达到跟踪的目的；
若拦截失败则反馈管理员，管理员安排海事监管人员根据UWUO当前的位置进行人工拦截。
以上实施例仅用于说明本发明的设计思想和特点，其目的在于使本领域内的技术人员能够了解本发明的内容并据以实施，本发明的保护范围不限于上述实施例。所以，凡依据本发明所揭示的原理、设计思路所作的等同变化或修饰，均在本发明的保护范围之内。

Claims (8)

1.一种基于多ROV协同的水下不明运动目标侦测系统，其特征在于：它包括水下固定声呐装置、目标识别系统客户端、ROV控制系统和证据数据库；其中，
水下固定声呐装置包括水下固定基座，水下固定基座上固定有声呐基阵；声呐基阵用于发射一定频率声波信号和接收自身发出声波的反射信号，从而对水下不明物UWUO的位置进行实时侦测；
所述的目标识别系统客户端设置在水上，通过水密电缆与声呐基阵连接，用于根据声呐基阵的声波信号和反射信号以及结合从控制中心接收的ROV信息确定的ROV位置，通过算法计算UWUO的位置并预测UWUO的路径；
ROV控制系统包括控制中心、ROV路径跟踪单元、光学摄像机、ROV基座和遥控水下机器人ROV，ROV路径跟踪单元、光学摄像机、ROV基座和ROV的数量相等，且光学摄像机设置在ROV上用于拍摄ROV执行任务时水下环境的视频；控制中心用于接收UWUO的位置以及预测的UWUO的路径，对若干个ROV路径跟踪单元发出拦截指令，ROV基座接收ROV路径跟踪单元的拦截指令，由工作人员控制对应的ROV执行拦截任务，光学摄像机将拍摄的视频按拦截指令的接收路径原路返回到控制中心并进行显示；同时控制中心将ROV的位置发送给所述的目标识别系统客户端；
证据数据库用于存储ROV编号以及与之对应的光学摄像机拍摄的视频和声呐探测信息，供用户通过数据库操作界面进行提取和存储。
2.根据权利要求1所述的基于多ROV协同的水下不明运动目标侦测系统，其特征在于：所述的目标识别系统客户端包括声呐信息处理单元、目标识别系统和声呐信息显示装置；其中，声呐信息处理单元用于利用卡尔曼滤波算法计算UWUO的位置并预测UWUO下一个时间节点的位置；目标识别系统将UWUO的历史路径和ROV的位置发送到声呐信息显示装置进行显示，同时将UWUO的位置和UWUO下一个时间节点的具体位置发送至ROV控制系统的控制中心。
3.根据权利要求1所述的基于多ROV协同的水下不明运动目标侦测系统，其特征在于：所述的水下固定基座上还设有用于采集环境参数的传感器组，通过水密电缆与所述的目标识别系统客户端连接。
4.根据权利要求3所述的基于多ROV协同的水下不明运动目标侦测系统，其特征在于：所述的传感器组包括流速计、温度计和高度计。
5.根据权利要求2所述的基于多ROV协同的水下不明运动目标侦测系统，其特征在于：所述的声呐信息处理单元具体按以下方法进行侦测：
将水下固定基座设为三维坐标原点建立数学模型，水下固定基座坐标S(0，0，0)；ROV分别均匀分布于两岸，坐标分别为P1(X1，Y1，Z1)、P2(X2，Y2，Z2)、P3(X3，Y3，Z3)…Pi(Xi，Yi，Zi)；声呐阵列全向发射一定频率的声波信号，侦测得到的信息传输至声呐信息处理单元；
利用声呐在前t时段获取UWUO在的卡尔曼滤波方程在三个方向X、Y、Z的初始值Vx、Vy、Vz，建立卡尔曼滤波方程，通过卡尔曼滤波算法预测下一时刻UWUO的水下位置坐标P0(X0，Y0，Z0)；其中，系统的状态方程：
X(k)＝φk,k-1·X(k-1)+Γk-1w(k-1)
系统观测方程：
Z(k)＝Hk·X(k)+v(k)
X(k)和X(k-1)为在k时刻和k-1时刻UWUO的理论状态，包括位置信息和X、Y、Z方向的速度信息；φk,k-1为状态转移矩阵；Γk-1为噪声驱动阵；w(k-1)为过程噪声；Z(k)为k时刻设备测得的UWUO实际状态信息；Hk为观测矩阵；v(k)为测量噪声；
状态的一步预测方程：
Figure FDA0002138201320000021
均方误差的一步预测：
Figure FDA0002138201320000022
滤波增益方程：
Figure FDA0002138201320000023
滤波估计方程：
Figure FDA0002138201320000024
均方误差更新矩阵：
Figure FDA0002138201320000025
Figure FDA0002138201320000026
和
Figure FDA0002138201320000027
为UWUO在k时刻和k-1时刻状态最终估计值；
Figure FDA0002138201320000028
表示k时刻的理论估计值；Pk为k时刻的最优均方误差；
Figure FDA0002138201320000029
为k-1时刻的最优均方误差通过方程估计出的k时刻均方误差；Kk为滤波增益；Rk为测量噪声的协方差；Qk-1为过程噪声的协方差；
通过声呐侦测到的UWUO在前t时间段内各个时刻的坐标，估计出测量噪声，利用已得到的数据对UWUO进行模拟，对的下一t时间段到达的坐标进行预测，得到下一时刻UWUO的水下位置坐标P0(X0，Y0，Z0)。
6.根据权利要求5所述的基于多ROV协同的水下不明运动目标侦测系统，其特征在于：所述的控制中心按以下步骤指定拦截策略，从而得到拦截指令：
控制ROV下潜至与下一时刻UWUO的水下位置坐标相同深度位置Z0；
根据下一时刻UWUO的水下位置坐标P0(X0，Y0，Z0)和各个ROV起始坐标Pi(Xi，Yi，Zi)，确定ROV前往预测坐标的拦截速度和与河岸的角度：
Figure FDA0002138201320000031
其中，∠θ表示ROV初始位置时刻与河岸的夹角；i表示ROV的编号；ROV沿着控制中心制定的路径按规定速度前往指定坐标执行拦截任务。
7.根据权利要求6所述的基于多ROV协同的水下不明运动目标侦测系统，其特征在于：所述的目标识别系统更新UWUO的实时坐标并发送至控制中心，计算ROV与UWUO的距离L，若L处于[m，n]范围内时控制ROV保持当前位置，其中L通过如下公式得到：
Figure FDA0002138201320000032
所述的n为根据光学摄像机的性能和水的透明度将ROV保持当前位置的最远可见距离；所述的m为ROV与UWUO最短安全距离。
8.根据权利要求7所述的基于多ROV协同的水下不明运动目标侦测系统，其特征在于：所述的控制中心根据ROV与UWUO的距离L，得到ROV的执行策略如下：
(1)当ROV与UWUO之间的距离L在[m，n]内，ROV得到与UWUO的方位并保持当前方位对UWUO进行拍摄；
(2)当ROV与UWUO之间的距离L不足m米时，ROV得到与UWUO的方位并保持当前方位远离UWUO方向运动，确保在安全距离之内；
(3)当ROV与UWUO之间的距离L超过n米时，ROV得到与UWUO的方位并保持当前方位追踪UWUO，确保在安全距离之内进行拍摄；
控制中心控制ROV前往下一个预测点坐标就位，实时反馈UWUO水下画面，达到跟踪的目的；
若拦截失败则反馈管理员，管理员安排海事监管人员根据UWUO当前的位置进行人工拦截。
CN201910659969.2A 2019-07-22 2019-07-22 基于多rov协同的水下不明运动目标侦测系统 Active CN110412583B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910659969.2A CN110412583B (zh) 2019-07-22 2019-07-22 基于多rov协同的水下不明运动目标侦测系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910659969.2A CN110412583B (zh) 2019-07-22 2019-07-22 基于多rov协同的水下不明运动目标侦测系统

Publications (2)

Publication Number Publication Date
CN110412583A CN110412583A (zh) 2019-11-05
CN110412583B true CN110412583B (zh) 2022-12-27

Family

ID=68362229

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910659969.2A Active CN110412583B (zh) 2019-07-22 2019-07-22 基于多rov协同的水下不明运动目标侦测系统

Country Status (1)

Country Link
CN (1) CN110412583B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112162562B (zh) * 2020-10-20 2021-09-07 中国石油大学(华东) 一种多平台基桩rov协同作业系统及方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102253388A (zh) * 2011-06-23 2011-11-23 哈尔滨工程大学 基于压缩感知的多无人水下航行器协同探测方法
CN109901205A (zh) * 2019-03-14 2019-06-18 南京信息工程大学 一种水下机器人多传感器融合与运动轨迹预测方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102253388A (zh) * 2011-06-23 2011-11-23 哈尔滨工程大学 基于压缩感知的多无人水下航行器协同探测方法
CN109901205A (zh) * 2019-03-14 2019-06-18 南京信息工程大学 一种水下机器人多传感器融合与运动轨迹预测方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
复杂混响背景下声呐基阵的目标方位估计算法;张国光;《舰船电子工程》;20170120(第01期);第22-26页 *

Also Published As

Publication number Publication date
CN110412583A (zh) 2019-11-05

Similar Documents

Publication Publication Date Title
US10725149B1 (en) System and method for autonomous joint detection-classification and tracking of acoustic signals of interest
CN103534608B (zh) 建造水下结构的三维模型
CN110414396A (zh) 一种基于深度学习的无人艇感知融合算法
US10054104B1 (en) Autonomous underwater beacon locator
CN109239709A (zh) 一种无人船的局部环境地图自主构建方法
CN103477244A (zh) 检测水下结构的结构变化
CN103620442A (zh) 判断水下航行器相对于水下结构的位置和方向
Packard et al. Continuous autonomous tracking and imaging of white sharks and basking sharks using a REMUS-100 AUV
CN110231778B (zh) 一种通用的uuv水下目标探测仿真方法及系统
Ferreira et al. Forward looking sonar mosaicing for mine countermeasures
KR20180129462A (ko) 드론 및 이를 이용한 해양 관측 시스템
CN110412583B (zh) 基于多rov协同的水下不明运动目标侦测系统
CN110333369B (zh) 基于水面gps校正的uuv的dvl测速系统及自适应去噪方法
CN109884729B (zh) 一种无人艇与机器鱼协作的水雷检测控制系统及水雷检测方法
CN106886017A (zh) 基于双频识别声呐的水下目标空间位置计算方法
CN110908404B (zh) 一种基于数据驱动的auv智能观测运动方法
Lohrasbipeydeh et al. Single hydrophone passive acoustic sperm whale range and depth estimation
Minart et al. An innovative sampling protocol for fish species identification methods in shallow waters: Towed diver, towed video and stereoscopic camera system
Lin et al. Using time of flight distance calculations for tagged shark localization with an AUV
Railey Demonstration of passive acoustic detection and tracking of unmanned underwater vehicles
Bunin et al. Fusion of acoustic measurements with video surveillance for estuarine threat detection
CN107941220B (zh) 一种基于视觉的无人船海天线检测与导航方法和系统
TWM583606U (zh) 海洋哺乳類追蹤系統以及載具
Dulepov et al. Investigation of bottom habitant diversity in Great Peter Bay using semi AUV TSL
Packard et al. Servo controlled rapid MCM target reacquisition using REMUS-100

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant