CN105404842A基于地标二维码的agv定位定向及测速方法

  • CN105404842A基于地标二维码的agv定位定向及测速方法已关闭评论
  • 1,469 views
  • A+
所属分类:AGV专利检索

CN105404842A基于地标二维码的agv定位定向及测速方法

CN105404842A基于地标二维码的agv定位定向及测速方法


本发明涉及一种基于地标二维码AGV定位定向及测速方法,属于导航与控制技术领域。本发明利用装在AGV上的对地拍照摄像头在固定时间间隔内连续拍摄两张包含地标二维码的图片,通过二维码识别所获地标信息得到地标点在AGV行驶全路径中的全局位置,通过分别解算二维码在图片中的位置和角度,反解出AGV本体相对于地标二维码的局部位置和角度,再与全局位置结合获得AGV在全局路径中的精确位置和航向;通过计算该固定时间段内的位置差获得AGV通过该地标时的速度,从而提供AGV导航所需的位置、航向和速度信息。因此,本发明实现了仅依靠地标二维码即可同时获得AGV的位置、航向和速度信息,简化了AGV导航所需的定位定向及测速附件。
专利类型:发明专利
申请(专利)号:CN201510808341.6
申请日期:2015年11月19日
公开(公告)日:2016年3月16日
公开(公告)号:CN105404842A
主分类号:G06K7/14,G06K7/00,G,G06,G06K,G06K7
分类号:G06K7/14,G06K7/00,G01P5/18,G01P5/00,G01P13/02,G01P13/00,G,G06,G01,G06K,G01P,G06K7,G01P5,G01P13,G06K7/14,G06K7/00,G01P5/18,G01P5/00,G01P13/02,G01P13/00
申请(专利权)人:北京特种机械研究所
发明(设计)人:段三军,李波,李明
主申请人地址:100143 北京市海淀区西四环北路149号
专利代理机构:中国兵器工业集团公司专利中心 11011
代理人:刘东升
国别省市代码:北京;11
主权项:一种基于地标二维码的AGV定位定向及测速方法,其特征在于,包括以下步骤:S1、在AGV行走通道(1)上按一定间距或在需要测定位置航向速度的点贴上矩阵式二维码,且二维码的偏角与地磁角度成一固定角度,按一定算法进行编码的二维码信息为地标点的点位信息,定义为地标二维码(3);S2、在AGV本体(5)上固定安装摄像头(4);S3、使AGV本体(5)在AGV行走通道(1)上行驶,在经过地标二维码(3)时,摄像头(4)拍摄地面图像(6),将拍摄到的图像(6)经过去噪声处理,设图像(6)中的二维码(8)在图像位置的A点,并且通过二维码(8)上的第一标志点(10)、第二标志点(11)、第三标志点(12)计算出二维码(8)的偏角,设二维码(8)在图像坐标系OXY中的位置和偏角为(x1,y1,θ1),其中x,y为位置信息,θ为偏角信息,并在预设间隔时间t内再拍摄一幅图像,得到新拍摄的图像中的二维码(8)在图像坐标系OXY中的位置和偏角为(x2,y2,θ2);该三个标志点是所有矩阵式二维码(2)上图形信息固定不变的位置的三个点;S4、按既定的编码方式对第一次或第二拍摄的图像中的二维码(8)信息进行解析,获得图像中的二维码(8)相对于整个行驶路径的全局位置坐标(xp,yp,θp),设图像坐标系OXY与地面长度的标定比例关系为K,则有:AGV本体(5)此时的位置及航向坐标为(xp‑x1/K,yp‑y1/K,θp‑θ1)AGV本体(5)此时的平移和偏航速度为((x1‑x2)/Kt,(y1‑y2)/Kt,(θ1‑θ2)/t)。
法律状态:公开,公开

weinxin
微信公众号
agvba是一个分享AGV知识和agv案例视频的网站。