建出运动车体工作环境的3D地图；
[0047]激光雷达3扫描运动车体行驶道路中的障碍物，红外传感器6扫描运动车体周围空间上的障碍物，两者配合对运动车体工作中的障碍物进行预警，并向中央处理器发出报警信号；
[0048]前置摄像头5扫描货架上的二维码；
[0049]中央处理器获取五台双目立体视觉摄像头4、前置摄像头5、激光雷达3和四台红外传感器6的信息，结合构建的3D地图信息将目标位置的坐标信息转换为指令信息，并下发指令信息给控制装置；
[0050]控制装置根据中央处理器下发的指令控制直流电机；
[0051]直流电机驱动四个麦克纳姆轮进而控制运动车体的工作；
[0052]里程计测量运动车体工作的行程信息。
[0053]如图2所示，本发明还提供了一种全向自动叉车3D立体视觉导航定位方法，包括以下步骤:
[0054]步骤1，五台双目立体视觉摄像头4对自动叉车的工作环境进行360度扫描，获取自动叉车的工作环境的图像信息，通过图像处理装置得到自动叉车工作环境中各个像素点的3D坐标信息；
[0055]步骤2，图像处理装置通过视觉SLAM算法，结合惯性测量装置得到的自动叉车的旋转角度，生成自动叉车工作环境的3D地图；
[0056]步骤3，自动叉车通过五台双目立体视觉摄像头4获取实时图像，并根据所述3D地图对自动叉车目前所在的起始位置进行定位；
[0057]步骤4，自动叉车确定需要工作的目标位置；
[0058]步骤5，自动叉车根据目标位置按照规划路径导航到目标位置，若自动叉车在工作过程中没有遇到障碍物，执行步骤6，否则，通过激光雷达3和四个红外传感器6扫描判断障碍物是否可行，若可行则自动叉车从侧面绕过障碍物，若不可行则自动叉车停止工作，发出警报信号直至障碍物被移除；
[0059]步骤6自动叉车行驶到目标位置后，通过前置摄像头5扫描识别货架上的二维码；
[0060]步骤7，里程计和所述激光雷达3探测所述自动叉车是否正面朝向货物并对准货物，若所述自动叉车正面朝向货物并对准货物，执行步骤8，否则，所述前置摄像头5通过二维码继续校准所述自动叉车的方位直至所述自动叉车正面朝向货物并对准货物；
[0061]步骤8，自动叉车插入货架托盘，完成取货或放货。
[0062]其中，安全区域包括激光雷达与红外传感器的扫描区域和自动叉车底部的半径区域。
[0063]本发明中，激光雷达3的扫描范围达180°，感应距离达7m，反应时间达60ms。
[0064]以上所述仅为本发明的优选实施例而已，并不用于限制本发明，对于本领域的技术人员来说，本发明可以有各种更改和变化。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。
【主权项】
1.全向自动叉车3D立体视觉导航定位方法，其特征在于，包括以下步骤: 步骤I，多台双目立体视觉摄像头对自动叉车的工作环境进行360度扫描，获取所述自动叉车的工作环境的图像信息，通过图像处理装置得到所述自动叉车工作环境中各个像素点的3D坐标信息； 步骤2，所述图像处理装置通过视觉SLAM算法，结合惯性测量装置得到的所述自动叉车的旋转角度，生成所述自动叉车工作环境的3D地图； 步骤3，所述自动叉车通过所述双目立体视觉摄像头获取实时图像，并根据所述3D地图对所述自动叉车目前所在的起始位置进行定位； 步骤4，所述自动叉车确定需要工作的目标位置； 步骤5，所述自动叉车根据目标位置通过A*算法导航到目标位置，若所述自动叉车在工作过程中没有遇到障碍物，执行步骤6，否则，通过所述激光雷达和红外传感器扫描障碍物是否在安全区域内，判断是否可行，若可行则所述自动叉车从侧面绕过障碍物，若不可行则所述自动叉车停止工作，发出警报信号直至障碍物被移除； 步骤6，所述自动叉车行驶到目标位置后，通过前置摄像头扫描识别货架上的二维码；步骤7，里程计和所述激光雷达探测所述自动叉车是否正面朝向货物并对准货物，若所述自动叉车正面朝向货物并对准货物，执行步骤8，否则，所述前置摄像头通过二维码继续校准所述自动叉车的方位直至所述自动叉车正面朝向货物并对准货物； 步骤8，所述自动叉车插入货架托盘，完成取货或放货。
2.根据权利要求1所述的一种全向自动叉车3D立体视觉导航定位方法，其特征在于，所述安全区域包括所述激光雷达与所述红外传感器的扫描区域和所述自动叉车底部的半径区域。
3.根据权利要求1所述的一种全向自动叉车3D立体视觉导航定位方法，其特征在于，所述激光雷达扫描所述自动叉车行驶道路中的障碍物，所述红外传感器扫描所述自动叉车周围空间上的障碍物。
4.一种全向自动叉车，其特征在于，包括: 安装有四个麦克纳姆轮的运动车体，所述运动车体包括支撑结构、安装在所述支撑结构靠近地面的位置上的激光雷达和安装在所述支撑结构内的电池、直流电机、控制装置、中央处理器、图像处理装置、惯性测量装置、里程计、无线装置； 叉车升降装置，所述叉车升降装置包括升降结构、安装在所述叉车升降结构的顶部托盘上的多台双目立体视觉摄像头、安装在所述升降结构的底部的前置摄像头和安装在所述升降结构顶部的前后左右四个方向上的四个红外传感器； 所述激光雷达和所述红外传感器扫描所述运动车体工作环境中的障碍物，对所述运动车体工作中的障碍物进行预警，并向所述中央处理器发出报警信号； 上位机，所述上位机下发指令到所述中央处理器； 充电箱，所述充电箱对所述电池进行充电； 所述上位机与所述中央处理器和所述充电箱通过所述无线装置进行通讯； 所述双目立体视觉摄像头进行360度的全方位扫描，获取所述运动车体工作环境的图像信息，通过所述图像处理装置处理获取的图像信息，结合所述惯性测量装置获取所述运动车体工作的姿态信息，构建出所述运动车体工作环境的3D地图； 所述激光雷达扫描所述运动车体行驶道路中的障碍物，所述红外传感器扫描所述运动车体周围空间上的障碍物，两者配合对所述运动车体工作中的障碍物进行预警，并向所述中央处理器发出报警信号； 所述前置摄像头扫描货架上的二维码； 所述中央处理器获取所述双目立体视觉摄像头、所述前置摄像头、所述激光雷达和所述红外传感器的信息，结合构建的3D地图信息将目标位置的坐标信息转换为指令信息，并下发指令信息给控制装置； 所述控制装置根据所述中央处理器下发的指令控制所述直流电机； 所述直流电机驱动四个麦克纳姆轮进而控制所述运动车体的工作； 所述里程计测量所述运动车体工作的行程信息。
5.根据权利要求4所述的一种全向自动叉车，其特征在于，所述双目立体视觉摄像头为5台，分别置于所述叉车升降装置顶部托盘的正上方和上下左右四个方向，形成一个金字塔的封闭空间。
6.根据权利要求4所述的一种全向自动叉车，其特征在于，四个所述红外传感器的扫描方向均为斜下方，形成一个金字塔的封闭空间。
7.根据权利要求4所述的一种全向自动叉车，其特征在于，所述激光雷达的扫描范围达180°，感应距离达7m，反应时间达60ms。
【专利摘要】本发明公开了一种全向自动叉车及3D立体视觉导航定位方法，包括：获取自动叉车工作环境中3D坐标信息；生成3D地图；获取实时图像，根据3D地图对起始位置定位；确定目标位置；导航到目标位置，判断是否遇到障碍物；扫描识别货架上二维码；判断自动叉车是否正面朝向货物并对准货物；自动叉车插入货架托盘完成取放货。本发明的有益效果：多台双目立体摄像头构建工作环境的3D地图，结合里程计、激光雷达和前置摄像头，有效精确的定位并实现取放货；利用麦克纳姆轮，实现平面上三自由度的全方位移动，无需转向就能在同一货架上取放货；通过激光雷达和红外传感器及时有效的规避工作环境中的任何障碍物；通过上位机与充电箱的通讯实现自动叉车的自动充电。
【IPC分类】G05D1-02
【公开号】CN104777835
【申请号】CN201510106059
【发明人】胡建军, 杜骁释, 李哲靖
【申请人】武汉汉迪机器人科技有限公司
【公开日】2015年7月15日
【申请日】2015年3月11日