Festo 六轴工业机械手结构设计及控制系统二次开发
Festo 六轴工业机械手结构设计及控制系统二次开发,Festo,六轴工业机械手结构设计及控制系统二次开发,工业,机械手,结构设计,控制系统,二次开发
毕业论文(设计)题目名称: Festo 六轴工业机械手结构设计 及控制系统二次开发所 在 学 院 : 专业( 班级): 学 生 姓 名 : 指 导 教 师 : 评阅人: 院 长 : Festo 六轴工业机械手结构设计及控制系统二次开发总计:毕业论文表格插图摘要工业机器人是集机械、电子、控制、计算机、传感器、人工智能等多学科先进技术于一体的现代制造业重要的自动化装备。目前,工业机器人主要承担着强干扰恶劣环境中重复性并且劳动强度极大的工作。本文通过对六轴工业机械手相关技术的学习和研究,完成六轴工业机械手的结构设计及控制系统的二次开发。首先是拟定出六轴工业机械手整体结构的设计方案并展开设计,具体是确定机械手各关节轴的轴长尺寸、利用 SolidWorks 绘制机械手的关节轴零件及其装配图。其次重点研究伺服驱动系统,具体完成 C 代码的 PID 闭环控制传递函数。最后结合实验室 Festo 六轴工业机械手,在熟悉控制程序设计及调试操作的基础上对其二次开发。具体开发内容是结合不同末端执行器完成分类搬运、弧焊轨迹模仿和执笔作画等开发任务。机器人技术属于具有前瞻性、战略性的高技术领域。机器人作为智能制造的重要体现,其技术水平直接反映工业自动化程度。开展结构设计和动作的控制系统开发, 可培养分析问题、解决问题能力和机电综合设计能力,有一定的创新性和设计实践意义。关键词:六轴机械手;结构设计;控制系统;二次开发IIABSTRACTIndustrial robots are an important automated equipment for modern manufacturing, integrating mechanical, electronic, control, computer, sensors, artificial intelligence and other multi-disciplinary advanced technologies. At present, industrial robots are mainly responsible for strong interference with harsh and repetitive tasks and labor-intensive work.In this paper, through the study and research on the relevant technology of the six-axis industrial manipulator, the structural design of the six-axis industrial manipulator and the secondary development of the control system are completed. The first is to develop a design plan for the overall structure of the six-axis industrial robot and to develop a design, specifically to determine the axial length of each joint axis of the manipulator, use SolidWorks to draw the joint axis parts of the manipulator and its assembly drawings. Secondly, we will focus on the servo drive system and complete the PID closed-loop control transfer function of the C code. Finally, in combination with the laboratory Festo six-axis industrial robot, it is secondarily developed after familiar with the control program design and debugging operations. The specific development content is the combination of different end-effectors to accomplish the tasks of classification and handling, arc welding track simulation and pen painting.Robotics is a forward-looking and strategic high-tech field. As an important embodiment of intelligent manufacturing, the robots technical level directly reflects the degree of industrial automation. The development of control systems for the development of structural designs and actions can foster analytical problems, problem solving capabilities, and comprehensive electromechanical design capabilities, with certain innovation and design practical significance.Keywords: six-axis manipulator ; structure design ; control system ; secondarily developedFesto 六轴工业机械手结构设计及控制系统二次开发目录摘要IABSTRACTII1 绪论11.1 工业机器人国内外发展现状11.2 工业机器人发展趋势21.3 课题设计的主要内容32 六轴工业机械手整体结构设计42.1 机械手的设计参数42.2 机械手的传动方案52.3 基本模型的参数化设计62.4 伺服电机和减速器的选型计算83 六轴工业机械手控制系统设计133.1 控制系统的硬件结构133.2 机械手的伺服控制系统143.3 基于 C 语言实现的闭环控制算法164 基于 Festo 六轴工业机械手的二次开发204.1 Festo 六轴工业机械手204.2 工件夹持任务开发224.3 焊枪弧焊轨迹模仿任务开发304.4 执笔作画任务开发355结论42参 考 文 献43致谢45附录:外文翻译46附录:外文原文50附录:工件夹持代码56附录:焊枪弧焊轨迹代码60附录:执笔作画代码62 - I - 1 绪论机械手在工业上应用越来越广泛,工业 4.0 的重要环节之一是确保加工前后序环节的自动化,六轴工业机械手高度自动化机器,在工业生产中能代替人做某些单调、频繁和重复的长时间作业,或是危险、恶劣环境下的作业。由于工业机器人具有一定的通用性和适应性,能适应多品种中、小批量的生产,成为柔性制造单元或柔性制造系统的组成部分。 然而,国外已经研制和生产了各种不同的标准组件,工业机器人技术远远超越我国,作为制造大国,应在工业机器人领域自力更生,创新进取。1.1 工业机器人国内外发展现状工业机器人自动化生产线成套设备已成为自动化装备的主流及未来的发展方向。各国都对工业机器人的研究和开发做大量投入,工业机器人技术得到突飞猛进。国外概况:国外的工业机器人研究概况优于我国。以智能化为主要方向,美国企 业一方面加大对新材料的研发力度,力争大幅降低机器人自重与负载比,一方面加快 发展视觉、触觉等人工智能技术,如视觉装配的控制和导航。日本产业体系配套完备, 政府大力推动应用普及和技术突破。日本工业机器人完备的配套产业体系,在控制器、传感器、减速机、伺服电机、数控系统等关键零部件方面,均具备较强的技术优势, 呈现出以工业机器人产业优势带动服务机器人产业发展的趋势。德国带动传统产业改 造升级,政府资助人机交互技术及软件开发。通过智能人机交互传感器,人类可借助物联网对下一代工业机器人进行远程管理,机器人还具备生产间隙的“网络唤醒模式”,以解决使用中的高能耗问题,促进制造业的绿色升级。国内概况:中国面临核心技术被发达国家控制等挑战,中国在机器人领域的部分技术已达到或接近国际先进水平。机器人涉及的技术较多,大体可分为器件技术、系统技术和智能技术。中国在通用零部件、信息网络等部分器件和系统技术领域与发达国家的差距在 10 年左右,而对智能化程度要求不高的焊接、搬运、清洁、码垛、包装机器人的国产化率较高。近年来,中国在人工智能方面的研发也有所突破,中国科学院和多所著名高校都培育出专门从事人工智能研究的团队,机器人学习、仿生识别、数据挖掘以及模式、语言和图像识别技术比较成熟。 45 1.2 工业机器人发展趋势随着计算机技术的不断向智能化方向发展,机器人应用领域的不断扩展和深化以及在系统(FMS、CIMS)中的群体应用,工业机器人也在不断向智能化方向发展, 以适应“敏捷制造”,满足多样化、个性化的需要,并适应多变的非结构环境作业, 向非制造领域进军。从优化设计、材料优选、加工工艺、装配技术、专用制造装备、产业化能力等多方面入手,全面提升高精密减速器、高性能机器人专用伺服电机和驱动器、高速高性能控制器、传感器、末端执行器等五大关键零部件的质量稳定性和批量生产能力,突破技术壁垒,打破长期依赖进口的局面。机械结构向模块化、可重构化发展。例如关节模块中的伺服电机、减速机、检测系统三位一体化;由关节模块、连杆模块用重组方式构造机器人整机。工业机器人控制系统向基于 PC 机的开放型控制器方向发展,便于标准化、网络化,控制器件集成度提高,控制柜日见小巧,且采用模块化结构,大大提高了系统的可控性、易操作性和可维修性。(1) 感觉功能:感觉功能方面将实现多传感器信息的融合,以检测多变的外部环境,做出判断和决策,其实质类似于人的五官和身体的综合感觉功能,包括视觉、触觉、力觉、滑觉、接近觉、压觉、听觉、味觉、臭觉、温觉等。研究包括各类传感信息的采集及融合处理、传感器与驱动器一体化技术、感觉功能继承模块等。(2) 控制智能化:由引导教向 NC,离线编程发展,进而发展到进一步应用。随着系统化、集成化生产的发展,基于 PC 的开放式控制系统将机器人控制和车间一级控制的发展方向,国外专家预测,2007 年它将占 30。(3) 移动功能的智能化:为解决长距离搬运作业、大作业对象、多作业对象及极限作业等问题,需开发自主移动系统(包括滑动、滚动、行走、爬行、跳跃、飞行等)。(4) 系统应用与集成化:支持以人为核心的生产系统,实现生产系统中机器人群体协调功能、群智能和多机通讯协议,开发能理解人的意志的“同事机器人”。国外专家预测,2020 以后有可能 IMS 要走向 MA(R)S(多智能体系统),而该系统中的“同事机器人”(Cobot)将成为操作人员不可或缺的伙伴。围绕着各种机器人与人共存的诸多课题,正在兴起一门新学科“软机器人学”。(5) 安全可靠性:由于大量不确定因素的存在,要实现智能化的安全可靠性, 机器人必须具有对各种意外情况的应变能力,及时采取预防措施和安全对策,包括硬件级、软件级、应用级和人机系统级的自诊断和自修复故障。(6) 微型化:向微型化发展,开发毫米级机器人,用于微加工、医学、宇宙和海洋开发等领域。就使用性和成本来看,毫米级最可行。(7) 多传感器信息融合与配置技术:机器人的传感器配置和融合技术在水泥生产过程控制和污水处理自动控制系统中的应用包括面向工艺过程的多传感器融合和配置技术;采用智能传感器的现场总线技术;面向工艺要求的新型传感器研制。机电一体化智能传感器:包括具有感知、自主运动、自清污(自调整、自适应)的机电一体化传感器研究;面向工艺要求的运动机构设计、实现检测和清污的自主运动;调节控制系统;机器人机构和控制技术在传感器设计中的应用。1.3 课题设计的主要内容(1) 了解工业机器人的功能和结构,并提出六轴工业机械手结构方案,为实现方案的可行化程度再进行三维实体设计。机械结构需模块化、可重构化,采用关节模块中的伺服电机、减速机、检测系统三位一体,由关节模块、连杆模块用重组方式构造工业机械手整机。(2) 了解工业机器人运动控制的原理,以用户角度对工业机器人做控制分析, 学习机器人语言,其控制系统要基于 PC 机的开放型控制器,通过嵌入式的实操手柄和电脑无线通讯的仿真上位机进行终端控制。本设计的研究重点在于控制系统的用户开发,基于实验室现有的 Festo 六轴工业机械手,完成设计任务和具体实现。2 六轴工业机械手整体结构设计工业机械手的整体结构设计内容是:基本设计参数,运动形式,整体构型,驱动系统。根据工业机械手的发展现状及趋势,对于六轴工业机械手关节轴的驱动控制系统基本都采用伺服电动机+增量编码器,可形成反馈的闭环控制系统,达到高精度轨迹运作当然还有高精密的减速器,通常采用谐波减速器。六轴工业机械手的整体构型包括腕部、小臂、大臂、腰部、臀部和基座等六个轴,大多数企业的机械手均相类似。本章主要描述工业机械手的参数化设计的方法和重要部件选型的方法。2.1 机械手的设计参数设计六轴工业机械手,首先根据工作任务确定机械手的工作空间,并规划动作, 制定各关节的节拍,分配各动作时间,初步确定各个关键的运动速度。接着确定在工作空间内的各个关节臂的运动行程和臂长等参数。然后根据任务对机械手进行粗略的受力分析确定末端的许用载荷等。本文以 FESTO 的六轴工业机械手为模板做参数设计。如机械手的侧视图和俯视图可大致给出机械手手腕中心点的工作范围,如图 2.1 所示。图 2.1六轴工业机械手工作空间示图参考 FESTO 六轴工业机械手的基本参数,拟定出机械手各关节的运动和物理特性等的基本参数,如下列表各所示。表 2.1 六轴工业机械手运动参数 运动轴 工作范围 最大速度 旋转轴 1 -165 +165 250/s 手臂轴 2 -110 +110 250/s 手臂轴 3 -90 +70 250/s 手腕轴 4 -160 +160 320/s 弯曲轴 5 -120 +120 320/s 旋转轴 6 -400 +400 420/s 表 2.2 六轴工业机械手物理特性 基座尺寸 180 * 180 mm 高度 700 mm 工作范围 580 mm 重量 25 kg 有效载荷 3 kg 2.2 机械手的传动方案选用伺服电机作为各关节的动力装置,电机本身就就被高精度的优点。但关键还是在于输入轴和输出轴之间的齿轮箱。齿轮箱本身就要有传动效率高体积小等等的要求,一般安装在工业机械手的各个关节处。根据常见的六轴工业机械手都采用谐波减速器。六轴工业机械手的齿轮箱的总体设计位置图,如图 2.2 所示。图 2.2 六轴工业机械手齿轮箱的位置注释 1)A-齿轮箱,轴 1(机座内);B-齿轮箱,轴 2;C-齿轮箱,轴 3; D-齿轮箱,轴 4;E-齿轮箱,轴 5;F-齿轮箱,轴 6;对于关节型工业机械手,越靠近起始端的的减速箱越为重要,相互比较,重要程度逐远逊次。始端轴 1 的减速箱输出 1 度的转动,与末端轴 6 的减速箱输出 1 度的转动,带来的运动行程相差得有几倍甚至几十倍。上一级电机作动力源,经减速器齿轮箱减速,将力矩放大,驱动下一级轴臂。轴臂粗大的,臂内的电机与齿轮箱放置比较灵活,齿轮箱可以设计的大小越大,则该齿轮箱的精度和传动比就可以设计得越高。对于较短的轴臂,其电机与齿轮箱紧挨着, 即电机的输出轴直接传入齿轮箱,如轴 1、2、4、6,其中 1、4、6 轴的输出都为旋转。而对于较长的关节轴臂,电机可以安装在离齿轮箱比较远的地方,选用带传动或链传动形式,如轴 3、5。从图中可以看出,越末端的电机和齿轮箱越小。2.3 基本模型的参数化设计根据六轴工业机械手的不同工作任务对其工作空间的不同要求,同一型号的工业机械手通过对各关节轴的伸缩摆动,即可达到工作范围的很大扩展。为了在设计中减轻负担,同型号的工业机械手的结构,选择参数化设计方法,以各关节的轴线在空间中的位置关系构成基础参数。通过各关节轴线相对位置的平移旋转进行调整,实现设计中工业机械手各零部件的尺寸变化,从而拟定出六轴工业机械手各个关节轴线的位置关系,如图 2.3 所示。图 2.3六轴工业机械手各关节轴坐标系根据工业机械手的基本参数则能拟定出机械手各个关节轴线的位置尺寸,那么就可以在三维建模软件上对六轴工业机械手进行整体结构建模,可利用 Solidworks 的测量功能,可得到模型的结构和质量属性等参数,如图 2.4 所示。图 2.4六轴工业机械手的整体结构2.4 伺服电机和减速器的选型计算伺服电机及减速器齿轮箱的选型尤为重要,所选型号要满足机械手正常运作的最大转速 n 和稳定工作的最大力矩 J 的需求。而电机和减速器在不同方式工作时,所选参数亦不同,当周期性工作时,力矩的参数应该采用机械手最大输出的加速力矩。减速器齿轮箱的传动比也是重要的参数。故,一般对机械手的驱动电机与关节轴的齿轮箱一起作选型。 2.4.1 选型方法 首先是转速,为实现低功耗,额定转速为重要参数,实际的转速最好不超过额定转速。如果电机正好处于额定转速的工作时,那么就是机械手关节处于最大转速的时候,其速度可由电机额定转速比上齿轮箱的传动比求得。 其次是转矩,额定转矩也是重要的参数,实际的转矩也最好不要超过额定转矩。结合机械手的结构尺寸和轨迹,受力分析,可计算出承载的最大力矩,应小于减速器齿轮箱输出的力矩,折算至电机输出端,也应小电机额定力矩。由于减速器齿轮箱的传动效率并不是 100%,因此它们所受力矩也存在些差异,它们承受的力矩关系如下式: (2.1) 式中:电机的输出力矩,N m; - 减速器的输出力矩,N m; - 减速器的传动比; - 传动效率; 同理机械手在实际运动的过程中,其实际的加速力矩也不得超过齿轮箱的最大输出力矩,再根据齿轮箱的传动效率,可算出电机的实际加速力矩,这个加速力矩也不得超过电机的额定加速力矩。 最后是惯量匹配,电机自身惯量与负载自身惯量符合一定比例称之为惯量匹配。惯量是否符合匹配要求,通过惯量比的大小来看,一般电机转子的惯量作为分母,负载的惯量作为分子,以 表示,如下式: (2.2) 式中:电机的许用惯量比; - 电机转子转动惯量, ; - 负载转动惯量, 。 根据设计经验 的值应尽量小于 10 则算是匹配,假设 与 不匹配,动量传递会出现激烈的冲撞;根据下式分析。 ( ) (2.3) 式中: - 电机转矩,N m; - 负载转矩,N m; - 电机转子转动惯量, ; - 负载转动惯量, 。 - 角加速度; 在一个工作任务中 电机转矩和 负载转矩通常不变,而电机一旦选定确认后, 电机转子转动惯量则也为定值。故,若想 负载转动惯量变小,则 角加速度就要加大。 2.4.2 六轴工业机械手末端轴 6 的电机及减速器的选型计算 末端轴所承受的外力主要由末端执行器和工件产生,其中占主要的还是末端执行器。当末端轴带动末端执行器和工件旋转时,承受的阻力矩有负载转矩和摩擦力矩, 而摩擦力矩过小可忽略不计。在此先计算工件的转动惯量,再计算末端执行器的转动惯量。 首先计算工件的转动惯量,设工件为长 a、宽 b、高 h 的矩形体, 图 2.5 方形工件 工件绕其质心轴线旋转时,根据转动惯量公式: ( + )1 ( + ) (2.4) 1 ( + )1 可根据实际任务,可给工件一个具体尺寸:a = 0.05m,b=0.05m,h=0.05m 即正方体,工件质量 m=1kg,那么三个质心轴线的转动惯量值一样。故,公式(4)可简化为: (2.5) 6式中的 i 为任意轴向。因为工件被抓取过程中主要绕其质心 y 轴旋转,所以 X, Z 轴的转动惯量可以不计,将数据带入(5)中计算得到: 件 61 0.05 6 4.17 104 kg 接着计算末端执行器的转动惯量,由于末端执行器的结构较为复杂,不像工件为矩形体或圆柱体,具有公式计算。在此利用 Solidworks 软件的测量功能得到末端执行器的转动惯量,同理只考虑取末端执行器 y 轴的转动惯量: 具 13.93 104 kg 然后将末端执行器的转动惯量与工件转动惯量相加可得末端轴的负载惯量: 末 件 具 18.1 104 kg 假设执行的任务需要末端轴在 0.1 秒内到达的最高转速为: 7 末 3 70 则转轴在 0.1 秒内的瞬间角加速度为: 末 末 7 30.1703 随着加速度的产生,负载也会相对应产生一个惯性力矩,并与成正比: 末 末 末 18.1 104 703 0.14 N m 最后将上诉所计算的值带入电机及减速箱的选型方法的折算公式中,根据所选减速器齿轮箱的传动比返求验算,则可简完成末端轴的电机和减速器的选型。 2.4.3 六轴工业机械手轴 1、4 的电机及减速器的选型计算 轴 1 的电机及减速器输出转矩为其他各个轴再加上末端执行器及工件的转矩总和。轴 4 的电机及减速器输出转矩为轴 5、6 再加上末端执行器及工件的转矩总和。它们结构复杂,难以精确计算出转动惯量。但可直接利用三维建模软件的测量功能, 将三维模型分别拟动为对轴 1、4 产生最大的转动惯量位置,展开测量得: 轴 1 0.837 kg 轴 4 0.023 kg 假设执行的任务需要轴 1、4 在 0.1 秒内到达的最高转速为: 4 轴 1 轴 4 353 40 50 则两转轴在 0.1 秒内的瞬间角加速度为: 轴 1轴 4 轴 1 轴 4 4 30.1 5 30.1403503 随着角加速度的产生,负载也会相对应产生一个惯性力矩,并与角加速度成正比,可求出惯性力矩: 轴 1 轴 1 轴 1 0.837 轴 4 轴 4 轴 4 0.023 40 35.06 N m 350 1.21 N m 3最后将上诉所计算的值带入电机及减速箱的选型方法的折算公式中,根据所选减速器齿轮箱的传动比返求验算,则可简完成轴 1 和轴 4 的电机及减速器的选型。 2.4.4 六轴工业机械手 2、3、5 轴的电机及减速器的选型计算 首先结合工业机械手的设计参数,将机械手至于各轴关节受静态力最大的位置及姿态,如下图 2.5 所示: 图 2.6末端执行器伸直最远处图 2.7平面平衡分析计算轴 2 的输出静态转矩,将六轴机械手分成两个部分,其中轴 1、2 为固定不变的第一整体,轴 3、4、5、6 和末端执行器 7 为另一个固定的第二整体。第二整体的重心大致位于 的中点处,利用三维建模软件的测量功能,测得第二整体的质量为17.74 kg。要想机械手实现静态力矩平衡,则可算出关节的输出力矩如下: 2 4 6 754 10 17.74 9.8 65.54 N m 2计算轴 3 的输出静态转矩,将轴 1、2、3 视为固定不变的第一整体,轴 4、5、6和末端执行器 7 视为另一个固定的第二整体。第二整体的重心大致位于 的中点处, 利用三维建模软件的测量功能,测得第二整体的质量为 10.04 kg。要想机械手实现静态力矩平衡,则可算出关节的输出力矩如下: 2 4 6 484 10 10.04 9.8 23.81 N m 2计算轴 5 的输出静态转矩,将轴 1、2、3、4、5 视为固定不变的第一整体,轴 6和末端执行器 7 视为另一个固定的第二整体。第二整体的重心大致位于 的中点处, 利用三维建模软件的测量功能,测得第二整体的质量为 2.87 kg。要想机械手实现静态力矩平衡,则可算出关节的输出力矩如下: 2 6 182 10 2.87 9.8 2.56 N m 2最后将上诉所计算的值带入电机及减速箱的选型方法的折算公式中,根据所选减速器齿轮箱的传动比返求验算,则可简完成轴 2、轴 3 和轴 4 的电机及减速器的选型。 I/O3 六轴工业机械手控制系统设计本章对六轴工业机械手的通用控制系统展开设计,主要是机械手的伺服驱动系统的设计。通过理论分析,将驱动控制系统理论算法转换为具体的实用算法,根据设计框图,利用 C 语言简单易懂的特性,设计出 PID 闭环控制传递函数。 3.1 控制系统的硬件结构工业机械手控制器其核心大脑,运行着各种复杂运算算法,其内核时钟基本要上 G 级别,处理着各种输入信号的同时,也输出各种控制信号。首先是编程示教器将各程序命令传入主机中,与主机直接通讯,构成人机交互。其次主机在于控制总线上的各个模块进行通讯,各模块包括传感器、伺服驱动模块和其他 I/O 设备,它们各自都有独一无二的总线通讯地址。最后终结于伺服驱动系统对伺服电机的闭环控制,实现机械手的运作,它们共同构成了工业机械手控制系统的硬件结构,如下图 3.1 所示: I/O图 3.1 工业机械手控制系统的硬件结构 CPU 主机配备 RTOS,具有多线程、实时性和稳定性。数据存储、信息打印、信息处理显示、监控信息显示,数据二次利用等等,关键在于机械手运动学的实时计算, 规划轨迹。机械手的末端执行器的位置及姿态由多个关节的运动合成,比如末端执行器走一个直线,需要各个轴的运动配合,有的轴加速,有的轴不用动,这些都有建立数学模型和智能算法来实现。 示教器编写程序时,要用到机器人语言,其示教方式主要分为实际示教法和不实际示教法。机械手运作的示教信息大概可分为三部分:顺序信息、姿态与位置信息和作业条件及动作信息。 3.2 机械手的伺服控制系统对机械手实际运作中的末端位姿进行实时监测是很困难的。为提高控制精度,机械手的电机控制必须选择闭环的方式去控制,而常用的闭环控制为 PID。有些机械手的控制器将驱动集成在伺服电机中,控制效果好,制造成本低。还有些控制器利用电机驱动实现电流、电压和速度闭环,完成机械手位置控制,如下图 3.2 所示: 图 3.2 机械手闭环伺服控制系统 假设电机驱动与伺服电机的动力学函数为: ( ) ( ) () () (3.1) 式中: ( )-电机控制电压; ()电机转角; ()干扰信号; -电机转动惯量; -有效阻尼。 3.2.1 PD 控制系统 在位置式闭环控制系统中常用 PD 控制器作为控制系统,其系统框图如下:图 3.3 PD 控制器 这时,电机的输入控制量是: ( ) ( )( ( ) ( ) (3.2) 式中: ( )-目标角度值。 -比例项系数。 -微分项系数。 由于干扰信号 ()的存在,则闭环系统可写为: ( ) + ( )1 () (3.3) ( )式中的 1()为特征多项式: ( ) 1() ( ) (3.4) 式(3.4)为二阶系统,主要参数有 阻尼系数以及 固有频率: + 2 2 (3.5) 一般 阻尼系数的值为 1, 和 作为 PD 闭环的重要参数,调节参数使之稳定。那么 PD 系统的跟随误差为: ( ) ( ) ( ) + ( )1 () (3.6) ( )( )如果系统产生阶跃信号 ( ) 和一个固定干扰信号 ,利用终值定理得到控制环的稳态误差为: m () (3.7) 可见当 增大时,稳态误差则会变小。 3.2.2 PID 控制系统 为消除静态温差,对 PD 系统进行改良,增加积分项,即 PID 控制系统,其控制框图如下:图 3.4 PID 控制器 则闭环系统可写为: ( ) + + ( ) () (3.8) ( )( )式中 为积分项系数,那么其特征多项式: () ( ) (3.9) 利用劳斯判据来判断系统是否处于稳定状态,系统增益不为负数,并且符合下式条件: ( + ) (3.10) 3.3 基于C 语言实现的闭环控制算法对于电机而言,只有扭矩、转速和转动方向等基本参数。如果给电机的转轴加上一个指针,那么指针的方向可以是任意的,在经过一段时间的转动后电机停止,根本就不知道指针的所指的方向。从这个角度分析,将电机的转动分为大于一周以上和在一周之内。 图 3.5 单关节控制反馈框图 3.3.1 增量式 PID 控制 增量式 PID 控制对应的是增量式编码器作为转轴的状态反馈传感器。增量式编码器并不能确定转轴的位置,当转轴转动一个小角度时,编码器会反馈一个脉冲信号,当转轴转动速度越快则编码器单位时间内反馈的脉冲数越多。一般增量式编码器安装在电机的输出端,因为那里转轴基本上都运行在很多周以上,专门用于检测电机的转速。 根据增量式 PID 控制控制原理,设计实际运用算法,在此利用 C 语言程序进行PID 闭环控制传递函数的算法设计,程序如下: /定义 PID 的比例项系数 P 及参数赋值int speedP = 21; /定义 PID 的积分项系数 I 及参数赋值int speedI = 16; /定义 PID 的微分项系数 D 及参数赋值int speedD = 0; /目标速度 int My_speed = 0; /全局变量,上一次的偏差 long int ierror1; /全局变量,上上一次的偏差 long int ierror2; /全局变量,上一次的速度控制量 long int oldspeedPWM; /增量式 PID 闭环控制系统的传递函数long int speedPID(int speed) /定义计算的中间变量 long int ierror,P,I,D, speedPWM; /计算当前偏差ierror=My_speed-speed; /计算积分项I=speedI*ierror; /计算比例项P=speedP*(ierror-ierror1); /计算微分销 D=speedD*(ierror-ierror1-ierror1+ierror2); /上次偏差存为上上次偏差 ierror2=ierror1; /当前偏差存为上次偏差 ierror1=ierror; /计算出当前速度控制量 speedPWM=oldspeedPWM+P+I+D; /当前控制量存为上次控制量 oldspeedPWM=speedPWM; /对当前速度控制量限幅 if(speedPWM7500) speedPWM=7500; if(speedPWMyoujixian_servo) newplace=youjixian_servo; if(newplacezuojixian_servo) newplace=zuojixian_servo; /返回位置控制量 return newplace; 参数调节原理同增量式 PID 一样。 4 基于 Festo 六轴工业机械手的二次开发利用控制柜 IRC5 和机械手留有的用户接口,在示教器上编写用户代码,就是对机械手控制系统的二次开发。接口的使用根据不同设计任务选用,配套的编写对应开发程序。 末端执行器的机械接口尤为重要,而我们通常说的工业机械手其实是不包含末端执行器的,六轴工业机械手的六个轴是其机械结构的最基本形式,而这个机械结构在随着机械手的不断发展,各家的设计基本都大同小异,机械手的基础参数性能逐渐模块化,全球化。 对机械手进行开发就是安装在手腕上的不同末端执行器。目前所出现的末端执行器可谓是五花八门,千型百态。工业机械手除了提供安装接口外,还提供了电子接口和液气压源接口,目的就是供给需要电气控制的末端执行器。 根据工业任务的不同,同一型号的机械手可能换接着不同末端执行器。接下来本章将对六轴工业机械手使用到不同的末端执行器做不同的任务做简单的开发。 4.1 Festo 六轴工业机械手根据设备条件,以 Festo 六轴工业机械手的控制系统为平台开发。其控制系统硬件主要由 IRC5 控制器、一个六轴工业机械手和手持示教器 Flex Pendent 三部分组成。如下图 4.1 所示: 图 4.1 六轴工业机械手系统图 手持示教器 Flex Penden 是集离线编程、监控、手动操纵、参数配置等于一身。是整个六轴工业机械手系统软件运行的平台,可用其进行编程调试。大部分的操作均由手持示教器的点触屏幕上实现的,手持示教器上留有常用的快捷按键开关,其中有4 个按键供任务开发。如下图 4.2 所示: 图 4.2 手持示教器 图中:1-连接器;2-点触屏;3-紧急停止按钮;4-控制遥感;5-USB 端口;6-三位使动装置;7-触摸笔;8-重置按钮;A-D-预设按键;E-机械单元;F-运动模式 1, 重定向或线性;G-运动模式 2,轴 1-3 或轴 4-6;H-增量模式;J-上一步按钮。按下此按钮,可使程序后退至上一条指令;K-运行按钮,开始执行程序;L-下一步按钮, 按下此按钮,可使程序前进至下一条指令;M-停止按钮,停止程序执行。 控制器 IRC5 分驱动模块和控制模块,两者装在一个柜中。驱动模块包括机械手伺服电机供电的全部电子设备,最多附有 9 个单元驱动。除了能处理六个电机外,还可以再附加三个电机。控制模块执行操作机械手所需的全部软件,即 Robot Ware 操作系统。控制柜上外引出许多通讯接口和控制端子供开发者使用,如下图 4.3 所示: 图 4.3 控制柜 IRC5 部分接口图 六轴机械手作为控制对象,实体内包含六个伺服电机,同时也带有六个编码器、阻尼开关和类似陀螺仪的角度姿态传感器等等传感器。为满足控制要求,机械手都引出它们的接口,与控制柜的接口通过电缆相连,实现机器人的基本运作。为了使机器人的末端执行器种类增加,机械手还留有供末端执行使用的若干电气接口,其中包含10 路电信号接入接出引脚和 4 路气压管接入接出口。如图 4.4 所示: 图 4.4 机械手部分接口图 注释 1)A-10 路电信号接口;B-4 路气压管接口; C-机械手内传感器读写接口;D-伺服电机及编码器接口。 4.2 工件夹持任务开发任务:六轴工业机械手夹取 A 位置高度不同的黑色或白色端盖,并按颜色分类, 白色夹至 B 位置,黑色夹至 C 位置。使用的末端执行如下图 4.5 所示: 图 4.5 末端工件夹具 控制分析:首先判断 A 位置是否有端盖,安装光电对管判断,当有端盖时,传感器反馈高电平接入 I/O 引脚,则读取值为 1,反之,读取值为 0;夹取动作由一 I/O 口引脚的输出功能控制电磁阀,再由电磁阀控制末端执行器气缸夹具。不同高度的端盖需要利用测距传感器,将距离转化为电压模拟量,经 AD 采集判断机械手每次下降的高度,实现灵活改变。端盖的黑白,由安装在夹具上的光电传感器的判断,当端盖为白色时,传感器反馈高电平接入 I/O 引脚,则读取值为 1,反之,读取值为 0; 4.2.1 夹具的气路驱动控制设计及气压计算 此任务所用的末端执行器是以气缸为执行元件的工件夹具,通过此夹具可实现工件的位移和旋转,同时夹具上还要安装一些光电管和红外传感器可作为测距和判断黑白颜色等。那么就需要用到机械手的用户接口,在此选用两路气压管接口和四路信号接口。以气缸为动力原件的夹具,驱动原理很简单,气路简图如下所示: 图 4.6 末端执行器气路驱动简图 利用两个反向的气缸,推杆上固定着夹子的半边,当两气缸推杆同时伸出时,夹子即打开。当两气缸推杆同时缩回时,夹子即关闭。这两种状态的切换,是通过改变气缸通气口内气体的流向,电磁阀的右位工作和左位工作,分别对应夹具的两种状态。 图 4.7 工件受力分析图 计算气压源压强的最小值 P_min,拟定气缸内推杆的受力横截面积为 A = 10mm * 10mm 的正方形,要夹持的方块质量为 m = 1 kg。可查方块表面摩擦系数 f = 0.15。如右图受力分析得到方程组如下式: 2 夹 夹 简化计算,可得气压源压强的最小值为: 2 1 9.82 0.15 1 104 0.327 通常在实验室里的气泵基本额定输出 7 MPa 的压强。 4.2.2 控制柜 IRC5 选择外设及其接口 控制柜 IRC5 仅提供通信接口和对工业机械手的控制接口,对于任务中外加的传感器并没有留出接口。在实际生产制造中,往往给控制器增加外设,如单片机,PLC 和 PC 端电脑等。尤其是遇到信息量特别大的传感器是,外设的处理速度采要求极高, 这样不仅减轻了控制器的负担,而且更有利于系统的开发设计。 图 4.8 外设的开发思路 本次采用 DSQC651 标准 I/O 开发板最为控制器 IRC5 的外设 I/O 单元,DSQC651 微处理器内有一个 DeviceNet 网络总线通讯模块,控制柜与 DSQC651 微处理器之间利用 DeviceNet 网络总线进行通信,将用到的传感器接在 DSQC651 开发板上,通过DSQC651 处理传感器信号,实现复杂算法,将计算的结果,通过 DeviceNet 网络总线发送到 IRC5 控制柜,比如发送的信息直接是机械手下一步要移动至的坐标信息。开发板和传感器所需要用到的电源由控制柜提供,并且开发板留有固定装置,可固定在控制柜 IRC5 的附近。其中 DSQC651 标准 I/O 开发板的端口使用参数如下: 图 4.9 外接 651 标准 I/O 开发板 图中:A-数字输出信号指示灯;B- X1 数字输出接口;C- X6 数字输出接口;D- X5 是 DeviceNet 接口;E- X3 数字输入接口;F-模块状态指示灯;G-数字输入信号指示灯。 表 4.1 板上普通端子引脚信息参数 X1 端子编号 使用定义 地址分配 X3 端子编号 使用定义 地址分配 1 OUTPUT_CH1 32 1 INPUT_CH1 0 2 OUTPUT_CH2 33 2 INPUT_CH2 1 3 OUTPUT_CH3 34 3 INPUT_CH3 2 4 OUTPUT_CH4 35 4 INPUT_CH4 3 5 OUTPUT_CH5 36 5 INPUT_CH5 4 6 OUTPUT_CH6 37 6 INPUT_CH6 5 7
收藏
编号:1706295
类型:共享资源
大小:2.84MB
格式:ZIP
上传时间:2019-11-03
30
积分
- 关 键 词:
-
Festo
六轴工业机械手结构设计及控制系统二次开发
工业
机械手
结构设计
控制系统
二次开发
- 资源描述:
-
Festo 六轴工业机械手结构设计及控制系统二次开发,Festo,六轴工业机械手结构设计及控制系统二次开发,工业,机械手,结构设计,控制系统,二次开发
展开阅读全文
- 温馨提示:
1: 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
2: 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
3.本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
5. 装配图网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
装配图网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。