机械手臂的控制设计

合集下载

机械手臂plc课程设计

机械手臂plc课程设计

机械手臂plc课程设计一、课程目标知识目标:1. 学生能够理解机械手臂的基本结构和功能,掌握PLC编程的基础知识。

2. 学生能够描述机械手臂的运动原理,了解PLC在自动化控制中的应用。

3. 学生能够解释机械手臂PLC控制系统的工作原理,掌握相关术语和概念。

技能目标:1. 学生能够运用PLC编程软件进行简单的程序编写,实现对机械手臂运动的控制。

2. 学生能够通过实际操作,熟练使用机械手臂PLC控制系统的相关设备。

3. 学生能够运用问题解决策略,对机械手臂PLC控制系统进行故障排除和优化。

情感态度价值观目标:1. 培养学生对机械手臂PLC控制技术的兴趣,激发创新意识和探索精神。

2. 培养学生团队协作意识,提高沟通与交流能力,学会共同解决问题。

3. 增强学生的安全意识,培养严谨的科学态度和良好的工程素养。

课程性质:本课程为实践性较强的学科课程,结合理论知识与实际操作,培养学生的动手能力和创新能力。

学生特点:学生具备一定的物理和数学基础,对机械手臂和PLC技术有一定了解,对实践操作有浓厚兴趣。

教学要求:注重理论与实践相结合,强调学生的主体地位,引导学生主动探究,提高解决问题的能力。

将课程目标分解为具体的学习成果,便于教学设计和评估。

二、教学内容1. 机械手臂基本结构及功能:介绍机械手臂的组成部分,包括执行器、传感器、控制器等,并分析其各自功能。

教材章节:第二章 机械手臂的结构与原理2. PLC编程基础:讲解PLC的基本指令、编程方法和应用案例,使学生掌握PLC编程的基本技能。

教材章节:第三章 PLC编程与应用3. 机械手臂运动原理:分析机械手臂的运动学原理,包括正运动学、逆运动学以及动力学等内容。

教材章节:第四章 机械手臂的运动学与动力学4. PLC在自动化控制中的应用:介绍PLC在机械手臂控制系统中的应用,以及与其他自动化设备的配合。

教材章节:第五章 PLC在自动化系统中的应用5. 机械手臂PLC控制系统设计与实践:通过实际案例,教授学生如何设计机械手臂PLC控制系统,并进行实践操作。

课程设计--机械手臂搬运加工流程控制设计

课程设计--机械手臂搬运加工流程控制设计

青岛理工大学琴岛学院课程设计说明书课题名称:机械手臂搬运加工流程控制设计学院:机电工程系专业班级:机电一体化技术093班学号:20090212085学生:荣佑平指导老师:陈燕青岛理工大学琴岛学院教务处2011年03 月12 日《现代电气控制及PLC应用技术课程设计》评阅书摘要(1)机床加工工件的装卸,特别是在自动化车床、组合机床上使用较为普遍。

(2)在装配作业中应用广泛,在电子行业中它可以用来装配印制电路板,在机械行业中它以用来组装零部件。

(3)可在劳动条件差,单调重复易子疲劳的工作环境工作,以代替人的劳动。

(4)可在危险场合下工作,如军工品的装卸、危险品及有害物的搬运等。

(5)宇宙及海洋的开发,军事工程及生物医学方面的研究和试验。

(6)机械手电器控制系统,除了有多工步特点之外,还要求有单周期连续、自动循环和手动控制等操作方式。

(7)工作方式的选择可以很方便的操作面板上表示出来。

当旋钮打向回原点时,系统自动地回到左上角位置待命。

(8)当旋钮打向自动时,系统自动完成各工步操作,且循环动作。

当旋钮打向手动时,每一工步都要按下该工步按钮才能实现。

(9)机械手需将工件从工作台A移至工作台B上,其动作过程为下降、上升、右移、再下降、再上升。

左移。

这些均由电磁阀控制液压系统来驱动完成。

(10)此外,机械手在夹送工件工件右行到位后,如果工作台B上的工件尚没有运走,机械手则停止运动,待工作台B上的工件被运走后,机械手才能下降。

目录青岛理工大学琴岛学院 (1)课程设计说明书 (1)摘要 (I)1 序言 (1)2零件的分析 (2)2.1机械手的设计要求 (2)2.2机械手的运动原理 (2)3机械手的程序设计 (2)3.1机械手的操作方式 (2)3.2机械手PLC的输入/输出开关分配表 (3)3.3机械手PLC控制面板图 (4)3.4机械手PLC移动示意图 (5)3.5机械手PLC控制接线图 (6)3.6机械手PLC自动控制状态流程图 (7)3.7机械手PLC控制总梯形图 (8)3.8机械手PLC的语句表 (18)3.9机械手PLC程序设计说明 (21)3.9—1机械手PLC程序设计手动程序与自动程序的切换 (22)3.9—2机械手PLC程序设计手动程序 (22)3.9—3机械手PLC程序设计自动程序 (22)3.9—4机械手PLC程序设计返回原点程序 (24)4总结 (24)5参考文献 (24)1序言现代电气控制及PLC应用技术课程设计是在我们学完了大学的全部基础课、技术基础课以及大部分专业课之后进行的。

两节机械手臂控制系统的设计

两节机械手臂控制系统的设计
臂 按 预 设 轨 迹 精 确 自主 移 动 。 1 机 械 手 臂 控 制 系统 组 成 及 工 作 原 理 .
两 节 机 械 手 臂 控 制 系 统 的 目标 是 控 制 机 械 手 臂 按 照 预 设 轨 迹 移 动 。系 统 由 1台 计 算 机 、 2个 电 机 、 1块 数 据 采 集 板 ( D A Q
电 压 进 行 调 整 来 控 制 机 械 手 臂 的运 动 和 位 置 。 电 机 驱 动 电路 包 括 放大器和滤波器等。
图 2 两 节 机 械 手 臂 数 学 2 f 2 + 2 m 2 1 1 1 2 C 2 + ( m 1 + m 2 e
f 2 = m J 2 + m 2 1 1 I 2 C 2
pr opo s ed t o r ea l i z e t h e c on t r ol s y s t e m Th e r e su l t o f s i mul a t i on s h o ws t h a t PI D c on t r ol l er ca n e fe c t i v el y c on t r o l r o bo t i c ar m


2 两 节机 械 手 臂 数 学建 模
C =c os e 7 ; C2=c o s e 2; ST =si n e T ; =s / n 8 2
两 节 机 械 手 臂 数 学 参 考 坐 标 见 图 2,机 械 手 臂 的 长 度 分 别
为 I 1 、 I 2 , 质量 分别 为 m1 、 m2 , 扭矩分别为 T 1 、 T 2 。
We i V i v i e n S h i ( N a n j i n g U n i v e r s i t y o f A e r o n a u t i c s a n d A s t r o n a u t i c s , N a n j i n g , 2 1 0 0 1 6 , C h i n a

PLC实验报告机械手臂编程与控制

PLC实验报告机械手臂编程与控制

PLC实验报告机械手臂编程与控制PLC实验报告:机械手臂编程与控制摘要:本次实验旨在通过PLC(可编程逻辑控制器)来对机械手臂进行编程和控制,实现自动化操作。

本文将详细介绍实验的步骤和结果,讨论编程与控制的方法和技巧,同时探讨PLC在工业自动化领域的应用前景。

1. 引言机械手臂是一种多关节、可精确控制的机械装置,广泛应用于制造业的自动化生产线上。

为了实现对机械手臂的准确控制,本实验采用PLC作为控制核心,并对其进行编程以实现操作。

2. 实验步骤2.1 硬件准备在进行机械手臂编程与控制之前,首先要准备好所需的硬件设备。

包括机械手臂本体、传感器、执行器等。

2.2 PLC编程PLC的编程是实现机械手臂自动化控制的关键步骤。

编程主要包括以下几个方面:2.2.1 输入与输出的定义在PLC编程中,需要明确输入与输出的信号。

以机械手臂为例,输入信号可能来自传感器,输出信号用于控制机械手臂运动。

2.2.2 逻辑程序的设计根据实际需求,设计逻辑程序来控制机械手臂的运动。

逻辑程序根据输入信号的状态来判断执行何种动作。

2.2.3 编程语言的选择PLC支持多种编程语言,常见的有Ladder Diagram、Function Block Diagram等。

根据实际情况选择合适的编程语言。

2.3 软件配置将编写好的PLC程序通过相应软件配置到PLC中。

配置过程中需要设置输入与输出的信号对应关系,确保程序能够正确运行。

3. 实验结果与分析经过实验,我们成功实现了对机械手臂的编程与控制。

机械手臂根据预设的逻辑程序,准确无误地完成了指定动作。

实验结果表明,PLC 编程可实现对机械手臂的有效控制,为工业自动化生产线的应用提供了有力支持。

4. 编程与控制的技巧与方法4.1 逻辑设计在编程过程中,首先要进行逻辑设计。

合理的逻辑设计能够减少编程过程中的错误,并提高程序的效率和可靠性。

4.2 错误处理在编程过程中,可能会遇到各种错误。

良好的错误处理机制能够及时发现问题并采取相应的措施进行修复,降低故障对系统的影响。

关于机械手臂控制方案的研究

关于机械手臂控制方案的研究

关于机械手臂控制方案的研究摘要:本文通过机械手臂的动力学模型的创建和机械手臂的控制方案等,来对机械手臂的控制情况进行一些浅显的研究。

关键词:机械手臂控制方案随着科技的快速发展,运用机器来代替人工进行工业生产等已经成为一个重要发展趋势而受到广泛的关注。

因此,机械手臂的控制方案研究就成为了非常重要的科研项目。

本文就机械手臂的控制方案进行了一些研究。

1 机械手臂动力模型的构建1.1 机械手臂柔性体变形的描述柔性体变形的描述是作为机械手臂动力模型构建的基础,也是研究机械手臂控制方案的基础。

常见的柔性体变形的描述主要有以下几种方法:有限元法、有限段法以及拟态综合法等。

(1)有限元法。

有限元法是用于工业机械复杂结构运算的最广泛的数值解法。

它主要是将一个具有连续性的整体通过理想化成有限个单元集合体进行逐个求解。

也就是将复杂的问题进行简单化处理的一种算法。

尽管这种算法有广泛的应用,但其求解量非常的庞大,且所获得动力学求解方程也非常的复杂。

(2)有限段法。

这种算法主要是针对于一些细长的零件的描述。

将细长的零件进行分段,并将分段后的优先段作为刚体进行描述。

因此,有限段法的描述具有时变性、且只能够适用于小应变假设。

1.2 拟态综合法通过对系统中的子结构进行拟态,并综合拟态结果,构成整个系统的拟态。

这个过程是依靠于自由振动的特征值的求解来实现的,主要用于连杆变形的描述。

这种方法的计算量很少,所以计算速率很高,且方法简单。

但基于这种描述上的机械手臂的控制方案存在稳定性的问题。

2 建立动力学方程机械手臂的动力学模型主要分为连续动力学模型和离散动力学模型。

但无论是那种动力学模型的建立,都需要以矢量力学法和分析力学法作为基础研究方法进行研究。

常见的和比较成熟的动力学方程式是Newton-Euler公式和Lagrange方程。

此外还有变分原理、虚位移原理等。

2.1 Newton-Euler公式Newton-Euler公式可以很完整的表达系统的受力关系,是根据质心动量矩定理而来的隔离体动力方程,是很多动力学模型的规范形式,也是构建动力学模型的主要手段之一。

机械臂控制系统的设计

机械臂控制系统的设计

机械臂控制系统的设计1 引言近年来;随着制造业在我国的高速发展;工业机器人技术也得到了迅速的发展..根据负载的大小可以将机械臂分为大型、中型、小型三类..大型机械臂主要用于搬运、码垛、装配等负载较重的场合;中小型机械臂主要用于焊接、喷漆、检测等负载较小的场合..随着国外工业机器人技术的不断发展;尤其是一些中小型机器人;它们具有体积小、质量轻、精度高、控制可靠的特点;甚至研发出更为轻巧的控制箱;可以在工作区域随时移动;这样大大方便了工作人员的操作..在工业机器人的应用中最常见的是六自由度的机械臂..它是由6个独立的旋转关节串联形成的一种工业机器人;每个关节都有各自独立的控制系统..2机械臂硬件系统设计2.1 机械臂构型的选择要使机器臂的抓持器能够以准确的位置和姿态移动到给定点;这就要求机器人具有一定数量的自由度..机器臂的自由度是设计的关键参数;其数目应该与所要完成的任务相匹配..为了使安装在双轮自平衡机器人上的机械臂能够具有完善的功能;能够完成复杂的任务;将其自由度数目定为6个;这样抓持器就可以达到空间中的任意位姿;并且不会出现冗余问题..在确定自由度后;就可以合理的布置各关节来分配这些自由度了..由于计算数值解远比封闭解费时;数值解很难用于实时控制;这样;后3个关节就确定了末端执行器的姿态;而前3个关节确定腕关节原点的位置..采用这种方法设计的机械臂可以认为是由定位结构及其后面串联的定向结构或手腕组成的..这样设计出来的机器人都具有封闭解..另外;定位结构都采用简单结构连杆转角为0或90°的形式;连杆长度可以不同;但是连杆偏距都为0;这样的结构会使推倒逆解时计算简单..定位机构是涉及形式主要有以下几种:SCARA型机械臂;直角坐标型机械臂;圆柱坐标型机械臂;极坐标型机械臂;关节坐标型机械臂等..SCARA机械臂是平面关节型;不能满足本文对机械臂周边3维空间任意抓取的要求;直角坐标型机械臂投影面积较大;工作空间小;极坐标方式需要线性移动;机械臂如需较大的工作空间;则臂长较长;和其他类型相比关节型机械臂在其工作空间内干涉是最小的;是一种较为优良的结构..所以初步确定本文机械臂构型为关节型..2.2臂杆长度的确定机械臂的臂杆设计如表2-1所示:表2-1 机械臂臂杆长度臂体名称大臂L1 小臂L2 机械手长度mm 550 500 1502.3 机械臂结构设计2.3.1 关节结构方案为了便于机械臂关节的模块化涉及和简化结构;本设计使用电机直接连接减速器;减速器连接臂体连接结构..图2-1是关节结构动力传递方案..图2-1 关节结构动力传递方案使用这种联接方式因中间零件少;故形变量与回程间隙都较小;且能保持较高的结构刚度..2.4 关键部件的选型2.4.1 关节负载的估算各关节的动态参数是驱动元件的选择和关节传动零件选择的重要依据..由机器人动力学相关知识可知完整的机器人动力学方程为:式中一般使用静力学方法和动力学方法计算机器人的动力参数;速度较低的机械;在运行过程中;惯性引起的动载荷较小;一般使用静力学方法;忽略C和F的影响..而对于运行速度较高机械;其动载荷也较大;即C项的影响较大;甚至超过静载荷;且粘滞摩擦也较大;同时考虑静载荷和动载荷;需使用动力学计算..本文的设计要求是一款可以安装在全向移动平台上的轻型机械臂;对关节的旋转速度要求不高;因此估算机械臂力矩时采用静力学方法..图2-2 机械臂受力简图估计关节力矩之前;首先假设每个关节的重力作用集中在中心;将连杆的重量均分于各关节;机械臂受力简图如图 2-2 所示;使用静力学方法计算关节所受力矩的最大值..六自由度机械臂三维静态仿真图如图2-3所示:图2-3 三维静态仿真图2.4.2 关节驱动系统电机的选型机械臂的驱动系统;有三种基本类型;即电动驱动、液压驱动和气动驱动;也可以根据需要组合成为复合式的驱动系统..1 电机驱动目前机械臂上使用最多的一种驱动方式是电动驱动;它利用各种电机产生的力和力矩;直接或通过机械传动装置来驱动执行机构..这类系统效率比液压驱动和气动驱动系统高;且电源方便;所以在机器人中得到了广泛的应用..2 液压驱动液压驱动的主要优点是功率密度大..液压缸也可直接作为臂体的一部分;因而结构紧凑;刚性好..由于液压油液的不可压缩性;系统的固有频率较高;快速响应好;可实现频繁平稳的变速和换向..液压系统易于实现过载保护;动作平稳、耐冲击、耐振动、防爆性好..3 气动驱动气动驱动系统通常由气缸、气阀、气罐和空压机组成;其特点是气源方便、结构简单、造价较低、维修方便..与液压驱动系统相比;同体积条件下功率较小;也难以进行速度控制;多用于中、小负荷且精度要求不高的机器人控制系统中..综上;本设计决定使用电动驱动方式为机械臂提供动力;步进电机为驱动电机..2.4.3驱动系统减速器的选型结合上文;本文将使用步进电机为驱动电机为机械臂提供动力;结合各关节受力和机械臂关节传动机构组合方式;应在驱动电机和机械臂关节间安装减速器做扭矩适配;降低输出轴的速度;增大输出扭矩..一般行星齿轮减速器、蜗轮蜗杆减速器、谐波减速器、齿轮减速器等可以和步进电机适配..1、行星齿轮减速器行星齿轮减速器通常由一个或者多个外部齿轮围绕着一个中心齿轮旋转;就像行星绕着太阳公转一样..在工作状态中多个行星齿轮协同工作;因而承载能力大;属纯扭矩传动;工作平稳..单级行星齿轮减速器的减速比一般较小;需要增加减速比时只需增加行星轮系的级数即可;而整体体积变化较小..2、蜗轮蜗杆减速器蜗轮蜗杆减速器的传动比大;一般为 10-80;也可以达到 80 以上..此外;蜗轮蜗杆减速器机械结构紧凑、热交换性能好、工作平稳、噪声小、具备机械自锁能力;安全性高..3、谐波减速器波发生器;柔轮;刚轮是谐波减速器的三大部分;谐波齿轮减速器传动结构简单;减速比高;同时啮合的齿数多;运行平稳、传动承载力大;齿侧间隙小;传动精度高;传动误差只有普通圆柱齿轮传动的 1/4 左右;传动空程小;适用于反向转动;在机器人领域有着广泛应用..但对柔轮材料有较高的强度要求;工艺复杂..4、齿轮减速器圆柱齿轮减速机构为定传动比齿轮机构;其传动准确;平稳高效;传动功率范围和速度范围大;广泛用于各种仪器仪表中;但其制造和安装精度要求高;高减速比时结构较为复杂;体积一般较大..综上;初步去确定使用谐波齿轮减速器;减速比大;传动精度高;体积小巧;输入轴与输出轴轴线重合;可很方便地与步进电机组合安装成为机械臂关节的一部分;同时便于机械臂的模块化设计..本文将采用 Harmonic Drive CSF-mini 系列组合型谐波减速器;其中腰关节采用型号为 CSF-14-100-2XH-F;肘关节俯仰和肘关节旋转采用 CSF-11-100-2XHF;腕俯仰采用 CSF-8-100-2XH-F..2.4.4电机驱动器的选型虽然步进电机广泛地应用于各行各业;但步进电机并不能像普通的直流电机那样通过控制输入的等效电压就可以驱动和调速..它必须利用电子电路;将直流电变成分时多相时序控制电流;用这种电流为步进电机供电;步进电机才能正常工作..常见的有单片机 I/O 直接控制;步进电机驱动芯片、运动控制卡..1、单片机 I/O 直接控制方式使用单片机内部的锁存器、计数/定时器;和并行 I/O 接口;可以实现对步进电机的控制;脉冲环形分配器的功能由单片机系统实现完成;通过软件中断方式实现步进电机的变速控制;改变通电顺序则可改变转向..2、步进电机专用驱动芯片步进电机专用驱动芯片一般集成度较高;外围电路简单;一般有 ENABLE、STEP 和 DIR 三个输入端;ENABLE 为使能端;使能有效时方可驱动步进电机;STEP 为脉冲输入;输入一个脉冲;即可驱动步进电机产生微动;DIR 为方向 ;改变 DIR 逻辑电平即可换向..3、运动控制卡驱动控制通过计算机可直接控制步进电机;运动控制卡是专用于步进电机控制的 PC 插卡;是应对复杂系统的控制而出现的;一般可同时控制十几台甚至几十台步进电机的运动;一般价格很高..综上;本设计将使用步进电机专用驱动芯片来驱动步进电机..其中肩关节和肘关节俯仰有自锁需求;使用东芝 THB7128 3A 128 高细分步进电机专用驱动芯片驱动;其他轴选用 A4988 微步驱动器..2.4.5传感器的选型本文将使用步进电机和谐波齿轮减速器为机械臂提供动力;步进电机只需要通控制驱动脉冲的数量;即可简单实现较高精度的定位;并使工作物在精确地停在目标位置..步进电机以细分后的步距角为基本单位进行定位..以两相电机为例;其步距角为1.8°;使用 1/16 细分方式进行驱动;那么每给驱动器一个脉冲步进电机转子旋转的角度为角度=1.8°1/16=0.1125°;转子旋转一周需要脉冲数为360°/0.1125°=3200;需要旋转到其他任意角度的计算方式与上式相同..本文使用限位开关的型号为 Omron 微动开关 SS-5 摆杆型限位开关..2.4.6下位机的选型对于机器臂控制;需要对多台电机进行联动控制..为了实现多台电机之间的通信和控制;必须建立一套数据通信系统来完成主计算机与各运动控制单元间的数据交换..基于现场总线的分布式控制技术能够解决这些问题..但常见的分布式控制系统又有 USB 总线;SERCOS总线;RS-485 总线和 CAN 总线等这几种..本设计将采用RS-485 总线来实现机械臂的分布式控制..本设计选用了TI公司的2000系列 DSP TMS320LF2407 作为控制单元..其时钟频率可达 40MHz;具有高速的处理能力;片内资源丰富;特别是它特有两个内置事件管理器模块EVA、EVB..通过JTAG 接口可以方便的对 DSP 进行全速的在系统调试仿真..TMS320LF2407 的电源电压为 3.3V;正常下作电流为 80m A 左右;抗干扰能力较强..关节控制器硬件电路关节控制器是以 DSP 芯片为核心;芯片本身及其外围电路的性能直接决定了系统的性能..故芯片的选择及其外围电路的设计;也就显得十分的重要..下面将通过单个模块电路的方式分别介绍控制器硬件电路..(1)电源电路通过开关电源;接入B0505LS模块产生稳定的的5V 电压作为TPS7333芯片的供电电压;管脚8做为2407 的上电复位信号..管角 5;6 通过滤波电容输出作为 2407 的供电电压3.3V..如图2-5..图2-4 电源电路(2)时钟电路TMS320LF2407 的时钟源可以来自外部有源晶振也可以用晶体;利用内部振荡器..一般经常使用外部时钟输入;因为使用外部时钟时;时钟的精度高、信号比较稳定;外部时钟电路和锁相环电路如图 2-6 所示..图2-5 时钟电路(3)JTAG 接口电路仿真接口电路如图2-7所示.目标层次的TI调试标准使用5个标准的IEEE1149.1JTAG信号TRST、TCK、TMS、TDI、TDO和两个TI扩展口EMU0、EMU1..JTAG 目标器件通过专用的仿真端口支持仿真;此端口由仿真器直接访问并提供仿真功能..JTAG 接口电路为仿真器与微机的接口电路;便于系统进行在线调试..图2-6 JTAG电路(4)外接SRAM电路TMS320LF2407最多可寻址64K的外部程序空间和64K的外部数据空间..由于控制算法的需要;本系统需扩充外部 RAM..TMS320LF2407片内的 Flash可用作程序存储器;但在开发阶段使用 Flash 作为程序存储器极为不便;因为每一次程序的修改都需要对 Flash 进行清除、擦除和编程操作;而且进行CCS 调试时只能设置硬件断点;故从调试的角度考虑;应扩充程序 RAM..这里用的是CY7C1021V33芯片;它是64K16bit的SRAM;存取时间为15ns;故不需要插入等待周期;可保证系统全速运行..图 2-8 为外接 SRAM 扩展电路图..图2-7 SRAM扩展电路图(5)编码器处理电路增量式编码器信号处理电路如图2-9所示..图 2-8 增量式编码器信号处理电路(6)霍尔接近开关电路本设计选用 A31443E 常开型霍尔接近开关..其接法如图 2-10;提供电压为5V;由于输出采用了集电极开路门;必须通过 10K 的上拉电阻接到 5V 电源上..当磁源的某一极与霍尔传感器的距离达到一定范围以内时;输出低电平;否则输出高电平;不需要外接放大电路..一套关节控制器将采用 3 支霍尔接近开关..HALL1、HALL2 分别固定在关节控制器运动的极限位置;其信号通过 IOPE5、IOPE6 不断查询..HALL3 用于绝对零位检测;采用中断的方式..图2-9 霍尔接近开关的接法2.5 机械臂的模块化设计机械臂的大小臂体和关节在整个机械臂中具有高度的相似性;同时机械臂是机电一体化的典型;其主体结构和联接结构都有一定的复杂性;而采用模块化设计思想;可以一定程度上简化设计流程;只需对不同的应用对象进行少量修改便可完成组合适配..2.5.1 旋转关节的设计机械臂的基本单元有旋转关节和俯仰关节;其结构具有相似性;本文重点介绍旋转关节的设计..旋转关节包含有电机、减速器、编码器、制动器以及其他附件;本文使用步进电机直连谐波减速器的驱动方式;使用限位微动开关确定机械臂初始定位零点;以计步进电机已发脉冲数为关节相对旋转角度参考;是一个开环的运动控制系统;动力传递链路为:电机--波发生器--柔轮--刚轮—输出轴..机械臂的旋转关节模块在运行过程中会受到来自机械臂末端的弯矩;因此需要对输出轴做轴向和径向卸荷;减少输出轴的负载;保证系统的刚度;延长使用寿命..一般来说;一根轴需要两个支点;每个支点由一个或一个以上的轴承组成;每组轴承间有以下三种常用的配置方法..1、双支点各单向固定这种轴承配置常用两个反向安装的圆锥滚子轴承或角接触球轴承;两个轴承各限制轴向一个方向的轴向移动..这种配置方式轴向移动限制比较精确、也便于调整轴承的预紧程度..另外深沟球轴承也可用于双支点各单向固定;通过调整外壳与轴承端盖端面的厚度来补偿轴的受热伸长;因而这种配置方式不适合需要对轴做精确轴向定位的场合..2、一支点双向固定;另一端支点游动对于热伸长量较大的轴;这种轴一般跨距较大且工作温度较高;应该采用一支点双向固定;另一支点游动的支撑结构..其双向固定端需要使用能承受双向轴向载荷的轴承;内外圈都需要固定..3、两端游动支撑对于人字齿轮轴;由于本身具有相互间的轴向限位作用;其中只需保证一根轴与机座有相对固定的轴向位置;另一根轴上的两个轴承必须游动;防止人字齿轮卡死或两侧受力不均匀..本文将采用一支点双向固定;另一端支点游动的方式组合成卸荷轴承组;其中双向固定端使用深沟球轴承;游动端使用滚针轴承..其中腰关节使用型号为 HRB 61809-2Z、SKF HK5020;肘关节旋转使用型号为 HRB 61806-2Z、SKF HK3512..2.5.2 旋转关节的设计各运动轴基于模块化设计;设计时已考虑各运动轴的联接;使用简单的金属板件便能将各运动轴连接可靠;并具有一定的刚度..本文各运动轴均为法兰端面输出;与金属板材间通过螺钉联接固定;依靠金属板与法兰端面的摩擦力传递扭矩到金属板材..图 2-11 为肩关节联接金属板材机械加工工程图:图2-10 肩关节联接金属板2.5.3 抓手的设计一款通用型的机械臂应该具有抓取多种物体的能力;也为某一目标物体专门设计一款抓手;因而在设计机械臂臂体与机械抓手时;需要设计一个合理的联接结构;以便机械抓手能够快速更换..机械抓手在抓取物体时需要保持一定的夹持力;本文将使用舵机为机械手爪提供动力;舵机在旋转到位后能持续提供一定的扭矩以保持夹持状态..使用舵机型号为 TowerPro MG945 全金属齿舵机;表2-5舵机型号及相关参数图2-12 为和机械抓手配合的臂体联接结构..同理只要末端执行器设计为可与该联接结构配合;即可实现更换;以完成对不同物体的抓取任务..图2-11 机械臂执行器联接结构3机械臂软件系统设计整个机械臂控制系统软件包括主计算机监控软件和各关节控制器软件..主计算机接收目标位姿数据;完成路径规划算法..另外;主计算机要实时读取关节控制器的反馈数据;记录机械臂的当前位姿;并显示在屏幕上..不仅直线运动、点到点运动、复位动作的完成需要主计算机监控软件协调;而且像各关节绝对位置的确定过程、各关节运动范围是否越界也必须由主计算机实时参与;及时做出决策..主计算机还要提供给用户友好的人机交互界面;方便于用户输入各种命令;存储设置好的参数;允许数据以表格或者曲线等形式导出..3.1 关节控制器软件设计3.1.1 PID控制算法关节控制器TMS320LF2407来实现;完成电机的位置环控制和速度环控制;如图3-1所示..位置环的控制周期设为2ms;速度环的控制周期也设为2ms..由于采用了速度环;系统的动态性性能可以得到显着提高..两个闭环都采用积分分离PD控制;根据实际调试情况;可以对控制律进行适当的化简..零位霍尔接近开关在系统上电时用于较粗略的确定电机的绝对位置;再结合增量编码器的Z通道的信号;就可以较精确的确定出电机的绝对位置..主计算机路径规划求得的目标位置;应该换算成增量码盘的脉冲数后;再发给关节控制器..关节控制器利用它和从增量编码器实际测得的脉冲数进行比较;利用积分分离PID算法求解位置环的控制量..3.1.2 关节控制器程序流程主程序的流程图如3-2所示:图3-1 主程序流程图寄存器初始化操作主要包括:设置CPUCLK为外部晶振的2倍频;即16MHZ;设置串口通讯波特率为:38.4kbPs;设置定时器/计数器相关寄存器;设置QEP 电路单元相关寄存器;设置中断控制寄存器等等..串口数据接收中断服务程序流程图如3-3所示..在中断服务程序中;读取数据接收寄存器中的数据;存入数据接收区;而并不作任何进一步分析和处理..数据接收区是内存中暂时存放数据的区域;当存满一条完整指令信息后;由主程序分析和处理..图 3-2 串口数据接收中断服务程序流程图控制周期2ms定时中断服务程序的流程见图3-4..定时器/计数器3为位置环和速度环控制周期定时2ms;每3ms进入定时中断服务程序一次;读取位置反馈值和速度反馈值;进行积分分离PID运算;最后输出给DA转换成模拟量..每一个插补周期50ms;主计算机向关节控制器发送一次运动规划后的目标位置..该目标位置是以增量编码器信号四倍频后的脉冲数为单位;以前一次的目标位置作为脉冲计数的零点;因此;关节控制器在读取新的目标位置后;也应该以前一次的目标位置作为新的增量码盘脉冲计数零点;测量实际的电机位置;与新的目标位置比较、运算..主计算机根据需要可以查询当前电机运行的实际位置;关节控制器返回的位置则是关节角的绝对位置;单位是0.1度..图3-3 控制周期定时中断服务服务程序流程图4 结束语本文提出了一套机械臂结构方案..硬件上;对机械臂的构型、臂杆长度、电机、驱动器、减速器、传感器和主控制器进行了选型..并且对机械臂进行了模块化设计;其中包括旋转关节的设计、连接件的设计和抓手的设计..软件方面设计了DSP关节控制器;实现了电机位置和速度闭环控制..基于RS485总线和DSP 的分布式控制体系结构;具有高速、稳定、可靠、易于维护等优点;适合于六自由度机械臂的实时控制..5 参考文献1 王罗罗. 机械臂的结构设计及控制研究D. 哈尔滨工业大学; 2009.2 招绍坤. 轻型机械臂模块化设计与运动控制的研究 D. 哈尔滨工业大学; 2010.3 王再明. 轻型臂电控系统的研究D. 哈尔滨工业大学; 2007.4 方红根;杨军. 基于模块化关节轻型机械臂的研制J. 上海电气技术; 2011.5 濮良贵. 机械设计M. 北京:高等教育出版社;2012:186-273.6 李世其; 刘洋; 朱文革 ;刘燕; 贾阳. 多关节轻型机械臂的设计研究J. 航天器工程; 2009.7 刘宝志. 步进电机的精确控制方法研究D. 山东大学; 2010.8 雷凯. 步进电机细分驱动技术的研究D. 苏州大学; 2003.。

机械设计中的机械手臂设计

机械设计中的机械手臂设计机械手臂是一种由多个关节连接而成的机械结构,具有类似人臂的灵活度和自主操作能力。

在机械设计领域中,机械手臂的设计是一项重要的任务,对于提升生产效率和实现自动化生产具有至关重要的作用。

本文将就机械设计中的机械手臂设计进行探讨和分析。

一、机械手臂的基本组成机械手臂一般由五个主要组成部分构成,包括机械结构、驱动系统、传感器、控制系统和终端执行器。

机械结构是机械手臂的主体部分,决定了机械手臂的运动能力和灵活度,其设计需要考虑到机械手臂的工作范围、负载能力和运动速度等因素。

驱动系统是机械手臂实现运动的关键部件,通常包括电机、减速器和传动装置等。

传感器用于感知环境中的信息,如力、力矩、位置和姿态等。

控制系统用于控制机械手臂的运动和操作,通常由计算机和控制算法组成。

终端执行器是机械手臂的工作部分,根据具体应用可以为夹具、吸盘或者工具等。

二、机械手臂的运动学分析机械手臂的运动学分析是机械设计中的重要环节之一,通过对机械手臂的位姿和轨迹进行描述,确定机械手臂的关节角度和终端位置。

在机械手臂的运动学分析中,通常会采用数学方法和仿真工具进行分析和求解。

数学方法包括解析法和数值法两种,解析法适用于简单的机械手臂结构,可以通过几何关系和三角函数等确定机械手臂的位姿和轨迹;数值法适用于复杂的机械手臂结构,通过数值计算和迭代求解,得到机械手臂的关节角度和终端位置。

仿真工具包括MATLAB、SolidWorks和ADAMS等,通过建立机械手臂的数学模型,进行仿真和优化,得到机械手臂的运动学性能和工作空间等参数。

三、机械手臂的动力学分析机械手臂的动力学分析是机械设计中的关键环节之一,通过对机械手臂的加速度、力矩和惯性等进行分析,确定机械手臂的运动特性和工作能力。

在机械手臂的动力学分析中,需要考虑到机械手臂的惯性、摩擦、重力和外部载荷等因素。

通过建立机械手臂的动力学模型,可以求解机械手臂的加速度和力矩,进而评估机械手臂的运动性能和负载能力。

机械臂快速控制原型系统设计与开发

机械臂快速控制原型系统设计与开发摘要:随着工业自动化的不断发展,机械臂在工业生产中发挥着重要的作用。

本文针对机械臂控制系统的需求,设计并开发了一个快速控制原型系统。

该系统具有高效、灵活、稳定的特点,能够实现对机械臂的精确控制,提高工作效率。

1. 引言机械臂作为一种重要的工业自动化设备,广泛应用于各个领域,如制造业、仓储物流等。

为了满足对机械臂控制的需求,快速控制原型系统的设计和开发尤为重要。

2. 系统设计本文基于嵌入式技术,设计了一个机械臂快速控制原型系统。

该系统包括主控制器、传感器、执行机构等组成部分。

主控制器采用高性能的处理器,具有强大的计算能力和良好的实时性。

传感器用于感知机械臂的位置、姿态等信息,以实现对机械臂的精确控制。

执行机构通过接收主控制器的指令,实现对机械臂的运动控制。

3. 系统开发在系统开发过程中,我们首先进行了硬件设计和选型。

选择了高性能的处理器和稳定可靠的传感器、执行机构,以确保系统的性能和稳定性。

然后,进行了软件设计和开发。

主控制器通过编程实现对传感器和执行机构的控制,以及与外部设备的通信。

我们采用了实时操作系统和相关的开发工具,提高了系统的实时性和可靠性。

4. 系统测试与应用经过系统开发后,我们对机械臂快速控制原型系统进行了测试。

测试结果表明,该系统能够实现对机械臂的精确控制,运动轨迹准确、稳定。

在实际应用中,系统能够提高工作效率,减少人工操作的错误率,降低生产成本。

5. 结论本文设计并开发了一个机械臂快速控制原型系统,该系统具有高效、灵活、稳定的特点,能够实现对机械臂的精确控制。

在实际应用中,该系统能够提高工作效率,提高生产质量。

然而,该系统还存在一些问题,需要进一步优化和改进。

在未来的研究中,我们将进一步完善系统的功能和性能,探索更多先进的控制算法和技术,以满足不断发展的工业自动化需求。

基于单片机的机械手臂控制系统设计

广西轻工业GUANGXIJOURNALOFLIGHTINDUSTRY计算机与信息技术2008年8月第8期(总第117期)【作者简介】方龙,副教授,从事电子技术的教学与科研工作。

1引言机器手臂是近几十年来涌现的一种工业技术装备,它能模仿人体上肢某些动作,在生产过程中代替人搬运物件或操持工具进行操作。

在工业生产中应用机器手臂,可以提高劳动生产率,保证产品质量,减轻工人劳动强度,实现生产过程自动化。

因此近年来工业机器手的应用越来越普遍。

机器手臂具有两个部分:控制部分和直接进行工作的部分。

控制系统通过编程,决定直接工作的机器臂部分。

由于采用程序控制,所以很容易根据需要改变其工作方式和任务。

本设计结合坐标式三自由度机器机器手臂模型,应用单片机控制。

该手臂具有二或三个关节,夹持装置,采用3台微型伺服马达驱动,至少可以完成抬臂、转臂、抓取物体等简单动作。

电机的驱动控制器由单片机AT89C51实现,使其按程序和操作要求实现抓取、搬运物体。

2伺服马达微型伺服马达有着如下的优点:大扭力、控制简单、装配灵活。

一个微型伺服马达内部包括了一个小型直流马达、一组变速齿轮组、一个反馈可调电位器及一块电子控制板。

其中高速转动的直流马达提供了原始动力,带动变速(减速)齿轮组,使之产生高扭力的输出,齿轮组的变速比愈大,伺服马达的输出扭力也愈大,也就是说越能承受更大的重量,但转动的速度也愈低。

减速齿轮组由马达驱动,其终端(输出端)带动一个线性的比例电位器作位置检测,该电位器把转角坐标转换为一比例电压反馈给控制线路板,控制线路板将其与输入的控制脉冲信号比较,产生纠正脉冲,并驱动马达正向或反向地转动,使齿轮组的输出位置与期望值相符,令纠正脉冲趋于为0,从而达到使伺服马达精确定位的目的。

伺服马达的瞬时运动速度是由其内部的直流马达和变速齿轮组的配合决定的,在恒定的电压驱动下,其数值唯一。

但其平均运动速度可通过PWM方式控制。

标准的微型伺服电机有三条控制线,分别为:电源,地及控制线。

本科毕业论文-基于单片机的多自由度机械手臂控制器设计解析

唐山学院毕业设计设计题目:基于单片机的多自由度机械手臂控制器设计系别:信息工程系班级:11电气工程及其自动化3班姓名:刘亮指导教师:田红霞2015年6月1日基于单片机的多自由度机械手臂控制器设计摘要机械臂控制器作为机械臂的大脑,对于它的研究有着十分重要的意义。

随着微电子技术和控制方法的不断进步,以单片机作为控制器的控制系统越来越成熟。

本课题正是基于单片机的机械臂控制系统的研究。

本文首先介绍了国内外机械臂发展状况以及控制系统的发展状况。

其次,阐述了四自由度机械手臂控制系统的硬件电路设计及软件实现。

详细阐述了机械臂控制系统中单片机及其外围电路设计、电源电路设计和舵机驱动电路设计。

在程序设计中,着重介绍了利用微分插补法进行PWM调速的程序设计。

并给出了控制器软件设计及流程图。

最后,给出了系统调试中出现的软硬件问题,进行了详细的分析并给出了相应的解决办法。

关键词:机械臂单片机自由度舵机PWMDesign of Multi DOF Manipulator ControllerBased on MCUAbstractAs the brain of robot arm, manipulator controller is very important for its research.With the development of microelectronics technology and control method, the control system of MCU is becoming more and more mature.This thesis is based on the research of the manipulator control system of MCU.Firstly,it is introduced the development of the manipulator and the control system at home and abroad.Secondly,it is given the circuit and software design for the four DOF manipulator in this disertation.it is expatiated the Single Chip Microcomputer(SCM),the relative circuit design ,Power circuit design,and driver circuit design of manipulator control system.In the design of the program, the design of PWM speed regulation by differential interpolation is introduced emphatically. The software design and flow chart of the controller are given.Finally,it is presented the problems of hardware and software in practive given resolves.Key word: Manipulator;MCU;DOF;Steering engine;PWM目录1引言 (1)1.1研究的背景和意义 (1)1.2国内外机械臂研究现状 (2)1.2.1国外机械臂研究现状 (2)1.2.2国内机械臂研究现状 (3)1.3机械臂控制器的发展现状 (3)1.4本设计研究的任务 (4)2机械结构与控制系统概述 (5)2.1机械结构 (5)2.2控制系统 (6)2.3系统功能介绍 (8)2.4舵机工作原理与控制方法 (8)2.4.1概述 (8)2.4.2舵机的组成 (8)2.4.3舵机工作原理 (9)3系统硬件电路设计 (11)3.1时钟电路设计 (11)3.2复位电路设计 (11)3.3控制器电源电路设计 (12)3.4舵机驱动电路 (13)3.5串口通信电路设计 (13)4系统软件设计 (14)4.1四自由机械臂轨迹规划 (15)4.2主程序设计 (16)4.3舵机调速程序设计 (17)4.3.1舵机PWM信号 (17)4.3.2利用微分插补法实现对多路PWM信号的输出 (18)4.4初末位置置换子程序 (21)4.5机械爪控制程序 (22)4.6定时器中断子程序 (23)4.6.1定时器T1中断程序 (23)4.6.2定时器T0中断子程序 (24)5系统软硬件调试 (25)5.1单片机系统开发调试工具 (25)5.1.1编程器 (25)5.1.2集成开发环境Keil和Protues (25)5.2控制系统的仿真 (26)5.3软件调试 (27)5.4硬件调试 (27)5.5软硬件联合调试 (28)6结论 (29)谢辞 (30)参考文献 (31)附录 (32)1引言1.1研究的背景和意义机器人是传统的机械结构学结合现代电子技术、电机学、计算机科学、控制理论、信息科学和传感器技术等多学科综合性高新技术产物,它是一种拟生结构、高速运行、重复操作和高精度机电一体化的自动化设备。

  1. 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
  2. 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
  3. 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。

,. 目 录 1 引言 ............................................................................................................................... 1 2 机械手概述 ................................................................................................................... 3 2.1 机械手的概念和分类........................................................................................ 3 2.2机械手的总体结构 ............................................................................................. 3 2.3机械手工作原理 ................................................................................................. 4 2.4机械手的操作方式 ............................................................................................. 4 3 机械手的工作方式 ...................................................................................................... 6 3.1手动工作方式 ..................................................................................................... 7 3.2自动程序 ............................................................................................................. 9 3.2.1单周期工作方式 ...................................................................................... 9 3.2.2单步工作方式 .......................................................................................... 9 3.2.3连续工作方式 ........................................................................................ 10 3.3 自动回原点 ...................................................................................................... 10 4 PLC的I/O分配 ......................................................................................................... 13 5 PLC的外部接线图 ..................................................................................................... 14 6 结束语 ......................................................................................................................... 15 参考文献 .......................................................................................................................... 16 附录 .................................................................................................................................. 18 ,. 1 引言 工业机械手是近代自动控制领域中出现的一项新技术,是现代控制理论与工业生产自动化实践相结合的产物,并已成为现代机械制造生产系统中的一个重要组成部分。工业机械手是提高生产过程自动化、改善劳动条件、提高产品质量和生产效率的有效手段之一。尤其在高温、高压、粉尘、噪声以及带有放射性和污 ,. 染性的场合,应用的最为广泛。在我国,近几年也有较快发展,并取得一定成果,受到机械工业和铁路工业部门的重视。 机械手也称自动手。机械手主要由手部、运动机构、控制系统三大部分组成。手部用来抓持工件的部件,根据被抓持物件的形状、尺寸、重量、材料和作业要求而有多种结构形式,如夹持型、托持型和吸附型。运动机构,使手部完成各种转动,移动或复合运动来实现规定的动作,改变被抓持物件的位置和姿势。运动机构的升降、伸缩、旋转等独立运动方式,称为机械手的自由度。为了抓取空间中任意和方位的物体,需要6个自由度。自由度是机械手设计的关键参数。自由度越多,机械手灵活性越大,通用性越广,其结构也越复杂。一般机械手有2~3个自由度。 机械手的种类,按驱动方式分为液压式、气动式、电动式、机械式机械手;按适用范围可分为专用机械手和通用机械手两种;按运动轨迹控制方式可分为点位控制和连续的轨迹控制机械手。 ,. 2 机械手概述 2.1 机械手的概念和分类 它是一种能模仿人手和臂的某些动作功能,用以按固定程序抓取、搬运物件或操作工具的自动操作装置。它可代替人的繁重劳动以实现生产的机械化和自动化,能在有害环境下操作以保护人身安全,因而广泛应用于机械制造、冶金、电子、轻工和原子能等部门。 机械手一般分为三类。第一类是不需要人工操作的通用机械手,它是一种独立的不附属于某一主机的装置。它可以根据任务的需要编制程序,以完成各项规定工作。它的特点是除具备普通机械的物理性能外,还具备通用机械、记忆智能的三元机械。第二类是需要人工操作的,称为操作机。它起源于原子、军事工业,先是通过操作机来完成特定的作业,后来发展到用无线电信号操作机械手来进行探测月球、火星等。第三类是专用机械手,主要附属于自动机床或自动线上,用于解决机床上下料和工件传送。它是为主机服务的,由主机驱动,除少数外,工作程序一般是固定的,因此是专用的。本项目要求设计的机械手模型可归为第一类,即通用机械手 2.2机械手的总体结构 本文设计的机械手主要包括机械手的旋转、大臂的伸缩、小臂的升降、手抓的松紧。各关节均采用电磁阀作为驱动装置,在机械大臂伸缩和小臂的升降以及手抓的松紧环节都配有传感器,并编制了能满足运动控制要求的软件,实现对机械手的速度、位置以及4关节联动控制。 ,. 机械手主要由手部和运动机构组成。手部是用来抓持工件(或工具)的部件,根据被抓持物件的形状、尺寸、重量、材料和作业要求而有多种结构形式,如夹持型、托持型和吸附型等。运动机构,使手部完成各种转动(摆动)、移动或复合运动来实现规定的动作,改变被抓持物件的位置和姿势。运动机构的升降、伸缩、旋转等独立运动方式,称为机械手的自由度 。为了抓取空间中任意位置和方位的物体,需有6个自由度。自由度是机 械手设计的关 键参数。自由 度越多,机械手的灵活性越大,通用性越广,其结构也越复杂。一般专用机械手有2~3个自由度。 2.3机械手工作原理 机械手在生产线上的任务是将工件从A处传送到B处。根据外界情况,机械手在空间主要进行以下动作:机械手下降,机械手抓紧工件,机械手与工件上升,机械手与工件右移,机械手与工件下降,机械手放松工件,机械手上升,机械手左移。控制器检测上,下,左,右限位开关的通断,决定当前的动作,通过驱动系统输出,控制机械手的动作。 2.4机械手的操作方式 机械手的操作方式分为手动、回原点、单步、单周期、自动五种工作方式,五种工作不仅能各自独立工作,还能按顺序实现他们之间的互相转换,转换过程中原状态保持,转换后按照新的工作方式进行。 (1)手动: 选择手动方式,按下手动按钮,结合限位开关,对各个动作进行单独控制。 如:按下机械手下降按钮,机械手下降,松开机械手按钮,机械手停止下降,或者到位后,机械手停止下降,机械手只能在左限位和有限位才能下降中间不可以,. 下降。 (2)回原点: 选择回原点方式,按下原点按钮,机械手以最快及最安全的路径回到原点位置停止。如:若机械手未夹物体时,以最快路径回到原点位置;若机械手夹了物体必须搬运到B点,在回到原点位置。 (3)单步: 选择单步方式,按一次启动按钮,机械手动作一个工步后自动停止。 (4)单周期: 选择单周期方式,按启动按钮,机械手动作一个周期后自动停止;在动作过程中,按停止按钮,机械手立即停止,在按启动按钮,机械手继续动作,机械手继续动作,一个周期后自动停止。 (5)自动: 选择自动方式,按启动方式,机械手周而复始的动作;在动作过程中,按停止按钮,机械手不立即停止等到当前一个周期结束才停止。

相关文档
最新文档