[发明专利]一种自定义二维码定位和定向系统及实现方法

说明书

技术领域

本发明涉及二维码定位和定向技术领域，具体涉及一种自定义二维码定位和定向系统及实现方法，主要应用于自动导航车系统，也可应用到其它类似需要快速精确定位的工业场景。

背景技术

在工业自动化尤其是自动导航车领域，如何实现精确定位和定向，是技术研究的重点也是难点所在。目前市场中主流的自动导航车定位方法有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，如果找到该边界信息，进行下一步操作；