CN104407615B - 一种agv机器人导引偏差校正方法 - Google Patents
一种agv机器人导引偏差校正方法 Download PDFInfo
- Publication number
- CN104407615B CN104407615B CN201410607249.9A CN201410607249A CN104407615B CN 104407615 B CN104407615 B CN 104407615B CN 201410607249 A CN201410607249 A CN 201410607249A CN 104407615 B CN104407615 B CN 104407615B
- Authority
- CN
- China
- Prior art keywords
- robot
- quick response
- response code
- rfid
- parsing
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
一种AGV机器人导引偏差校正方法,属于机器人技术领域。本发明AGV机器人导引偏差校正方法包括步骤1,采集第N个二维码标签信息和第N个RFID标签信息;步骤2,读取、解析第N个二维码标签信息和第N个RFID标签信息;步骤3,确认机器人当前地理位置:步骤4,确认机器人偏移情况,若不存在偏移情况再次从步骤1开始;步骤5,调整机器人路径,以控制所述伺服电机***校正机器人行走方向,当机器人校正后行驶到第N+1个二维码标签或第N+1个RFID标签时,再次从步骤1开始。本发明导引偏差校正方法用于包括多个二维码标签、多个RFID标签、二维码图像采集***、RFID阅读***、伺服电机***、通讯***和嵌入式工控板的AGV机器人路径导航***,方法简单且容易实施,还可自动校正机器人行走方向,确保机器人沿自身路径顺利行进。
Description
技术领域
本发明涉及机器人技术领域,特别涉及一种AGV机器人导引偏差校正方法。
背景技术
无人搬运车(简称AGV机器人),是指具备电磁或光学等自动导引装置,能够沿规定路径行驶,具有安全保护以及各种移载功能的运输车。对于拥有自主路径规划功能的AGV机器人来说,确认自己在地图中的位置非常重要,并且实时校正机器人行进方向,有利于提高运输行业的高效性。一般,AGV机器人仅用RFID标签实现路径导航,如实用新型专利CN203405960 U,则RFID标签的无方向性使得路径导航***无法获得机器人偏移角度和机器人偏移RFID中心点距离;而AGV机器人仅用二维码标签实现路径导航,如发明专利申请CN103268119 A,则二维码标签在AGV高速运行时得到错误的机器人位置信息。
发明内容
本发明针对现有技术存在的不足,提供一种同时具有RFID标签和二维码标签作用的导引偏差校正方法,并且方法简单、运行高效且可自动校正机器人行走方向。
本发明的技术方案是提供一种导引偏差校正方法,用于包括多个二维码标签、多个RFID标签、二维码图像采集***、RFID阅读***、伺服电机***、通讯***和嵌入式工控板的AGV机器人路径导航***,其特征在于,在嵌入式工控板内初始设定机器人参考偏移角度αref、机器人驱动轮间距D、相邻二维码标签中心距离LDM,
步骤1,机器人沿预设路径行驶,所述二维码图像采集***和所述RFID阅读***分别采集第N个二维码标签信息和第N个RFID标签信息;第N个二维码标签信息包括机器人二维码位置信息和机器人二维码状态图像信息,第N个RFID标签信息包括机器人RFID位置信息,N=1,2,...n;
步骤2,所述二维码图像采集***和所述RFID阅读***分别读取第N个二维码标签信息和第N个RFID标签信息,并经所述通讯***送入嵌入式工控板解析第N个二维码标签信息和第N个RFID标签信息;
步骤3,确认机器人当前地理位置:所述嵌入式工控板比较解析后的第N个机器人二维码位置信息和解析后的第N个机器人RFID位置信息以确认机器人地理位置;
步骤4,确认机器人偏移情况:所述嵌入式工控板比较解析后的第N个机器人二维码状态图像信息以确认机器人偏移情况;
步骤5,调整机器人路径:所述嵌入式工控板根据解析后的第N个机器人二维码状态图像信息,判断选择步骤5.1的差速调整或步骤5.2的停车调整,以控制所述伺服电机***校正机器人行走方向,当机器人校正后行驶到第N+1个二维码标签或第N+1个RFID标签时,再次从步骤1开始。
该方法采用二维码叠加RFID标签,使机器人丢失位姿的概率大大降低,利用RFID的高速性和无方向性弥补二维码的不足,得到机器人的位置信息,提高采用所述方法的AGV导航***的稳定性;同时利用二维码的方向性弥补RFID的不足,简单快速得到AGV机器人偏移角度以及偏移中心点距离。该方法可自动识别、确认机器人自身在行走环境中的具***姿(位置和角度),根据测得的角度和偏移距离,经过多重判断进行差速调整或停车调整,自动校正机器人行走方向,以确保机器人行进顺利。
作为本发明的优选,所述步骤3:当解析后的第N个机器人二维码位置信息=解析后的第N个机器人RFID位置信息,确认机器人地理位置为解析后的第N个机器人二维码位置信息或解析后的第N个机器人RFID位置信息;当解析后的第N个机器人二维码位置信息≠解析后的第N个机器人RFID位置信息,确认机器人地理位置为解析后的第N个机器人RFID位置信息。
作为本发明的优选,解析后的机器人二维码状态图像信息包括用以构建机器人与二维码位置关系的二维坐标系信息、机器人偏移二维码角度α和机器人偏移二维码中心距离ΔL。
作为本发明的优选,所述步骤4:当机器人偏移二维码角度α=0度时,机器人保持原来状态行进,直到机器人行驶到第N+1个二维码标签和第N+1个RFID标签处,再次从步骤1开始;当机器人偏移二维码角度α≠0度时,执行步骤5。
作为本发明的优选,所述步骤5:所述嵌入式工控板比较第N个机器人偏移二位码角度α和机器人参考偏移角度αref,当α≥αref时,进入步骤5.2停车调整;当α<αref时,所述嵌入式工控板判断机器人运动方向和位置情况,进而选择进入步骤5.1差速调整或步骤5.2停车调整。
作为本发明的优选,机器人运动方向和位置情况包括八种,机器人行进方向偏向预设路径右方且机器人中心位于第一象限;机器人行进方向偏向预设路径右方且机器人中心位于第二象限;机器人行进方向偏向预设路径右方且机器人中心位于第三象限;机器人行进方向偏向预设路径右方且机器人中心位于第四象限;机器人行进方向偏向预设路径左方且机器人中心位于第一象限;机器人行进方向偏向预设路径左方且机器人中心位于第二象限;机器人行进方向偏向预设路径左方且机器人中心位于第三象限;机器人行进方向偏向预设路径左方且机器人中心位于第四象限。
作为本发明的优选,当所机器人运动方向和位置情况为以下任意一种时,进入步骤5.1差速调整:机器人行进方向偏向预设路径右方且机器人中心位于第一象限,机器人行进方向偏向预设路径右方且机器人中心位于第四象限,机器人行进方向偏向预设路径左方且机器人中心位于第二象限,机器人行进方向偏向预设路径左方且机器人中心位于第三象限;当所述机器人运动方向和位置情况为以下任意一种时,进入步骤5.2停车调整:机器人行进方向偏向预设路径右方且机器人中心位于第二象限,机器人行进方向偏向预设路径右方且机器人中心位于第三象限,机器人车行进方向偏向预设路径左方且机器人中心位于第一象限,机器人行进方向偏向预设路径左方且机器人中心位于第四象限。
作为本发明的优选,所述步骤5.1差速调整:当机器人行进方向偏向预设路径右方时,调整VR>VL,VR’=VL+ W*D,W=π*α/180;当机器人行进方向偏向预设路径左方时,调整VR<VL,VL’=VR+W*D,W=π*α/180,其中W为机器人中心点角速度,VL为机器人左轮线速度,VR为机器人右轮线速度,VL’为调整后机器人左轮线速度,VR’为调整后机器人右轮线速度。
作为本发明的优选,所述步骤5.2停车调整:
步骤5.2.1,校正偏移角度:
步骤5.2.1.1,机器人停止当前运动并原地旋转α角度;
步骤5.2.2,校正偏移中心点距离:
步骤5.2.2.1,小机器人停止当前运动并原地向二维码中心所在方向旋转β角度,机器人中心在第一、第二象限时,,机器人中心在第三、第四象限时,;
步骤5.2.2.2,保持VL=VR,机器人中心在第一、第二象限时,,机器人中心在第三、第四象限时,机器人行走距离;
步骤5.2.2.3,机器人停止当前运动并原地向二维码中心所在方向反向旋转β角度;
其中为机器人偏移二维码中心距离ΔL的X轴方向距离,为机器人偏移二维码中心距离ΔL的Y轴方向距离,VL为机器人左轮线速度,VR为机器人右轮线速度。
作为本发明优选,所述二维码标签为DM码标签。
本发明具有以下有益效果:
本发明导引偏差校正方法简单、容易实施,其采用二维码叠加RFID标签双重***,使机器人丢失位姿概率大大降低,该方法还能自动确认机器人行进中的位置,并依次根据机器人偏移角度和机器人运动方向和位置,选择差速调整或停车调整而自动校正机器人行进方向,提高自动化运输高效性。
附图说明
图1为本发明一种AGV机器人导引偏差校正方法的流程图;
图2为图1中步骤3的流程图;
图3为图1中步骤5的流程图;
图4为为图3中步骤5.1的流程图;
图5为图3中步骤5.2的流程图;
图6a为本发明一种AGV机器人导引偏差校正方法当α<αref时的第一种机器人运动方向和位置;
图6b为本发明一种AGV机器人导引偏差校正方法当α<αref时的第二种机器人运动方向和位置;
图6c为本发明一种AGV机器人导引偏差校正方法当α<αref时的第三种机器人运动方向和位置;
图6d为本发明一种AGV机器人导引偏差校正方法当α<αref时的第四种机器人运动方向和位置;
图6e为本发明一种AGV机器人导引偏差校正方法当α<αref时的第五种机器人运动方向和位置;
图6f为本发明一种AGV机器人导引偏差校正方法当α<αref时的第六种机器人运动方向和位置;
图6g为本发明一种AGV机器人导引偏差校正方法当α<αref时的第七种机器人运动方向和位置;
图6h为本发明一种AGV机器人导引偏差校正方法当α<αref时的第八种机器人运动方向和位置;
图7为本发明一种AGV机器人导引偏差校正方法当当α≥αref时的机器人运动方向和位置;
图8为利用本发明一种AGV机器人导引偏差校正方法的AGV机器人路径导航***。
具体实施方式
以下结合附图对本发明作进一步详细说明。
如图1所示为本发明一种AGV机器人导引偏差校正方法的流程图,该导引偏差校正方法用于AGV机器人路径导航***(如图8)。AGV机器人路径导航***包括多个二维码标签、多个RFID标签、二维码图像采集***、RFID阅读***、伺服电机***、通讯***和嵌入式工控板。所述二维码图像采集***和RFID阅读***分别读取二维码标签和RFID标签信息经所述通讯***上传至所述嵌入式工控板,所述嵌入式工控板通过图1所示导引偏差校正方法,输出前进或差速调整或停车调整指令至所述伺服电机***,使得机器人确认自身在行走环境中的位姿并校正行走方向。
如图2-5,初始设定机器人参考偏移角度αref、机器人驱动轮间距D、相邻二维码标签中心距离LDM,初始设定机器人行进路径。
步骤1,机器人沿预设路径行驶,所述二维码图像采集***和所述RFID阅读***分别采集第N个二维码标签信息和第N个RFID标签信息;第N个二维码标签信息包括机器人二维码位置信息和机器人二维码状态图像信息,第N个RFID标签信息包括机器人RFID位置信息,N=1,2,...n;
步骤2,所述二维码图像采集***和所述RFID阅读***分别读取第N个二维码标签信息和第N个RFID标签信息,并经所述通讯***送入嵌入式工控板解析第N个二维码标签信息,所述RFID阅读***直接解析第N个RFID标签信息,其中所述二维码图像采集***可以为摄像头,采集的信息通过图片采集卡把图片数字化,所述RFID阅读***为RFID阅读器,所述通讯***包括由MINI PCIE接口构成的用以实现二维码图像采集***和嵌入式工控板通讯的二维码通讯***、由USB接口构成的用以实现RFID阅读***和嵌入式工控板通讯的RFID通讯***和用以实现嵌入式工控板和伺服电机***通讯的CANopen总线通讯***;解析后的机器人二维码状态图像信息包括用以构建机器人与二维码位置关系的二维坐标系信息、机器人偏移二维码角度α和机器人偏移二维码中心距离ΔL;
步骤3,确认机器人当前地理位置:所述嵌入式工控板比较解析后的第N个机器人二维码位置信息和解析后的第N个机器人RFID位置信息以确认机器人地理位置:当解析后的第N个机器人二维码位置信息=解析后的第N个机器人RFID位置信息,确认机器人地理位置为解析后的第N个机器人二维码位置信息或解析后的第N个机器人RFID位置信息;当解析后的第N个机器人二维码位置信息≠解析后的第N个机器人RFID位置信息,确认机器人地理位置为解析后的第N个机器人RFID位置信息,其中解析后的所第N个机器人二维码位置信息和第N个机器人RFID位置信息为地理坐标信息。利用RFID只需在标签作用范围内即可得到机器人位置信息的特点,快速、准确识别并确认机器人当前地理位置,在此基础上通过下述步骤进一步确定机器人是否按预定路径行进。
步骤4,确认机器人偏移情况:所述嵌入式工控板比较解析后的第N个机器人二维码状态图像信息以确认机器人偏移情况:当机器人偏移二维码角度α=0度时,机器人保持原来状态行进,直到机器人行驶到第N+1个二维码标签和第N+1个RFID标签处,再次从步骤1开始;当机器人偏移二维码角度α≠0度时,执行步骤5。
步骤5,调整机器人路径:所述嵌入式工控板根据解析后的第N个机器人二维码状态图像信息,比较第N个机器人偏移二位码角度α和机器人参考偏移角度αref,当α≥αref时,进入步骤5.2停车调整;当α<αref时,所述嵌入式工控板判断机器人运动方向和位置情况。经多次测验,当αref约为15度时,机器人边走边校正效果最好。
机器人运动方向和位置情况有八种(如图6):图6a-6h依次示出了机器人运动方向和位置情况机器人行进方向偏向预设路径右方且机器人中心位于第一象限;机器人行进方向偏向预设路径右方且机器人中心位于第二象限;机器人行进方向偏向预设路径右方且机器人中心位于第三象限;机器人行进方向偏向预设路径右方且机器人中心位于第四象限;机器人行进方向偏向预设路径左方且机器人中心位于第一象限;机器人行进方向偏向预设路径左方且机器人中心位于第二象限;机器人行进方向偏向预设路径左方且机器人中心位于第三象限;机器人行进方向偏向预设路径左方且机器人中心位于第四象限。
当所述机器人运动方向和位置情况为以下任意一种时,进入步骤5.1差速调整:机器人行进方向偏向预设路径右方且机器人中心位于第一象限(如图6a),机器人行进方向偏向预设路径右方且机器人中心位于第四象限(如图6d),机器人行进方向偏向预设路径左方且机器人中心位于第二象限(如图6f),机器人行进方向偏向预设路径左方且机器人中心位于第三象限(如图6g);该差速调整在机器人行进过程中进行,行进路径近似呈现S型。当所述机器人运动方向和位置情况为以下任意一种时,进入步骤5.2停车调整:机器人行进方向偏向预设路径右方且机器人中心位于第二象限(如图6b),机器人行进方向偏向预设路径右方且机器人中心位于第三象限(如图6c),机器人行进方向偏向预设路径左方且机器人中心位于第一象限(如图6e),机器人行进方向偏向预设路径左方机器人中心位于第四象限(如图6h)。校正结束后,当机器人行驶到第N+1个二维码标签或第N+1个RFID标签时,再次从步骤1开始。
其中,所述步骤5.1差速调整:
当机器人行进方向偏向预设路径右方时,调整VR>VL,使得机器人行进方向朝预设路径偏转,即机器人中心靠近二维码中心,VR’=VL+W*D,W=π*α/180;当机器人行进方向偏向预设路径左方时,调整VR<VL,使得机器人行进方向朝预设路径偏转,即机器人中心靠近二维码中心,VL’=VR+W*D,W=π*α/180,其中W为机器人中心点角速度,VL为机器人左轮线速度,VR为机器人右轮线速度,VL’为调整后机器人左轮线速度,VR’为调整后机器人右轮线速度。
所述步骤5.2停车调整:
步骤5.2.1,校正偏移角度:
步骤5.2.1.1,机器人停止当前运动并原地旋转α角度,原地旋转弧长;
步骤5.2.2,校正偏移中心点距离:
步骤5.2.2.1,机器人停止当前运动并原地向二维码中心所在方向旋转β角度,机器人中心在第一、第二象限时,,机器人中心在第三、第四象限时,,原地旋转弧长;
步骤5.2.2.2,保持VL=VR,机器人中心在第一、二象限时,,机器人中心在第三、四象限,;
步骤5.2.2.3,机器人停止当前运动并原地向二维码中心所在方向反向旋转β角度,原地旋转弧长;
其中为机器人偏移二维码中心距离ΔL的X轴方向距离,为机器人偏移二维码中心距离ΔL的Y轴方向距离,,VL为机器人左轮线速度,VR为机器人右轮线速度;L1为机器人行走距离。
实施例一
如图6d所示,假定机器人当前位置为二维码A所包含的路径信息处,以二维码A的中心点为原点,以机器人规划路径下一目的二维码B与当前二维码A的连线为Y轴正方向,建立二维坐标系。
机器人位姿与二维码A的位置如图所示:机器人中心点O偏移二维码A的中心点水平方向距离为, 垂直方向距离为,机器人当前前进方向与预设路径偏角为α。假设机器人左轮线速度为VL,机器人右轮线速度为VR,机器人中心点的线速度为V,机器人中心点的角速度为W,机器人左右轮距为D,此时实施差速控制。差速控制后,机器人右轮速度大于左轮速度,机器人向左拐弯,左右轮以及机器人中心点的行走轨迹为圆弧,假设左轮圆弧半径为DL,则右轮圆弧半径为DL+D,根据圆周定理,左右轮以及机器人中心点所对应的圆心角相等,可得关系式如下:
经转换后,得。
则AGV机器人中心点的行走半径R:
则AGV机器人中心点运动角速度W:
其中
根据以上关系式,把VR,VL换算成伺服***的速度参数,当机器人行进方
向偏向预设路径右方时,调整VR>VL,VR’=VL+W*D;当机器人行进方向偏向预设路径左方时,调整VR<VL,VL’=VR+W*D,即可实现差速控制,保证机器人在下一中心点可以拍摄到二维码。
如图6d所示,α小于15°的情况下,AGV机器人要从A点行驶到B点,起点A处,机器人偏移二维码的角度为α=10°,机器人中心偏离二维码中心点的水平和垂直距离分别是ΔX=0.02m和ΔY=0.01m,机器人驱动轮间距D=0.55m,假设要求在1秒内校正角度,则机器人中心点运动角速度W:
设定机器人左轮速度VL按***需要的正常速度1m/s的速度行驶,则VR:
=3.14*10*0.55/180+1=1.096m/s
1秒后,改变右轮速度VR,使VR=VL=1m/s;
到达B点,检测到机器人偏移角度为α2,机器人中心偏离二维码中心点的水平和垂直距离分别是ΔX2和ΔY2,由图可以看出,α2=0,ΔX2<ΔX和ΔY2<ΔY。
实施例二
如图7所示,当α不小于15°的情况下,机器人中心位于第四象限(机器人中心位于第三象限同机器人中心位于第四象限)则需要AGV机器人停止当前运动,先校正当前偏差,再继续执行任务,具体实施方法如下:
位置①机器人左轮超前,右轮滞后,机器人偏移角度为a,机器人偏离中心点的为ΔL,机器人两轮间宽度为D,两个二维码中心距离为,
第一步校正偏移角度,左轮向后,右轮向前,旋转a角度到达位置②,旋转弧长为;
第二步校正偏离中心点距离,首先让机器人向二维码中心所在方向原地旋转β角度到达位置③,则β角度与机器人偏离中心点水平距离的关系为:
旋转弧长为:
然后让机器人行走距离L1(左右轮同速同距)到达位置④,则L1近似等于
最后让机器人相对上次旋转的角度,机器人原地反向旋转β角度,到达位置⑤。至此,完成校正。此时机器人中心偏移二维码中心角度为0°,机器人中心偏离二维码中心距离接近0°。
当机器人中心位于第一象限或第二象限时(图中未示出),β角度与机器人偏离中心点水平距离的关系为:
机器人行走距离L1(左右轮同速同距):
上面所述的实施例仅是对本发明的优选实施方式进行描述,并非对本发明的构思和范围进行限定。在不脱离本发明设计构思的前提下,本领域普通人员对本发明的技术方案做出的各种变型和改进,均应落入到本发明的保护范围,本发明请求保护的技术内容,已经全部记载在权利要求书中。
Claims (6)
1.一种AGV机器人导引偏差校正方法,用于包括多个二维码标签、多个RFID标签、二维码图像采集***、RFID阅读***、伺服电机***、通讯***和嵌入式工控板的AGV机器人路径导航***,其特征在于,在嵌入式工控板内初始设定机器人参考偏移角度αref、机器人驱动轮间距D、相邻二维码标签中心距离LDM,
步骤1,机器人沿预设路径行驶,所述二维码图像采集***和所述RFID阅读***分别采集第N个二维码标签信息和第N个RFID标签信息;第N个二维码标签信息包括机器人二维码位置信息和机器人二维码状态图像信息,第N个RFID标签信息包括机器人RFID位置信息,N=1,2,...n;
步骤2,所述二维码图像采集***和所述RFID阅读***分别读取第N个二维码标签信息和第N个RFID标签信息,并经所述通讯***送入嵌入式工控板解析第N个二维码标签信息和第N个RFID标签信息;
步骤3,确认机器人当前地理位置:所述嵌入式工控板比较解析后的第N个机器人二维码位置信息和解析后的第N个机器人RFID位置信息以确认机器人地理位置;
步骤4,确认机器人偏移情况:所述嵌入式工控板比较解析后的第N个机器人二维码状态图像信息以确认机器人偏移情况;
步骤5,调整机器人路径:所述嵌入式工控板根据解析后的第N个机器人二维码状态图像信息,比较第N个机器人偏移二维码角度α和机器人参考偏移角度αref,当α≥αref时,进入步骤5.2停车调整;当α<αref时,所述嵌入式工控板判断机器人运动方向和位置情况,进而选择进入步骤5.1差速调整或步骤5.2停车调整,以控制所述伺服电机***校正机器人行走方向,当机器人校正后行驶到第N+1个二维码标签或第N+1个RFID标签时,再次从步骤1开始;
当所述机器人运动方向和位置情况为以下任意一种时,进入步骤5.1差速调整:机器人行进方向偏向预设路径右方且机器人中心位于第一象限,机器人行进方向偏向预设路径右方且机器人中心位于第四象限,机器人行进方向偏向预设路径左方且机器人中心位于第二象限,机器人行进方向偏向预设路径左方且机器人中心位于第三象限;当所述机器人运动方向和位置情况为以下任意一种时,进入步骤5.2停车调整:机器人行进方向偏向预设路径右方且机器人中心位于第二象限,机器人行进方向偏向预设路径右方且机器人中心位于第三象限,机器人行进方向偏向预设路径左方且机器人中心位于第一象限,机器人行进方向偏向预设路径左方且机器人中心位于第四象限;
其中,解析后的机器人二维码状态图像信息包括用以构建机器人与二维码位置关系的二维坐标系信息、机器人偏移二维码角度α和机器人偏移二维码中心距离ΔL。
2.根据权利要求1所述的AGV机器人导引偏差校正方法,其特征在于,所述步骤3:当解析后的第N个机器人二维码位置信息=解析后的第N个机器人RFID位置信息,确认机器人地理位置为解析后的第N个机器人二维码位置信息或解析后的第N个机器人RFID位置信息;当解析后的第N个机器人二维码位置信息≠解析后的第N个机器人RFID位置信息,确认机器人地理位置为解析后的第N个机器人RFID位置信息。
3.根据权利要求1所述的AGV机器人导引偏差校正方法,其特征在于,所述步骤4:当机器人偏移二维码角度α=0度时,机器人保持原来状态行进,直到机器人行驶到第N+1个二维码标签和第N+1个RFID标签处,再次从步骤1开始;当机器人偏移二维码角度α≠0度时,执行步骤5。
4.根据权利要求1所述的AGV机器人导引偏差校正方法,其特征在于,所述步骤5.1差速调整:当机器人行进方向偏向预设路径右方时,调整VR>VL,VR’=VL+W*D,W=π*α/180;当机器人行进方向偏向预设路径左方时,调整VR<VL,VL’=VR+W*D,W=π*α/180,其中W为机器人中心点角速度,VL为机器人左轮线速度,VR为机器人右轮线速度,VL’为调整后机器人左轮线速度,VR’为调整后机器人右轮线速度。
5.根据权利要求1所述的AGV机器人导引偏差校正方法,其特征在于,所述步骤5.2停车调整:
步骤5.2.1,校正偏移角度:
步骤5.2.1.1,机器人停止当前运动并原地旋转α角度;
步骤5.2.2,校正偏移中心点距离:
步骤5.2.2.1,机器人停止当前运动并原地向二维码中心所在方向旋转β角度,机器人中心在第一、第二象限时, ,机器人中心在第三、第四象限时,;
步骤5.2.2.2,保持VL=VR,机器人中心在第一、二象限时,,机器人中心在第三、四象限,;
步骤5.2.2.3,机器人停止当前运动并原地向二维码中心所在方向反向旋转β角度;
其中为机器人偏移二维码中心距离ΔL的X轴方向距离,为机器人偏移二维码中心距离ΔL的Y轴方向距离,VL为机器人左轮线速度,VR为机器人右轮线速度;L1为机器人行走距离。
6.根据权利要求1所述的AGV机器人导引偏差校正方法,其特征在于,所述二维码标签为DM码标签。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410607249.9A CN104407615B (zh) | 2014-11-03 | 2014-11-03 | 一种agv机器人导引偏差校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410607249.9A CN104407615B (zh) | 2014-11-03 | 2014-11-03 | 一种agv机器人导引偏差校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104407615A CN104407615A (zh) | 2015-03-11 |
CN104407615B true CN104407615B (zh) | 2017-01-25 |
Family
ID=52645253
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410607249.9A Expired - Fee Related CN104407615B (zh) | 2014-11-03 | 2014-11-03 | 一种agv机器人导引偏差校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104407615B (zh) |
Families Citing this family (54)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2016125001A1 (en) * | 2015-02-05 | 2016-08-11 | Grey Orange Pte, Ltd. | Apparatus and method for navigation path compensation |
CN104898661A (zh) * | 2015-03-31 | 2015-09-09 | 苏州佳世达电通有限公司 | 一种车辆纠偏控制方法及*** |
CN104932496B (zh) * | 2015-05-13 | 2017-11-17 | 浙江德马科技股份有限公司 | 一种搬运车的自动导航方法 |
CN104848876B (zh) * | 2015-05-18 | 2017-10-03 | 哈尔滨工程大学 | 全方位移动机器人定位码盘的安装误差测量方法 |
CN106708033A (zh) * | 2015-11-18 | 2017-05-24 | 苏州宝时得电动工具有限公司 | 路径误差消除***及方法 |
CN105651286B (zh) * | 2016-02-26 | 2019-06-18 | 中国科学院宁波材料技术与工程研究所 | 一种移动机器人视觉导航方法与***、以及仓库*** |
CN106168802B (zh) * | 2016-04-18 | 2020-04-14 | 深圳众为兴技术股份有限公司 | 一种用于移动机器人的位置感知装置 |
CN106168803A (zh) * | 2016-04-18 | 2016-11-30 | 深圳众为兴技术股份有限公司 | 一种用于移动机器人的位置感知方法 |
CN106054873A (zh) * | 2016-05-19 | 2016-10-26 | 北京海尔广科数字技术有限公司 | 一种多电机驱动的移动设备的校准方法及装置 |
CN105929834B (zh) * | 2016-06-27 | 2018-08-28 | 中国计量大学 | 基于辅助定位装置的视觉导引车定位方法及视觉导引车 |
WO2018021457A1 (ja) * | 2016-07-29 | 2018-02-01 | 日本電産株式会社 | 移動体誘導システム、移動体、誘導装置およびコンピュータプログラム |
CN106444772B (zh) * | 2016-10-25 | 2019-05-03 | 北京京东尚科信息技术有限公司 | 自动引导车轮系舵角自动调整方法、装置和自动引导车 |
CN107085428B (zh) * | 2017-05-18 | 2020-03-10 | 广州视源电子科技股份有限公司 | 智能移动方法、装置、机器人及存储介质 |
CN107065883A (zh) * | 2017-05-18 | 2017-08-18 | 广州视源电子科技股份有限公司 | 移动控制方法、装置、机器人及存储介质 |
CN107132844B (zh) * | 2017-05-24 | 2019-07-16 | 浙江大学 | 一种移动机器人基于姿态检测模块和特殊地标的运动自矫正方法 |
CN107422728B (zh) * | 2017-05-31 | 2023-08-25 | 北京物资学院 | 一种物流机器人横偏控制方法及物流机器人 |
CN107300696A (zh) * | 2017-06-16 | 2017-10-27 | 北京军立方机器人科技有限公司 | 一种基于rfid的移动机器人位置校正方法和装置 |
CN107515605B (zh) * | 2017-07-12 | 2020-12-18 | 台州智奥通信设备有限公司 | 一种基于超声波测距的agv小车导航方法及*** |
CN109254564B (zh) | 2017-07-13 | 2021-03-26 | 杭州海康机器人技术有限公司 | 物品搬运方法、装置、终端及计算机可读存储介质 |
CN107671863B (zh) * | 2017-08-22 | 2020-06-26 | 广东美的智能机器人有限公司 | 基于二维码的机器人控制方法、装置及机器人 |
CN107490379B (zh) * | 2017-08-28 | 2020-11-27 | 山东非凡智能科技有限公司 | 利用二维码地标定位agv工作点位置的方法及*** |
CN109426251B (zh) * | 2017-08-29 | 2020-11-06 | 杭州海康机器人技术有限公司 | 一种机器人的行驶控制方法和装置 |
CN109491374B (zh) * | 2017-09-12 | 2022-08-09 | 杭州海康机器人技术有限公司 | 自动导引车辆的轨迹调整方法及装置 |
CN109582011A (zh) * | 2017-09-29 | 2019-04-05 | 凌子龙 | 一种地标定位的机器人***及其使用的地标和机器人和机器人地标定位方法 |
CN108021134B (zh) * | 2017-11-30 | 2021-02-02 | 厦门华蔚物联网科技有限公司 | 一种机器人纠偏***及其控制方法 |
CN107992059B (zh) * | 2018-01-08 | 2020-04-24 | 陕西理工大学 | 电磁智能车的控制方法 |
CN108592906B (zh) * | 2018-03-30 | 2020-02-14 | 合肥工业大学 | 基于二维码和惯性传感器的agv复合导航方法 |
CN108469826B (zh) * | 2018-04-23 | 2021-06-08 | 宁波Gqy视讯股份有限公司 | 一种基于机器人的地图生成方法及*** |
US10802498B2 (en) * | 2018-05-30 | 2020-10-13 | Datalogic Ip Tech S.R.L. | Target direction estimation using centroid follower |
CN109003029A (zh) * | 2018-07-20 | 2018-12-14 | 福州大学 | 一种基于深度学习的智能仓库巡检方法及*** |
CN109213177B (zh) * | 2018-11-09 | 2022-01-11 | 苏州瑞得恩光能科技有限公司 | 机器人导航***及导航方法 |
CN109552417B (zh) * | 2018-12-27 | 2020-02-21 | 华晟(青岛)智能装备科技有限公司 | 一种驱动轮角度零偏的校准方法及*** |
CN109711503A (zh) * | 2018-12-29 | 2019-05-03 | ***股份有限公司 | 一种机器人定位方法及装置 |
CN111496773B (zh) * | 2019-01-30 | 2023-05-02 | 北京京东乾石科技有限公司 | 一种调整机器人机械参数的方法和装置 |
CN111521181A (zh) * | 2019-02-01 | 2020-08-11 | 北京京东尚科信息技术有限公司 | 一种行驶偏差的确定方法和装置 |
CN109765904A (zh) * | 2019-02-28 | 2019-05-17 | 上海木木聚枞机器人科技有限公司 | 一种移动装置进出狭窄空间的引导控制方法和移动装置 |
CN111694349A (zh) * | 2019-03-12 | 2020-09-22 | 北京京东尚科信息技术有限公司 | 一种控制自动导引运输车运动的方法和装置 |
CN110109460B (zh) * | 2019-05-23 | 2022-05-27 | 广州市技田信息技术有限公司 | 一种基于十字码的agv小车导航*** |
CN110186459B (zh) * | 2019-05-27 | 2021-06-29 | 深圳市海柔创新科技有限公司 | 导航方法、移动载体及导航*** |
CN110221609B (zh) * | 2019-06-06 | 2022-08-12 | 珠海格力智能装备有限公司 | 基于二维码的轨迹纠偏方法 |
CN110154787B (zh) * | 2019-06-27 | 2023-08-15 | 浙江亿控自动化设备有限公司 | 一种双舵轮无人搬运车及其控制方法 |
CN110304386B (zh) * | 2019-06-28 | 2021-07-02 | 北京极智嘉科技股份有限公司 | 机器人及机器人丢码后的重新定位方法 |
CN112445220A (zh) * | 2019-08-30 | 2021-03-05 | 北京京东乾石科技有限公司 | 自动导引车的控制方法及装置、存储介质及电子设备 |
CN110796118B (zh) * | 2019-11-12 | 2022-06-10 | 深圳创维数字技术有限公司 | 获取运输设备的姿态调整参数方法、运输设备及存储介质 |
CN111077852B (zh) * | 2019-11-15 | 2021-10-15 | 北京旷视机器人技术有限公司 | 旋转控制方法、装置、计算机设备和存储介质 |
CN111470243A (zh) * | 2020-03-30 | 2020-07-31 | 无锡顺达智能自动化工程股份有限公司 | 仓储机器人曲线行走的算法及实施方法 |
CN112286204A (zh) * | 2020-11-11 | 2021-01-29 | 珠海格力智能装备有限公司 | 自动导引装置的控制方法及装置、处理器、电子设备 |
CN112731928A (zh) * | 2020-12-21 | 2021-04-30 | 珠海格力智能装备有限公司 | 控制自动导引装置的方法、装置、非易失性存储介质 |
CN112526998B (zh) * | 2020-12-21 | 2022-10-28 | 珠海格力智能装备有限公司 | 轨迹纠偏方法及装置、自动驾驶引导车 |
CN112762928B (zh) * | 2020-12-23 | 2022-07-15 | 重庆邮电大学 | 含有激光slam的odom与dm地标组合移动机器人及导航方法 |
CN113183141A (zh) * | 2021-06-09 | 2021-07-30 | 乐聚(深圳)机器人技术有限公司 | 双足机器人的行走控制方法、装置、设备及存储介质 |
CN113433951B (zh) * | 2021-07-28 | 2024-03-29 | 广东奥普特科技股份有限公司 | 一种agv叉车智能导引方法及agv叉车智能导引*** |
CN113625713B (zh) * | 2021-08-11 | 2024-04-16 | 北京京东振世信息技术有限公司 | 自动引导运输车的控制方法和装置 |
CN115113632B (zh) * | 2022-08-31 | 2022-11-22 | 深圳市米塔机器人有限公司 | 机器人的控制方法、机器人及电子设备 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100555141C (zh) * | 2007-11-15 | 2009-10-28 | 浙江大学 | 基于射频识别标签和视觉的自动导引***及其方法 |
CN102346483B (zh) * | 2011-06-07 | 2012-11-28 | 南京航空航天大学 | 基于无源rfid和辅助视觉的agv运行控制方法 |
US20130054129A1 (en) * | 2011-08-26 | 2013-02-28 | INRO Technologies Limited | Method and apparatus for using unique landmarks to locate industrial vehicles at start-up |
TWI439404B (zh) * | 2011-12-15 | 2014-06-01 | Ind Tech Res Inst | 自動搬運車導引系統及自動搬運車導引方法 |
CN102944236B (zh) * | 2012-11-20 | 2015-03-18 | 无锡普智联科高新技术有限公司 | 基于多个二维码读码器的移动机器人定位***及方法 |
CN103123682B (zh) * | 2013-01-17 | 2015-09-16 | 无锡普智联科高新技术有限公司 | 基于规则图形码复合标签的移动机器人定位***及方法 |
-
2014
- 2014-11-03 CN CN201410607249.9A patent/CN104407615B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN104407615A (zh) | 2015-03-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104407615B (zh) | 一种agv机器人导引偏差校正方法 | |
CN104460669B (zh) | 一种agv机器人路径导航*** | |
CN107463173B (zh) | 仓储agv导航方法及装置、计算机设备及存储介质 | |
CN103353758B (zh) | 一种室内机器人导航方法 | |
CN103324194B (zh) | 基于二维码导航带的移动机器人定位*** | |
CN106323294A (zh) | 变电站巡检机器人定位方法及定位装置 | |
CN108594822A (zh) | 基于二维码的机器人定位方法、机器人充电方法及*** | |
CN103064416B (zh) | 巡检机器人室内外自主导航*** | |
CN109270953A (zh) | 一种基于同心圆视觉标识的多旋翼无人机自主降落方法 | |
CN106382934A (zh) | 一种高精度移动机器人定位***和方法 | |
CN106527432A (zh) | 基于模糊算法和二维码自矫正的室内移动机器人协作*** | |
CN108052107A (zh) | 一种融合磁条、磁钉和惯导的agv室内外复合导航***及方法 | |
CN103294059A (zh) | 基于混合导航带的移动机器人定位***及其方法 | |
CN104835173A (zh) | 一种基于机器视觉的定位方法 | |
CN203241826U (zh) | 基于混合导航带的移动机器人定位*** | |
CN104181926A (zh) | 机器人的导航控制方法 | |
CN108345005A (zh) | 巷道掘进机的实时连续自主定位定向***及导航定位方法 | |
CN102135429A (zh) | 一种基于视觉的机器人室内定位导航方法 | |
CN110347160A (zh) | 一种基于双摄像头扫码的自动引导车及其导航方法 | |
CN107436422B (zh) | 一种基于红外线灯立体阵列的机器人定位方法 | |
CN205121338U (zh) | 基于图像识别与无线网络的agv导航*** | |
CN206321253U (zh) | 变电站巡检机器人定位装置 | |
CN203241825U (zh) | 一种基于二维码导航带的移动机器人定位*** | |
CN108279026A (zh) | 一种基于t型rfid信标的agv惯性导航***及方法 | |
CN102520723A (zh) | 基于上悬无线传输摄像头的轮椅室内全局视频监控导航*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170125 Termination date: 20211103 |