位姿跟踪方法及装置与流程

本公开涉及计算机视觉技术领域。更具体地，本公开涉及一种位姿跟踪方法及装置。

背景技术：

近几年，多种6自由度位姿估计的方法被提出并且广泛应用于机器人抓取、虚拟现实/增强现实和人机交互等领域。虚拟现实和增强现实对系统延迟有很高的要求。如果系统对于头部运动反应较迟钝，那么就会导致用户眩晕、恶心。维尔福(valve)的系统的延迟在7-15毫秒。目前商用的虚拟现实(vr)追踪产品最低的延迟是15毫秒，还不能让用户拥有完美的沉浸式体验。

当前很多光学跟踪系统都是基于互补金属氧化物半导体(cmos)相机的。但是这种消费机的cmos相机延迟一般都大于16.7毫秒(60fps)。硬件的限制导致这些方法不能够及时的将用户的动作输入显示在屏幕上，不能满足vr的低延迟要求。

在一些方案中也使用主动式发光二极管(led)标记来恢复物体的6自由度姿态。但是这些方法都有一些限制，要么led灯的数目必须是四个且是共面的，要么计算量比超过预设偏差阈值不能应用于实时的系统。仅仅有4个led灯会影响位姿跟踪的精度和系统的健壮性，这是因为如果其中有一个灯没有被检测到，那么位姿解算就会失败。另外，暴力求解2d/3d点集的对应关系非常耗时，不能够应用于led灯较多的情况下和实时系统中。

技术实现要素：

本公开的示例性实施例在于提供一种位姿跟踪方法及装置，以降低位姿跟踪对led标记特定布局的依赖性，同时降低位姿跟踪的延迟，并且提高位姿跟踪的精度和效率。

根据本公开的示例性实施例，提供一种位姿跟踪方法，包括：获取跟踪对象的图像，其中，所述跟踪对象上设置有以特定频率闪烁的标记；从获取的图像中获取亮度变化的像素；基于获取的像素计算所述跟踪对象的6自由度姿态，从而降低了位姿跟踪对led标记特定布局的依赖性，同时降低了位姿跟踪的延迟，并且提高了位姿跟踪的精度和效率。

可选地，基于获取的像素计算所述跟踪对象的6自由度姿态的步骤可包括：获取所述跟踪对象的惯性测量单元数据，基于获取的惯性测量单元数据估计所述跟踪对象的3自由度姿态，其中，所述3自由度姿态是在所述跟踪对象的本体坐标系下绕x、y、z三个坐标轴旋转的姿态；基于所述3自由度姿态和获取的像素计算所述跟踪对象的6自由度姿态，其中，所述6自由度姿态是在所述跟踪对象的本体坐标系下沿x、y、z三个坐标轴方向的姿态和绕x、y、z三个直角坐标轴旋转的姿态，从而提高了位姿跟踪的精度和效率。

可选地，基于所述3自由度姿态和获取的像素计算所述跟踪对象的6自由度姿态的步骤可包括：基于所述3自由度姿态和获取的像素，求解所述标记的2d点集与3d点集的对应关系，得到所述标记的关于2d点集与3d点集的匹配对，其中，所述2d点集中包括所述标记的像素坐标，所述3d点集中包括所述标记在所述跟踪对象的本体坐标系下的坐标；基于所述匹配对，计算所述跟踪对象的6自由度姿态，从而提高了位姿跟踪的精度和效率。

可选地，计算所述跟踪对象的6自由度姿态的步骤可包括：从所述匹配对中去除重投影偏差超过预设偏差阈值的像素，并根据去除后剩余的像素计算6自由度位姿；对计算得到的6自由度位姿进行最小化重投影误差操作，得到所述跟踪对象的6自由度姿态，从而提高了位姿跟踪的精度和效率。

可选地，计算所述跟踪对象的6自由度姿态的步骤可包括：从所述匹配对中去除重投影偏差超过预设偏差阈值的像素，并根据去除后剩余的像素计算6自由度位姿；对计算得到的6自由度位姿进行最小化重投影误差操作；根据所述3自由度姿态对最小化重投影误差操作后的6自由度位姿进行优化，得到所述跟踪对象的6自由度姿态，从而提高了位姿跟踪的精度和效率。

可选地，得到所述跟踪对象的6自由度姿态之后，所述位姿跟踪方法还可包括：根据所述跟踪对象的6自由度姿态对所述匹配对中的重投影误差超过预设偏差阈值的像素进行重新匹配，以用于后续的位姿跟踪。

根据本公开的示例性实施例，提供一种位姿跟踪装置，包括：图像获取单元，被配置为获取跟踪对象的图像，其中，所述跟踪对象上设置有以特定频率闪烁的标记；像素获取单元，被配置为从获取的图像中获取亮度变化的像素；和姿态计算单元，被配置为基于获取的像素计算所述跟踪对象的6自由度姿态，从而降低了位姿跟踪对led标记特定布局的依赖性，同时降低了位姿跟踪的延迟，并且提高了位姿跟踪的精度和效率。

可选地，姿态计算单元可被配置为：获取所述跟踪对象的惯性测量单元数据，基于获取的惯性测量单元数据估计所述跟踪对象的3自由度姿态，其中，所述3自由度姿态是在所述跟踪对象的本体坐标系下绕x、y、z三个坐标轴旋转的姿态；基于所述3自由度姿态和获取的像素计算所述跟踪对象的6自由度姿态，其中，所述6自由度姿态是在所述跟踪对象的本体坐标系下沿x、y、z三个坐标轴方向的姿态和绕x、y、z三个直角坐标轴旋转的姿态，从而提高了位姿跟踪的精度和效率。

可选地，姿态计算单元还可被配置为：基于所述3自由度姿态和获取的像素，求解所述标记的2d点集与3d点集的对应关系，得到所述标记的关于2d点集与3d点集的匹配对，其中，所述2d点集中包括所述标记的像素坐标，所述3d点集中包括所述标记在所述跟踪对象的本体坐标系下的坐标；基于所述匹配对，计算所述跟踪对象的6自由度姿态，从而提高了位姿跟踪的精度和效率。

可选地，姿态计算单元还可被配置为：从所述匹配对中去除重投影偏差超过预设偏差阈值的像素，并根据去除后剩余的像素计算6自由度位姿；对计算得到的6自由度位姿进行最小化重投影误差操作，得到所述跟踪对象的6自由度姿态，从而提高了位姿跟踪的精度和效率。

可选地，姿态计算单元还可被配置为：从所述匹配对中去除重投影偏差超过预设偏差阈值的像素，并根据去除后剩余的像素计算6自由度位姿；对计算得到的6自由度位姿进行最小化重投影误差操作；将所述3自由度姿态与最小化重投影误差操作后的6自由度位姿进行融合，得到所述跟踪对象的6自由度姿态，从而提高了位姿跟踪的精度和效率。

可选地，所述位姿跟踪装置还可包括：重新匹配单元，被配置为在得到所述跟踪对象的6自由度姿态之后，根据所述跟踪对象的6自由度姿态对重投影误差超过预设偏差阈值的像素进行重新匹配，以用于后续的位姿跟踪。

根据本公开的示例性实施例，提供一种电子装置，包括：相机，用于获取跟踪对象的图像，并且从获取的图像中获取亮度变化的像素，其中，所述跟踪对象上设置有以特定频率闪烁的标记；处理器，用于基于所述相机获取的像素计算所述跟踪对象的6自由度姿态，从而降低了位姿跟踪对led标记特定布局的依赖性，同时降低了位姿跟踪的延迟，并且提高了位姿跟踪的精度和效率。

根据本公开的示例性实施例，提供一种计算机可读存储介质，其上存储有计算机程序，当所述计算机程序被处理器执行时，实现根据本公开的示例性实施例的位姿跟踪方法。

根据本公开的示例性实施例，提供一种计算装置，包括：处理器；存储器，存储有计算机程序，当所述计算机程序被处理器执行时，实现根据本公开的示例性实施例的位姿跟踪方法。

根据本公开的示例性实施例的位姿跟踪方法及装置，通过获取跟踪对象的图像，从获取的图像中获取亮度变化的像素，基于获取的像素计算跟踪对象的6自由度姿态，从而降低了位姿跟踪对led标记特定布局的依赖性，同时降低了位姿跟踪的延迟，并且提高了位姿跟踪的精度和效率。

将在接下来的描述中部分阐述本公开总体构思另外的方面和/或优点，还有一部分通过描述将是清楚的，或者可以经过本公开总体构思的实施而得知。

附图说明

通过下面结合示例性地示出实施例的附图进行的描述，本公开示例性实施例的上述和其他目的和特点将会变得更加清楚，其中：

图1示出根据本公开示例性实施例的位姿跟踪方法的流程图；

图2示出跟踪对象的2d主动式led标记跟踪结果；

图3示出根据本公开示例性实施例的位姿跟踪装置的框图；

图4示出根据本公开示例性实施例的电子装置的示意图；和

图5示出根据本公开示例性实施例的计算装置的示意图。

具体实施方式

现将详细参照本公开的示例性实施例，所述实施例的示例在附图中示出，其中，相同的标号始终指的是相同的部件。以下将通过参照附图来说明所述实施例，以便解释本公开。

图1示出根据本公开示例性实施例的位姿跟踪方法的流程图。图1中示出的位姿跟踪方法适用于设置有多个以特定频率闪烁的标记的跟踪对象，其中，以特定频率闪烁的标记可以是例如主动式led。在以下说明中，以led灯作为标记的示例进行说明，但是应理解本发明不限于此。本领域的技术人员可根据实施例的需要采用其他形式的标记。

参照图1，在步骤s101，获取跟踪对象的图像。

在本公开的示例性实施例中，可以通过dvs相机来获取跟踪对象的图像。图1中示出的位姿跟踪方法可适用于具有能够获取亮度变化的像素的相机和能够进行计算的主机的电子装置，或者可适用于由能够获取亮度变化的像素的相机和能够进行计算的主机组成的系统。

在步骤s102，从获取的图像中获取亮度变化的像素。

在本公开的示例性实施例中，dvs相机在步骤s101获得图像后不是直接将图像传输到主机，而是在步骤s102从获取的图像中获取亮度变化的像素，之后，将获取的像素传输到主机以用于位姿跟踪，从而减少了传输的数据量和用于计算的数据量，降低了位姿跟踪的延迟。

具体来说，当标记(例如，主动式led灯)闪烁的时候，dvs能够产生对应的on和off事件。这些事件通过led闪烁的频率可以很容易与其它事件区分开。这些筛选出来的事件可以分成不同的簇，每一簇代表一个led灯。然后可使用一个基于区域生长的聚类算法和轻量级的投票算法来处理这些筛选出来的事件，将簇中密度最高的点识别为标记的中心。另外，可以使用全局最近邻跟踪方法和基于匀速模型的卡尔曼滤波来跟踪多个标记，从而降低了标记的漏检和错检的概率。

在步骤s103，基于获取的像素计算跟踪对象的6自由度姿态。这里，6自由度姿态表示的是在跟踪对象的本体坐标系下沿x、y、z三个坐标轴方向的姿态和绕x、y、z三个直角坐标轴旋转的姿态。

在本公开的示例性实施例中，仅仅使用由于运动引起的亮度变化的那些像素来计算跟踪对象的6自由度姿态，从而降低了位姿跟踪的延迟。

在本公开的示例性实施例中，在基于获取的像素计算跟踪对象的6自由度姿态时，可首先获取跟踪对象的惯性测量单元(imu)数据，基于获取的惯性测量单元(imu)数据估计跟踪对象的3自由度姿态(即，在跟踪对象的本体坐标系下绕x、y、z三个坐标轴旋转的姿态)，然后基于3自由度姿态和获取的像素计算跟踪对象的6自由度姿态，从而提高了位姿跟踪的精度和效率。

在本公开的示例性实施例中，在基于3自由度姿态和获取的像素计算跟踪对象的6自由度姿态时，可首先基于3自由度姿态和获取的像素，求解标记的2d点集与3d点集的对应关系，得到标记的关于2d点集与3d点集的匹配对，然后基于匹配对，计算跟踪对象的6自由度姿态。这里，2d点集中包括各个标记的像素坐标，3d点集中包括各个标记在跟踪对象的本体坐标系下的坐标。

具体来说，在基于3自由度姿态和获取的像素计算跟踪对象的6自由度姿态时，可定义pia、pib分别是图像上已经去畸变的两个led灯(led灯a和led灯b)的像素坐标，pa、pb分别是led灯a、led灯b在物体本体坐标系下的坐标。跟踪对象的3自由度姿态矩阵r＝[r1,r2,r3]^t可以由航姿参考系统通过imu数据估计出来，r1、r2和r3分别表示r的第一行、第二行和第三行的行向量。t＝[tx,ty,tz]^t是未知的平移向量，其中，tx,ty,tz分别表示沿x、y、z三个坐标轴方向的位移。通过小孔成像原理，可以得到以下方程：

其中，xa、ya分别表示led灯a在图像上的x坐标和y坐标。xb、yb分别表示led灯b在图像上的x坐标和y坐标。上述方程只有t是未知的，4个方程，3个未知量，解方程可得：

t＝azpia-rpa(3)

其中，

可通过dvs相机检测和聚类算法，得到led灯在图像的像素坐标点集o和已知的led灯在物体本体坐标系下的坐标点集l。从点集o、l中任意选择两个点(o,l)进行配对，那么可以通过(3)式计算得到平移t。通过上述操作，可以得到可能的平移向量列表t。其中有些无效的平移向量(向量各个元素太大或者tz是负的)可以删除，一些近似相等的平移向量可以合并。对于t中任意一个有效的平移向量tvalid，可以通过moller-trumbore射线相交算法确定可见其对应的可见led灯的点集lv：如果某个led灯与相机的确定的射线与物体相交的第一个点是此led灯，那么这个led灯就是可见的，否则这个led灯在此位姿下是不可见的。确定可见的led灯点集对于多个led灯的情况可以减少计算量和误匹配的情况。然后将可见点集lv用对应的6自由度位姿和相机内参投影到像平面p上。这样就可以使用kuhn-munkres算法来求解可见点集lv和观测点集o的最佳匹配和匹配误差。遍历可能的平移向量列表t，匹配误差最小的那组匹配就是正确的关于2d点集与3d点集的匹配对。

在本公开的示例性实施例中，在计算跟踪对象的6自由度姿态时，可首先从匹配对中去除重投影偏差超过预设偏差阈值的像素，并根据去除后剩余的像素计算6自由度位姿，然后对计算得到的6自由度位姿进行最小化重投影误差操作，得到跟踪对象的6自由度姿态，从而进一步提高了位姿跟踪的精度和效率。

在本公开的示例性实施例中，在计算跟踪对象的6自由度姿态时，可首先从匹配对中去除重投影偏差超过预设偏差阈值的像素，并根据去除后剩余的像素计算6自由度位姿，然后对计算得到的6自由度位姿进行最小化重投影误差操作，之后根据3自由度姿态对最小化重投影误差操作后的6自由度位姿进行优化，得到跟踪对象的6自由度姿态，从而进一步提高了位姿跟踪的精度和效率。

在本公开的示例性实施例中，在得到跟踪对象的6自由度姿态之后，还可根据跟踪对象的6自由度姿态对匹配对中的重投影误差超过预设偏差阈值的像素进行重新匹配。此外，还可以更新新观测到的标记(例如，主动式led灯)的2d点集与3d点集的对应关系或者2d点集与3d点集的匹配对，从而进一步提高了位姿跟踪的精度和效率。

具体来说，在得到2d点集与3d点集的对应关系之后，可首先利用随机抽样一致(randomsampleconsensus，简称ransac)算法去除匹配对中的重投影偏差超过预设偏差阈值的点，然后用有效透视n点定位(efficientperefficientperspective-n-pointspective-n-point，简称epnp)算法求解6自由度位姿。接着用光束法平差(bundleadjustment，简称ba)算法对epnp算法求解得到的粗糙的位姿进一步优化，这样就能得到更为精确的位姿。可利用这个精确的位姿对匹配对中的重投影误差超过预设偏差阈值的点进行重新匹配并更新新观测到的led的匹配关系。最后可基于扩展卡尔曼滤波器的传感器融合算法对上述得到的6自由度位姿与imu中的3自由度姿态进行融合，得到更为光滑和一致的6自由度位姿(即，融合后的6自由度位姿)。此外，还可利用融合后的6自由度位姿对重投影误差超过预设偏差阈值的点进行重新匹配并更新新观测到的led匹配关系。

根据本公开的示例性实施例的位姿跟踪方法，降低了位姿跟踪对led标记特定布局的依赖性，同时降低了位姿跟踪的延迟，并且提高了位姿跟踪的精度和效率。

用于获得跟踪对象的运动而引起亮度变化的像素的dvs相机可以是例如三星的三代vga设备，其分辨率为640*480，并且可通过usb3.0与主机进行连接。dvs相机能够对相对光照强度变化的像素点产生事件。每个事件用元组<t,x,y,p>来表示，其中t是事件发生的时间戳(微秒级的解析度)，x,y是事件对应的像素坐标，p∈{0,1}是事件的极性，其中，当led灯亮的时候，会产生<t,x,y,1>的事件，当led灯灭的时候，会产生<t,x,y,0>的事件。

位姿跟踪方法中需要应用到一些固定的参数(相机内参)和转移矩阵(imu到手柄本体，dvs相机到头盔等)。本公开的示例性实施例中使用optitrack光学运动跟踪系统来校准这些固定的参数和转移矩阵，同时optitrack光学运动跟踪系统也用来提供手柄位姿真值对位姿跟踪的精度进行评价。当校准完成后，用户的实际使用过程中，optitrack光学运动跟踪系统是不需要的。

在optitrack光学运动跟踪系统中存在多个坐标系，例如相机(c)坐标系、头盔(h)坐标系、世界(w)坐标系、imu(i)坐标系、手柄本体(b)坐标系、手柄模型(m)坐标系和optitrack(o)坐标系。为了简化optitrack光学运动跟踪系统，可将手柄本体坐标系和手柄模型坐标系对齐，将世界坐标系和optitrtack坐标系进行对齐。所以要求解的运动手柄的6自由度位姿可以表示为是手柄模型坐标系到相机坐标系的旋转矩阵，^cpm是模型坐标系原点在相机坐标系下的表示。需要提前标定dvs相机的内参和一些固定的转移矩阵

由于dvs的光学特性与普通cmos相机是相同的，因此可以用标准的小孔成像模型来确定相机内参(例如，焦距、投影中心和畸变参数)。dvs相机与普通相机的区别是dvs相机不能看到没有光照变化的东西，所以可以用一个闪烁的棋盘格来校准dvs。

可以用optitrack小球来校准一些固定的转移矩阵。在3d模型中，手柄模型的原点是手柄顶端大圆的圆心。可以将optitrack小球固定在大圆的圆周，并对应标记模型中x、y、z轴的方向，这样就可以在optitrack光学运动跟踪系统中确定运动手柄的模型坐标系。将optitrack小球固定在imu芯片处，并利用imu的读数确定x、y、z轴的方向，这样就在optitrack光学运动跟踪系统中确定了imu坐标系。optitrack光学运动跟踪系统能够实时记录imu坐标系和模型坐标系的位姿，那么可以计算运动手柄的模型坐标系与imu坐标系之间的转换关系。而且头盔到相机的转换矩阵也可以通过那些特定模式的闪烁led来确定：其中，和都由optitrack光学运动跟踪系统来提供，可以通过用epnp算法计算得到(特定模式的点集匹配关系是固定的)。计算得到的两个矩阵例如可如下所示：

主动式led标记闪烁间隔可以通过on-off-on、off-on-off的事件确定。如果一个像素的闪烁间隔处于[800μs,1200μs]区间，那么就可以断定这个事件是由led闪烁引起的。然后使用区域生长算法和投票方法来确定led的中心位置。可以使用全局最近邻和卡尔曼滤波对多个led灯进行跟踪。图2示出跟踪对象的2d主动式led标记跟踪结果。在图2中，每一条连续的线条表示一个标记(例如，led)的运动轨迹，小空心圈表示运动轨迹的起始点，内有实心圆的大圈表示运动轨迹的终点。

此外，为了提高ba算法的性能，可将ba算法的优化窗口设定为10，而且每4帧才执行一次优化。不用每次都更新匹配关系，仅有当已匹配的led灯的数目与所有观测到的led灯的数目的比值小于预设值例如0.6的时候才对匹配关系进行更新，从而提高了ba算法的效率。启动阶段初始化后，整个处理流程仅需要花费1.23毫秒。因此加上led灯闪烁事件的筛选时间(1毫秒)，那么整个延迟是2.23毫秒。

以上已经结合图1至图2对根据本公开示例性实施例的位姿跟踪方法进行了描述。在下文中，将参照图3对根据本公开示例性实施例的位姿跟踪装置及其单元进行描述。

图3示出根据本公开示例性实施例的位姿跟踪装置的框图。

参照图3，位姿跟踪装置包括图像获取单元31、像素获取单元32和姿态计算单元33。

图像获取单元31被配置为获取跟踪对象的图像，其中，跟踪对象上设置有以特定频率闪烁的标记。

像素获取单元32被配置为从获取的图像中获取亮度变化的像素。

姿态计算单元33被配置为基于获取的像素计算跟踪对象的6自由度姿态。

在本公开的示例性实施例中，姿态计算单元33可被配置为：获取跟踪对象的惯性测量单元数据，基于获取的惯性测量单元数据估计跟踪对象的3自由度姿态，这里，3自由度姿态是在跟踪对象的本体坐标系下绕x、y、z三个坐标轴旋转的姿态；基于3自由度姿态和获取的像素计算跟踪对象的6自由度姿态，这里，6自由度姿态是在跟踪对象的本体坐标系下沿x、y、z三个坐标轴方向的姿态和绕x、y、z三个直角坐标轴旋转的姿态。

在本公开的示例性实施例中，姿态计算单元33还可被配置为：基于3自由度姿态和获取的像素，求解标记的2d点集与3d点集的对应关系，得到标记的关于2d点集与3d点集的匹配对，这里，2d点集中包括各个标记的像素坐标，3d点集中包括各个标记在跟踪对象的本体坐标系下的坐标；基于匹配对，计算跟踪对象的6自由度姿态。

在本公开的示例性实施例中，姿态计算单元33还可被配置为：从匹配对中去除重投影偏差超过预设偏差阈值的像素，并根据去除后剩余的像素计算6自由度位姿；对计算得到的6自由度位姿进行最小化重投影误差操作，得到跟踪对象的6自由度姿态。

在本公开的示例性实施例中，姿态计算单元33还可被配置为：从匹配对中去除重投影偏差超过预设偏差阈值的像素，并根据去除后剩余的像素计算6自由度位姿；对计算得到的6自由度位姿进行最小化重投影误差操作；根据3自由度姿态对最小化重投影误差操作后的6自由度位姿进行优化，得到跟踪对象的6自由度姿态。

在本公开的示例性实施例中，位姿跟踪装置还可包括：重新匹配单元，被配置为在得到所述跟踪对象的6自由度姿态之后，根据跟踪对象的6自由度姿态对重投影误差超过预设偏差阈值的像素进行重新匹配。

图4示出根据本公开示例性实施例的电子装置的示意图。

参照图4，电子装置4包括：相机41和处理器42。

其中，相机41用于获取跟踪对象的图像，并且从获取的图像中获取亮度变化的像素，其中，跟踪对象上设置有以特定频率闪烁的标记。处理器42用于基于相机获取的像素计算跟踪对象的6自由度姿态。

在本公开的示例性实施例中，处理器42可用于获取跟踪对象的惯性测量单元数据，基于获取的惯性测量单元数据估计跟踪对象的3自由度姿态，这里，3自由度姿态是在跟踪对象的本体坐标系下绕x、y、z三个坐标轴旋转的姿态；基于3自由度姿态和获取的像素计算跟踪对象的6自由度姿态，这里，6自由度姿态是在跟踪对象的本体坐标系下沿x、y、z三个坐标轴方向的姿态和绕x、y、z三个直角坐标轴旋转的姿态。

在本公开的示例性实施例中，处理器42可用于基于3自由度姿态和获取的像素，求解标记的2d点集与3d点集的对应关系，得到标记的关于2d点集与3d点集的匹配对，这里，2d点集中包括各个标记的像素坐标，3d点集中包括各个标记在跟踪对象的本体坐标系下的坐标；基于匹配对，计算跟踪对象的6自由度姿态。

在本公开的示例性实施例中，处理器42可用于从匹配对中去除重投影偏差超过预设偏差阈值的像素，并根据去除后剩余的像素计算6自由度位姿；对计算得到的6自由度位姿进行最小化重投影误差操作，得到跟踪对象的6自由度姿态。

在本公开的示例性实施例中，处理器42可用于从匹配对中去除重投影偏差超过预设偏差阈值的像素，并根据去除后剩余的像素计算6自由度位姿；对计算得到的6自由度位姿进行最小化重投影误差操作；根据3自由度姿态对最小化重投影误差操作后的6自由度位姿进行优化，得到跟踪对象的6自由度姿态。

在本公开的示例性实施例中，处理器42可用于在得到所述跟踪对象的6自由度姿态之后，根据跟踪对象的6自由度姿态对重投影误差超过预设偏差阈值的像素进行重新匹配。

此外，根据本公开的示例性实施例，还提供一种计算机可读存储介质，其上存储有计算机程序，当所述计算机程序被执行时，实现根据本公开的示例性实施例的位姿跟踪方法。

作为示例，所述计算机可读存储介质可承载有一个或者多个程序，当所述计算机程序被执行时可实现以下步骤：获取跟踪对象的图像，其中，跟踪对象上设置有以特定频率闪烁的标记；从获取的图像中获取亮度变化的像素；基于获取的像素计算跟踪对象的6自由度姿态。

计算机可读存储介质例如可以是，但不限于，电、磁、光、电磁、红外线、或半导体的系统、装置或器件，或者任意以上的组合。计算机可读存储介质的更具体的例子可以包括但不限于：具有一个或多个导线的电连接、便携式计算机磁盘、硬盘、随机访问存储器(ram)、只读存储器(rom)、可擦式可编程只读存储器(eprom或闪存)、光纤、便携式紧凑磁盘只读存储器(cd-rom)、光存储器件、磁存储器件、或者上述的任意合适的组合。在本公开的实施例中，计算机可读存储介质可以是任何包含或存储计算机程序的有形介质，该计算机程序可以被指令执行系统、装置或者器件使用或者与其结合使用。计算机可读存储介质上包含的计算机程序可以用任何适当的介质传输，包括但不限于：电线、光缆、rf(射频)等等，或者上述的任意合适的组合。计算机可读存储介质可以包含在任意装置中；也可以单独存在，而未装配入该装置中。

以上已经结合图3和图4对根据本公开示例性实施例的位姿跟踪装置和电子装置进行了描述。接下来，结合图5对根据本公开的示例性实施例的计算装置进行描述。

图5示出根据本公开示例性实施例的计算装置的示意图。

参照图5，根据本公开示例性实施例的计算装置5，包括存储器51和处理器52，所述存储器51上存储有计算机程序，当所述计算机程序被处理器52执行时，实现根据本公开的示例性实施例的位姿跟踪方法。

作为示例，当所述计算机程序被处理器52执行时，可实现以下步骤：获取跟踪对象的图像，其中，跟踪对象上设置有以特定频率闪烁的标记；从获取的图像中获取亮度变化的像素；基于获取的像素计算跟踪对象的6自由度姿态。

图5示出的计算装置仅仅是一个示例，不应对本公开实施例的功能和使用范围带来任何限制。

以上已参照图1至图5描述了根据本公开示例性实施例的位姿跟踪方法及装置。然而，应该理解的是：图3中所示的位姿跟踪装置及其单元可分别被配置为执行特定功能的软件、硬件、固件或上述项的任意组合，图5中所示的计算装置并不限于包括以上示出的组件，而是可根据需要增加或删除一些组件，并且以上组件也可被组合。

根据本公开的示例性实施例的位姿跟踪方法及装置，通过获取跟踪对象的图像，从获取的图像中获取亮度变化的像素，基于获取的像素计算跟踪对象的6自由度姿态，从而降低了位姿跟踪对led标记特定布局的依赖性，同时降低了位姿跟踪的延迟，并且提高了位姿跟踪的精度和效率。

尽管已经参照其示例性实施例具体显示和描述了本公开，但是本领域的技术人员应该理解，在不脱离权利要求所限定的本公开的精神和范围的情况下，可以对其进行形式和细节上的各种改变。