一种采摘机器机械手控制系统设计.docVIP

一种采摘机器机械手的控制系统设计 　　摘要：水果采摘费用高且劳动量大，为快速且正确完成采摘作业，需要加快研发采摘机械手设计。本文以苹果采摘机械手运动控制为研究对象，对机械手进行运动学分析与建模，设计并实现了基于PLC的苹果采摘机械手运动控制的实验系统，可为其他类型采摘机械手设计提供一定参考作用。 　　关键词：机械手运动控制；建模；设计 　　引言 　　随着社会经济的快速发展，农业生产正朝着规模化、多样化、精确化方向发展，农业劳动力的成本迅速上升，劳动力不足的现象日趋明显，在此背景下，机器人技术越来越受到了人们的关注。但是，目前国内的采摘自动化程度仍然很低，尤其是采摘机器人的关键部位――机械手，为此，本文以PLC 控制器作为控制中心，对苹果采摘机械手运动控制系统进行设计，旨在提高采摘自动化及降低人工成本，为种植户带来最佳的经济效益。 　　1.苹果采摘机械手运动控制系统整体设计 　　1.1运动控制系统设计要求 　　苹果采摘机械手包括手臂和手腕两个执行部分，机械手准确采摘目标果实，需要灵活的避开途中障碍物，而实现该功能需要依靠机械手的自由度。一般情况下，采摘机械手运动范围取决于手臂自由度，为了使机械手灵活、运动范围大，手臂至少需要3个以上自由度。同理，采摘机械手手腕是用来控制机械手空间姿态的，为了使其获取更多运行姿态，手腕也至少需要3个以上自由度。 　　苹果采摘机械手运动控制系统先从上位机或人机交互界面接受指令，然后驱动对应伺服电机，从而使末端采摘执行器准确采摘目标苹果。 　　1.2运动控制系统整体设计 　　苹果采摘机械手运动控制系统主要包括上位机监控系统、PLC控制器，以及驱动、执行部件和传感器多个模块。上位机监控系统通过串口、以太网采集机械手的数据，获取机械手状况，完成与现场数据的实时交换，实现对系统的监控功能；运动控制模块通过程序或终端的指令对机械手实现控制，保证其末端执行器以确定状态运动，同时能够完成采摘任务；驱动模块根据程序指令给各电机提供动力；执行模块主要是完成苹果采摘作业。运动控制系统整体框架如图1所示。 　　苹果采摘机械手运动控制系统由以上各模块协调工作，共同完成采摘作业任务。系统采用PLC可编程逻辑控制器，通过其执行逻辑运算、顺序控制、定时及计数等操作，并通过外部控制开关、按键接入PLC 输入设备，进而根据内部程序进行输出控制，实现对驱动、伺服和气动设备的控制。在运动控制中，采摘机械手位置状况信息通过组态软件实时显示，操作员可以实时了解其作业情况。 　　2.机械手运动学分析与建模 　　苹果采摘机器人运动学分析的基础是在正确选择机械手刚体位姿方法上进行的。本文采用齐次变化方法描述机器人运动学问题，需要建立XAYAZA参考和XTYTZT手爪两个坐标系。在参考坐标系中，Z轴是末端执行器接近目标苹果的方向，为接近矢量a；Y轴是末端执行器两手指的并和方向，为并和矢量o；X轴是a和o所在平面的法线向量，为法线矢量n。因此，手爪坐标系XTYTZT可由{n，o，a；P}进行描述，即{T}={n，o，a；P}。 　　2.1正运动学分析模型 　　本文采用D-H法建立末端执行器空间运动坐标系，用齐次变换矩阵表述机械手连杆间平移和旋转运动，从而建立运动学方程。为了方便计算，特地将机械手基准与腰关节两个坐标系叠加在一起。 　　式（5）～式（7）为机械手末端执行器正运动学方程，其描述了机械手坐标系与基准坐标系之间的位姿关系。 　　2.2 逆运动学分析模型 　　逆运动学是研究机械手运动控制的理论来源，是将机械手位姿变换转为关节变量的依据，逆运动学对控制精准度和快捷性具有重要作用。苹果采摘机械手的相邻关节轴之间平行，经过系统整体优化，各关节角运动范围固定，可以得出唯一解。为了简化计算过程，提高机械手运动效率，本文采用解析法对苹果采摘机械手进行逆运动学求解。苹果采摘机械手逆运动学求解过程如下： 　　根据式（2）可以得到末端执行器变换矩阵的逆矩阵为 　　3.运动控制硬软件设计 　　3.1硬件设计 　　该机械手控制系统主要由PLC、监控图像管理、触摸屏、行走电机驱动板、执行机构电机驱动板和伺服电机组成。整个控制系统采用三菱公司FX2N-48MT-DPLC控制器，该处理器具有40个I/O端子（24个输入点、16输出点），点数余量充足，系统采用编程语言简单，开发周期短。因此，PLC控制系?y比较稳定，可靠性强、费用低、抗干扰性强。监控图像管理系统采用Windows操作系统、PCI总线、单屏操作方式，并融合了图像通信技术，可以实现对图像的输入输出、图像文件的存储与加载，以及对机械手的监测和控制；触摸屏控制器的作用操作员可以人为控制机械手进行采摘作业，能够准确地控制机械手的运行速度和距离；行走电机驱动板和执行机构电机