一种自定义二维码定位和定向系统及实现方法技术方案

本发明专利技术涉及一种自定义二维码定位和定向系统及实现方法。通过摄像头单元采集图像数据得到二值化图像；在得到的二值化图像中查找符合自定义的二维码标签外围边框规则的正方形边界信息；在得到的边界信息中，查找二维码的四个辅助定位色块；计算图像中每个像素的实际尺寸p，对得到的边界区域内的二维码图像进行拉伸和旋转操作，得到便于识别的二维码图像；对得到的二维码图像进行数据解码，得到二维码的有效编码和CRC校验值，并对数据进行CRC校验；读取相应二维码标签所在的实际坐标和方向角度值；通过二维坐标转换，计算得到摄像头单元的实际坐标，最终得到摄像头单元的实际坐标以及实际方向角。定位速度快、精度高、准确率高、结构简单。

A custom two-dimensional code positioning and orientation system and its implementation method

The invention relates to a custom two-dimensional code positioning and orientation system and a realization method. Through the camera image data acquisition unit binarization image is obtained; in two value image in search of square boundary information in accordance with the rules of the two-dimensional code custom label peripheral frame; in the boundary information and four auxiliary positioning components finding two-dimensional code; calculating the actual size of each pixel in the image of P, the the boundary regions derived from the two-dimensional code image stretching and rotation operations, we have obtained the recognition of two-dimensional code image; data decoding of the two-dimensional code image, effectively encoding and CRC checksum value of two-dimensional code, and CRC check on the data; the actual coordinates and direction angle to read the corresponding two-dimensional code label's value; through two-dimensional coordinate conversion, coordinate calculation of actual camera unit, finally get the actual coordinates of the camera unit and the actual direction angle. The positioning speed is fast, the precision is high, the accuracy is high, and the structure is simple.

【技术实现步骤摘要】
一种自定义二维码定位和定向系统及实现方法
本专利技术涉及二维码定位和定向
，具体涉及一种自定义二维码定位和定向系统及实现方法，主要应用于自动导航车系统，也可应用到其它类似需要快速精确定位的工业场景。
技术介绍
在工业自动化尤其是自动导航车领域，如何实现精确定位和定向，是技术研究的重点也是难点所在。目前市场中主流的自动导航车定位方法有RFID定位、超声波定位、激光雷达定位以及越来越受到人们关注的普通二维码定位技术等。这些定位方法在一定程度上满足了自动导航车的定位功能需要，但它们的缺点也十分明显。RFID定位方法因为其结构特性，定位精度有限，很难实现毫米级别的定位，且无法实现定向功能；超声波定位的速度慢，抗干扰能力差，精度也很难达到厘米或者更高的水平；激光雷达定位的精度高，速度快，但激光设备的构造复杂，成本较高，对运行环境要求苛刻；采用普通二维码定位方法可以实现高精度的定位和定向，但这种方法一般采用工业相机以及工控机组合的系统架构，成本较高，体积也较大。
技术实现思路
本专利技术针对现有自动导航车一般定位方法的速度慢、精度低以及成本高的问题，提供了一种自定义二维码定位和定向系统及实现方法，其定位速度快、精度高、准确率高、结构简单，且能够有效的降低制造成本。本专利技术为实现上述目的，所采用的技术方案是：一种基于自定义二维码的定位和定向系统，其特征在于：由主控制单元、摄像头单元以及自定义二维码标签组成；主控制单元采用STM32F767芯片，摄像头单元采用MT9V034图像传感器，其中主控制单元通过DCMI接口的D0～D7引脚对应于摄像头单元的DOUT0～7引脚分别相连，进行并行数据传输；主控制单元DCMI接口的VSYNC引脚与摄像头单元的VSYNC引脚相连，进行场同步；主控制单元DCMI接口的HSYNC引脚与摄像头单元的HSYNC引脚相连，进行行同步；主控制单元DCMI接口的PCLK引脚与摄像头单元的PIXCLK引脚相连，同步像素时钟；主控制单元的PB4和PB3引脚分别对应于摄像头单元的SDK和SDA两个引脚相连，负责控制命令数据传输；主控制单元的PC13引脚与摄像头单元的PWDN引脚相连，负责摄像头单元的电源控制；所述自定义二维码标签具有一个用于快速识别的黑色正方形边框，边框的实际尺寸为L_0，实际应用中，L_0根据需要可自由选择，保证所有二维码标签边框大小相同即可，该边框不仅用来快速识别二维码，还用来计算拍摄二维码所得到图像中每个像素点的尺寸；边框内部为等距排列且相同大小的黑色和白色正方形编码色块，编码色块的行数和列数要求相同，且每行、每列不少于6个编码色块，不多于10个编码色块；边框和编码色块之间以及各编码色块之间使用相同宽度的白色分割线相互隔离；编码色块中位于顶点的四个色块为辅助定位色块，辅助定位色块由三个黑色辅助定位色块及一个白色辅助定位色块组成，或由一个黑色辅助定位色块和三个白色辅助定位色块组成，选择数量为一个的辅助定位色块分布在二维码标签的右下角，但并不局限于此，可以根据实际需要自由选择，保证各二维码标签规则统一即可，所述各二维码标签规则是指，所有二维码标签的黑色辅助定位色块及白色辅助定位色块的排列顺序以及数量相同，并选择两种色块中数量为一个的辅助定位色块设置在所在区域为二维码的右下角；编码色块中除辅助定位色块外，其余为有效数据色块组和数据校验色块组，有效数据色块组和数据校验色块组中最后8个色块为数据校验色块组，其余为有效数据色块组；有效数据色块组和数据校验色块组中黑色色块表示1，白色色块表示0，这些色块按照从左到右，从上到下的顺序进行二进制编码，黑色色块与白色色块的数量和排列顺序由二维码所表达的二进制数值所决定。一种基于自定义二维码的定位和定向系统的实现方法，其特征在于：首先测量二维码标签中心点的实际坐标(X_0，Y_0)以及二维码标签的方向角度值(A_0)，并存储到主控制单元中，主控制单元中控制程序的主要流程包括：步骤a-1，通过摄像头单元采集图像数据；步骤a-2，对步骤a-1得到的图像数据进行二值化处理，得到二值化图像；步骤a-3，在步骤a-2得到的二值化图像中查找符合自定义的二维码标签外围边框规则的正方形边界信息，如果未查找到该边界信息，则判定未找到二维码，返回步骤a-1，如果找到该边界信息，进行下一步操作；步骤a-4，在步骤a-3中得到的边界信息中，查找二维码的四个辅助定位色块，如果未找到四个辅助定位色块，则判定未找到二维码，返回步骤a-1，否则得到图像中二维码边界上四个顶点A、B、C、D的像素坐标A(x_a，y_a)、B(x_b，y_b)、C(x_c，y_c)、D(x_d，y_d)，并进行下一步操作；步骤a-5，计算图像中每个像素的实际尺寸p，计算方法为计算二维码相对于摄像头的位置偏移量(X_1,Y_1)，计算方法为计算二维码图像相对于整个图像的偏转角A_1，计算方法为步骤a-6，对步骤a-3得到的边界区域内的二维码图像进行拉伸和旋转操作，得到便于识别的二维码图像；步骤a-7，对步骤a-6中得到的二维码图像进行数据解码，得到二维码的有效编码和CRC校验值，并对数据进行CRC校验，如果未通过CRC校验，放弃此二维码，返回步骤a-1，否则进行下一步操作；步骤a-8，读取相应二维码标签所在的实际坐标(X_0，Y_0)和方向角度值(A_0)；步骤a-9，通过二维坐标转换，计算得到摄像头单元的实际坐标(X_2，Y_2)，计算方法为计算得到摄像头单元的实际角度值A_2，计算方法为A2＝A0-A1通过以上步骤，最终得到摄像头单元的实际坐标(X_2，Y_2)以及实际方向角A_2。本专利技术的有益效果是：本专利技术提供了一种基于自定义二维码的定位和定向系统，该定位和定向系统采用一种自定义二维码图形、高速图像传感器以及STM32F767作为主控制器。相比于RFID及超声波等一般定位方法其定位和定向速度快、精度高，相比于激光雷达定位技术，其结构简单，成本低，与一般的QR二维码定位方案对比，其定位速度快，识别率高，结构简单，成本较低。经实际测算，系统每秒钟最高可拍摄60张图像并进行处理，其定位精度可达到0.5mm以上，定向精度可达到0.5度以上。附图说明图1是本专利技术主控制单元与摄像头单元连接的示意图；图2是本专利技术自定义二维码标签的示意图；图3是本专利技术摄像头单元拍摄到二维码图像的示意图；图4是本专利技术实现定位和定向方法流程图。图5是本专利技术在自动导航车运行环境中布置方法示意图。具体实施方式为了更清楚的对本专利技术进行解释并展现其优点，这里参照附图对本专利技术在自动导航车中应用的具体实施方法做进一步详细阐述。如图1所示，一种基于自定义二维码的定位和定向系统，由主控制单元、摄像头单元以及二维码标签2组成。其中主控制单元通过DCMI接口的D0～D7引脚与摄像头单元DOUT0～DOUT7分别相连，进行并行数据传输；主控制单元DCMI接口的VSYNC引脚与摄像头单元的VSYNC引脚相连，进行场同步；主控制单元DCMI接口的HSYNC引脚与摄像头单元的HSYNC引脚相连，进行行同步；主控制单元DCMI接口的PCLK引脚与摄像头单元的PIXCLK引脚相连，同步像素时钟；主控制单元的PB4和PB3引脚分别对应于摄像头单元的SDK和SDA两个本文档来自技高网...

【技术保护点】
一种基于自定义二维码的定位和定向系统，其特征在于：由主控制单元、摄像头单元以及自定义二维码标签(2)组成；主控制单元采用STM32F767芯片，摄像头单元采用MT9V034图像传感器，其中主控制单元通过DCMI接口的D0～D7引脚对应于摄像头单元的DOUT0～7引脚分别相连，进行并行数据传输；主控制单元DCMI接口的VSYNC引脚与摄像头单元的VSYNC引脚相连，进行场同步；主控制单元DCMI接口的HSYNC引脚与摄像头单元的HSYNC引脚相连，进行行同步；主控制单元DCMI接口的PCLK引脚与摄像头单元的PIXCLK引脚相连，同步像素时钟；主控制单元的PB4和PB3引脚分别对应于摄像头单元的SDK和SDA两个引脚相连，负责控制命令数据传输；主控制单元的PC13引脚与摄像头单元的PWDN引脚相连，负责摄像头单元的电源控制；所述自定义二维码标签(2)具有一个用于快速识别的黑色正方形边框(2‑1)，边框(2‑1)的实际尺寸为L_0，实际应用中，L_0根据需要可自由选择，保证所有二维码标签边框(2‑1)大小相同即可，该边框(2‑1)不仅用来快速识别二维码，还用来计算拍摄二维码所得到图像中每个像素点的尺寸；边框(2‑1)内部为等距排列且相同大小的黑色和白色正方形编码色块，编码色块的行数和列数要求相同，且每行、每列不少于6个编码色块，不多于10个编码色块；边框(2‑1)和编码色块之间以及各编码色块之间使用相同宽度的白色分割线(2‑3)相互隔离；编码色块中位于顶点的四个色块为辅助定位色块，辅助定位色块由三个黑色辅助定位色块(2‑4)及一个白色辅助定位色块(2‑5)组成，或由一个黑色辅助定位色块(2‑4)和三个白色辅助定位色块(2‑5)组成，选择数量为一个的辅助定位色块分布在二维码标签的右下角，但并不局限于此，可以根据实际需要自由选择，保证各二维码标签规则统一即可，所述各二维码标签规则是指，所有二维码标签的黑色辅助定位色块(2‑4)及白色辅助定位色块(2‑5)的排列顺序以及数量相同，并选择两种色块中数量为一个的辅助定位色块设置在所在区域为二维码的右下角；编码色块中除辅助定位色块外，其余为有效数据色块组(2‑2)和数据校验色块组(2‑6)，有效数据色块组(2‑2)和数据校验色块组(2‑6)中最后8个色块为数据校验色块组(2‑6)，其余为有效数据色块组(2‑2)；有效数据色块组(2‑2)和数据校验色块组(2‑6)中黑色色块(2‑2‑1)表示1，白色色块(2‑2‑2)表示0，这些色块按照从左到右，从上到下的顺序进行二进制编码，黑色色块(2‑2‑1)与白色色块(2‑2‑2)的数量和排列顺序由二维码所表达的二进制数值所决定。...

【技术特征摘要】
1.一种基于自定义二维码的定位和定向系统，其特征在于：由主控制单元、摄像头单元以及自定义二维码标签(2)组成；主控制单元采用STM32F767芯片，摄像头单元采用MT9V034图像传感器，其中主控制单元通过DCMI接口的D0～D7引脚对应于摄像头单元的DOUT0～7引脚分别相连，进行并行数据传输；主控制单元DCMI接口的VSYNC引脚与摄像头单元的VSYNC引脚相连，进行场同步；主控制单元DCMI接口的HSYNC引脚与摄像头单元的HSYNC引脚相连，进行行同步；主控制单元DCMI接口的PCLK引脚与摄像头单元的PIXCLK引脚相连，同步像素时钟；主控制单元的PB4和PB3引脚分别对应于摄像头单元的SDK和SDA两个引脚相连，负责控制命令数据传输；主控制单元的PC13引脚与摄像头单元的PWDN引脚相连，负责摄像头单元的电源控制；所述自定义二维码标签(2)具有一个用于快速识别的黑色正方形边框(2-1)，边框(2-1)的实际尺寸为L_0，实际应用中，L_0根据需要可自由选择，保证所有二维码标签边框(2-1)大小相同即可，该边框(2-1)不仅用来快速识别二维码，还用来计算拍摄二维码所得到图像中每个像素点的尺寸；边框(2-1)内部为等距排列且相同大小的黑色和白色正方形编码色块，编码色块的行数和列数要求相同，且每行、每列不少于6个编码色块，不多于10个编码色块；边框(2-1)和编码色块之间以及各编码色块之间使用相同宽度的白色分割线(2-3)相互隔离；编码色块中位于顶点的四个色块为辅助定位色块，辅助定位色块由三个黑色辅助定位色块(2-4)及一个白色辅助定位色块(2-5)组成，或由一个黑色辅助定位色块(2-4)和三个白色辅助定位色块(2-5)组成，选择数量为一个的辅助定位色块分布在二维码标签的右下角，但并不局限于此，可以根据实际需要自由选择，保证各二维码标签规则统一即可，所述各二维码标签规则是指，所有二维码标签的黑色辅助定位色块(2-4)及白色辅助定位色块(2-5)的排列顺序以及数量相同，并选择两种色块中数量为一个的辅助定位色块设置在所在区域为二维码的右下角；编码色块中除辅助定位色块外，其余为有效数据色块组(2-2)和数据校验色块组(2-6)，有效数据色块组(2-2)和数据校验色块组(2-6)中最后8个色块为数据校验色块组(2-6)，其余为有效数据色块组(2-2)；有效数据色块组(2-2)和数据校验色块组(2-6)中黑色色块(2-2-1)表示1，白色色块(2-2-2)表示0，这些色块按照从左到右，从上到下的顺序进行二进制...

【专利技术属性】
技术研发人员：范自来，赵玉雷，李川，
申请(专利权)人：天津通信广播集团有限公司，
类型：发明
国别省市：天津,12