一种agv机器人路径导航系统的制作方法
【专利摘要】一种AGV机器人路径导航系统，属于机器人【技术领域】。本发明AGV机器人路径导航系统包括二维码标签、RFID标签、二维码图像采集系统、RFID阅读系统、伺服电机系统、通讯系统和嵌入式工控板；所述二维码图像采集系统和RFID阅读系统分别读取二维码标签和RFID标签信息经所述通讯系统上传至所述嵌入式工控板，所述嵌入式工控板经判断处理后输出前进或差速调整或停车调整指令至所述伺服电机系统，使得机器人确认自身在行走环境中的位姿并校正行走方向。本发明系统简单、容易实施，其采用二维码叠加RFID标签双重系统，使机器人丢失位姿概率大大降低，该系统还能自动确认机器人行进中的位置并能自动校正机器人行进方向，提高自动化运输高效性。
【专利说明】-种AGV机器人路径导航系统
【技术领域】
[0001] 本发明涉及机器人【技术领域】，特别涉及一种AGV机器人路径导航系统。
【背景技术】
[0002] 无人搬运车(简称AGV机器人)，是指具备电磁或光学等自动导引装置，能够沿规定 路径行驶，具有安全保护以及各种移载功能的运输车。对于拥有自主路径规划功能的AGV 机器人来说，确认自己在地图中的位置非常重要，并且实时校正机器人行进方向，有利于提 高运输行业的高效性。一般，AGV机器人仅用RFID标签实现路径导航，如实用新型专利CN 203405960 U，则RFID标签的无方向性使得路径导航系统无法获得机器人偏移角度和机器 人偏移RFID中心点距离；而AGV机器人仅用二维码标签实现路径导航，如发明专利申请CN 103268119 A，则二维码标签在AGV高速运行时得到错误的机器人位置信息。
【发明内容】
[0003] 本发明针对现有技术存在的不足，提供一种同时具有RFID标签和二维码标签作 用的AGV机器人路径导航系统，系统简单，运行高效且可自动校正机器人行走方向。
[0004] 本发明的技术方案是提供一种AGV机器人路径导航系统，其特征在于，包括二维 码标签、RFID标签、二维码图像采集系统、RFID阅读系统、伺服电机系统、通讯系统和嵌入 式工控板；所述二维码图像采集系统和RFID阅读系统分别读取二维码标签和RFID标签信 息经所述通讯系统上传至所述嵌入式工控板，所述嵌入式工控板经判断处理后输出前进或 差速调整或停车调整指令至所述伺服电机系统，使得机器人确认自身在行走环境中的位姿 并校正行走方向。
[0005] 该系统采用二维码叠加 RFID标签双重系统，使机器人丢失位姿的概率大大降低， 利用RFID的高速性和无方向性弥补二维码的不足，得到机器人的位置信息，提高系统的稳 定性；同时利用二维码的方向性弥补RFID的不足，简单快速得到AGV机器人偏移角度以及 偏移中心点距离。该系统利用双重系统，确认机器人自身在行走环境中的具体位姿(位置和 角度)，根据测得的角度和偏移距离，自动校正机器人行走方向，以确保机器人行进顺利。
[0006] 作为本发明的优选，所述二维码标签信息为包括机器人二维码位置和机器人二维 码状态图像的位姿信息；所述RFID标签信息为机器人RFID位置信息。
[0007] 作作为本发明的优选，所述嵌入式工控板包括图片信息识别单元、图片信息处理 单元、地理位置确认单元、偏差控制单元；所述二维码标签信息经所述通讯系统上传至所述 图片信息识别单元，所述图片信息识别单元输出解析后的机器人二维码位置信息至所述地 理位置确认单元，所述RFID标签信息经所述通讯系统将解析后的机器人RFID位置信息上 传至所述地理位置确认单元，所述地理位置确认单元连接所述偏差控制单元；所述二维码 标签信息还经所述通讯系统上传至所述图片信息处理单元，所述图片信息处理单元输出解 析后的机器人二维码状态图像信息至所述偏差控制单元；所述偏差控制单元经所述通讯系 统输出控制指令至所述伺服电机系统。
[0008] 作为本发明的优选，所述地理位置确认单元通过比对解析后的机器人二维码位置 信息和解析后的机器人RFID位置信息，以确认机器人地理位置；当解析后的机器人二维码 位置信息与解析后的机器人RFID位置信息相等，则确认机器人地理位置为解析后的机器 人二维码位置信息或解析后的机器人RFID位置信息；反之，则确认机器人地理位置为解析 后的机器人RFID位置信息。
[0009] 作为本发明的优选，所述偏差控制单元包括偏差判断单元、差速调整单元和停车 调整单元。
[0010] 作为本发明的优选，所述偏差判断单元包括偏移角度判断单元、机器人运动方向 和位置判断单元；所述图片信息处理单元将解析后的机器人二维码状态图像信息送入所述 偏移角度判断单元和所述机器人运动方向和位置判断单元；所述偏移角度判断单元分别与 所述机器人运动方向和位置判断单元和所述停车调整单元连接，所述机器人运动方向和位 置判断单元分别经所述停车调整单元和所述差速调整单元连接所述伺服电机系统。
[0011] 作为本发明的优选，所述图片信息处理单元中解析后的机器人二维码状态图像信 息包括用以构建机器人与二维码位置关系的二维坐标系信息、机器人偏移二维码角度和机 器人偏移二维码中心距离。
[0012] 作为本发明的优选，所述偏移角度判断单元将机器人偏移二维码角度与参考偏移 角度比较，当所述机器人偏移二维码角度不小于所述参考偏移角度时，所述停车调整单元 工作；当所述机器人偏移二维码角度小于所述参考偏移角度时，所述机器人运动方向和位 置判断单元工作，判断机器人运动方向和位置后确定启动所述停车调整单元或所述差速调 整单元。
[0013] 作为本发明的优选，所述机器人运动方向和位置判断单元包括八种机器人运动方 向和位置情况；所述八种机器人运动方向和位置情况包括：机器人行进方向偏向预设路径 右方且机器人中心位于第一象限；机器人行进方向偏向预设路径右方且机器人中心位于第 二象限；机器人行进方向偏向预设路径右方且机器人中心位于第三象限；机器人行进方向 偏向预设路径右方且机器人中心位于第四象限；机器人行进方向偏向预设路径左方且机器 人中心位于第一象限；机器人行进方向偏向预设路径左方且机器人中心位于第二象限；机 器人行进方向偏向预设路径左方且机器人中心位于第三象限；机器人行进方向偏向预设路 径左方且机器人中心位于第四象限。
[0014] 作为本发明的优选，当所述机器人运动方向和位置情况为以下任意一种时，所述 差速调整单元工作：机器人行进方向偏向预设路径右方且机器人中心位于第一象限，机器 人行进方向偏向预设路径右方且机器人中心位于第四象限，机器人行进方向偏向预设路径 左方且机器人中心位于第二象限，机器人行进方向偏向预设路径左方且机器人中心位于第 三象限；当所述机器人运动方向和位置情况为以下任意一种时，所述停车调整单元工作： 机器人行进方向偏向预设路径右方且机器人中心位于第二象限，机器人行进方向偏向预设 路径右方且机器人中心位于第三象限，机器人行进方向偏向预设路径左方且机器人中心位 于第一象限，机器人行进方向偏向预设路径左方且机器人中心位于第四象限。
[0015] 本发明具有以下有益效果： 本发明系统简单、容易实施，其采用二维码叠加 RFID标签双重系统，使机器人丢失位 姿概率大大降低，该系统还能自动确认机器人行进中的位置并能自动校正机器人行进方 向，提高自动化运输高效性。
【专利附图】
【附图说明】
[0016] 图1为本发明一种AGV机器人路径导航系统的结构框图； 图2为本发明一种AGV机器人路径导航系统的嵌入式工控板的结构框图； 图3为本发明一种AGV机器人路径导航系统的偏差判断单元的结构框图； 图4为本发明一种AGV机器人路径导航系统的实施方法的流程图。
【具体实施方式】
[0017] 以下结合附图对本发明作进一步详细说明。
[0018] 如图1所示为一种AGV机器人路径导航系统的结构框图，该系统包括二维码标签、 RFID标签、二维码图像采集系统、RFID阅读系统、伺服电机系统、通讯系统和嵌入式工控 板；所述二维码图像采集系统和RFID阅读系统分别读取二维码标签和RFID标签信息经所 述通讯系统上传至所述嵌入式工控板，所述嵌入式工控板经如图4所示方法判断处理后输 出前进或差速调整或停车调整指令至所述伺服电机系统，使得机器人确认自身在行走环境 中的位姿并校正行走方向。其中，所述二维码图像采集系统可以为摄像头，采集的信息通过 图片采集卡把图片数字化，所述RFID阅读系统为RFID阅读器，所述通讯系统包括由MINI PCIE接口构成的用以实现二维码图像采集系统和嵌入式工控板通讯的二维码通讯系统、由 USB接口构成的用以实现RFID阅读系统和嵌入式工控板通讯的RFID通讯系统和用以实现 嵌入式工控板和伺服电机系统通讯的CANopen总线通讯系统。
[0019] 如图2、3,所述嵌入式工控板包括图片信息识别单元、图片信息处理单元、地理位 置确认单元、偏差控制单元；所述二维码标签和所述RFID标签信息，也就是二维码图像采 集系统和RFID阅读系统读取的信息，经所述通讯系统分别上传至所述图片信息识别单元 和所述地理位置确认单元，所述RFID阅读系统可直接解析所述RFID标签信息中的机器人 RFID位置信息，所述图片信息识别单元用以解析机器人二维码位置信息，并将解析后的机 器人二维码位置信息送入所述地理位置确认单元，其中所述机器人RFID位置信息和机器 人二维码位置信息为地理坐标信息，所述地理位置确认单元判断确认机器人地理位置并输 送至所述偏差控制单元；所述二维码标签信息还经所述通讯系统上传至所述图片信息处理 单元，所述图片信息处理单元用以解析机器人二维码状态图像信息，解析后的所述机器人 二维码状态图像信息包括用以构建机器人与二维码位置关系的二维坐标系信息、机器人偏 移二维码角度和机器人偏移二维码中心距离，所述信息输出至所述偏差控制单元；所述偏 差控制单元收到地理位置信息后，再根据解析后的机器人二维码状态图像信息判断偏移情 况，若不偏移，机器人继续前行，当机器人到达另一个二维码标签时，该系统重新开始工作， 若偏移则根据偏差控制单元内部处理方法进行偏移调整，调整指令通过所述通讯系统控制 所述伺服电机系统，机器人边走边调整行走方向，即差速调整，或者机器人停车调整。
[0020] 所述偏差控制单元包括偏差判断单元、差速调整单元和停车调整单元。所述偏差 判断单元包括偏移角度判断单元、机器人运动方向和位置判断单元；所述图片信息处理单 元将解析后的机器人二维码状态图像信息送入所述偏移角度判断单元和所述机器人运动 方向和位置判断单元；所述偏移角度判断单元分别与所述机器人运动方向和位置判断单元 和所述停车调整单元连接，所述机器人运动方向和位置判断单元分别经所述停车调整单元 和所述差速调整单元连接所述伺服电机系统。
[0021] 图4示出了本发明一种AGV机器人路径导航系统的实施方法的流程图。初始设定 机器人参考偏移角度a Mf、机器人驱动轮间距D、相邻二维码标签中心距离LDM，初始设定机 器人行进路径。
[0022] 步骤1，机器人沿初始设定路径行进，所述二维码图像采集系统和RFID阅读系统 分别采集第N个二维码标签信息和第N个RFID标签信息；第N个二维码标签信息包括机器 人二维码位置信息和机器人二维码状态图像信息，第N个RFID标签信息包括机器人RFID 位置信息，N=I, 2,... η ; 步骤2,所述二维码图像采集系统和所述RFID阅读系统分别读取第N个二维码标签信 息和第N个RFID标签信息，并经所述通讯系统送入嵌入式工控板，利用所述图片信息识别 单元解析第N个二维码标签信息的机器人二维码位置信息，利用所述RFID阅读系统解析第 N个RFID标签信息的机器人RFID位置信息，并利用所述图片信息处理单元解析第N个二维 码标签信息的机器人二维码状态图像信息。其中解析后的机器人二维码状态图像信息包括 用以构建机器人与二维码位置关系的二维坐标系信息、机器人偏移二维码角度α和机器 人偏移二维码中心距离Λ L，其中二位坐标系是以第N个二维码的中心点为原点，以机器人 规划路径下一目的第Ν+1个二维码与当前第N个二维码的连线为Y轴正方向，建立二维坐 标系。
[0023] 步骤3,确认机器人当前地理位置：所述地理位置确认单元比较解析后的第N个机 器人二维码位置信息和解析后的第N个机器人RFID位置信息以确认机器人地理位置：当解 析后的第N个机器人二维码位置信息=解析后的第N个机器人RFID位置信息，确认机器人 地理位置为解析后的第N个机器人二维码位置信息或解析后的第N个机器人RFID位置信 息；当解析后的第N个机器人二维码位置信息尹解析后的第N个机器人RFID位置信息，确 认机器人地理位置为解析后的第N个机器人RFID位置信息，其中解析后的所第N个机器人 二维码位置信息和第N个机器人RFID位置信息为地理坐标信息。
[0024] 步骤4,确认机器人偏移情况：所述偏移角度判断单元比较解析后的第N个机器人 二维码状态图像信息以确认机器人偏移情况：当机器人偏移二维码角度α =〇度时，机器人 保持原来状态行进，直到机器人行进到第Ν+1个二维码标签和第Ν+1个RFID标签处，再次 从步骤1开始；当机器人偏移二维码角度α尹0度时，执行步骤5。
[0025] 步骤5,调整机器人路径：所述偏移角度判断单元根据解析后的第N个机器人二 维码状态图像信息，比较第N个机器人偏移二位码角度α和机器人参考偏移角度a Mf，当 α彡时，进入所述停车调整单元实施步骤5. 2停车调整；当α〈α 时，所述机器人运 动方向和位置单元判断机器人运动方向和位置情况。经多次测验，当a 约为15度时，机 器人边走边校正效果最好。
[0026] 机器人运动方向和位置情况有八种：机器人行进方向偏向预设路径右方且机器人 中心位于第一象限；机器人行进方向偏向预设路径右方且机器人中心位于第二象限；机器 人朝行进方向偏向预设路径右方且机器人中心位于第三象限；机器人行进方向偏向预设路 径右方且机器人中心位于第四象限；机器人行进方向偏向预设路径左方且机器人中心位于 第一象限；机器人行进方向偏向预设路径左方且机器人中心位于第二象限；机器人行进方 向偏向预设路径左方且机器人中心位于第三象限；机器人行进方向偏向预设路径左方且机 器人中心位于第四象限。
[0027] 当所述机器人运动方向和位置情况为以下任意一种时，进入所述差速调整单元实 施步骤5. 1差速调整：机器人行进方向偏向预设路径右方且机器人中心位于第一象限，机 器人行进方向偏向预设路径右方且机器人中心位于第四象限，机器人行进方向偏向预设路 径左方且机器人中心位于第二象限，机器人行进方向偏向预设路径左方且机器人中心位于 第三象限；该差速调整在机器人行进过程中进行，行进路径近似呈现S型。当所述机器人运 动方向和位置情况为以下任意一种时，进入所述停车调整实施步骤5. 2停车调整：机器人 行进方向偏向预设路径右方且机器人中心位于第二象限，机器人行进方向偏向预设路径右 方且机器人中心位于第三象限，机器人行进方向偏向预设路径左方且机器人中心位于第一 象限，机器人行进方向偏向预设路径左方且机器人中心位于第四象限。校正结束后，当机器 人行驶到第N+1个二维码标签或第N+1个RFID标签时，再次从步骤1开始。
[0028] 其中，所述步骤5. 1差速调整： 当机器人行进方向偏向预设路径右方时，调整使得机器人行进方向向预设路径 偏转，即机器人中心靠近二维码中心，VK，='+ W*D，W = π /180 ;当机器人行进方向偏向 预设路径左方时，调整VK〈'，使得机器人行进方向向预设路径偏转，即机器人中心靠近二 维码中心，=VK+W*D，W= π * α /180,其中W为机器人中心点角速度，八为机器人左轮线速 度，％为机器人右轮线速度，V ρ为调整后机器人左轮线速度，Vk，为调整后机器人右轮线速 度。
[0029] 所述步骤5. 2停车调整： 步骤5.2. 1，校正偏移角度： 步骤5. 2. 1. 1，机器人停止当前运动并原地旋转α角度，原地旋转弧长
【权利要求】
1. 一种AGV机器人路径导航系统，其特征在于，包括二维码标签、RFID标签、二维码图 像采集系统、RFID阅读系统、伺服电机系统、通讯系统和嵌入式工控板；所述二维码图像采 集系统和RFID阅读系统分别读取二维码标签和RFID标签信息经所述通讯系统上传至所述 嵌入式工控板，所述嵌入式工控板经判断处理后输出前进或差速调整或停车调整指令至所 述伺服电机系统，使得机器人确认自身在行走环境中的位姿并校正行走方向。
2. 根据权利要求1所述的AGV机器人路径导航系统，其特征在于，所述二维码标签信息 为包括机器人二维码位置和机器人二维码状态图像的位姿信息；所述RFID标签信息为机 器人RFID位置信息。
3. 根据权利要求2所述的AGV机器人路径导航系统，其特征在于，所述嵌入式工控板包 括图片信息识别单元、图片信息处理单元、地理位置确认单元、偏差控制单元；所述二维码 标签信息经所述通讯系统上传至所述图片信息识别单元，所述图片信息识别单元输出解析 后的机器人二维码位置信息至所述地理位置确认单元，所述RFID标签信息经所述通讯系 统将解析后的机器人RFID位置信息上传至所述地理位置确认单元，所述地理位置确认单 元连接所述偏差控制单元；所述二维码标签信息还经所述通讯系统上传至所述图片信息处 理单元，所述图片信息处理单元输出解析后的机器人二维码状态图像信息至所述偏差控制 单元；所述偏差控制单元经所述通讯系统输出控制指令至所述伺服电机系统。
4. 根据权利要求3所述的AGV机器人路径导航系统，其特征在于，所述地理位置确认单 元通过比对解析后的机器人二维码位置信息和解析后的机器人RFID位置信息，W确认机 器人地理位置；当解析后的机器人二维码位置信息与解析后的机器人RFID位置信息相等， 则确认机器人地理位置为解析后的机器人二维码位置信息或解析后的机器人RFID位置信 息；反之，则确认机器人地理位置为解析后的机器人RFID位置信息。
5. 根据权利要求3所述的AGV机器人路径导航系统，其特征在于，所述偏差控制单元包 括偏差判断单元、差速调整单元和停车调整单元。
6. 根据权利要求5所述的AGV机器人路径导航系统，其特征在于，所述偏差判断单元包 括偏移角度判断单元、机器人运动方向和位置判断单元；所述图片信息处理单元将解析后 的机器人二维码状态图像信息送入所述偏移角度判断单元和所述机器人运动方向和位置 判断单元；所述偏移角度判断单元分别与所述机器人运动方向和位置判断单元和所述停车 调整单元连接，所述机器人运动方向和位置判断单元分别经所述停车调整单元和所述差速 调整单元连接所述伺服电机系统。
7. 根据权利要求6所述的AGV机器人路径导航系统，其特征在于，所述图片信息处理单 元中解析后的机器人二维码状态图像信息包括用W构建机器人与二维码位置关系的二维 坐标系信息、机器人偏移二维码角度和机器人偏移二维码中也距离。
8. 根据权利要求7所述的AGV机器人路径导航系统，其特征在于，所述偏移角度判断单 元将机器人偏移二维码角度与参考偏移角度比较，当所述机器人偏移二维码角度不小于所 述参考偏移角度时，所述停车调整单元工作；当所述机器人偏移二维码角度小于所述参考 偏移角度时，所述机器人运动方向和位置判断单元工作，判断机器人运动方向和位置后确 定启动所述停车调整单元或所述差速调整单元。
9. 根据权利要求8所述的AGV机器人路径导航系统，其特征在于，所述机器人运动方向 和位置判断单元包括八种机器人运动方向和位置情况；所述八种机器人运动方向和位置情 况包括：机器人行进方向偏向预设路径右方且机器人中也位于第一象限；机器人行进方向 偏向预设路径右方且机器人中也位于第二象限；机器人行进方向偏向预设路径右方且机器 人中也位于第H象限；机器人行进方向偏向预设路径右方且机器人中也位于第四象限；机 器人行进方向偏向预设路径左方且机器人中也位于第一象限；机器人行进方向偏向预设路 径左方且机器人中也位于第二象限；机器人行进方向偏向预设路径左方且机器人中也位于 第H象限；机器人行进方向偏向预设路径左方且机器人中也位于第四象限。
10.根据权利要求9所述的AGV机器人路径导航系统，其特征在于，当所述机器人运动 方向和位置情况为W下任意一种时，所述差速调整单元工作；机器人行进方向偏向预设路 径右方且机器人中也位于第一象限，机器人行进方向偏向预设路径右方且机器人中也位于 第四象限，机器人行进方向偏向预设路径左方且机器人中也位于第二象限，机器人行进方 向偏向预设路径左方且机器人中也位于第H象限；当所述机器人运动方向和位置情况为W 下任意一种时，所述停车调整单元工作；机器人行进方向偏向预设路径右方且机器人中也 位于第二象限，机器人行进方向偏向预设路径右方且机器人中也位于第H象限，机器人偏 向预设路径左方且机器人中也位于第一象限，机器人行进方向偏向预设路径左方且机器人 中也位于第四象限。
【文档编号】G05D1/02GK104460669SQ201410607380
【公开日】2015年3月25日 申请日期:2014年11月3日 优先权日:2014年11月3日
【发明者】何瑶瑶, 赵永胜, 余渊, 陈云雷, 曹克江, 施颖涌, 张颖, 潘吉亮 申请人:上海电器科学研究所（集团）有限公司, 湖州上电科电器科学研究有限公司, 上海赛晶机电设备工程有限公司, 上电科湖州电器科学研究院