一种袋状物料装车机器人车辆识别与控制系统技术方案

本发明专利技术公开了一种袋状物料装车机器人车辆识别与控制系统，其包括：二维激光扫描仪、云台传动机构、云台支架、云台零点开关、定距吐包缓存装置、激光对射传感器、行走机构、摆臂机构以及提升机构，本发明专利技术可以将识别系统获取的三维点云进行提取与处理，对车辆进行识别与定位，通过定距吐包装置对输送带传送的水泥包进行排序处理，保证下料的顺序性，通过运动学求解计算出装车机器人到达预订装车起始点以及各个轨迹各伺服电机所需要转动的角度，进而来对机器人进行精确控制，保证装车的顺利进行。同时，系统机械结构模块化，方便维修；工作过程半自动化，把工人从繁重的体力劳动工作环境中解放出来，极大地提高劳动生产率。

Vehicle identification and control system for bag material loading robot

The invention discloses a bag material loading robot vehicle identification and control system, which comprises: a two-dimensional laser scanner, camera driving mechanism, head support, tilt switch, zero distance packet buffer device, spit laser beam sensor, walking mechanism, swing arm mechanism and lifting mechanism, the invention can 3D point cloud the recognition system obtained by extraction and processing, identification and location of the vehicle, the distance of spit bag device for conveyor cement package sorting, guarantee the order of material, through kinematics calculated loading robot to reach the starting point and the reservation loading trajectory of each servo motor to the rotation angle then, the precise control of the robot, to ensure smooth loading. At the same time, the mechanical structure of the system is modular and convenient for maintenance. The work process is semi-automatic, and the workers are liberated from the heavy manual labor environment, which greatly improves labor productivity.

【技术实现步骤摘要】
一种袋状物料装车机器人车辆识别与控制系统
本专利技术涉及自动化装车领域，尤其涉及智能车辆识别系统。
技术介绍
目前装车行业为高危型，重体力行业，尤其是以水泥为代表的作业过程中产生高粉的行业，其劳动强度高，对人的危害大，劳动效率低，设计一种能够用机器替代人的自动化系统显得尤为重要。为了弥补国内对自动化装车行业的缺陷，将激光激光测距仪自动化检测设备与机器人技术相结合，通过对车辆的识别与定位进而来指导机器人进行装车作业，从而实现机器替代工人来完成装车作业，提高装车效率。
技术实现思路
(一)要解决的技术问题：本专利技术要解决的技术问题是提供一种基于激光扫描仪的车辆识别与定位系统，并且控制直角坐标柔性机器人来进行装车作业。(二)技术方案为了解决上述技术问题，本专利技术提供了一种袋状物料装车机器人车辆识别与控制系统，它由以下技术方案实现：一种袋状物料装车机器人车辆识别与控制系统，其包括：二维激光扫描仪、云台传动机构、云台支架、云台零点开关、定距吐包缓存装置、激光对射传感器、行走机构、摆臂机构以及提升机构。本系统通过OpengL进行车厢底座进行三维重建，该传感器通信模式为TCP+HTTP模式；开发平台为VS2010。本专利技术可以将识别系统获取的三维点云进行提取与处理，对车辆进行识别与定位，通过定距吐包装置对输送带传送的水泥包进行排序处理，保证下料的顺序性。通过运动学求解计算出装车机器人到达预订装车起始点以及各个轨迹各伺服电机所需要转动的角度，进而来对机器人进行精确控制，保证装车的顺利进行。本专利技术的有益效果如下：本设备利用R2000倍加福激光扫描仪以360°50HZ对车辆进行测距扫描，扫描识别与定位，精确扫描出车长、车宽与车高，误差在0.1cm以内，对平板车、工程车等不同车辆的卸料位置加以区分，合理安排物料位置，实现有限空间最大化利用，有效的避免了因人工操作而造成的物料安排不合理所导致的空间不合理利用、因路况导致物料掉落等缺陷。另外，控制系统由包括三轴同步移动X方向精确移动机构，Z方向伺服卷帘提升机构，Y方向丝杠平移机构，分别对应了扫描仪所扫描出的车长、车高、车宽进行精确操作。三维立体操作，通过定距吐包装置对输送带传送的水泥包进行排序处理，保证下料的顺序性，更易于控制卸料的位置，从而更容易优化装车工艺。此外，本系统通过OpengL进行车厢底座的三维重建，OpenGL独立于窗口系统和操作系统，是一个开放的三维图形软件包。以它为基础开发的应用程序可以十分方便地在各种平台间移植；OpenGL可以与VisualC++紧密接口，便于实现工业机器人的有关计算和图形算法，可保证算法的正确性和可靠性；OpenGL使用简便，效率高。此外，该传感器通信模式为TCP+HTTP模式，TCP最大的优点是可靠，HTTP协议支持客户/服务器模式，操作起来简单快速，非常灵活。两者结合的通信模式操作简单并且非常可靠。此外，该控制系统的开发平台为VS2010，该平台全面兼容win7、Vista，加入了更多功能更加稳定，不会出现崩溃，编译也不会出错，优化编译，让程序执行起来效率更高，调试过程中的“逐调试”、“断点”等功能稳定且强大，大大缩短调试时间，更加全面的错误提示，并提供几种修改方案，使操作系统更可靠。附图说明本专利技术的目的、特征以及优点根据与附图相关联的以下实施方式的说明会变的更清楚。在该附图中：图1是机器人车辆识别与控制系统扫描和识别结构图；图2是机器人车辆识别与控制系统结构图；图3是机器人车辆识别与控制系统控制、识别、开始停止结构图；图4是机器人车辆识别与控制系统控制皮带机、滚筒结构图；图5是机器人车辆识别与控制系统控制面板、传感器、开始停止结构图；图6是机器人车辆识别与控制系统识别、传感器结构图；图7是机器人车辆识别与控制系统传感器、控制、开始停止结构图；图8是袋状物料装车机器人机械结构图；图9是扫描算法程序框图；具体实施方式以下，参照附图说明本专利技术所涉及的袋状物料装车机器人车辆识别与控制系统。首先，说明本专利技术的第一实施例所涉及的袋状物料装车机器人车辆识别与控制系统。图2示出本专利技术的第一势力所涉及的袋状物料装车机器人车辆识别与控制系统结构图。本专利技术的第一实施例所涉及的袋状物料装车机器人车辆识别与控制系统的特征在于，具有：袋状物料装车机器人12上的线上拖拽引导装置2，料袋转位装置3，料袋输送皮带机装置4，料袋缓存装置5，料袋挤压整形装置6、料袋精确调整装置7，料袋投放坐标码垛装置8，投放坐标码垛升降摆动装置9，R2000倍加福激光扫描仪10、总控制器11；R2000倍加福激光扫描仪10，其用来扫描待装车辆14的位置及尺寸；车辆识别与定位系统15，与扫描仪10之间用以太网通信；设备的开始、停止与回零系统16，通过动力与编码器专用线缆控制自动装车机器人12的开始、停止与回零；设备报警、急停装置17，与自动装车机器人12通过动力与编码器专用线缆进行交互通信；装车信息控制面板18，通过485通信与工控机进行通信。如图1、图8、图9所示，首先，把袋状物料装车机器人车辆识别与控制系统初始化，初始化完成之后等待待装车辆14进入等候区域，车辆进入等候区域之后R2000倍加福激光扫描仪13开始扫描，扫描数据以以太网通信传输到工控机的车辆识别与定位系统15，系统读取第一标定点距离D，按照协议读取顺序距离点d1，如果D减去d1大于m，则记录x1，如果D减去d1小于m，继续进行判断。按照笛卡尔坐标特征读取d2，如果D2减去d2大于n，则记录x2，如果D2减去d2小于n，继续判断。启动云台转向90度运动，读传感器初始位置的距离，根据编码器的角度实时求解d3，以及根据激光扫描仪的度数求解Y1，如果D减去d3大于k，则记录Y1，如果D减去d3小于k，继续判断。同上所述记录Y2,输出车辆位置、大小坐标。操作人员对扫描数据进行判断，如果正确则开始让工控机进行数据处理，如果错误重新扫描数据重复扫描之后的步骤，不再累述。如图3、图9所示，当工控机数据处理完成之后，在装车信息控制面板18输入车辆类型、装车吨数和行包数，点击装车信息控制面板18上的开始装车按钮，将数据通过485通信传输到工控机上。然后，设备的开始、停止与回零系统16启动自动装车机器人12上的料袋投放坐标码垛装置8上的定位电机，自动装车机器人12运行到初始装车位置。如图4、图8所示，自动装车机器人12运行至初始位置后通过动力与编码器专用线缆与设备的开始、停止与回零系统16进行通信，其控制自动装车机器人12上的开始工作铃发出响声，然后袋状物料装车机器人12上的线上拖拽引导装置2，料袋输送皮带机装置4，料袋缓存装置5，料袋挤压整形装置6、料袋精确调整装置7开始运行。如图5、图8所示，当物料传送到自动装车机器人12的小摆臂，其上的计数器一开始计数通过动力与编码器专用线缆与工控机的控制面板通信，数量显示到控制面板上。物料进入自动装车机器人12的料袋缓存装置5后，其上的激光对射计数器二感应物料11开始计数，通过动力与编码器专用线缆与工控机的控制面板通信，数量显示到控制面板上。自动装车机器人12的缓存伺服电机快速旋转额定脉冲，吐出物料，并且计数，当计数器满足匹数，缓存停止，等待。物料进入下滑道，激光对射传感器三，等待物料，当物料从中间经本文档来自技高网...

【技术保护点】
一种袋状物料装车机器人识别与控制系统，其特征在于:包括车辆扫描定位系统，所述车辆扫描定位系统包括伺服电机、零点开关、云台支架、安装板、R2000倍加福激光扫描仪，所述的控制系统由包括三轴同步移动X方向精确移动机构、Z方向伺服卷帘提升机构、Y方向丝杠平移机构以及顺序下包感应机构组成，每一部运动装置都能带动装车机器人末端执行器的落包点的XYZ三个方向的移动，感应袋状物料的传感器位于下料口、缓存装置口和下滑道末端。

【技术特征摘要】
1.一种袋状物料装车机器人识别与控制系统，其特征在于:包括车辆扫描定位系统，所述车辆扫描定位系统包括伺服电机、零点开关、云台支架、安装板、R2000倍加福激光扫描仪，所述的控制系统由包括三轴同步移动X方向精确移动机构、Z方向伺服卷帘提升机构、Y方向丝杠平移机构以及顺序下包感应机构组成，每一部运动装置都能带动装车机器人末端执行器的落包点的XYZ三个方向的移动，感应袋状物料的传感器位于下料口、缓存装置口和下滑道末端。2.根据权利要求1所述的一种袋状物料装车机器人识别与控制系统，其特征在于，控制系统通过以太网将扫描系统获取的电机角度以及距离点数据通过极坐标系与笛卡尔坐标系的转换来判断车辆的位置。3.根据权利要求1所述的一种袋状物料装车机器人识别与控制系统，其特征在于，运动控制系统上位系统由工控机、端子板、IO扩展板、235-422转换器、触摸屏、液晶显示器、24V开关电源和滤波器组成。4.根据权利要求1所述的一种袋状物料装车机器人识...

【专利技术属性】
技术研发人员：董国强，王凯，
申请(专利权)人：烟台博特自动化设备有限公司，
类型：发明
国别省市：山东,37