09-10四自由度码垛机器人控制系统设计.doc

四自由度码垛机器人控制系统设计一、四自由度码垛机器人简介随着科技工业自动化的发展,,后道包装机械作业使用一些成套设备不仅效率提高几十倍,生产成本也降低了。其中四自由度码垛机器人每天自动对1000箱食品进行托盘处理,这些码垛机器人夜以继日地工作,从不要求增加工资。码垛机器人的应用越来越广。码垛机器人配备有特殊定制设计的多功能抓取器,不管包装箱尺寸或重量如何,机器人都可以使用真空吸盘牢固地夹持和传送包装箱。如图1所示,四自由度码垛机器人本体由腰部、大臂、小臂、腕部组成。腰部大臂小臂腕部图1码垛机器人简图如图2所示,码垛机器人具有独特的线性执行机构,使其保证了手部在水平与垂直方向的平行移动。无耦合垂直线性运动无耦合水平线性运动图2码垛机器人的线性执行机构运动示意图此四自由度码垛机器人的应用案例如图3所示。具有示教作业简单,现场操作简便。只需对抓取点与放置点进行示教,最优轨迹规划自动由控制器生成。图3码垛机器人的应用案例二、四自由度码垛机器人控制要求及其控制方案1、控制要求如图1所示,四自由度码垛机器人的运动主要由控制腰部、大臂、小臂、腕部的驱动电机实现。在此均采用松下A5伺服电机;抓取部件等其他辅助运动采用气动,由电磁阀动作来控制抓取部件的动作。四自由度码垛机器人的运动控制系统主要包括感知部分、硬件部分和软件部分,其运动控制系统的主要任务是要控制此机器人在工作空间中的运动位置、姿态和轨迹以及作业流程等。此外,还要求:1)防碰撞检测和在线编程控制,可以进行离线仿真;2)人机界面友善、高度可靠作性和安全性;3)便携式触摸屏示教器、全中文界面;4)利用使能开关双电路设计使在紧急状态下自动切断伺服动作,从而保证安全。2、控制方案控制方案1:基于PLC的运动控制方案基于PLC的机器人运动控制系统,一般利用触摸屏进行人机交互。在触摸屏上的人机界面,由组态软件编写人机操作界面实现人机交互;PLC则通过I/O模块与码垛机器人以及现场设备通信并实现控制,通过接受PLC的控制命令,实现机器人及其周边、物流设备的启停与协调,同时将码垛机器人及其周边、物流设备的运行状态返回给PLC。控制方案2:基于嵌入式PC的运动控制方案基于嵌入式PC的运动控制模式,实现控制系统的模块化,同时又兼具开放性,可通过调用驱动器的基本功能函数在嵌入式PC上编程来实现机器人的复杂控制算法。图中运动控制器实现对电机的基本控制,包括插补,控制加减速等。嵌入式PC主要完成对运动控制器的控制,实现复杂的运动控制算法和人机界面。码垛机器人轴数:4轴(即4个伺服电机,分别是3个750W,型号MSMJ082G1U,一个400w,型号MSMJ042G1U)伺服系统选择日本松下A5系列电机和配套驱动器。工控机选用工业以太网口嵌入式工控机。控制软件系统整体需求:首先需要实现的机器人在运动空间内实现单关节,单电机驱动,也就是能够实现关节空间的单轴运动;同时还需要实现在笛卡尔坐标系中X轴、Y轴和Z轴的单轴运动。这些基本的运动能作为示教编程的基础。然后需要实现示教编程功能,要实现示教编程,需要保存机器人的当前位置状态信息,利用机器人的运动学方程及轨迹规划算法来实现空间直线和空间圆弧的运动。最后要实现离线编程功能,则需要利用虚拟现实技术用计算机来模拟真实的机器人和工作环境。通过对