一种AGV视觉定位系统及方法技术方案

本发明专利技术涉及一种AGV视觉定位系统及方法，系统由地面上的编码点和AGV车体上的相机、光源、工控机构成。其中，地面每个编码点不仅能提供唯一的编码识别信息，同时也提供多个特征角点全局坐标信息，该全局坐标通过近景摄影测量技术获得，并用于建立行驶场地电子地图，从而为AGV视觉定位提供依据；通过标定相机坐标系与AGV坐标系之间的位姿关系，即可在行驶过程中，基于视场中编码点的特征信息和单目视觉定位技术实现AGV坐标系在全局坐标系下位姿的精确解算。本发明专利技术提供的AGV视觉定位系统及方法具有灵活性强、精度高、实时性好、鲁棒性强等特点。

【技术实现步骤摘要】
一种AGV视觉定位系统及方法
本专利技术涉及机器人定位领域，特别涉及AGV视觉定位系统及方法。
技术介绍
AGV(AutomatedGuidedVehicle，AGV)作为一种无人操纵的自动化运输设备，它能承载一定的质量沿着规划的路径自主运行，到达指定地点，完成一系列既定任务，其在自动化物流运输系统、柔性生产组织系统中已经得到了广泛应用。目前，国内外AGV产品所采用的导航方法主要有电磁导航、激光导航、惯性导航、视觉导航等。其中，电磁导航方法的应用比例最高，其次为激光导航。基于电磁感应原理的电磁导航方式是最早成功应用于AGV的导航，该方法需要在AGV规划路线下面埋设专门电缆线，由AGV上的传感器依靠电磁感应跟踪该线，实现导航。该方法可靠性高，经济实用，主要缺点在于无法为AGV提供准确的坐标信息，且路径修改困难。基于激光扫描测距与测角原理的激光导航方式是在AGV行驶空间的特定位置处布置一批激光光束反射镜，AGV在行驶过程中，车顶激光扫描仪向360°方向按一定频率发射激光，不断接收到已知位置反射来的激光束，利用得到的数个反射角来计算AGV的绝对位置坐标，实现导航。激光定位的精度较高，但是由于AGV在工作的过程中至少要同时能够接收到3个反射镜的反射光束，因此激光导航方式需要提供足够多反射镜面和宽阔的扫描空间，并局限于室内，但不适用于狭小的空间，且成本较高。视觉传感器获得的信息远远高于其他传感器，因此基于视觉定位的导航方法是上世纪90年代以来智能自主移动机器人导航的一个主要研究方向。目前视觉定位主要分为局部视觉和全局视觉两种方式。全局视觉定位是将相机安装在天花板或者墙上，以整个工作环境为目标，对包括AGV、导航路径、障碍物等进行对象识别，对各个相机获取的图像进行基于特征的图像融合，得到全局地图。在生成的全局地图中，每个AGV单元，导航线路，障碍物的绝对坐标都能够实时获取。全局视觉定位方法需要根据不同的现场环境，按照视野不被遮挡并覆盖整个工作空间的原则，决定相机的数目、安装位姿，因此这种全局视觉方法仅仅适用于室内且空间较大的场合，且定位精度较低。局部视觉定位是将单车看作一个智能体，在车上安装相机和图像处理系统完成自主定位，其主要有基于自然场景和结构化场景两种定位方式。基于自然场景的定位方式通过运行路径周围环境的图像信息与环境图像数据库中的信息进行比较，从而确定当前位置。这种方法不要求设置任何物理路径，在理论上具有最佳的柔性，但三维图像处理的实时性差和环境图像数据库的难以建立，限制了它的实际应用。相对而言，目前国内外AGV视觉定位领域研究较多的是基于结构化场景的定位方式，该方式一般是在地面粘贴或铺设一些特殊形状或颜色的人工标识，由视觉系统识别预定义的人工标识实现定位。如钱晓明等在专利号为201610286380.9的专利技术专利“基于多窗口实时测距的单目视觉AGV的精确定位方法及系统”中提出利用远端窗口、中间窗口和近端窗口中圆形标志点的几何特征实现AGV的精确定位，该方法采用的圆形标志点由于缺少编码信息，因此无法保证AGV在移动过程中获得连续的位姿信息。胡斌等在专利号为201710748607.1的专利技术专利“利用二维码地标定位AGV工作点位置的方法及系统”中提出了利用二维码地标实现AGV的视觉定位，该方法通过提取二维码三个角落上最外围正方形的质心点分析出二维码中心点相对图像中心点的位置，同时计算得到二维码的旋转角度，由于缺少相机坐标系和AGV坐标系的标定，因此只能给出偏航角和AGV与二维码的像素偏差，无法给出AGV全局坐标；刘征在专利号为201210186563.5的专利技术专利“基于二维码的室内移动机器人定位系统和方法”中提出通过标定得到空间点在图像坐标系和小车坐标系的转换关系R，再提取二维码中心点与图像中心点的偏差实现机器人的定位，该方法将相机视为理想中心投影模型，缺少相机光心偏离、镜头畸变等分析，难以实现高精度的机器人定位。综上所述，现阶段AGV视觉定位还未获得广泛应用，其主要难点在于视觉系统的灵活性、实时性、鲁棒性和测量精度等尚不能满足工程实践需要。
技术实现思路
本专利技术技术解决问题：克服现有技术的不足，提供一种AGV视觉定位系统及方法，能够实现大场地AGV连续的视觉定位，且系统具有使用灵活、实时性好、鲁棒性强、测量精度高等特点。为达到上述目的，本专利技术的技术方案是这样实现的：一种AGV视觉定位系统，该系统包括地面上的编码点和AGV车体上的相机、光源和工控机；其中，地面每个编码点提供唯一的编码识别信息，同时也提供多个特征角点全局坐标信息，该全局坐标信息通过近景摄影测量技术获得，并用于建立行驶场地电子地图，从而为AGV视觉定位提供依据；通过标定相机坐标系与AGV坐标系之间的位姿关系，即可在行驶过程中，基于视场中编码点的特征信息和单目视觉定位技术实现AGV坐标系在全局坐标系下位姿的精确解算；光源为图像采集过程补光，可有效缩短相机曝光时间，减小拖影现象；工控机负责完成图像采集控制、编码点信息提取和位姿解算等任务。AGV视觉定位方法具体包括以下步骤：a、采用不干胶贴纸打印、粘贴编码点，或瓷砖丝网印刷编码点方式在行驶场地地面上布置编码点，并基于近景摄影测量技术实现所有特征角点全局坐标的测量，建立行驶场地电子地图；b、安装相机，并借助外部测量设备(如激光跟踪仪、经纬仪等)确定AGV坐标系，然后在相机视场内摆放3D立体靶标，实现相机内参和外参的标定，其中相机的外参为AGV坐标系到相机坐标系的旋转矩阵RA-C和平移矢量TA-C；c、AGV行驶过程中，控制相机连续采集图像，并提取图像中编码点的编码信息和特征角点的图像坐标信息；d、基于步骤c得到的编码点编码信息，在步骤a建立的行驶场地电子地图中查找对应特征角点的全局坐标信息，同时结合特征角点图像坐标信息，即可基于单目视觉定位技术实现相机坐标系到全局坐标系旋转矩阵RC-G和平移矢量TC-G的求解；e、结合步骤b标定得到的(RA-C,TA-C)和步骤d得到的(RC-G,TC-G)，最终求解得到AGV坐标系到全局坐标系的旋转矩阵RA-G和平移矢量TA-G，即实现AGV的视觉定位，其中：(RA-G,TA-G)＝(RC-GRA-C,RC-GTA-C+TC-G)。所述步骤a编码点特征角点全局坐标的测量采用近景摄影测量技术，即采用高清单反相机对地面所有编码点顺序拍照，且相邻测站的视场有数个公共编码点，然后基于光束法平差(BundleAdjustment，BA)优化算法实现所有特征角点坐标的全局优化，对m个测站，N个特征角点的BA目标函数如下：其中：表示第i个测站图像中提取的第j个特征角点图像二维坐标；Ri,Ti表示第i个测站与第1个测站相机坐标系之间的旋转矩阵和平移向量；Xj表示第j个特征角点的三维坐标；π表示相机内参决定的中心投影函数；另外，θij的取值如下：所述步骤c行驶过程中，需采用光源为编码点图像采集过程补光，同时尽量缩短相机的曝光时间，从而减小拖影现象对编码点信息提取的影响。所述步骤d采用的单目视觉定位技术为透视n点定位算法，即输入图像中编码点特征角点的图像坐标值和对应全局坐标值，即可求解相机坐标系与全局坐标系的转换关系(RC-G,TC-G)。所采用的编码点为具有7×7位编码信息的A本文档来自技高网...

【技术保护点】
1.一种AGV视觉定位系统，其特征在于：包括地面上的编码点和AGV车体上的相机、光源和工控机；其中，地面每个编码点提供唯一的编码识别信息，同时也提供多个特征角点全局坐标信息，该全局坐标信息通过近景摄影测量技术获得，并用于建立行驶场地电子地图，从而为AGV视觉定位提供依据；通过标定相机坐标系与AGV坐标系之间的位姿关系，即可在行驶过程中，基于视场中编码点的特征信息和单目视觉定位技术实现AGV坐标系在全局坐标系下位姿的精确解算；光源为图像采集过程补光，可有效缩短相机曝光时间，减小拖影现象；工控机负责完成图像采集控制、编码点信息提取和位姿解算任务。

【技术特征摘要】
1.一种AGV视觉定位系统，其特征在于：包括地面上的编码点和AGV车体上的相机、光源和工控机；其中，地面每个编码点提供唯一的编码识别信息，同时也提供多个特征角点全局坐标信息，该全局坐标信息通过近景摄影测量技术获得，并用于建立行驶场地电子地图，从而为AGV视觉定位提供依据；通过标定相机坐标系与AGV坐标系之间的位姿关系，即可在行驶过程中，基于视场中编码点的特征信息和单目视觉定位技术实现AGV坐标系在全局坐标系下位姿的精确解算；光源为图像采集过程补光，可有效缩短相机曝光时间，减小拖影现象；工控机负责完成图像采集控制、编码点信息提取和位姿解算任务。2.一种AGV视觉定位方法，其特征在于：包括以下步骤：a、采用不干胶贴纸打印、粘贴编码点，或瓷砖丝网印刷编码点方式在行驶场地地面上布置编码点，并基于近景摄影测量技术实现所有特征角点全局坐标的测量，建立行驶场地电子地图；b、安装相机，并借助外部测量设备(如激光跟踪仪、经纬仪等)确定AGV坐标系，然后在相机视场内摆放3D立体靶标，实现相机内参和外参的标定，其中相机的外参为AGV坐标系到相机坐标系的旋转矩阵RA-C和平移矢量TA-C；c、AGV行驶过程中，控制相机连续采集图像，并提取图像中编码点的编码信息和特征角点的图像坐标信息；d、基于步骤c得到的编码点编码信息，在步骤a建立的行驶场地电子地图中查找对应特征角点的全局坐标信息，同时结合特征角点图像坐标信息，即可基于单目视觉定位技术实现相机坐标系到全局坐标系旋转矩阵RC-G和平移矢量TC-G的求解；e、结合步骤b标定得到的(RA-C,TA-C)和步骤d得到的(RC-G,TC-G)，最终求解得到AGV坐标系到全局坐标系的旋转矩阵RA-G和平移矢量TA-G，即实现AGV的视觉定位，其中：(RA-G,TA-G)＝(RC-GRA-C,RC-GTA-C+TC-G)。3.根据权利要求2所述的方法，其特征在于：所述步骤a编码点特征角点全局坐标的测量采用近景摄影测量技术，即采用高清单反相机对地面所有编码点顺序拍照，且相邻测站的视场有数个公共编码点，然后基于光束法平差(BundleAdjustment，BA)优化...

【专利技术属性】
技术研发人员：孙军华，程晓琦，张志龙，卢扬扬，蔡虎，张皓悦，刘畅，
申请(专利权)人：北京航空航天大学，北京星航机电装备有限公司，
类型：发明
国别省市：北京,11