一种远距二维码及其物体空间位姿获取方法及系统与流程

1.本发明涉及室内空间定位技术，尤其涉及一种远距二维码及其物体空间位姿获取方法及系统。


背景技术：

2.随着工业机器人应用场景的增多，不同场景部署的导航方式也不同。常见传统的定位形式有激光建图定位、磁条及射频定位、反光柱定位等。但是由于工业环境场景变化大，定位精度高等要求，传统定位方式存在很大的局限性。
3.近年来随着二维码的普及，工业领域也有先行者在尝试基于二维码对物体空间位姿进行检测估算，如现有技术曾提出了“一种基于二维码的物体空间位姿获取方法”（中国专利申请公布号：cn 112766008 a）其通过单目摄像头获取目标的实时图像，输入至处理器，然后对实时图像进行二值化处理，并找出图像中所有的二维码，获取实时图像的二维码位置坐标信息；对所述二维码位置坐标进行单应变换，获得二维码的单应变换矩阵，基于所述单应变换矩阵获取二维码的欧拉角和空间位置；最后记录各二维码的相对位置关系，将各二维码的欧拉角转换成轴角，融合各个二维码坐标系，并将融合后的坐标系对应到空间坐标系上；基于已识别的二维码当前位姿，获取融合后坐标系上的位姿，得到物体在空间坐标系下的位姿。
4.然而诸如此类的二维码空间位姿估算方案，在实际应用中都并不理想。因为发明人发现，若将二维码设置在室内顶部这种高度较高的场景中，由于受到检测距离较远，检测视角位置变换等因素影响，使得传统二维码的识别和检测会变得非常困难。
5.究其原因，发明人认为，由于此类方案大多采用类似像素方块的传统二维码来作为信息载体，因此忽视了这种二维码设计之初只考虑过近距离的检测效果，而并不适用于远距离多角度的检测，一旦二维码与检测相机距离较远、角度变换，则此类二维码在相机拍摄的检测图像中容易呈模糊在一起的块团状，从而无法进行准确的识别。


技术实现要素：

6.为此，本发明的主要目的在于提供一种远距二维码及其物体空间位姿获取方法及系统，以确保二维码在远距及多角度检测条件下的识别准确率，以及基于该远距二维码，能够精确的解得相机相对于远距二维码的空间位姿关系。
7.为了实现上述目的，根据本发明的一个方面，提供了一种远距二维码，其包括：定位码，信息码，其中定位码由数个方向点围绕中心点在数个非交叉方向布设而成，并在各个相邻方向点的夹角处划分出数个象限区域，所述信息码根据预设码表布设在对应象限区域中，以与定位码组成二维点阵。
8.在可能的优选实施方式中，所述数个方向点中至少存在一个主方向点与中心点的设置距离与其他副方向点相异，各副方向点与中心点的设置距离相等。
9.在可能的优选实施方式中，所述方向点、中心点、信息点呈圆形、椭圆形、圆环形、
椭圆环形中的任一一种，且皆在表面设有反光层。
10.在可能的优选实施方式中，其中定位码由数个方向点根据东南西北四个方向围绕中心点布设而成，以在各个相邻方向点的夹角处划分出四个象限区域，所述信息码根据预设码表在对应的象限区域中布设，以与定位码组成二维点阵，其中所述方向点中存在至少一个主方向点与中心点的设置距离是其他副方向点的半数，而各副方向点与中心点的设置距离相等。
11.为了实现上述目的，对应上述远距二维码，根据本发明的第二个方面，还提供了一种基于远距二维码的物体空间位姿获取方法，步骤包括：
12.步骤s100获取包含远距二维码信息的图像做二值化处理后，进行边缘提取；
13.步骤s200根据提取的边缘信息进行椭圆拟合检测，获取原始码及其圆心坐标；
14.步骤s300根据定位码的几何关系，定位出原始码中对应各远距二维码的定位码分布位置；
15.步骤s400根据定位码在图像中的圆心坐标，计算对应远距二维码在相机坐标系下的空间位姿。
16.在可能的优选实施方式中，其中步骤s400中计算远距二维码在相机坐标系下空间位姿的步骤包括：
17.步骤s410设定位码的圆心坐标为，建立齐次矩阵
[0018][0019]
基于svd法求解单应性矩阵h，其中u，v表示定位码圆心的像素坐标、表示远距二维码坐标系下点的坐标，s为等效距离比例因子；
[0020]
步骤s420 根据单应性矩阵与远距二维码在相机坐标系下转换矩阵的关系
[0021][0022]
求得旋转和平移矩阵，其中p为相机投影矩阵、e为截断外参矩阵，, 分别为相机方向和方向的焦距，，为相机中心点坐标，为旋转矩阵中的前两列，, , 分别表示在相机坐标系下远距二维码中心的位置，为3
×
3的单应投影矩阵。
[0023]
在可能的优选实施方式中，其中还包括：
[0024]
步骤430 通过迭代优化方法求解最小化误差函数
[0025][0026]
以优化旋转和平移矩阵，其中r表示旋转，t表示平移
[0027][0028]
[0029]
表示平移向量中的第i个元素，表示旋转矩阵中的第i列；其中分别表示图像中第个远距二维码的圆心投影到相机归一化坐标系中的坐标；表示所有定位码的的圆心坐标；分别表示由远距二维码中第个定位码的圆心空间坐标，按照旋转平移矩阵转换到相机归一化平面中的点的坐标；表示在远距二维码坐标系中每一个定位码的圆心空间坐标；
[0030]
其中在求解过程中以
[0031][0032]
作为约束条件。
[0033]
在可能的优选实施方式中，所述基于远距二维码的物体空间位姿获取方法，其中步骤还包括：
[0034]
步骤s500 按照时间过滤和先验位姿约束，对经步骤s400获得的空间位姿进行约束，其中时间过滤步骤包括：当判断空间位姿结果存在突变时，滤除；先验位姿约束步骤包括：当判断空间位姿结果中远距二维码坐标系和相机坐标系处于非平行时，滤除。
[0035]
在可能的优选实施方式中，其中步骤s200中还包括：
[0036]
根据椭圆方程的长轴、短轴公式，判断各原始码的长轴短轴比例是否符合阈值，当不符时进行滤除的步骤。
[0037]
为了实现上述目的，对应上述方法，根据本发明的第三个方面，还提供了一种基于远距二维码的物体空间位姿获取系统，其包括：
[0038]
存储单元，用于存储包括如上任一所述基于远距二维码的物体空间位姿获取方法步骤的程序，以供控制单元，处理单元适时调取执行；
[0039]
控制单元，用于控制红外相机拍摄包含远距二维码的待处理图像；
[0040]
处理单元，用于将待处理图像做二值化处理后，进行边缘提取；而后根据提取的边缘信息进行椭圆拟合检测，获取原始码及其圆心坐标；之后根据远距二维码预设的定位码的几何关系，定位出原始码中对应各远距二维码的定位码分布位置，以筛选出原始码中的信息码，并根据通码表来获取远距二维码的id信息；以当判断该id下的远距二维码首次出现时，根据定位码在图像中的圆心坐标，计算远距二维码在相机坐标系下的空间位姿并对应id信息保存在存储单元中。
[0041]
通过本发明提供的该远距二维码及其物体空间位姿获取方法及系统，巧妙的利用了圆形几何形状在空间中即便随相机视角变化，产生仿射变换也只会变成椭圆状，且依然存在圆心的特性，以及圆形即便在远距离检测容易模糊的情况下依然呈圆/椭圆状的鲁棒特性，设计出了适于远距离检测的二维码，同时对应该远距二维码的前述特性，通过椭圆检测，能够十分精确的获得椭圆圆心以建立与相机的位姿变换矩阵，从而解决了传统二维码与检测相机在距离较远、角度变换时，拍摄出的检测图像中的二维码容易呈现模糊的块团状，而造成无法进行准确识别的问题。
附图说明
[0042]
构成本技术的一部分的附图用来提供对本发明的进一步理解，本发明的示意性实施例及其说明用于解释本发明，并不构成对本发明的不当限定。在附图中：
[0043]
图1为本发明的远距二维码在室内环境下粘贴于天花板，用于室内定位场景的示意图；
[0044]
图2为本发明的远距二维码点阵结构示意图，其中圆环部分示意的是信息码的可布设位置；
[0045]
图3为本发明的远距二维码通码表示意图；
[0046]
图4为本发明的远距二维码几何位置关系示意图；
[0047]
图5为红外相机拍摄的本发明的远距二维码的示意图；
[0048]
图6为本发明的基于远距二维码的物体空间位姿获取方法步骤示意图；
[0049]
图7为本发明的基于远距二维码的物体空间位姿获取方法中二值化图像的示意图；
[0050]
图8为位姿奇异现象的示意图；
[0051]
图9为本发明的基于远距二维码的物体空间位姿获取系统结构示意图。
具体实施方式
[0052]
为了使本领域的技术人员能够更好的理解本发明的技术方案，下面将结合实施例来对本发明的具体技术方案进行清楚、完整地描述，以助于本领域的技术人员进一步理解本发明。显然，本案所描述的实施例仅仅是本发明一部分的实施例，而不是全部的实施例。应当指出的是，对本领域的普通技术人员来说，在不脱离本发明构思及相互不冲突的前提下，本技术中的实施例及实施例中的特征可以相互组合。基于本发明中的实施例，在本领域普通技术人员没有做出创造性劳动前提下所获得的所有其他实施例，都应当属于本发明的揭露及保护范围。
[0053]
此外本发明的说明书和权利要求书及附图中的术语“第一”、“第二”、“s100”、“s200”等是用于区别类似的对象，而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换，以便这里描述的本发明的实施例能够以除了在这里描述的那些以外的顺序实施。同时本发明中的术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含。除非另有明确的规定和限定，术语“设置”、“布设”、“安装”、“相连”、“连接”应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接；可以是机械连接，也可以是电连接；可以是直接相连，也可以通过中间媒介间接相连，可以是两个元件内部的连通。对于本领域的普通技术人员而言，可以根据具体情况，结合现有技术来理解上述术语在本案中的具体含义。
[0054]
请参阅图1所示，考虑到建立室内二维码定位方案时，若将二维码贴于室内天花板等离地较远的上部空间，此时行驶中的移动机器人的相机在拍摄二维码时，由于存在距离和角度变换因素，因此会出现二维码无法被精确识别的技术缺陷。
[0055]
为此，请参阅图2至图5所示，为了确保二维码在远距及多角度检测条件下的识别准确率，本发明提供了一种远距二维码，其包括：定位码，信息码，其中定位码由数个方向点围绕中心点在数个非交叉方向布设而成，并在各个相邻方向点的夹角处划分出数个象限区域，所述信息码根据预设码表布设在对应象限区域中，以与定位码组成二维点阵。
[0056]
具体来说，发明人发现由于圆形（包括：椭圆形、椭圆环形、圆环形）在视角变化时会产生仿射变换，在相机平面中是以椭圆的形式展现，因此其应对视角变换的能力相对较
弱。而传统方块像素的二维码，虽然角点在不同视角的情况下的鲁棒性更强，但其弱点是在远距离视角下容易角点发生偏移，基于该发现，发明人设计了一种点阵形态的二维码。
[0057]
如图2至图4所示，在本示例中，该远距二维码中，定位码由数个方向点根据东南西北四个方向围绕中心点布设而成，以在各个相邻方向点的夹角处划分出如图4所示的四个象限区域，而所述信息码则如图2所示，可根据预设码表在对应的象限区域中布设，以与定位码组成如图3所示的二维点阵，且本示例下，该方向点、中心点、信息点优选呈圆形、椭圆形、椭圆环形、圆环形中的任一一种。
[0058]
经此设置，该远距二维码中由于只有一种基础图案（圆点），因此不但降低了加工制作二维码的难度。同时此类点阵的设计中，任意两个二维码的排列方式的差异性很大，从而可降低误检测的几率，以支持不同的高度距离。
[0059]
此外，为了加强定位码的排布特征，如图4所示在本优选示例中，所述数个方向点中至少存在一个主方向点（如图4中的a点）与中心点b的设置距离与其他副方向点相异，如a与b的间隔距离是c、d、f与b间隔距离的一半。而各副方向点则与中心点的设置距离相等。从而将此作为该远距二维码识别时的约束之一，可以进一步提高识别准确率。
[0060]
进一步的，考虑到环境光因素，以及室内天花板的底色，悬吊干扰物等多种综合因素的影响，会对相机拍摄的图像形成干扰，以影响远距二维码的识别率，为此本示例中，优选在远距二维码的定位码和信息码表面设置反光层，如采用亮银反光布，而对应的该相机优选设置为红外相机，以在相机镜头和cmos之间加装了一个红外滤光镜，让一定波段内的红外光通过，吸收或反射可见光和紫外线，并可选择为相机添加红外灯。经此设置后，如图5所示，该红外相机便可轻松捕捉到明显包含远距二维码信息的图像。
[0061]
另一方面，对应上述示例的该远距二维码，如图6所示，本发明还提供了一种基于远距二维码的物体空间位姿获取方法，步骤包括：
[0062]
步骤s100获取包含远距二维码信息的图像做二值化处理后，进行边缘提取。
[0063]
具体的，根据上述远距二维码的示例可知，当红外相机拍摄到含有远距二维码的图像时，获取的图片如图5所示，除定位码和信息码圆点为白色外，其余部分为黑色，此时可将图像的像素值进行取反。并将取反后的图像进行二值化处理，将灰度图像转换成黑白图像，如图7所示。
[0064]
之后，将黑白图像利用canny边缘检测算法，提取边缘。由于前述红外相机的特殊性，此时导致黑白图像中边缘较少，其能大大加快边缘提取的过程。
[0065]
步骤s200根据提取的边缘信息进行椭圆拟合检测，获取原始码及其圆心坐标。
[0066]
具体的，圆是椭圆的一种特殊形状，由于视角的不同，远距二维码中的点在成像平面中一般为近似椭圆。椭圆拟合常用于特征提取，场景建模，摄像机标定等问题中，给定一组来自某个椭圆的图像测量数据所有边缘点的集合，其中包含了所有的祖成椭圆的边缘点。表示每个边缘点，其坐标由像素位置组成，此处n表示组成该边缘的像素点数量。这里使用的是图像点边缘点信息。
[0067][0068]
由于测量数据不可避免的带有误差，问题变为从带有误差的数据中恢复其对应的
椭圆信息。其中椭圆的方程可写为：其中表示椭圆的参数集合。椭圆参数共有6个。
[0069][0070]
因为每个椭圆的边缘点都在椭圆上，因此所有的边缘点都在椭圆上。 椭圆拟合转变为线性最小二乘问题:
[0071][0072]
为保证最小二乘的解一定为椭圆，必须添加约束条件，，，
[0073][0074]
其中：
[0075][0076]
从而构造一个带有约束的非线性优化问题:
[0077][0078]
对于这种非线性优化问题，所以可使用列温伯格-马夸尔特算法求解其对应的椭圆参数信息。
[0079]
基于上述椭圆检测方案，待提取所有的边缘信息后，将每一个边缘信息分别进行基于最小二乘的椭圆拟合。进而得到每一个黑色的椭圆拟合信息，即原始码，其中椭圆的一般方程如下。其中a，b，c，d，e为椭圆方程的参数，在椭圆拟合过程中求解得到的。
[0080]
通过椭圆参数。进而得到椭圆的几何中心的坐标为：
[0081][0082]
其中椭圆的长轴和短轴b的长度分别为：
[0083][0084]
进一步的，由于图像中会存在噪点或者因为其他反光材料造成的影响，需要对每一个椭圆信息进行过滤，找到最圆的椭圆方程。
[0085]
为此其中步骤s200中还包括：根据椭圆方程的长轴、短轴公式，判断各原始码的长轴短轴比例是否符合阈值，当不符时进行滤除的步骤。例如当长轴和短轴之间的比例小于1.3时，认为此椭圆（原始码）不符合圆的形状，进而进行滤除。同时，为排除其他噪点的影响，所有属于同一个远距二维码的圆点的半径，应该在相同的范围内，因此可根据此条件对所有的原始码进行进一步的过滤，以快速滤除不合格的原始码。
[0086]
步骤s300根据定位码的几何关系，定位出原始码中对应各远距二维码的定位码分布位置。
[0087]
具体的，当得到所有可能组成远距二维码的原始码后，由于远距二维码如上述示例所述，是由定位码和信息码组成的。定位码由五个点组成，即是一个固定的模板，如图4所示，因此在中心的一个圆b与与其最近的圆a之间的距离正好是其他三个圆c、d、f分别与圆b之间距离的。基于上述示例几何关系的存在，因此每一个远距二维码在图像中的位置信息，可以被快速的被定位。
[0088]
因此便得到了每一个远距二维码的分组。此种分类方法可大大加快远距二维码在图像中的定位过程，同时由于类似于模板匹配，如果图像中出现多个远距二维码也会被进行区分，而无需额外的聚类过程。
[0089]
此外，当对一张图像中所有的远距二维码进行分组后，便得到每一个远距二维码的定位码在图像中的位置。为进一步验证，对所有定位码的圆度进行检查，确保每一个圆都有相同的长轴和短轴的长度。通过定位码的空间位置，可以快速得到远距二维码中信息码的分布情况。
[0090]
由于信息码搭载了远距二维码的id信息。因此每一个远距二维码都有不同的信息码。当确定定位码位置后，通过计算各象限中像素块的黑白情况，便可得到远距二维码的所有信息码。之前通码表确定了每一个远距二维码圆点的空间位置信息，因此对照该码表便可确定出每一个远距二维码的id信息。
[0091]
以供判断该id下的远距二维码是否首次出现，如果非首次，意味着存在已经计算好的该远距二维码在相机坐标系下的空间位姿矩阵，可直接调用；若为首次，便可执行下一步，计算该远距二维码在相机坐标系下的空间位姿。从而节省算力，同时若该远距二维码在环境中的位置已经被记录，则该id的识别，也可被作为移动机器人在地图中的定位。
[0092]
步骤s400根据定位码在图像中的圆心坐标，计算对应远距二维码在相机坐标系下的空间位姿。
[0093]
具体的来说，第一步，确定输入的标签（远距二维码）坐标系坐标和像素（图像）坐标。
[0094]
如：计算 3
×
3 单应矩阵，将齐次坐标中的 2d圆点从标签坐标系（其中 位于远距二维码的中心，标签在
ꢀꢀ
和 方向上延伸一个单位）投影到 2d 图像坐标系。使用直接线性变换 (dlt) 算法计算单应性。请注意，由于单应性投影点在齐次坐标中，因此仅按尺度定义。
[0095]
第二步，建立单应性矩阵与转换矩阵的关系。
[0096]
计算远距二维码的位置和方向，即外参矩阵，需要额外的信息：相机的焦距和标签的物理尺寸。 其中3
ꢀ×ꢀ
3 单应矩阵（由 dlt 计算）可以写成 3
ꢀ×ꢀ
4 相机投影矩阵 p（假设它是已知的）和 4
×
3 截断外参矩阵 e 的乘积。
[0097]
而外参矩阵通常是 4
ꢀ×ꢀ
4，但标签上的每个位置都在标签坐标系中的 z = 0 处。 因此，可以将每个标签坐标重写为 z 隐式为零的二维齐次点，并删除外参矩阵的第三列，形成截断的外参矩阵。
[0098]
建立后的单应性矩阵与转换矩阵的关系为：
[0099][0100]
其中p为相机投影矩阵，其旋转分量表示为，e为截断外参矩阵，将平移分量表示为 ，s为等效距离比例因子。
[0101]
第三步，求解单应性矩阵。
[0102]
首先平面的单应性被定义为，从一个平面到另一个平面的投影映射，通过数学表达式描述即，一个平面上的点与投影矩阵相乘，结果为另一个平面上对应点，点 的坐标为检测到的椭圆的中心点，其中u，v分别表示椭圆中心的像素坐标。表示标签坐标系下的点坐标。用齐次矩阵表达即为：
[0103][0104]
其中投影矩阵 h为一个3
×
3方阵
[0105][0106]
将式(10)展开
[0107][0108]
其中上式中等式的格式为矩阵 h中各行系数求比，也就说等式右边的分子分母可同时乘以一个缩放因子
[0109][0110]
而不影响结果的正确性，因此投影矩阵不是唯一的，矩阵元素可以等比例放缩，故在求解矩阵 h时，未知数只有8个而不是9个，只要为矩阵中任意一非零元素的赋一确定值，其他元素根据比例也就得到了确定的值。
[0111]
通常情况下，使用的矩阵是将的值置为1而得到的，记为。为了使元素 h3、 h6为 u、v在 x和y都取 0时的值，这在某些应用场合是有特定意义的。从前面的推导可以看出，每提供两个平面上的一对点，即可联立分别基于和坐标的两个方程，而求投影矩阵 h需要8个约束条件，故需提供4对点才能求出h。
[0112]
而本示例中，为保证位姿计算的精度，则额外加入了一个点。 由步骤s200椭圆检测示例可知，每一个远距二维码都可以提供至少五组定位点。五组定位点相对与四对定位点提供了更充分的约束，继而保证了位姿计算的精度。
[0113]
第四步，基于svd求解单应性矩阵。
[0114]
将 (13)式写成如下形式
[0115][0116]
也就是
[0117][0118]
其中
[0119][0120][0121]
当有两个平面上的五对点 时，即可得如下所示的方程组
[0122][0123]
其中
[0124][0125]
为了更直观，将下式展开
[0126][0127]
接下来解这个方程，这个矩阵的解法一般使用奇异值分解。
[0128]
第五步，通过单应性矩阵求解转换矩阵。
[0129][0130]
通过第四步经svd分解得到h矩阵后，由于相机的内参信息可以通过相机标定得到，因此通过得到的单应性矩阵，以及摄像机位置关系即式(21)，可以分别求向量，，。由于旋转矩阵的正交性可得。得到每一个远距二维码相对与相机坐标系的转换矩阵，进而可得到旋转和平移矩阵。
[0131]
此外，由于噪声的影响，该方法计算的旋转和平移矩阵并不是全局最优解，因此需要通过构造非线性优化问题对该结果，进行结果优化。
[0132]
第六步，通过迭代优化方法求解最小化误差函数，以优化旋转和平移矩阵。
[0133]
由于直接法得到的结果受图像噪声影响很大，因此需要根据像素点和空间点的分布情况通过迭代优化方法对结果进行优化，得到更加准确的远距二维码姿态信息。根据空
间点集以及其对应的图像点集，此处表示远距二维码中所有定位码圆心的数量,进而确定相机姿态信息。
[0134]
摄像机相对与二维码坐标系的旋转表示为和平移矩阵
[0135][0136]
在理想情况下无噪声等因素影响下，在摄像机已经标定的情况下，空间点和投射到相机归一化平面坐标系中的点满足如下方程，
[0137][0138]
其中分别表示由远距二维码中第个定位码的圆心坐标，按照旋转平移矩阵转换到相机归一化平面中的点的坐标，表示在远距二维码坐标系中每一个定位码的圆心空间坐标。
[0139]
由于误差的影响，空间点和像素点实际上并不满足上述问题，该问题转变为寻找最优参数最小化误差函数，其中r表示旋转，t表示平移。其中表示平移向量中的第i个元素，表示旋转矩阵中的第i列，其中分别表示图像中第个远距二维码的圆心投影到相机归一化坐标系中的坐标。表示所有定位码的的圆心坐标。则最小化误差函数为：
[0140][0141]
在最小化过程中，为保证r为旋转矩阵，所以其约束条件有：
[0142][0143]
其优化函数变为
[0144][0145]
对于这种非线性优化问题，使用列温伯格-马夸尔特算法，即可求解其对应准确的旋转和平移矩阵。
[0146]
进一步的，如图8所示，由于在实际使用中，如果远距二维码很小或从很远的距离观察，有时会发生位置奇异的情况。位置奇异问题属于问题基本特性。从在几何上解释，这两个位姿大致对应于对象围绕平面的翻转，该平面的法线穿过从相机中心到对象中心的视线。在此类情况下，通常有两种位姿情况可以由上述方案求解得到，这两种解的结果重投影误差类似，因此无法使用重投影误差选择正确的姿势。
[0147]
当前还没有可靠的算法能够解决位姿歧义问题，因为它是平面目标恢复3d位姿问题的一个自然属性。解决此问题需要更多信息来约束二维码的位姿。
[0148]
为此本示例的方法中，骤还包括：步骤s500 按照时间过滤和先验位姿约束，对经
步骤s400获得的空间位姿进行约束，其中时间过滤是当移动机器人获取到远距二维码的位姿信息计算当前移动机器人的位姿时，判断移动机器人的位姿是否发生突变，一旦发生错误定位时，则位姿会存在跳变情况，一旦发现，则可滤除当前远距二维码的位置信息。而先验位姿约束则是考虑到远距二维码粘贴在天花板上，其坐标系和地面也就是车体处于平行的平面中，因此远距二维码一旦发生错误位姿，可以通过该约束进行滤除。
[0149]
另一方面，如图9所示，对应上述方法，本发明还提供了一种基于远距二维码的物体空间位姿获取系统，其包括：
[0150]
存储单元，用于存储包括如上任一所述基于远距二维码的物体空间位姿获取方法步骤的程序，以供控制单元，处理单元适时调取执行；
[0151]
控制单元，用于控制红外相机拍摄包含远距二维码的待处理图像；
[0152]
处理单元，用于将待处理图像做二值化处理后，进行边缘提取；而后根据提取的边缘信息进行椭圆拟合检测，获取原始码及其圆心坐标；之后根据远距二维码预设的定位码的几何关系，定位出原始码中对应各远距二维码的定位码分布位置，以筛选出原始码中的信息码，并根据通码表来获取远距二维码的id信息；以当判断该id下的远距二维码首次出现时，根据定位码在图像中的圆心坐标，计算远距二维码在相机坐标系下的空间位姿并对应id信息保存在存储单元中。
[0153]
综上所述，通过本发明提供的该远距二维码及其物体空间位姿获取方法及系统，巧妙的利用了圆形几何形状在空间中即便随相机视角变化，产生仿射变换也只会变成椭圆状，且依然存在圆心的特性，以及圆形即便在远距离检测容易模糊的情况下依然呈圆/椭圆状的鲁棒特性，设计出了适于远距离检测的二维码，同时对应该远距二维码的前述特性，通过椭圆检测，能够十分精确的获得椭圆圆心以建立与相机的位姿变换矩阵，从而解决了传统二维码与检测相机在距离较远、角度变换时，拍摄出的检测图像中的二维码容易呈现模糊的块团状，而造成无法进行准确识别的问题。
[0154]
以上公开的本发明优选实施例只是用于帮助阐述本发明。优选实施例并没有详尽叙述所有的细节，也不限制该发明仅为所述的具体实施方式。显然，根据本说明书的内容，可作很多的修改和变化。本说明书选取并具体描述这些实施例，是为了更好地解释本发明的原理和实际应用，从而使所属技术领域技术人员能很好地理解和利用本发明。本发明仅受权利要求书及其全部范围和等效物的限制，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。
[0155]
本领域技术人员可以理解，除了以纯计算机可读程序代码方式实现本发明提供的系统、装置、单元及其各个模块以外，完全可以通过将方法步骤进行逻辑编程来使得本发明提供的系统、装置、单元及其各个模块以逻辑门、开关、专用集成电路、可编程逻辑控制器以及嵌入式微控制器等的形式来实现相同程序。所以，本发明提供的系统、装置及其各个模块可以被认为是一种硬件部件，而对其内包括的用于实现各种程序的模块也可以视为硬件部件内的结构；也可以将用于实现各种功能的模块视为既可以是实现方法的软件程序又可以是硬件部件内的结构。
[0156]
此外实现上述实施例方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成，该程序存储在一个存储介质中，包括若干指令用以使得单片机、芯片或处理器（processor）执行本技术各个实施例所述方法的全部或部分步骤。而前述的存储介质包括：
u盘、移动硬盘、只读存储器（rom，read-only memory）、随机存取存储器（ram，random access memory）、磁碟或者光盘等各种可以存储程序代码的介质。
[0157]
此外，本发明实施例的各种不同的实施方式之间也可以进行任意组合，只要其不违背本发明实施例的思想，其同样应当视为本发明实施例所公开的内容。

技术特征：
1.一种基于远距二维码的物体空间位姿获取方法，步骤包括：步骤s100获取包含远距二维码信息的图像做二值化处理后，进行边缘提取；步骤s200根据提取的边缘信息进行椭圆拟合检测，获取原始码及其圆心坐标；步骤s300根据定位码的几何关系，定位出原始码中对应各远距二维码的定位码分布位置；步骤s400根据定位码在图像中的圆心坐标，计算对应远距二维码在相机坐标系下的空间位姿。2.根据权利要求1所述的基于远距二维码的物体空间位姿获取方法，其中步骤s400中计算远距二维码在相机坐标系下空间位姿的步骤包括：步骤s410设定位码的圆心坐标为，建立齐次矩阵；基于svd法求解单应性矩阵h，其中u，v表示定位码圆心的像素坐标、表示远距二维码坐标系下点的坐标，s为等效距离比例因子；步骤s420 根据单应性矩阵与远距二维码在相机坐标系下转换矩阵的关系；求得旋转和平移矩阵，其中p为相机投影矩阵、e为截断外参矩阵，, 分别为相机方向和y方向的焦距，，为相机中心点坐标，为旋转矩阵中的前两列，, , 分别表示在相机坐标系下远距二维码中心的位置，为3
×
3的单应投影矩阵。3.根据权利要求2所述的基于远距二维码的物体空间位姿获取方法，其中还包括：步骤430 通过迭代优化方法求解最小化误差函数:；以优化旋转和平移矩阵，其中r表示旋转，t表示平移，；表示平移向量中的第i个元素，表示旋转矩阵中的第i列；其中分别表示图像中第个远距二维码的圆心投影到相机归一化坐标系中的坐标；表示所有定位码的的圆心坐标；分别表示由远距二维码中第个定位码的圆心空间坐标，按照旋转平移矩阵转换到相机归一化平面中的点的坐标；表示在远距二维码坐标系中每一个定位码的圆心空间坐标；其中在求解过程中以作为约束条件。
4.根据权利要求1所述的基于远距二维码的物体空间位姿获取方法，其中步骤还包括：步骤s500 按照时间过滤和先验位姿约束，对经步骤s400获得的空间位姿进行约束，其中时间过滤步骤包括：当判断空间位姿结果存在突变时，滤除；先验位姿约束步骤包括：当判断空间位姿结果中远距二维码坐标系和相机坐标系处于非平行时，滤除。5.根据权利要求1所述的基于远距二维码的物体空间位姿获取方法，其中步骤s200中还包括：根据椭圆方程的长轴、短轴公式，判断各原始码的长轴短轴比例是否符合阈值，当不符时进行滤除的步骤。6.根据权利要求1所述的基于远距二维码的物体空间位姿获取方法，其中远距二维码包括：定位码，信息码，其中定位码由数个方向点围绕中心点在数个非交叉方向布设而成，并在各个相邻方向点的夹角处划分出数个象限区域，所述信息码根据预设码表布设在对应象限区域中，以与定位码组成二维点阵。7.根据权利要求6所述的基于远距二维码的物体空间位姿获取方法，其中所述数个方向点中至少存在一个主方向点与中心点的设置距离与其他副方向点相异，各副方向点与中心点的设置距离相等。8.根据权利要求6所述的基于远距二维码的物体空间位姿获取方法，其中所述方向点、中心点、信息点呈圆形、椭圆形、圆环形、椭圆环形中的任一一种，且皆在表面设有反光层。9.根据权利要求6所述的基于远距二维码的物体空间位姿获取方法，其中定位码由数个方向点根据东南西北四个方向围绕中心点布设而成，以在各个相邻方向点的夹角处划分出四个象限区域，所述信息码根据预设码表在对应的象限区域中布设，以与定位码组成二维点阵，其中所述方向点中存在至少一个主方向点与中心点的设置距离是其他副方向点的半数，而各副方向点与中心点的设置距离相等。10.一种基于远距二维码的物体空间位姿获取系统，其包括：存储单元，用于存储包括如权利要求1至9中任一所述基于远距二维码的物体空间位姿获取方法步骤的程序，以供控制单元，处理单元适时调取执行；控制单元，用于控制红外相机拍摄包含远距二维码的待处理图像；处理单元，用于将待处理图像做二值化处理后，进行边缘提取；而后根据提取的边缘信息进行椭圆拟合检测，获取原始码及其圆心坐标；之后根据远距二维码预设的定位码的几何关系，定位出原始码中对应各远距二维码的定位码分布位置，以筛选出原始码中的信息码，并根据通码表来获取远距二维码的id信息；以当判断该id下的远距二维码首次出现时，根据定位码在图像中的圆心坐标，计算远距二维码在相机坐标系下的空间位姿并对应id信息保存在存储单元中。

技术总结
本发明提供了一种远距二维码及其物体空间位姿获取方法及系统，其中方法步骤包括：步骤S100获取包含远距二维码信息的图像做二值化处理后，进行边缘提取；步骤S200根据提取的边缘信息进行椭圆拟合检测，获取原始码及其圆心坐标；步骤S300根据定位码的几何关系，定位出原始码中对应各远距二维码的定位码分布位置；步骤S400根据定位码在图像中的圆心坐标，计算对应远距二维码在相机坐标系下的空间位姿。籍此以确保二维码在远距及多角度检测条件下的识别准确率，以及基于该远距二维码，能够精确的解得相机相对于远距二维码的空间位姿关系。关系。关系。


技术研发人员：刘洋洋 赵越
受保护的技术使用者：上海仙工智能科技有限公司
技术研发日：2023.09.01
技术公布日：2023/10/6