一种基于视觉反馈的无人艇目标跟踪方法技术

一种基于视觉反馈的无人艇目标跟踪方法，本发明专利技术涉及基于视觉反馈的无人艇目标跟踪方法。本发明专利技术为了解决现有方法复杂、响应速度慢、运算精度低以及抗扰动能力差的问题。本发明专利技术包括：一：对跟踪目标采用KCF跟踪算法进行检测和跟踪，确定跟踪目标的位置坐标；二：建立像素坐标系与世界坐标系下跟踪目标的对应关系，得到跟踪目标在世界坐标系下的坐标；三：无人艇处理器计算跟踪目标位置和自身位置的偏差，发送命令给运动控制单元进行控制，调整无人艇舵机的舵角以及推进电机的转速，使跟踪目标保持在相机视场的中央并使无人艇与跟踪目标保持在设定距离范围内，即实现了无人艇船舶运动控制系统对目标进行跟踪航行。本发明专利技术用于无人艇导航领域。

A visual feedback based target tracking method for unmanned craft

A target tracking method for Unmanned Aerial Vehicle Based on visual feedback, which relates to a target tracking method for Unmanned Aerial Vehicle Based on visual feedback. The present invention solves the problems of complicated existing methods, slow response speed, low operation precision and poor anti-disturbance ability. The invention comprises the following steps: firstly, the tracking target is detected and tracked by using the KCF tracking algorithm to determine the position coordinates of the tracking target; secondly, the corresponding relationship between the pixel coordinate system and the tracking target in the world coordinate system is established to obtain the coordinates of the tracking target in the world coordinate system; and thirdly, the tracking target position is calculated by the UAV processor. With the deviation of its position, the command is sent to the motion control unit to control, the rudder angle of the rudder and the speed of the propulsion motor are adjusted, so that the tracking target is kept in the center of the camera field of view and the unmanned ship and the tracking target are kept within the set distance range, that is, the target of the unmanned ship motion control system is realized. Follow up the voyage. The invention is applied to the navigation field of an unmanned boat.

【技术实现步骤摘要】
一种基于视觉反馈的无人艇目标跟踪方法
本专利技术涉及无人艇导航领域，具体涉及基于视觉反馈的无人艇目标跟踪方法。
技术介绍
水面无人艇(USV)能够自主航行，自主规划航迹，对周围环境具有一定的感知能力，能够实现对目标识别追踪，自主避障等功能。水面无人艇在应用到海军上，需要具有，海上安全，反水雷措施，电子战，海上拦截，反潜战，水面战，军力支持等能力。相对于陆地与天空环境，水面无人艇面临着更加恶劣的条件，由此提升无人艇的环境感知、视觉感知能力，对提升水面无人艇的自操作能力和安全性有很大的提升。结合计算机视觉，能够对水面目标有更强的感知识别能力，对无人艇的生存作业能力有巨大的提升。能够自主识别判断其作业环境中的目标物是水面无人艇的主要任务之一，因此对其视觉与处理系统有较高的智能化要求。水面无人艇对近距离目标或障碍物识别主要基于视觉系统而进行，因此，研究无人艇对水面目标的追踪具有十分重大的意义。
技术实现思路
本专利技术的目的是为了解决现有方法复杂、响应速度慢、运算精度低以及抗扰动能力差的缺点，而提出一种基于视觉反馈的无人艇目标跟踪方法。一种基于视觉反馈的无人艇目标跟踪方法包括以下步骤：本专利技术的目的是为水面无人艇提供一种可实现视觉跟踪的系统，以此实现无人艇的自主目标跟踪，实现无人艇的智能控制。该系统可适用于各种无人艇的视觉导航与跟踪，在可控制的范围内，对于指定的目标，在视觉单元捕捉到目标后，保证目标始终处在船载相机的视野范围之内，完成自主跟踪任务。步骤一：对跟踪目标采用KCF(KernelCorrelationFilter)跟踪算法进行检测和跟踪，确定跟踪目标的位置坐标；步骤二：建立像素坐标系与世界坐标系下跟踪目标的对应关系，计算无人艇与跟踪目标的距离，完成跟踪目标的精确定位，即得到跟踪目标世界坐标系下的坐标；步骤三：无人艇处理器计算跟踪目标位置(步骤二得到的跟踪目标世界坐标系下的坐标)和自身位置的偏差，发送命令给运动控制单元进行控制，调整无人艇舵机的舵角以及推进电机的转速，使跟踪目标保持在相机视场的中央并使无人艇与跟踪目标保持在设定距离范围内，即实现了无人艇船舶运动控制系统对目标进行跟踪航行。本专利技术的有益效果为：本专利技术的提供了一种基于视觉反馈的无人艇目标跟踪系统，系统主要分为两部分：即无人艇的船体部分与船体以外的地面部分。其中船体部分主要通过安装在无人艇前方的摄像头作为反馈元件，把拍摄到的实时的目标图像反馈给无人艇上的处理器进行图像处理，计算目标的实时位置并跟踪目标。处理器计算目标位置与自身位置的偏差，发送控制信号，通过控制船上部分的运动控制单元实现目标跟踪任务。具有算法简单、相应速度快、运算精度高、抗扰动能力强的特点。本专利技术目标识别率达到99％以上。本专利技术的视觉反馈单元(相机)，能够准确识别并跟踪目标物体的位置变化，所选的目标定位算法能够准确计算出目标物体与无人艇的相对位置，从而控制无人艇根据视觉的反馈，能够跟踪上目标。本专利技术的航向控制单元(舵机)，采用PID控制算法，在有外界扰动的情况下，能够控制无人艇按照设定航向运动。本专利技术所述的系统，能够适用于各种小型水面无人艇的目标跟踪需要。附图说明图1为本专利技术的控制系统结构示意图；图2为KCF目标跟踪算法原理图；图3为垂直方向目标定位；图4为水平方向目标定位；图5为目标物体有实际高度时的目标定位；图6为航向控制框图；图7为无人艇速度控制框图；图8为本专利技术的系统总体示意图。具体实施方式具体实施方式一：一种基于视觉反馈的无人艇目标跟踪方法包括以下步骤：如图1所示，本专利技术的一种基于视觉反馈的无人艇目标跟踪系统，通过安装在无人艇前方的摄像头作为反馈元件，把拍摄到的实时的目标图像反馈给无人艇上的处理器进行图像处理，跟踪目标并计算目标的实时位置。处理器计算目标位置与自身位置偏差，通过运动控制单元实现目标跟踪任务。步骤一：对跟踪目标采用KCF(KernelCorrelationFilter)跟踪算法进行检测和跟踪，确定跟踪目标的位置坐标；步骤二：建立像素坐标系与世界坐标系下跟踪目标的对应关系，计算无人艇与跟踪目标的距离，完成跟踪目标的精确定位，即得到跟踪目标的坐标；步骤三：无人艇处理器计算跟踪目标位置和自身位置的偏差，发送命令给运动控制单元进行控制，调整无人艇舵机的舵角以及推进电机的转速，使跟踪目标保持在相机视场的中央并使无人艇与跟踪目标保持在设定距离范围内，即实现了无人艇船舶运动控制系统对目标进行跟踪航行。本专利技术以视觉信号作为反馈，控制器计算目标位置与自身位置偏差，对系统进行闭环控制，从而实现无人艇的自主跟踪。本专利技术提高了无人艇的环境感知能力，提高了水面无人艇的自主操作能力及其安全性能。具体实施方式二：本实施方式与具体实施方式一不同的是：所述步骤一中对跟踪目标采用KCF跟踪算法进行检测和跟踪，确定跟踪目标的位置坐标的具体过程为：在训练过程中，对选定的跟踪目标区域进行采样，将跟踪目标区域作为正样本，背景区域作为负样本，提取HOG(HistogramofOrientedGradients)特征，将正负样本输入到岭回归分类器中进行训练；在检测过程中，将视频帧的目标区域作为中心，对目标区域进行采样，将得到的样本采用训练得到的岭回归器进行分类，岭回归器输出目标区域的位置，KCF跟踪算法采用循环矩阵生成样本，能够得到较快的训练和检测速度。其它步骤及参数与具体实施方式一相同。具体实施方式三：本实施方式与具体实施方式一或二不同的是：所述建立像素坐标系与世界坐标系下跟踪目标的对应关系的具体过程为：本专利技术的一种基于视觉反馈的无人艇目标跟踪系统，其目标定位算法通过单目视觉模型将的深度定位与水平方向的横向定位方法相结合，建立像素坐标系下的点(u,v)与世界坐标系下的位置坐标(X,Y)的映射关系。建立像素坐标系下的点(u,v)与世界坐标系下的位置坐标(X,Y)的映射关系；如图3所示，相机的焦距为f，O1M为相机的光轴位置，光心O2距离地面高度为h，O1是光轴在像平面上的交点，α代表光轴O1M与水平方向的夹角，取地面上的一个点P，透过相机在像平面上的点为P1，PP1与地面的夹角用β表示，PP1和光轴O1M的夹角用γ表示，O3P表示点P与光心O2的水平距离；在图3中，设有下面几个坐标系：1)世界坐标系XO3Y：以光心O2的投影O3为原点，与摄像头垂直指向O3P的方向为Y轴的正方向，X轴与Y轴垂直，坐标用(X,Y)来表示，以长度为单位；2)图像坐标系xo1y：原点在摄像头成像平面的中心，以(x,y)代表其坐标；3)像素坐标系uov：将图像平面的左上角当作坐标系的原点，以(u,v)表示其坐标，以像素为单位；O1在像素坐标系下的坐标表示为(u0,v0)；假设图像坐标系xo1y下P1的坐标是P1(0,y)，则根据图3得到以下关系式：β＝α-γ(1)在图像得到的不是y值，而是像素坐标系上的v值，则我们通过公式：y＝(v-v0)×dy，令中间变量fy＝f/dy，则有如下关系式：如图4所示，要想得到目标物体距离无人艇的坐标位置，在得到目标与小艇的垂直距离Y之后，还需要得到目标与小艇的水平距离X。假设图中的两点P和Q在世界坐标系XO3Y系下的坐标表示为P(0,Y)，Q(X,Y)，点P1，Q1为点P，Q在图像坐标系xo1本文档来自技高网...

【技术保护点】
1.一种基于视觉反馈的无人艇目标跟踪方法，其特征在于：所述基于视觉反馈的无人艇目标跟踪方法包括以下步骤：步骤一：对跟踪目标采用KCF跟踪算法进行检测和跟踪，确定跟踪目标的位置坐标；步骤二：建立像素坐标系与世界坐标系下跟踪目标的对应关系，计算无人艇与跟踪目标的距离，完成跟踪目标的精确定位，即得到跟踪目标在世界坐标系下的坐标；步骤三：无人艇处理器计算跟踪目标位置和自身位置的偏差，发送命令给运动控制单元进行控制，调整无人艇舵机的舵角以及推进电机的转速，使跟踪目标保持在相机视场的中央并使无人艇与跟踪目标保持在设定距离范围内，即实现了无人艇船舶运动控制系统对目标进行跟踪航行。

【技术特征摘要】
1.一种基于视觉反馈的无人艇目标跟踪方法，其特征在于：所述基于视觉反馈的无人艇目标跟踪方法包括以下步骤：步骤一：对跟踪目标采用KCF跟踪算法进行检测和跟踪，确定跟踪目标的位置坐标；步骤二：建立像素坐标系与世界坐标系下跟踪目标的对应关系，计算无人艇与跟踪目标的距离，完成跟踪目标的精确定位，即得到跟踪目标在世界坐标系下的坐标；步骤三：无人艇处理器计算跟踪目标位置和自身位置的偏差，发送命令给运动控制单元进行控制，调整无人艇舵机的舵角以及推进电机的转速，使跟踪目标保持在相机视场的中央并使无人艇与跟踪目标保持在设定距离范围内，即实现了无人艇船舶运动控制系统对目标进行跟踪航行。2.根据权利要求1所述一种基于视觉反馈的无人艇目标跟踪方法，其特征在于：所述步骤一中对跟踪目标采用KCF跟踪算法进行检测和跟踪，确定跟踪目标的位置坐标的具体过程为：在训练过程中，对选定的跟踪目标区域进行采样，将跟踪目标区域作为正样本，背景区域作为负样本，提取HOG特征，将正负样本输入到岭回归分类器中进行训练；在检测过程中，将视频帧的目标区域作为中心，对目标区域进行采样，将得到的样本采用训练得到的岭回归器进行分类，岭回归器输出目标区域的位置，KCF跟踪算法采用循环矩阵生成样本。3.根据权利要求1或2所述一种基于视觉反馈的无人艇目标跟踪方法，其特征在于：所述建立像素坐标系与世界坐标系下跟踪目标的对应关系的具体过程为：建立像素坐标系下的点(u,v)与世界坐标系下的位置坐标(X,Y)的映射关系；相机的焦距为f，O1M为相机的光轴位置，光心O2距离地面高度为h，O1是光轴在像平面上的交点，α代表光轴O1M与水平方向的夹角，取地面上的一个点P，透过相机在像平面上的点为P1，PP1与地面的夹角用β表示，PP1和光轴O1M的夹角用γ表示，O3P表示点P与光心O2的水平距离；1)世界坐标系XO3Y：以光心O2的投影O3为原点，与摄像头垂直指向O3P的方向为Y轴的正方向，X轴与Y轴垂直，坐标用(X,Y)来表示，以长度为单位；2)图像坐标系xo1y：原点在摄像头成像平面的中心，以(x,y)代表其坐标；3)像素坐标系uov：将图像平面的左上角当作坐标系的原点，以(u,v)表示其坐标，以像素为单位；O1在像素坐标系下的坐标...

【专利技术属性】
技术研发人员：曾薄文，赵洋，段涛，项伯贵，刘庭瑞，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江,23