一种多目标光学跟踪方法技术

本发明专利技术提供一种高精度、低成本的光学跟踪方法，利用接收器计算接收到扫描信号的时间从而获取接收器在发射器中的图像坐标，并对所有可能的图像坐标对应关系进行检验，从中找出唯一正确的接收器图像坐标与各发射器的对应关系，继而实现了接收器空间坐标的解算；本发明专利技术从技术原理上解决了使用多发射器时的数据刷新率下降问题，可以级联使用任意数量的发射器而不降低跟踪数据刷新率。

A multi-target optical tracking method

The present invention provides an optical high precision and low cost tracking method, calculation of receiving the scanning signal time to obtain image coordinates in the receiver transmitter receiver is used, and to examine all the possible relationship between image coordinates, finds the corresponding relationship between the only correct image coordinates and the receiver from transmitter, and then to realize the space coordinates of the receiver solution; the invention solves the problem of using multiple transmitter refresh rate decreased when the data from the technical principle, can use any number of transmitter cascade without decreasing the tracking data refresh rate.

【技术实现步骤摘要】
一种多目标光学跟踪方法
本专利技术属于跟踪定位领域，尤其涉及一种多目标光学跟踪方法。
技术介绍
在当今的跟踪定位领域中，Vicon和HTCVIVE是较为常用的技术。Vicon使用高帧率、高分辨率的摄像机作为信号捕捉设备，使用红外反光球作为被跟踪标记物，若反光球被多个摄像机拍摄到，即可通过计算机视觉方法计算其空间位置。Vicon系统的跟踪精度和刷新率与使用的跟踪摄像机的性能相关，例如其V16摄像机分辨率达到1600万像素而帧率到达120Hz。由于高性能摄像机的制造难度很大且需要后续数据处理设备，这导致Vicon系统的成本高昂，只能在专业领域使用而不能获得广泛普及。HTCVIVE使用与本专利技术类似的技术原理，其硬件系统同样由发射器和接收器构成。该方案硬件系统较为简单，成本低廉，已经投入市场。如图3所示，HTCVIVE在跟踪时需要发射器先发出一帧同步扫描信号，然后再依次对水平和垂直方向进行扫描。当多个发射器级联使用时，为了避免信号干扰，同一时间段内只能让一个发射器工作，必须由控制器分配工作时间，以保证同一时间段内只有一个发射器对跟踪区域进行扫描。这导致该系统在多发射器级联使用时的刷新率成倍下降。由于跟踪区域越大，需要的发射器越多，因此为了保证足够的跟踪数据刷新率，目前的HTCVIVE系统只使用两个发射器，而其跟踪区域也被限制在5mx5m的空间内。
技术实现思路
为解决上述问题，本专利技术提供一种高精度、低成本的光学跟踪方法，可允许所有发射器同时工作，保证了多发射器级联使用时跟踪数据刷新率不下降，可以通过多发射器级联扩展跟踪区域的大小。一种多目标光学跟踪方法，包括以下步骤：步骤1：接收器分别记录各个发射器在水平X方向上发出的扫描信号与起始信号的时间差，以及各个发射器在垂直Y方向上发出的扫描信号与起始信号的时间差；步骤2：利用步骤1的时间差计算接收器相对于m个发射器的所有图像坐标ui和vi，其中ui为接收器相对于第i个发射器的水平X方向上的图像坐标，vi为接收器相对于第i个发射器的垂直Y方向上的图像坐标，i＝1,2,3,...,m；步骤3：将m个水平X方向上的图像坐标ui构成集合{ui}，m个水平Y方向上的图像坐标vi构成集合{vi}，从集合{ui}和集合{vi}中分别任选一个图像坐标ui和vi进行排列组合，得到接收器在一个周期内相对于m个发射器所有可能的图像坐标的组合总数S；步骤4：从S种组合中任意选一组图像坐标，将该组中接收器对应各个发射器的估计图像坐标记为xj，其中j＝1,2,3,...,S，表示第j种图像坐标组合；步骤5：根据估计图像坐标xj，利用超定线性投影方程计算接收器在第j组图像坐标组合下的理论空间三维坐标Xw：步骤6：将接收器理论空间三维坐标Xw作为已知量代入超定线性投影方程，计算在第j种图像坐标组合情况下，接收器在m个发射器中对应的理论图像坐标xj'；步骤7：对第j种图像坐标组合的估计值xj与理论值xj'进行欧式距离评估，根据评估结果判断当前尝试的第j组图像坐标组合与实际情况是否相符；如果相符，则步骤5中获得的接收器理论空间三维坐标Xw正确，实现对接收器的光学跟踪；如果不相符，则进入步骤8；步骤8：选取新的图像坐标组合，重复步骤4-7进行验证，直至找到正确的接收器三维空间坐标Xw。一种多目标光学跟踪方法，步骤1中所述的接收器分别记录各个发射器在水平X方向上发出的扫描信号与起始信号的时间差，以及各个发射器在垂直Y方向上发出的扫描信号与起始信号的时间差，具体步骤为：步骤11：固定m个发射器，将接收器置于m个发射器的扫描重叠区域内；步骤12：m个发射器同时发射一帧起始信号；步骤13：接收器接收起始信号后，各发射器沿水平X方向对跟踪区域发射扫描信号，接收器记录水平X方向的m个扫描信号与起始信号之间的时间差txi；步骤14：m个发射器再同时发射一帧起始信号；步骤15：接收器接收起始信号后，各发射器沿垂直Y方向对跟踪区域发射扫描信号，接收器记录垂直Y方向的m个扫描信号与起始信号之间的时间差tyi。一种多目标光学跟踪方法，步骤2所述的计算接收器相对于m个发射器的所有图像坐标ui和vi具体方法为：利用公式(1)依次计算接收器对应m个发射器的所有图像坐标ui和vi：其中ω为已知的扫描速度。一种多目标光学跟踪方法，步骤3所述的m个发射器所有可能的图像坐标的组合总数S具体计算方法为：对于m个发射器，每个接收器在水平X方向上对应各发射器的图像坐标集合{ui}共有种排列方式，垂直Y方向上对应各发射器的图像坐标集合{vi}同样也有种排列方式，则一个接收器在一个周期内对应的发射器图像坐标组合总数S为：一种多目标光学跟踪方法，步骤5所述的理论空间三维坐标Xw计算方法为：令Xw＝Xw，Xw为接收器齐次坐标形式的空间三维坐标，其中Xw＝[Xw,1]T，Xw＝[x,y,z]T，Xw为接收器的非齐次形式的空间三维坐标，上标T表示矩阵转置，求解接收器与m个发射器之间的超定线性投影方程(3)，得到接收器在第j组图像坐标组合下的理论空间三维坐标Xw：xj＝PXw(3)其中P为通过初始标定获得的各个发射器对应的投影矩阵，xj为估计图像坐标xj对应的齐次坐标。一种多目标光学跟踪方法，步骤6所述的理论图像坐标xj'计算方法为：将步骤5中获得的接收器理论空间三维坐标Xw再次代入超定线性投影方程(3)中得到方程(4)，计算在第j种图像坐标组合情况下，接收器在m个发射器中对应的理论图像坐标xj'：xj'＝PXw(4)一种多目标光学跟踪方法，步骤7所述的对第j种图像坐标组合的估计值xj与理论值xj'进行欧式距离评估具体为：使用判别函数f(xj)对第j种图像坐标组合的估计值xj与理论值xj'进行评估：其中xj*是xj'的非齐次坐标形式；若判别函数f(xj)的值小于设定阈值thresh，则当前尝试的第j组图像坐标组合与实际情况相符，完成接收器空间三维坐标的计算；若判别函数f(xj)的值大于设定阈值thresh，则当前尝试的第j组图像坐标组合与实际情况不符，并进入步骤8。有益效果：本专利技术采用一种基于光学跟踪系统的多目标光学跟踪方法，其中硬件构成包含发射器、接收器、处理器等；发射器在水平和垂直两个方向对跟踪区域进行扫描，接收器硬件可输出某一时刻其在所有发射器中的图像坐标集合，但此时并不知道坐标与各个发射器的对应关系。因此本专利技术利用接收器计算接收到扫描信号的时间从而获取接收器在发射器中的图像坐标，并对所有可能的图像坐标对应关系进行检验，从中找出唯一正确的接收器图像坐标与各发射器的对应关系，继而实现了接收器空间坐标的解算；本专利技术从技术原理上解决了使用多发射器时的数据刷新率下降问题，可以级联使用任意数量的发射器而不降低跟踪数据刷新率。发射器数量越多，其扫描覆盖范围越大，本专利技术可以支持更多数量的发射器，因此可以将跟踪区域扩展到更大范围；本专利技术所有发射器同时发射同步信号和进行X、Y方向扫描，根据所处位置的不同，一个扫描周期内同一个接收器会先后接收到若干个扫描信号；通过对所有可能的图像坐标对应关系进行检验，对没有正确匹配的发射器图像坐标进行配对，可允许所有发射器同时工作，保证了多发射器级联使用时跟踪数据刷新率不下降。附图说明图1为本专利技术的实现方法流程图；图2为本专利技术的跟踪本文档来自技高网...

【技术保护点】
一种多目标光学跟踪方法，其特征在于，包括以下步骤：步骤1：接收器分别记录各个发射器在水平X方向上发出的扫描信号与起始信号的时间差，以及各个发射器在垂直Y方向上发出的扫描信号与起始信号的时间差；步骤2：利用步骤1的时间差计算接收器相对于m个发射器的所有图像坐标u

【技术特征摘要】
1.一种多目标光学跟踪方法，其特征在于，包括以下步骤：步骤1：接收器分别记录各个发射器在水平X方向上发出的扫描信号与起始信号的时间差，以及各个发射器在垂直Y方向上发出的扫描信号与起始信号的时间差；步骤2：利用步骤1的时间差计算接收器相对于m个发射器的所有图像坐标ui和vi，其中ui为接收器相对于第i个发射器的水平X方向上的图像坐标，vi为接收器相对于第i个发射器的垂直Y方向上的图像坐标，i＝1,2,3,...,m；步骤3：将m个水平X方向上的图像坐标ui构成集合{ui}，m个水平Y方向上的图像坐标vi构成集合{vi}，从集合{ui}和集合{vi}中分别任选一个图像坐标ui和vi进行排列组合，得到接收器在一个周期内相对于m个发射器所有可能的图像坐标的组合总数S；步骤4：从S种组合中任意选一组图像坐标，将该组中接收器对应各个发射器的估计图像坐标记为xj，其中j＝1,2,3,...,S，表示第j种图像坐标组合；步骤5：根据估计图像坐标xj，利用超定线性投影方程计算接收器在第j组图像坐标组合下的理论空间三维坐标Xw：步骤6：将接收器理论空间三维坐标Xw作为已知量代入超定线性投影方程，计算在第j种图像坐标组合情况下，接收器在m个发射器中对应的理论图像坐标xj'；步骤7：对第j种图像坐标组合的估计值xj与理论值xj'进行欧式距离评估，根据评估结果判断当前尝试的第j组图像坐标组合与实际情况是否相符；如果相符，则步骤5中获得的接收器理论空间三维坐标Xw正确，实现对接收器的光学跟踪；如果不相符，则进入步骤8；步骤8：选取新的图像坐标组合，重复步骤4-7进行验证，直至找到正确的接收器三维空间坐标Xw。2.如权利要求1所述的一种多目标光学跟踪方法，其特征在于，步骤1中所述的接收器分别记录各个发射器在水平X方向上发出的扫描信号与起始信号的时间差，以及各个发射器在垂直Y方向上发出的扫描信号与起始信号的时间差，具体步骤为：步骤11：固定m个发射器，将接收器置于m个发射器的扫描重叠区域内；步骤12：m个发射器同时发射一帧起始信号；步骤13：接收器接收起始信号后，各发射器沿水平X方向对跟踪区域发射扫描信号，接收器记录水平X方向的m个扫描信号与起始信号之间的时间差txi；步骤14：m个发射器再同时发射一帧起始信号；步骤15：接收器接收起始信号后，各发射器沿垂直Y方向对跟踪区域发射扫描信号，接收器记录垂直Y方向的m个扫描信号与起始信号之间的时间差tyi。3.如权利要求1所述的一种...

【专利技术属性】
技术研发人员：翁冬冬，李冬，杨奕，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：北京,11