CN104793637A - 一种移动设备的实时跟踪***及跟踪方法 - Google Patents
一种移动设备的实时跟踪***及跟踪方法 Download PDFInfo
- Publication number
- CN104793637A CN104793637A CN201510164172.7A CN201510164172A CN104793637A CN 104793637 A CN104793637 A CN 104793637A CN 201510164172 A CN201510164172 A CN 201510164172A CN 104793637 A CN104793637 A CN 104793637A
- Authority
- CN
- China
- Prior art keywords
- screen
- laser
- receiving screen
- laser spots
- receiving
- 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.)
- Granted
Links
Landscapes
- Closed-Circuit Television Systems (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明提供一种移动设备的实时跟踪***及跟踪方法,有助于提高移动设备跟踪的可靠性和抗干扰能力。所述***包括:激光跟踪基站子***和跟踪偏差反馈子***;所述跟踪偏差反馈子***包括:接收屏屏幕;所述激光跟踪基站子***包括:控制器、驱动器、水平电机、俯仰电机和激光测距仪;所述跟踪偏差反馈子***,用于对采集的接收屏屏幕上的图像进行处理,确定激光点相对于接收屏屏幕中心的偏差信息;所述控制器,用于根据接收到的偏差信息生成控制指令,驱动所述驱动器控制水平电机和俯仰电机的运动带动激光测距仪旋转并使所述激光测距仪发出的激光射在接收屏屏幕的中心。本发明适用于通信技术领域。
Description
技术领域
本发明涉及通信技术领域,特别是指一种移动设备的实时跟踪***及跟踪方法。
背景技术
近年来,相对于室外定位,地下定位无法用全球定位***为移动设备(例如,车辆)的自主行驶定位导航,由于巷道狭窄,信号繁杂等一系列的问题使得地下定位一直都是一个难题。目前所使用的定位方法主要包括:航迹推算定位技术、无线电定位技术、视觉定位技术及惯性导航技术等都在精度上或者可靠性上都有一定缺陷。
在移动设备跟踪方面,主要方法有基于无线传感器网络、视频图像的处理等方法,而基于无线传感器网络的方法在传感器的布置上有较高要求,并且需要的传感器数量大,成本高,而且跟踪易受干扰;基于视频图像的跟踪方法受场景光线的变化、阴影的问题,背景的复杂化等影响,都会使跟踪丢失或出现跟踪错的情况。
发明内容
本发明要解决的技术问题是提供一种移动设备的实时跟踪***及跟踪方法,以解决现有技术所存在的实时跟踪成本高、易受干扰、可靠性低的问题。
为解决上述技术问题,本发明实施例提供一种移动设备的实时跟踪***,包括:激光跟踪基站子***和安装在移送设备上的跟踪偏差反馈子***;所述跟踪偏差反馈子***包括:接收屏屏幕;所述激光跟踪基站子***包括:控制器、驱动器、水平电机、俯仰电机和激光测距仪;
所述跟踪偏差反馈子***,用于采集接收屏屏幕上的图像,并对所述图像进行处理,确定激光点相对于接收屏屏幕中心的偏差信息,同时将所述偏差信息发送至所述控制器;
所述控制器,用于根据接收到的偏差信息生成控制指令,驱动所述驱动器控制水平电机和俯仰电机的运动带动激光测距仪旋转并使所述激光测距仪发出的激光射在接收屏屏幕的中心。
可选地,所述跟踪偏差反馈子***还包括:摄像头、图像采集电路及箱体;
所述箱体,一面用于安装所述接收屏,并在其对面安装所述摄像头;
所述摄像头,用于采集整个接收屏屏幕的图像;
所述图像采集电路,用于对采集的图像进行处理,判断采集的图像上是否有激光点,若有激光点,则确定所述激光点在接收屏屏幕上的实际物理坐标,并确定激光点相对于接收屏屏幕中心的偏差信息,同时将所述偏差信息发送至控制器,所述偏差信息包括:激光点相对于接收屏屏幕中心的水平、竖直偏差量及捕获标识,否则,将将生成的包括未捕获标识的偏差信息发送至控制器。
可选地,激光点在接收屏屏幕上的理想像素坐标(x,y)与激光点在接收屏屏幕上的实际物理坐标(x’,y’)之间的关系为:
[x’,y’]=A[x,y]+B
其中,(u,v)为激光点在接收屏屏幕上的实际像素坐标,r为激光点在接收屏屏幕上的实际像素坐标与坐标原点的距离,a为图像畸变系数,A、B为物理坐标尺寸与像素坐标尺寸的比例参数。
可选地,所述激光跟踪基站子***的工作模式包括:扫描模式和跟踪模式;
当控制器接收到的偏差信息包括未捕获标识时,所述激光跟踪基站子***进入扫描模式,所述控制器通过驱动器控制水平电机和俯仰电机的转角及转速带动激光测距仪进行旋转并使激光测距仪发出的激光在所述激光跟踪基站子***覆盖的工作区域内成W型扫描移动设备;
当控制器接收到的偏差信息包括捕获标识时,所述激光跟踪基站子***进入跟踪模式,所述控制器根据激光点相对于接收屏屏幕中心的水平、竖直偏差量通过驱动器控制水平电机和俯仰电机的转角及转速带动激光测距仪进行旋转并使激光测距仪发出的激光射在接收屏屏幕的中心,对移动设备进行实时跟踪。
可选地,在激光丢失跟踪的移动设备的瞬间,通过跟踪偏差反馈子***记录该瞬间点的接收屏屏幕上的激光点的实际物理坐标信息,并确定激光运动出所述接收屏屏幕的运动轨迹,根据所述运动轨迹由控制器控制水平电机和俯仰电机的转角及转速按照该运动轨迹的反方向进行运动。
可选地,所述摄像头的像素不低于640*480,采集频率不低于30fps;
所述接收屏屏幕尺寸为380*285,所述摄像头的采集分辨率为640*320;
所述水平电机和俯仰电机分别为旋转误差在15角秒内的伺服电机。
可选地,所述控制器采用DSP+ARM的双核嵌入式结构,并采用浮点型DSP芯片作为主处理器,ARM芯片作为协处理器;
所述协处理器,用于与所述跟踪偏差反馈子***进行通讯获取跟踪偏差消息,并将所述偏差信息发送至所述主处理器;
所述主处理器,用于采集水平电机及俯仰电机的旋转角度信息,并结合协处理器发送的跟踪偏差消息,生成脉冲和频率控制指令驱动所述驱动器带动水平电机及俯仰电机进行运动。
另一方面,本发明实施例还提供一种移动设备的实时跟踪方法,包括:通过跟踪偏差反馈子***采集接收屏屏幕上的图像,并对所述图像进行处理,确定激光点相对于接收屏屏幕中心的偏差信息,同时将所述偏差信息发送至控制器;
根据接收到的偏差信息,由控制器生成控制指令,驱动驱动器控制水平电机和俯仰电机的运动带动激光测距仪进行旋转并使激光测距仪发出的激光射在接收屏屏幕的中心。
可选地,所述跟踪偏差反馈子***包括:接收屏屏幕、摄像头、图像采集电路及箱体,所述箱体,一面用于安装所述接收屏,并在其对面安装摄像头;
所述通过跟踪偏差反馈子***采集接收屏屏幕上的图像,并对所述图像进行处理,确定激光点相对于接收屏屏幕中心的偏差信息,同时将所述偏差信息发送至控制器包括:
通过所述摄像头采集整个接收屏屏幕的图像;
通过所述图像采集电路对采集的图像进行处理,判断采集的图像上是否有激光点;
若有激光点,则确定所述激光点在接收屏屏幕上的实际物理坐标,并确定激光点相对于接收屏屏幕中心的偏差信息,同时将所述偏差信息发送至控制器,所述偏差信息包括:激光点相对于接收屏屏幕中心的水平、竖直偏差量及捕获标识;
若没有激光点,则将生成的包括未捕获标识的偏差信息发送至控制器。
可选地,所述确定所述激光点在接收屏屏幕上的实际物理坐标包括:
利用圆形模板变异的方法对桶形畸变进行修正,确定激光点在接收屏屏幕上的理想像素坐标(x,y)和激光点在接收屏屏幕上的实际像素坐标(u,v)的关系为:
其中,r为激光点在接收屏屏幕上的实际像素坐标与坐标原点的距离,a为图像畸变系数;
通过一次拟合运算,确定修正后的理想像素坐标(x,y)与该激光点在接收屏屏幕上的实际物理坐标(x’,y’)的关系为:
[x’,y’]=A[x,y]+B
其中,A、B为物理坐标尺寸与像素坐标尺寸的比例参数。
本发明的上述技术方案的有益效果如下:
上述方案中,通过对采集的图像进行处理,确定激光点相对于接收屏屏幕中心的偏差信息并将所述偏差信息反馈给激光跟踪基站子***,再由激光跟踪基站子***的控制器根据所述偏差信息生成控制指令,驱动所述驱动器控制水平电机和俯仰电机的运动带动激光测距仪旋转并使所述激光测距仪发出的激光射在接收屏屏幕的中心,形成移动设备的实时跟踪的闭环控制***,这样,由于激光的亮度远大于一般场景下的环境光,且受环境因素影响较小,抗干扰能力强、稳定性高,因此,根据激光点在屏幕上的偏差信息跟踪移动设备,能够提高跟踪的可靠性。
附图说明
图1为本发明实施例提供的激光发射基站子***和跟踪偏差反馈子***联合工作示意图;
图2为本发明实施例提供的跟踪偏差反馈子***的示意图;
图3为本发明实施例提供的激光发射基站子***的示意图;
图4为本发明实施例提供的跟踪偏差反馈子***工作流程图;
图5为本发明实施例提供的跟踪基站子***和跟踪偏差反馈子***的闭环***示意图。
具体实施方式
为使本发明要解决的技术问题、技术方案和优点更加清楚,下面将结合附图及具体实施例进行详细描述。
本发明针对现有的实时跟踪成本高、易受干扰、可靠性低的问题,提供一种移动设备1的实时跟踪***及跟踪方法。
实施例一
参看图1至图3所示,本发明实施例提供的一种移动设备1的实时跟踪***,包括:激光跟踪基站子***3和安装在移送设备上的跟踪偏差反馈子***2;所述跟踪偏差反馈子***2包括:接收屏21屏幕;所述激光跟踪基站子***3包括:控制器、驱动器、水平电机35、俯仰电机31和激光测距仪33;
所述跟踪偏差反馈子***2,用于采集接收屏21屏幕上的图像,并对所述图像进行处理,确定激光点相对于接收屏21屏幕中心的偏差信息,同时将所述偏差信息发送至所述控制器;
所述控制器,用于根据接收到的偏差信息生成控制指令,驱动所述驱动器控制水平电机35和俯仰电机31的运动带动激光测距仪33旋转并使所述激光测距仪33发出的激光射在接收屏21屏幕的中心。
本发明实施例所述的移动设备1的实时跟踪***,通过对采集的图像进行处理,确定激光点相对于接收屏21屏幕中心的偏差信息并将所述偏差信息反馈给激光跟踪基站子***3,再由激光跟踪基站子***3的控制器根据所述偏差信息生成控制指令,驱动所述驱动器控制水平电机35和俯仰电机31的运动带动激光测距仪33旋转并使所述激光测距仪33发出的激光射在接收屏21屏幕的中心,形成移动设备1的实时跟踪的闭环控制***,这样,由于激光的亮度远大于一般场景下的环境光,且受环境因素影响较小,抗干扰能力强、稳定性高,因此,根据激光点在屏幕上的偏差信息跟踪移动设备1,能够提高跟踪的可靠性。
本发明实施例中,所述跟踪偏差反馈子***2一般安装在移动设备1的前方或者后方,使得在移动设备1的运动过程中接收屏21屏幕不被遮挡,所述激光跟踪基站子***3安装在移动设备1的工作场地,在移动设备1运动的过程中,激光跟踪基站子***3和跟踪偏差反馈子***2之间不能有遮挡,例如,所述跟踪偏差反馈子***2固定安装在移动设备1(例如,车辆)的前方,所述激光跟踪基站子***3布置在移动设备1行驶方向的前方。激光跟踪基站子***3是将一个激光测距仪33固定安装在激光测距仪固定架32上,通过水平电机35和俯仰电机31的运动带动所述激光测距仪33在水平、垂直方向作360°旋转,因此可以使得激光测距仪33发出的激光覆盖整个激光跟踪基站子***3的工作区域,激光测距仪33发出的激光射在接收屏21屏幕上形成激光点,其中,水平电机35通过水平电机固定架34安装在激光跟踪基站子***3上,俯仰电机31通过俯仰电机固定架安装在激光跟踪基站子***3上。
在前述移动设备1的实时跟踪***的具体实施方式中,可选地,所述跟踪偏差反馈子***2还包括:摄像头22、图像采集电路及箱体;
所述箱体,一面用于安装所述接收屏21,并在其对面安装所述摄像头22;
所述摄像头22,用于采集整个接收屏21屏幕的图像;
所述图像采集电路,用于对采集的图像进行处理,判断采集的图像上是否有激光点,若有激光点,则确定所述激光点在接收屏21屏幕上的实际物理坐标,并确定激光点相对于接收屏21屏幕中心的偏差信息,同时将所述偏差信息发送至控制器,所述偏差信息包括:激光点相对于接收屏21屏幕中心的水平、竖直偏差量及捕获标识,否则,将将生成的包括未捕获标识的偏差信息发送至控制器。
本发明实施例中,参看图2和图4所示,所述跟踪偏差反馈子***2包括:摄像头22、接收屏21屏幕、图像采集电路以及箱体,所述箱体的一个面安装接收屏21屏幕,并在其对面安装摄像头22,所述摄像头22的采集范围覆盖整个接收屏21屏幕,通过所述摄像头22不断地采集接收屏21屏幕上的图像,并通过所述图像采集电路对采集的每帧图像进行一系列的处理,包括图像的特征分量的提取、动态阈值法获得二值化图像、图像桶形畸变修正等方法等处理后,判断是否有激光点射在接收屏21屏幕上,当有激光点射在接收屏21屏幕上时,确定所述激光点在接收屏21屏幕上的实际物理坐标,并确定激光点相对于接收屏21屏幕中心的偏差信息,同时将所述偏差信息发送至激光跟踪基站子***3的控制器,所述偏差信息包括:激光点相对于接收屏21屏幕中心的水平、竖直偏差量及捕获标识,当没有激光点射在接收屏21屏幕上时,所述偏差信息包括:未捕获标识,并将所述偏差信息发送至激光跟踪基站子***3的控制器。
在前述移动设备1的实时跟踪***的具体实施方式中,可选地,激光点在接收屏21屏幕上的理想像素坐标(x,y)与激光点在接收屏21屏幕上的实际物理坐标(x’,y’)之间的关系为:
[x’,y’]=A[x,y]+B
其中,(u,v)为激光点在接收屏21屏幕上的实际像素坐标,r为激光点在接收屏21屏幕上的实际像素坐标与坐标原点的距离,a为图像畸变系数,A、B为物理坐标尺寸与像素坐标尺寸的比例参数。
本发明实施例中,所述跟踪偏差反馈子***2作为整个闭环的反馈数据提供,反馈越准确、及时,跟踪的效果越好,为了反馈准确,需要采集的激光点在接收屏21屏幕上的物理尺寸上的偏差、误差越小越好。由于采集到的图像是像素信息,而跟踪基站子***3需要根据实际的物理尺寸信息来控制水平电机35和俯仰电机31的运动,因此还需通过图像采集电路来确定采集的激光点的实际偏差,即:激光点在接收屏21屏幕上的实际物理坐标(x’,y’)。为了使摄像头22的捕捉范围覆盖到整个接收屏21屏幕,摄像头22所用的镜头都会带有一定的广角性质,而广角镜头会引起图像的桶形畸变,这会导致采集到的图像的像素与实际的物理尺寸间不成单一的比例关系。首先利用圆形模板变异的方法对桶形畸变进行修正,得出激光点在接收屏21屏幕上的理想像素坐标(x,y)与激光点在接收屏21屏幕上的实际像素坐标(u,v)的关系为式(1):
式(1)中,r为激光点在接收屏21屏幕上的实际像素坐标与坐标原点的距离,a为图像畸变系数;
根据圆形模板变异的方法基本能够修正由广角摄像头22引起的桶形畸变,但是修正之后获得理想像素坐标(x,y)还是像素坐标系下的坐标,需再通过一次拟合的方式得到激光点在接收屏21屏幕上的实际物理坐标(x’,y’),激光点在接收屏21屏幕上的理想像素坐标(x,y)与激光点在接收屏21屏幕上的实际物理坐标(x’,y’)之间的关系为式(2):
[x’,y’]=A[x,y]+B 式(2)
式(2)中,A、B为一次拟合的参数,表示物理坐标尺寸与像素坐标尺寸的比例参数,通过桶形畸变的修正以及一次拟合,可以实现激光点的偏差误差在1mm以内,保证了反馈的准确性,从而保障激光跟踪基站子***3跟踪移动设备1,提高跟踪的准确性。
在前述移动设备1的实时跟踪***的具体实施方式中,可选地,所述激光跟踪基站子***3的工作模式包括:扫描模式和跟踪模式;
当控制器接收到的偏差信息包括未捕获标识时,所述激光跟踪基站子***3进入扫描模式,所述控制器通过驱动器控制水平电机35和俯仰电机31的转角及转速带动激光测距仪33进行旋转并使激光测距仪33发出的激光在所述激光跟踪基站子***3覆盖的工作区域内成W型扫描移动设备1;
当控制器接收到的偏差信息包括捕获标识时,所述激光跟踪基站子***3进入跟踪模式,所述控制器根据激光点相对于接收屏21屏幕中心的水平、竖直偏差量通过驱动器控制水平电机35和俯仰电机31的转角及转速带动激光测距仪33进行旋转并使激光测距仪33发出的激光射在接收屏21屏幕的中心,对移动设备1进行实时跟踪。
本发明实施例中,当激光跟踪基站子***3接收到跟踪偏差反馈子***2传递来的偏差信息包括未捕获标识,即没有激光点射在接收屏21屏幕上,这时说明移动设备1处于未被跟踪的状态,激光跟踪基站子***3需要先找到移动设备1,此时激光跟踪基站子***3处于扫描状态,激光跟踪基站子***3通过控制水平电机35和俯仰电机31的转速以及方向,使的激光在激光跟踪基站子***3的工作区域内呈“W”型扫描,W型扫描的目的是激光可以覆盖到激光跟踪基站子***3的整个工作区域,只要移动设备1处于该工作区域内就可以被扫描到。
当跟踪偏差反馈子***2识别到激光射在接收屏21屏幕上后,跟踪偏差反馈子***2将激光点的相对于接收屏21屏幕中心的偏差量传递给地面的激光跟踪基站子***3,激光跟踪基站子***3切换工作模式,进入跟踪模式。参看图5所示,跟踪偏差反馈子***2的反馈和激光跟踪基站子***3的运动形成一个闭环***,激光跟踪基站子***3根据跟踪偏差反馈子***2***反馈的当前激光点在接收屏21屏幕上的实际物理坐标信息与接收屏21屏幕中心的角度偏差量,控制水平电机35和俯仰电机31进行水平和竖直方向的不断微调,实现激光点始终在接收屏21屏幕的中心附近,最终实现对移动设备1的实时动态跟踪。
本发明实施例中,激光跟踪基站子***3通过控制脉冲数和脉冲频率来控制电机的转角及转速,而跟踪偏差反馈子***2提供的为接收屏21屏幕的水平、垂直方向偏差量,因此需要做水平、垂直方向偏差量与转角间的转换得出角度偏差量,在移动设备1运动方向与朝向激光跟踪基站子***3的方向夹角不太大的情况下,水平电机35的目标转角α和俯仰电机31的目标转角β满足式(3):
式(3)中,l为激光测距仪33测得的移动设备1与激光跟踪基站子***3之间的距离。
在前述移动设备1的实时跟踪***的具体实施方式中,可选地,在激光丢失跟踪的移动设备1的瞬间,通过跟踪偏差反馈子***2记录该瞬间点的接收屏21屏幕上的激光点的实际物理坐标信息,并确定激光运动出所述接收屏21屏幕的运动轨迹,根据所述运动轨迹由控制器控制水平电机35和俯仰电机31的转角及转速按照该运动轨迹的反方向进行运动。
本发明实施例,由于***间的通信延迟或者其他原因导致激光丢失跟踪移动设备1的情况,跟踪偏差反馈子***2会在丢失的瞬间记录激光点的坐标信息,并推算出激光运动出所述接收屏21屏幕的运动轨迹,然后地面的激光跟踪基站子***3就可以按照该运动轨迹的方向快速往回找,使得丢失后能够立马找回,跟踪实时、可靠。
在前述移动设备1的实时跟踪***的具体实施方式中,可选地,所述摄像头22的像素不低于640*480,采集频率不低于30fps;
所述接收屏21屏幕尺寸为380*285,所述摄像头22的采集分辨率为640*320;
所述水平电机35和俯仰电机31分别为旋转误差在15角秒内的伺服电机。
本发明实施例中,为了实时地跟踪移动设备1以及提高跟踪的精确性,需及时向激光跟踪基站子***3反馈所述跟踪偏差反馈子***2生成的偏差信息,为了能够反馈及时,本***采用的摄像头22的像素要求不低于640*480,采集频率不低于30fps,由于需对接收屏21屏幕上的图像进行频繁的采集,且采集的图像的像素高,所述采集的图像数据庞大,因而对图像采集电路的计算能力要求较高,所述图像采集电路可以采用S5PV210处理器,运算能力可达到1000DMIPS(每秒运算20亿条指令集)。从理论上说,接收屏21屏幕的尺寸越大,则对于激光跟踪基站子***3来说越好跟踪移动设备1,但是当分辨率相同时,如果接收屏21屏幕的尺寸越大,则意味着数据量会越大,对摄像机的采集和图像采集电路的图像处理过程的要求都会相应提高,而且大的接收屏21屏幕所占的体积越大,在移动设备1的安装空间需要更大。因此考虑接收屏21屏幕的制约条件,选择的接收屏21屏幕尺寸是380*285,而摄像机采集的分辨率为640*320,也就是说,接收屏21屏幕上每平方毫米都会对应至少四个像素点,因此可以保证在数据采集正确的情况下,对于激光点距离中心的判断精度可以达到1mm以内。
本发明实施例,为了保证跟踪的精度以及远距离跟踪的可靠性,水平电机35和俯仰电机31分别采用旋转误差在15角秒内的伺服电机。
在前述移动设备1的实时跟踪***的具体实施方式中,可选地,所述控制器采用DSP+ARM的双核嵌入式结构,并采用浮点型DSP芯片作为主处理器,ARM芯片作为协处理器;
所述协处理器,用于与所述跟踪偏差反馈子***2进行通讯获取跟踪偏差消息,并将所述偏差信息发送至所述主处理器;
所述主处理器,用于采集水平电机35及俯仰电机31的旋转角度信息,并结合协处理器发送的跟踪偏差消息,生成脉冲和频率控制指令驱动所述驱动器带动水平电机35及俯仰电机31进行运动。
本发明实施例中,控制器采用DSP+ARM的双核嵌入式结构,并选用浮点型DSP芯片作为主处理器,选用ARM芯片作为协处理器。协处理器主要作用为通讯,是作为激光跟踪基站子***3与跟踪偏差反馈子***2、移动设备1,激光跟踪基站子***3内部等各个***通信中转。主处理器主要是完成对水平电机35、俯仰电机31的驱动,具体为,根据跟踪偏差反馈子***2发送的偏差信息并结合采集的水平电机35及俯仰电机31的旋转角度信息,生成脉冲和频率控制指令控制水平电机35、俯仰电机31的运动,实现对移动设备1的实时跟踪。
实施例二
本发明还提供一种移动设备1的实时跟踪方法的具体实施方式,由于本发明提供的移动设备1的实时跟踪方法与前述移动设备1的实时跟踪***的具体实施方式相对应,该移动设备1的实时跟踪方法可以通过执行上述方法具体实施方式中的流程步骤来实现本发明的目的,因此上述移动设备1的实时跟踪***具体实施方式中的解释说明,也适用于本发明提供的移动设备1的实时跟踪方法的具体实施方式,在本发明以下的具体实施方式中将不再赘述。
本发明实施例还提供一种移动设备1的实时跟踪方法,包括:
通过跟踪偏差反馈子***2采集接收屏21屏幕上的图像,并对所述图像进行处理,确定激光点相对于接收屏21屏幕中心的偏差信息,同时将所述偏差信息发送至控制器;
根据接收到的偏差信息,由控制器生成控制指令,驱动驱动器控制水平电机35和俯仰电机31的运动带动激光测距仪33进行旋转并使激光测距仪33发出的激光射在接收屏21屏幕的中心。
本发明实施例所述的移动设备1的实时跟踪方法,通过对采集的图像进行处理,确定激光点相对于接收屏21屏幕中心的偏差信息,再由激光跟踪基站子***3的控制器根据接收到的偏差信息生成控制指令,驱动所述驱动器控制水平电机35和俯仰电机31的运动带动激光测距仪33旋转并使所述激光测距仪33发出的激光射在接收屏21屏幕的中心,这样,由于激光的亮度远大于一般场景下的环境光,且受环境因素影响较小,抗干扰能力强、稳定性高,根据激光点在屏幕上的偏差信息跟踪移动设备1,能够提高跟踪的可靠性。
在前述移动设备1的实时跟踪方法的具体实施方式中,可选地,所述跟踪偏差反馈子***2包括:接收屏21屏幕、摄像头22、图像采集电路及箱体,所述箱体,一面用于安装所述接收屏21,并在其对面安装摄像头22;
所述通过跟踪偏差反馈子***2采集接收屏21屏幕上的图像,并对所述图像进行处理,确定激光点相对于接收屏21屏幕中心的偏差信息,同时将所述偏差信息发送至控制器包括:
通过所述摄像头22采集整个接收屏21屏幕的图像;
通过所述图像采集电路对采集的图像进行处理,判断采集的图像上是否有激光点;
若有激光点,则确定所述激光点在接收屏21屏幕上的实际物理坐标,并确定激光点相对于接收屏21屏幕中心的偏差信息,同时将所述偏差信息发送至控制器,所述偏差信息包括:激光点相对于接收屏21屏幕中心的水平、竖直偏差量及捕获标识;
若没有激光点,则将生成的包括未捕获标识的偏差信息发送至控制器。
在前述移动设备1的实时跟踪方法的具体实施方式中,可选地,所述确定所述激光点在接收屏21屏幕上的实际物理坐标包括:
利用圆形模板变异的方法对桶形畸变进行修正,确定激光点在接收屏21屏幕上的理想像素坐标(x,y)和激光点在接收屏21屏幕上的实际像素坐标(u,v)的关系为:
其中,r为激光点在接收屏21屏幕上的实际像素坐标与坐标原点的距离,a为图像畸变系数;
通过一次拟合运算,确定修正后的理想像素坐标(x,y)与该激光点在接收屏21屏幕上的实际物理坐标(x’,y’)的关系为:
[x’,y’]=A[x,y]+B
其中,A、B为物理坐标尺寸与像素坐标尺寸的比例参数。
以上所述是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明所述原理的前提下,还可以作出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (10)
1.一种移动设备的实时跟踪***,其特征在于,包括:激光跟踪基站子***和安装在移送设备上的跟踪偏差反馈子***;所述跟踪偏差反馈子***包括:接收屏屏幕;所述激光跟踪基站子***包括:控制器、驱动器、水平电机、俯仰电机和激光测距仪;
所述跟踪偏差反馈子***,用于采集接收屏屏幕上的图像,并对所述图像进行处理,确定激光点相对于接收屏屏幕中心的偏差信息,同时将所述偏差信息发送至所述控制器;
所述控制器,用于根据接收到的偏差信息生成控制指令,驱动所述驱动器控制水平电机和俯仰电机的运动带动激光测距仪旋转并使所述激光测距仪发出的激光射在接收屏屏幕的中心。
2.根据权利要求1所述的***,其特征在于,所述跟踪偏差反馈子***还包括:摄像头、图像采集电路及箱体;
所述箱体,一面用于安装所述接收屏,并在其对面安装所述摄像头;
所述摄像头,用于采集整个接收屏屏幕的图像;
所述图像采集电路,用于对采集的图像进行处理,判断采集的图像上是否有激光点,若有激光点,则确定所述激光点在接收屏屏幕上的实际物理坐标,并确定激光点相对于接收屏屏幕中心的偏差信息,同时将所述偏差信息发送至控制器,所述偏差信息包括:激光点相对于接收屏屏幕中心的水平、竖直偏差量及捕获标识,否则,将将生成的包括未捕获标识的偏差信息发送至控制器。
3.根据权利要求2所述的***,其特征在于,激光点在接收屏屏幕上的理想像素坐标(x,y)与激光点在接收屏屏幕上的实际物理坐标(x’,y’)之间的关系为:
[x’,y’]=A[x,y]+B
其中,(u,v)为激光点在接收屏屏幕上的实际像素坐标,r为激光点在接收屏屏幕上的实际像素坐标与坐标原点的距离,a为图像畸变系数,A、B为物理坐标尺寸与像素坐标尺寸的比例参数。
4.根据权利要求2所述的***,其特征在于,所述激光跟踪基站子***的工作模式包括:扫描模式和跟踪模式;
当控制器接收到的偏差信息包括未捕获标识时,所述激光跟踪基站子***进入扫描模式,所述控制器通过驱动器控制水平电机和俯仰电机的转角及转速带动激光测距仪进行旋转并使激光测距仪发出的激光在所述激光跟踪基站子***覆盖的工作区域内成W型扫描移动设备;
当控制器接收到的偏差信息包括捕获标识时,所述激光跟踪基站子***进入跟踪模式,所述控制器根据激光点相对于接收屏屏幕中心的水平、竖直偏差量通过驱动器控制水平电机和俯仰电机的转角及转速带动激光测距仪进行旋转并使激光测距仪发出的激光射在接收屏屏幕的中心,对移动设备进行实时跟踪。
5.根据权利要求2所述的***,其特征在于,在激光丢失跟踪的移动设备的瞬间,通过跟踪偏差反馈子***记录该瞬间点的接收屏屏幕上的激光点的实际物理坐标信息,并确定激光运动出所述接收屏屏幕的运动轨迹,根据所述运动轨迹由控制器控制水平电机和俯仰电机的转角及转速按照该运动轨迹的反方向进行运动。
6.根据权利要求2所述的***,其特征在于,所述摄像头的像素不低于640*480,采集频率不低于30fps;
所述接收屏屏幕尺寸为380*285,所述摄像头的采集分辨率为640*320;
所述水平电机和俯仰电机分别为旋转误差在15角秒内的伺服电机。
7.根据权利要求2所述的***,其特征在于,所述控制器采用DSP+ARM的双核嵌入式结构,并采用浮点型DSP芯片作为主处理器,ARM芯片作为协处理器;
所述协处理器,用于与所述跟踪偏差反馈子***进行通讯获取跟踪偏差消息,并将所述偏差信息发送至所述主处理器;
所述主处理器,用于采集水平电机及俯仰电机的旋转角度信息,并结合协处理器发送的跟踪偏差消息,生成脉冲和频率控制指令驱动所述驱动器带动水平电机及俯仰电机进行运动。
8.一种移动设备的实时跟踪方法,其特征在于,包括:
通过跟踪偏差反馈子***采集接收屏屏幕上的图像,并对所述图像进行处理,确定激光点相对于接收屏屏幕中心的偏差信息,同时将所述偏差信息发送至控制器;
根据接收到的偏差信息,由控制器生成控制指令,驱动驱动器控制水平电机和俯仰电机的运动带动激光测距仪进行旋转并使激光测距仪发出的激光射在接收屏屏幕的中心。
9.根据权利要求8所述的方法,其特征在于,所述跟踪偏差反馈子***包括:接收屏屏幕、摄像头、图像采集电路及箱体,所述箱体,一面用于安装所述接收屏,并在其对面安装摄像头;
所述通过跟踪偏差反馈子***采集接收屏屏幕上的图像,并对所述图像进行处理,确定激光点相对于接收屏屏幕中心的偏差信息,同时将所述偏差信息发送至控制器包括:
通过所述摄像头采集整个接收屏屏幕的图像;
通过所述图像采集电路对采集的图像进行处理,判断采集的图像上是否有激光点;
若有激光点,则确定所述激光点在接收屏屏幕上的实际物理坐标,并确定激光点相对于接收屏屏幕中心的偏差信息,同时将所述偏差信息发送至控制器,所述偏差信息包括:激光点相对于接收屏屏幕中心的水平、竖直偏差量及捕获标识;
若没有激光点,则将生成的包括未捕获标识的偏差信息发送至控制器。
10.根据权利要求8所述的方法,其特征在于,所述确定所述激光点在接收屏屏幕上的实际物理坐标包括:
利用圆形模板变异的方法对桶形畸变进行修正,确定激光点在接收屏屏幕上的理想像素坐标(x,y)和激光点在接收屏屏幕上的实际像素坐标(u,v)的关系为:
其中,r为激光点在接收屏屏幕上的实际像素坐标与坐标原点的距离,a为图像畸变系数;
通过一次拟合运算,确定修正后的理想像素坐标(x,y)与该激光点在接收屏屏幕上的实际物理坐标(x’,y’)的关系为:
[x’,y’]=A[x,y]+B
其中,A、B为物理坐标尺寸与像素坐标尺寸的比例参数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510164172.7A CN104793637B (zh) | 2015-04-08 | 2015-04-08 | 一种移动设备的实时跟踪***及跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510164172.7A CN104793637B (zh) | 2015-04-08 | 2015-04-08 | 一种移动设备的实时跟踪***及跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104793637A true CN104793637A (zh) | 2015-07-22 |
CN104793637B CN104793637B (zh) | 2017-07-11 |
Family
ID=53558521
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510164172.7A Active CN104793637B (zh) | 2015-04-08 | 2015-04-08 | 一种移动设备的实时跟踪***及跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104793637B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106325196A (zh) * | 2015-10-23 | 2017-01-11 | 国网上海市电力公司 | 手持终端检测用激光自动瞄准装置 |
CN106842229A (zh) * | 2017-04-07 | 2017-06-13 | 赵�怡 | 一种激光云台智能空间定位***及空间定位方法 |
CN107894832A (zh) * | 2017-10-20 | 2018-04-10 | 深圳市虚拟现实科技有限公司 | 基于光点捕捉的移动端虚拟现实头显校正的方法与装置 |
CN108261761A (zh) * | 2018-01-18 | 2018-07-10 | 北京凌宇智控科技有限公司 | 一种空间定位方法和装置、计算机可读存储介质 |
CN108565000A (zh) * | 2018-04-03 | 2018-09-21 | 夏擎华 | 一种基于伺服电机的运动器材app |
CN109605397A (zh) * | 2019-01-11 | 2019-04-12 | 山东元脉电子技术股份有限公司 | 具有自动跟踪功能的人工智能教育机器人及其控制方法 |
CN110221626A (zh) * | 2019-06-06 | 2019-09-10 | 睿魔智能科技(深圳)有限公司 | 一种跟拍控制方法、装置、计算机设备及存储介质 |
CN111868551A (zh) * | 2019-01-09 | 2020-10-30 | 深圳市大疆创新科技有限公司 | 测距装置及其扫描机构、控制方法、可移动平台 |
CN112268523A (zh) * | 2020-10-09 | 2021-01-26 | 华中科技大学鄂州工业技术研究院 | 一种激光三维测量装置及测量方法 |
CN113050113A (zh) * | 2021-03-10 | 2021-06-29 | 广州南方卫星导航仪器有限公司 | 一种激光点定位方法和装置 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1996194A (zh) * | 2005-12-31 | 2007-07-11 | 清华大学 | 一种运动物体定位纠偏***及其运动跟踪方法 |
CN102003955A (zh) * | 2010-09-17 | 2011-04-06 | 江门市蒙德电气有限公司 | 基于图像分析的位置检测传感装置及其位置检测方法 |
CN102621998A (zh) * | 2012-04-20 | 2012-08-01 | 深圳市元创兴科技有限公司 | 光电跟踪***及方法 |
CN102870761A (zh) * | 2012-09-13 | 2013-01-16 | 西南科技大学 | 一种自动瞄准的多点激光驱鸟装置及控制方法 |
CN103777204A (zh) * | 2014-01-09 | 2014-05-07 | 中北大学 | 基于光电智能感知平台目标跟踪识别的测距装置及方法 |
US20140132729A1 (en) * | 2012-11-15 | 2014-05-15 | Cybernet Systems Corporation | Method and apparatus for camera-based 3d flaw tracking system |
-
2015
- 2015-04-08 CN CN201510164172.7A patent/CN104793637B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1996194A (zh) * | 2005-12-31 | 2007-07-11 | 清华大学 | 一种运动物体定位纠偏***及其运动跟踪方法 |
CN102003955A (zh) * | 2010-09-17 | 2011-04-06 | 江门市蒙德电气有限公司 | 基于图像分析的位置检测传感装置及其位置检测方法 |
CN102621998A (zh) * | 2012-04-20 | 2012-08-01 | 深圳市元创兴科技有限公司 | 光电跟踪***及方法 |
CN102870761A (zh) * | 2012-09-13 | 2013-01-16 | 西南科技大学 | 一种自动瞄准的多点激光驱鸟装置及控制方法 |
US20140132729A1 (en) * | 2012-11-15 | 2014-05-15 | Cybernet Systems Corporation | Method and apparatus for camera-based 3d flaw tracking system |
CN103777204A (zh) * | 2014-01-09 | 2014-05-07 | 中北大学 | 基于光电智能感知平台目标跟踪识别的测距装置及方法 |
Non-Patent Citations (1)
Title |
---|
段马丽: "广角图像畸变校正算法的研究与实现", 《中国优势硕士学位论文全文数据库》 * |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106325196A (zh) * | 2015-10-23 | 2017-01-11 | 国网上海市电力公司 | 手持终端检测用激光自动瞄准装置 |
CN106842229A (zh) * | 2017-04-07 | 2017-06-13 | 赵�怡 | 一种激光云台智能空间定位***及空间定位方法 |
CN107894832A (zh) * | 2017-10-20 | 2018-04-10 | 深圳市虚拟现实科技有限公司 | 基于光点捕捉的移动端虚拟现实头显校正的方法与装置 |
CN108261761B (zh) * | 2018-01-18 | 2021-01-12 | 北京凌宇智控科技有限公司 | 一种空间定位方法和装置、计算机可读存储介质 |
CN108261761A (zh) * | 2018-01-18 | 2018-07-10 | 北京凌宇智控科技有限公司 | 一种空间定位方法和装置、计算机可读存储介质 |
CN108565000A (zh) * | 2018-04-03 | 2018-09-21 | 夏擎华 | 一种基于伺服电机的运动器材app |
CN111868551A (zh) * | 2019-01-09 | 2020-10-30 | 深圳市大疆创新科技有限公司 | 测距装置及其扫描机构、控制方法、可移动平台 |
CN109605397A (zh) * | 2019-01-11 | 2019-04-12 | 山东元脉电子技术股份有限公司 | 具有自动跟踪功能的人工智能教育机器人及其控制方法 |
CN110221626A (zh) * | 2019-06-06 | 2019-09-10 | 睿魔智能科技(深圳)有限公司 | 一种跟拍控制方法、装置、计算机设备及存储介质 |
CN110221626B (zh) * | 2019-06-06 | 2022-03-25 | 睿魔智能科技(深圳)有限公司 | 一种跟拍控制方法、装置、计算机设备及存储介质 |
CN112268523A (zh) * | 2020-10-09 | 2021-01-26 | 华中科技大学鄂州工业技术研究院 | 一种激光三维测量装置及测量方法 |
CN113050113A (zh) * | 2021-03-10 | 2021-06-29 | 广州南方卫星导航仪器有限公司 | 一种激光点定位方法和装置 |
CN113050113B (zh) * | 2021-03-10 | 2023-08-01 | 广州南方卫星导航仪器有限公司 | 一种激光点定位方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
CN104793637B (zh) | 2017-07-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104793637A (zh) | 一种移动设备的实时跟踪***及跟踪方法 | |
CN110174093B (zh) | 定位方法、装置、设备和计算机可读存储介质 | |
CN108345005B (zh) | 巷道掘进机的实时连续自主定位定向***及导航定位方法 | |
CN102866706B (zh) | 一种采用智能手机导航的清扫机器人及其导航清扫方法 | |
EP3627269A1 (en) | Target tracking method and apparatus, mobile device and storage medium | |
CN109737981B (zh) | 基于多传感器的无人车目标搜索装置及方法 | |
CN106291535A (zh) | 一种障碍物检测装置、机器人及避障*** | |
CN106607907A (zh) | 一种移动视觉机器人及其测控方法 | |
CN105611277B (zh) | 一种基于无障碍导航飞艇的视频地图绘制*** | |
EP3913328B1 (en) | Vehicle positioning system and method, and vehicle | |
CN106054878A (zh) | 基于二维码定位的惯性引导车的导航方法及惯性引导车 | |
CN102997910A (zh) | 一种基于地面路标的定位导引***及方法 | |
CN104729538B (zh) | 基于激光扫描的采煤机定位定姿***的校准方法及装置 | |
US20200357141A1 (en) | Systems and methods for calibrating an optical system of a movable object | |
CN103065323A (zh) | 一种基于单应性变换矩阵的分段空间对准方法 | |
CN108776491A (zh) | 基于动态图像识别的无人机多目标监测***及监测方法 | |
KR101853127B1 (ko) | 구동형 마킹 시스템, 구동형 마킹 장치의 제어방법 및 컴퓨터 판독 가능한 기록매체 | |
WO2019019819A1 (zh) | 一种用于处理任务区域的任务的移动电子设备以及方法 | |
CN110058591A (zh) | 一种基于激光雷达与深度摄像机混合导航的agv*** | |
JP7038743B2 (ja) | 測位方法、装置およびシステム、測位システムのレイアウト方法、および記憶媒体 | |
CN104777452B (zh) | 一种移动设备的定位***及定位方法 | |
CN111319502A (zh) | 基于双目视觉定位的无人机激光充电方法 | |
CN106225779A (zh) | 基于三激光标记点图像的掘进机定位***及定位方法 | |
WO2020230410A1 (ja) | 移動体 | |
CN204479086U (zh) | 基于激光扫描的采煤机定位定姿***的校准装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |