1.1连杆的坐标系
应用D-H 法来建立机器人杆件的坐标系。在这种坐标系中，可以把机械手的任一连杆i （i=1，2，3···，n ）看作是一个刚体，与它相邻的两个关节i 、i-1的轴线i 和i-1
之间的关系也由它确定，如图1，可以用以下四个参数描
式中，cθi =cosθi ，sθi =sinθi ，i=1，2，3，···，n
图1连杆坐标系{i}到{i-1}的变换
i
αi-1/（rad ）a i-1/（cm ）d i /（cm 12340
90°090°042.5410014.520011.895.3表1机器人连杆参数表
定义了连杆坐标系和相应得连杆参数，就能建立运动学方程，焊接机器人末端关节的坐标系{n}相对于基础坐标系{0}中的齐次变换公式为：
对于6自由度的焊接机器人公式可以写为
（2
变换矩阵0
n T是关于n个关节变量的函数，这些变量
可以通过放置在关节上的传感器测得，则机器人末端连杆再基坐标系中的位置和姿态就能描述出来。
E n表示焊接机器人末端关节的姿态，
器人在世界坐标系中的位置。[3]
2机器人的逆运动学分析
逆运动学求解是已知机器人末端的位置和姿态即
求解机器人对应于该位置和姿态的关节角
只要0
n T表示的末端连杆坐标系的位置和姿态位于机
械手的可达空间内，则运动学方程至少有一个解，
达空间内，机械手具有任意姿态，导致运动学方程可能出现重解。
机器人的运动学方程是一组非线性方程式，
求解过程中，我们逐次在公式（4）的两端同时左乘一
即为
在上式两边的矩阵中寻找简单的表达式或常数，
对应相等，计算过程如下：
（
（
（
（
（
（3求取各关节的解集
依靠D-H法求解关节角的过程是和焊接机器人本身的结构相关的，换句话说，也就是特定配置的机器人需要特定的解决方案。通过公式（6）-（16）可以看出每个关节角的结果是不唯一的，如果采用已有的求解方法，显而易见该过程是缓慢的，复杂的。本文提出了一种计算最终执行器位置的所有精确值的算法。该算法是在MATLAB
程实现的。通过该算法得到各节点的解是更快速、有效的。
用变换矩阵
6T定义一条具有两个端点A和B
轨迹，如公式（17）和（19）。从而θ能够被求出，如公式20）
图2
由于关节角的求取依靠先前的关节角值，建立运动函数方程。为了获得每个关节角的所有解，先前的关节角值作为求取下一组关节角的参数。了清晰的流程图。
4结论
本文首先通过正运动学分析得到连杆坐标系进而求[2]蔡玉强，朱东升.龙门式焊接机器人制动过程的动力学特
性优化[J].华北理工大学学报（自然科学版），2017，39（04）：52-59.
[3]韩兴国，宋小辉，殷鸣，陈海军，殷国富.6R 焊接机器人逆解算法与焊接轨迹误差分析[J].农业机械学报，2017，48（384-390，412.
[4]谢黎明，张秀林，靳岚.基于ADAMS 的焊接机器人逆运动学求解[J].机械制造与自动化，2014，43（05）：146-149，166.
[5]金方强，高洪明，何广忠，吴林.焊接机器人逆运动学求解的通用高效算法[J].机电工程技术，2004（06）：48-51.
[6]林尚扬.焊接机器人及其应用[M].北京：机械工业出版社，2000.
焊接机器人运动分析 摘要：针对puma250焊接机器人，分析了它的正运动学、逆运动学的问题。采用D-H坐标系对机器人puma250 建立6个关节的坐标系并获取D-H 参数，并对其运动建立数学模型用MATLAB编程，同时仿真正运动学、逆运动学求解和轨迹规划利用pro-e对puma250建模三维模型。 关键词：puma250焊接机器人；正逆解；pro-e；Matlab；仿真 一、建立机器手三维图 Puma250机器人,具有6各自由度，即6个关节，其构成示意图如图1。各连杆包括腰部、两个臀部、腕部和手抓。设腰部为1连杆，两个臀部分别为2、3连杆，腰部为4连杆，手抓为5、6连杆，基座不包含在连杆范围之内，但看作0连杆，其中关节2、3、4使机械手工作空间可达空间成为灵活空间。1关节连接1连杆与基座0,2关节连接2连杆与1连杆，3关节连接3连杆与2连按，4关节连接4连杆与3连杆，5关节连接5连杆与4连杆。各连杆坐标系如图 2 所示。
图1 puma250 机器人二、建立连杆直角坐标系。
三、根据坐标系确定D-H表。 四、利用MATLAB 编程求机械手仿真图。>>L1=Link([pi/2 0 0 0 0],'standard'); L2=Link([0 0 0 -pi/2 0],'standard'); L3=Link([0 -4 8 0 0],'standard'); L4=Link([-pi/2 0 8 0 0],'standard'); L5=Link([-pi/2 0 0 -pi/2 0],'standard'); L6=Link([0 2 0 -pi/2 0],'standard'); bot=SerialLink([L1 L2 L3 L4 L5 L6],'name','ROBOT'); ([0 0 0 0 0 0])
1.1连杆的坐标系 应用D-H 法来建立机器人杆件的坐标系。在这种坐标系中，可以把机械手的任一连杆i （i=1，2，3···，n ）看作是一个刚体，与它相邻的两个关节i 、i-1的轴线i 和i-1 之间的关系也由它确定，如图1，可以用以下四个参数描 式中，cθi =cosθi ，sθi =sinθi ，i=1，2，3，···，n 图1连杆坐标系{i}到{i-1}的变换 i αi-1/（rad ）a i-1/（cm ）d i /（cm 12340 90°090°042.5410014.520011.895.3表1机器人连杆参数表
定义了连杆坐标系和相应得连杆参数，就能建立运动学方程，焊接机器人末端关节的坐标系{n}相对于基础坐标系{0}中的齐次变换公式为： 对于6自由度的焊接机器人公式可以写为 （2 变换矩阵0 n T是关于n个关节变量的函数，这些变量 可以通过放置在关节上的传感器测得，则机器人末端连杆再基坐标系中的位置和姿态就能描述出来。 E n表示焊接机器人末端关节的姿态， 器人在世界坐标系中的位置。[3] 2机器人的逆运动学分析 逆运动学求解是已知机器人末端的位置和姿态即 求解机器人对应于该位置和姿态的关节角 只要0 n T表示的末端连杆坐标系的位置和姿态位于机 械手的可达空间内，则运动学方程至少有一个解， 达空间内，机械手具有任意姿态，导致运动学方程可能出现重解。 机器人的运动学方程是一组非线性方程式， 求解过程中，我们逐次在公式（4）的两端同时左乘一 即为 在上式两边的矩阵中寻找简单的表达式或常数， 对应相等，计算过程如下： （ （ （ （ （ （3求取各关节的解集 依靠D-H法求解关节角的过程是和焊接机器人本身的结构相关的，换句话说，也就是特定配置的机器人需要特定的解决方案。通过公式（6）-（16）可以看出每个关节角的结果是不唯一的，如果采用已有的求解方法，显而易见该过程是缓慢的，复杂的。本文提出了一种计算最终执行器位置的所有精确值的算法。该算法是在MATLAB 程实现的。通过该算法得到各节点的解是更快速、有效的。 用变换矩阵 6T定义一条具有两个端点A和B 轨迹，如公式（17）和（19）。从而θ能够被求出，如公式20）
精心整理 焊接机器人离线编程应用技术 一、引述 随着国内外机械装备制造事业飞速发展，对各种机械设备的生产周期、产品质量、制造成本，提出了更高的要求。为了适应这种形势，设法提高及保证焊接接头质量的稳定性，机器人的柔性优势正是解决这一问题的的良好方案。 二、机器人系统简介 通用工业机器人，按其功能划分，一般由3个相互关连的部分组成：机械手总成、控制器、 教者的经验目测决定，对于复杂路径难以保证示教点的精确结果。而离线编程是将机器人所有编程的工作内容在计算机软件在完成，过程一般包括：机器人及设备的作业任务描述、建立变换方程、求解未知矩阵及编制任务程序等。在进行图形仿真以后，根据动态仿真的结果，对程序做适当的修正，以达到满意效果，最后在线控制机器人运动以完成作业。节省了在机器人上编程的时间、离线编程的程序易于修改、通过仿真模拟后，防止昂贵的设备发生碰撞而损坏、结合CAD 软件系统和其它人工智能技术与机器人系统一体化，来提高工作效率和焊接质量。由此看来当焊缝是直线或者简单曲线，焊缝上方没有干涉物且焊缝的精度要求不太高的情况下，采用在线示教的编程方式是非常理想的，但在许多复杂的作业应用中不是那么令人满意了。
因此，机器人离线编程及仿真是提高机器人焊接系统柔性化的一项关键技术，是现代机器人焊接制造业的一个重要方法。一般工业机器人焊接时，机器人对焊接过程动态变化、焊件变形和随机因素干扰等不具有自适应能力。随着焊接产品的高质量、多品种、小批量等要求增加，又对机器人焊接技术提出了更高要求。这就需要对本体机器人焊接系统进行二次开发，包括给焊接机器人配置适当的传感器，柔性周边设备以及相应软件功能，如焊缝跟踪传感、焊接过程传感与实时控制、焊接变位机构。这些功能大大扩展了基本的焊接机器人的功能，这样的焊接机器人系统智能程度的高低由所配置的传感器、控制系统以及软硬件所决定。根据目前的整体技术还不太容易满足机器人焊接的所有智能要求，但这是个重要的发展趋势。 其它 发那科公司的Roboguide以及日本OTC公司使用的离线模拟仿真软件就叫OTC。国内机器人厂家暂时还没有完全自主知识产权的模拟仿真软件。因为这些机器人公司业务主体是机器人与控制系统，而并非专业的软件公司，这些机器人厂家为了使自己的机器人更加适应市场需求，同时出于对机器人系统技术保护的考虑，而开发了只可用于自己公司机器人系统的离线模拟示教软件。这些软件虽然没有三维建模功能，但可以导入其它CAD软件设计的模型文件，通过虚拟示教方式离线编程，对于简单焊缝的作业倒也实用。
二自由度机械臂动力 学分析
平面二自由度机械臂动力学分析 姓名：黄辉龙 专业年级：13级机电 单位：汕头大学 摘要：机器臂是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，这里主要对平面二自由度机械臂进行动力学研究。拉格朗日方程在多刚体系统动力学的应用方法分析平面二自由度机械臂的正向动力学。经过分析，得出平面二自由度机械臂的动力学方程，为后续更深入研究做铺垫。 关键字：平面二自由度 动力学方程 拉格朗日方程 相关介绍 机器人动力学的研究有牛顿-欧拉（Newton-Euler ）法、拉格朗日 (Langrange)法、高斯（Gauss ）法等，但一般在构建机器人动力学方程中，多采用牛顿-欧拉法及拉格朗日法。 欧拉方程又称牛顿-欧拉方程，应用欧拉方程建立机器人机构的动力学方程是指研究构件质心的运动使用牛顿方程，研究相对于构件质心的转动使用欧拉方程，欧拉方程表征了力、力矩、惯性张量和加速度之间的关系。 在机器人的动力学研究中，主要应用拉格朗日方程建立机器人的动力学方程，这类方程可直接表示为系统控制输入的函数，若采用齐次坐标，递推的拉格朗日方程也可以建立比较方便且有效的动力学方程。 在求解机器人动力学方程过程中，其问题有两类： 1)给出已知轨迹点上? ??θθθ、及、 ，即机器人关节位置、速度和加速度，求相应的关节力矩矢量τ。这对实现机器人动态控制是相当有用的。 2)已知关节驱动力矩，求机器人系统相应各瞬时的运动。也就是说，给出关节力矩矢量τ，求机器人所产生的运动? ??θθθ、及、 。这对模拟机器人的运动是非常有用的。 平面二自由度机械臂动力学方程分析及推导过程 1、机器人是结构复杂的连杆系统，一般采用齐次变换的方法，用拉格朗日方程建立其系统动力学方程，对其位姿和运动状态进行描述。机器人动力学方程的具体推导过程如下： 1) 选取坐标系，选定完全而且独立的广义关节变量n r ,,2,1,r ???=θ。 2) 选定相应关节上的广义力r F ：当r θ是位移变量时，r F 为力；当r θ是角度变量时，r F 为力矩。 3)求出机器人各构件的动能和势能，构造拉格朗日函数。 4) 代入拉格朗日方程求得机器人系统的动力学方程。 2、下面以图1所示说明机器人二自由度机械臂动力学方程的推导过程。
机器人动力学研究的典型方法和应用 （燕山大学 机械工程学院） 摘 要：本文介绍了动力学分析的基础知识，总结了机器人动力学分析过程中比较常用的动力学分析的方法：牛顿—欧拉法、拉格朗日法、凯恩法、虚功原理法、微分几何原理法、旋量对偶数法、高斯方法等，并且介绍了各个方法的特点。并通过对PTl300型码垛机器人弹簧平衡机构动力学方法研究，详细分析了各个研究方法的优越性和方法的选择。 前 言：机器人动力学的目的是多方面的。机器人动力学主要是研究机器人机构的动力学。机器人机构包括机械结构和驱动装置，它是机器人的本体，也是机器人实现各种功能运动和操作任务的执行机构，同时也是机器人系统中被控制的对象。目前用计算机辅助方法建立和求解机器人机构的动力学模型是研究机器人动力学的主要方法。动力学研究的主要途径是建立和求解机器人的动力学模型。所谓动力学模指的是一组动力学方程（运动微分方程），把这样的模型作为研究力学和模拟运动的有效工具。 报告正文： （1）机器人动力学研究的方法 1）牛顿—欧拉法 应用牛顿—欧拉法来建立机器人机构的动力学方程，是指对质心的运动和转动分别用牛顿方程和欧拉方程。把机器人每个连杆（或称构件）看做一个刚体。如果已知连杆的表征质量分布和质心位置的惯量张量，那么，为了使连杆运动，必须使其加速或减速，这时所需的力和力矩是期望加速度和连杆质量及其分布的函数。牛顿—欧拉方程就表明力、力矩、惯性和加速度之间的相互关系。 若刚体的质量为m ，为使质心得到加速度a 所必须的作用在质心的力为F ，则按牛顿方程有：ma F = 为使刚体得到角速度ω、角加速度εω= 的转动，必须在刚体上作用一力矩M ， 则按欧拉方程有：εωI I M += 式中，F 、a 、M 、ω、ε都是三维矢量；I 为刚体相对于原点通过质心并与刚
焊接机器人的运动控制系统 作为焊接机器人的用户，为正确选择、合理使用并做到能常规维护焊接机器人，必须对焊接机器人的运动控制系统有一定层次的了解。 焊接机器人是装上了焊钳或各种焊枪的工业机器人。工业机器人的运动控制系统涉及数学、自动控制理论等，内容很多。要在较短的篇幅中，全面而系统地介绍工业机器人的运动控制系统，实在是非工业机器人控制专业人员所能及的事情，因此，本章内容是从焊接机器人的用户角度出发，尽量以图代解、简明地阐述有关机器人运动控制系统的一般性问题。 焊接机器人运动轴的定义 点焊与弧焊两种机器人都是由典型6关节型（也称6轴）工业机器人装上焊钳或焊枪而构成，因此，讨论焊接机器人运动系统构成，亦即讨论典型6关节工业机器人的运动系统构成。顾名思义，典型6关节工业机器人有6个可活动的关节，每个关节的运动名称都有定义，在图2中，给出了典型6关节工业机器人各关节的编号与动作状态（编号后面的英文大写字母就是规定动作英文名称的第一个字母），每个关节的运动都由一个伺服电（动）机驱动，每个电机都有各自的伺服控制系统。机器人最后“手”关节上所安装的工具中心点（TCP）（对点焊钳与电焊枪的TCP点，在相应的机器人结构中都作了规定）的运动轨迹是多个关节伺服系统协同动作的结果。而机器人运动控制系统（器）的作用就是如何根据编程指令来指挥控制6个伺服电（动）机协同动作，以完成工具中心点所要求实现的运动轨迹。 焊接机器人的运动轴参数 焊接机器人的运动轴参数主要包括：各轴最大运动范围、最大速度、相关轴的容许转距、相关轴的容许惯性力矩等 焊接机器人运动控制系统的组成 对机器人运动控制系统的一般要求 机器人控制系统是机器人的重要组成部分，主要用于对机器人运动的控制，以完成特定的工作任务，其基本功能如下： 记忆功能：存储作业顺序、运动路径、运动方式、运动速度和与生产工艺有
电子科技大学 实验报告 学生姓名： 一、实验室名称：机电一体化实验室 二、实验项目名称：实验三SCARA 学号： 机器人的运动学分析 三、实验原理： 机器人正运动学所研究的内容是：给定机器人各关节的角度，计算机器人末端执行器相对于参考坐标系的位置和姿态问题。 各连杆变换矩阵相乘，可得到机器人末端执行器的位姿方程（正运动学方程） 为： n x o x a x p x 0T40T1 11T2 22T3 d3 n y o y a y p y （ 1-5）3T4 4= o z a z p z n z 0001 式 1-5 表示了 SCARA 手臂变换矩阵0 T4，它描述了末端连杆坐标系{4} 相对基坐标系 {0} 的位姿，是机械手运动分析和综合的基础。 式中： n x c1c2c4s1 s2 c4 c1 s2s4s1 c2 s4，n y s1c2 c4c1 s2 c4s1 s2 s4c1c2 s4 n z0 ， o x c1c2 s4s1 s2 s4 c1 s2 c4s1c2c4 o y s1c2 s4c1 s2 s4s1 s2 c4c1c2c4 o z0 ， a x0 ， a y0 ， a z1 p x c1 c2 l2s1s2l 2c1l 1， p y s1c2 l 2 c1 s2 l 2 s1l1， p z d3 机器人逆运动学研究的内容是：已知机器人末端的位置和姿态，求机器人对应于这个位置和姿态的全部关节角，以驱动关节上的电机，从而使手部的位姿符合要求。与机器人正运动学分析不同，逆问题的解是复杂的，而且具有多解性。
1）求关节 1： 1 A arctg 1 A 2 l 12 l 22 p x 2 p y 2 arctg p x 式中：A p x 2 ； p y 2l 1 p y 2 2）求关节 2： 2 r cos( 1 ) arctg ) l 1 r sin( 1 式中 ： r p x 2 p y 2 ；arctg p x p y 3). 求 关节变 量 d 3 令左右矩阵中的第三行第四个元素（3.4）相等，可得： d 3 p z 4). 求 关节变 量 θ 4 令左右矩阵中的第二行第一个元素（1.1,2.1 ）相等，即： sin 1 n x cos 1n y sin 2 cos 4 cos 2 sin 4 由上式可求得： 4 arctg ( sin 1 n x cos 1 n y )2 cos 1 n x sin 1 n y 四、实验目的： 1. 理解 SCARA 机器人运动学的 D-H 坐标系的建立方法； 2. 掌握 SCARA 机器人的运动学方程的建立； 3. 会运用方程求解运动学的正解和反解； （ 1-8） （ 1-9） （ 1-10 ）
本 科 毕 业 论 文（设 计） 题目（中文 学学 完 成 日 期 2017 年 3 月
摘要 当今世界，工业化日趋成熟，机器人被广泛的应用于各行各业，最常用到的有四自由度，六自由度机器人。其中，自动化水平较高的汽车制造业和电子装配业经常常常要使用到六自由度机器人。因此对其实施运动学分析，是进行科学设计的基础，也是降低机器人生产成本，优化机器人运动轨迹的前提。此外，运动分析过程有效的模拟了机器人运动的真实情况，有助于提供有效可行的优化方案。本文主要探讨六自由度机器人的运动分析，基于经典运动学以及动力学的研究方法概念，首先通过solidworks做出机械臂各部分零件的三维图，然后通过SolidWorks装配出六自由度机器人机械臂的三维模型。通过该模型，选取其中一个关节和底座，并用SolidWorks进行运动学分析，对六自由度机器人的运动学和动力学计算方法进行了仿真验证。最后得到六自由度机器人的其中一个自由度的运动仿真实例。通过对该运动仿真实例的分析，得出最佳优化方案，优化机器人的运动轨迹提高机器人的工作效率，降低机器人生产成本。 关键词：六自由度机器人；运动分析；运动学；动力学；
目录 摘要 ...................................................................................................................... I Abstract ............................................................................... 错误！未定义书签。 1 绪论 (1) 1.1课题背景及研究的目的和意义 (1) 1.2机器人国内外发展现状及前景展望--------------------------1 2 六自由度机器人运动学分析 (3) 2.1六自由度机器人的结构-------------------------------------1 2.2运动学分析----------------------------------------------1 3 六自由度机器人动力学分析 (5) 3.1综述----------------------------------------------------3 3.2机器人动力学研究方法------------------------------------3 3.2.1几项假设-------------------------------------------3 3.2.2目标-----------------------------------------------4 3.2.3数学工具-------------------------------------------5 3.3动力学原理----------------------------------------------3 3.3.1动量矩定理---------------------------------------------------------------6 3.3.2能量守恒定理--------------------------------------6 3.3.3牛顿—欧拉方程------------------------------------7 3.3.4达朗贝尔原理--------------------------------------8 3.3.5拉格朗日方程--------------------------------------9 4 六自由度机器人运动分析 (8) 4.1运动分析的软件背景---------------------------------------3 4.2运用solidworks建立六度机器人机械臂三维模型--------------9 4.3运用Solidworks对进行运动学分析-------------------------4 5 结论 (14)
平面二自由度机械臂动力学分析 [摘要] 机器臂是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，这里主要对平面二自由度机械臂进行动力学研究。本文采用拉格朗日方程在多刚体系统动力学的应用方法分析平面二自由度机械臂的正向动力学。经过研究得出平面二自由度机械臂的动力学方程，为后续更深入研究做铺垫。 [关键字] 平面二自由度 一、介绍 机器人是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，简化解的过程，最大限度地减少工业机器人动力学在线计算的时间是一个受到关注的研究课题。 机器人动力学问题有两类： (1) 给出已知的轨迹点上的，即机器人关节位置、速度和加速度，求相应的关节力矩向量Q r。这对实现机器人动态控制是相当有用的。 (2) 已知关节驱动力矩，求机器人系统相应的各瞬时的运动。也就是说，给出关节力矩向量τ，求机器人所产生的运动。这对模拟机器人的运动是非常有用的。 二、二自由度机器臂动力学方程的推导过程 机器人是结构复杂的连杆系统，一般采用齐次变换的方法，用拉格朗日方程建立其系统动力学方程，对其位姿和运动状态进行描述。机器人动力学方程的具体推导过程如下： (1) 选取坐标系，选定完全而且独立的广义关节变量θr ，r=1, 2,…, n。 (2) 选定相应关节上的广义力F r：当θr是位移变量时，F r为力；当θr是角度变量时， F r为力矩。 (3) 求出机器人各构件的动能和势能，构造拉格朗日函数。 (4) 代入拉格朗日方程求得机器人系统的动力学方程。 下面以图1所示说明机器人二自由度机械臂动力学方程的推导过程。
作者简介：王求（１９７８－），男，在读硕士研究生；研究方向为焊接机器人运动学，材料焊接及其数值模拟。 合肥工业大学材料科学与工程学院 王求 胡小建 李雷阵 摘 要：关键词：针对在狭小空间或密闭容器内以及危险作业环境中焊接的特殊要求，以ＵＧ软件为基础设计了一种仿人焊接 机械手。采用Ｄ－Ｈ方法建立了焊接机械手的运动学方程，并讨论了该机械手的运动学问题。然后运用ＭＡＴＬＡＢ软件对机械手的运动学进行了仿真，通过仿真观察到机械手各个关节的运动，并得到所需的数据，说明了所设计参数的合理性和运动算法的正确性，为焊接机械手的动力学、控制及轨迹规划的研究提供了可靠的依据。焊接机械手；运动学；仿真；Ｍａｔｌａｂ 基于ＭＡＴＬＡＢ的仿人焊接机械手运动学分析和仿真 机器人技术作为信息技术和先进制造技术的典型代表和主要技术手段，已成为世界各发达国家竞相发展的高技术，其发展水平已经成为衡量一个国家技术发展水平的重要标志之一。焊接是制造业中最重要的工艺技术之一，它在机械制造、核工业、航空航天、能源交通、石油化工及建筑和电子等行业中的应用越来越广泛。从２１世纪先进制造技术的发展要求来看，焊接自动化生产已是必然趋势，而焊接机器人是焊接自动化的革命性进步 。但是现阶段的焊接机器人都是具 有固定底座的机械手（臂），只能在固定位置完成一定范围内的操作，适应性较低。进行复杂苛刻条件（如小直径的容器内径中焊接）和危险环境（如有辐射等作业环境）中焊接作业时，要求可以代替人类从事焊接作业的机器人，而焊接机械手是实现焊接机器人的关键技术，因此设计出一种小型焊接机械手，可以作为仿人焊接机器人的执行末端，也可以直接作为 ［１］ ［２］ 焊接的执行末端，能代替焊工实现在狭小空间或者密闭容器内以及危险作业环境中的焊接。本文根据预定要求对焊接机械手进行机械结构设计，以ＵＧ软件进行造型，然后运用Ｄ－Ｈ坐标系理论为基础建模，讨论了机械手的运动学问题，并运用Ｍａｔｌａｂ中的Ｒｏ－ｂｏｔｉｃｓＴｏｏｌｂｏｘ完成了机械手的运动学仿真和轨迹规划。 机械手主要用于点焊或弧焊，其 末端载荷要求不高，能够承受焊枪质量即可，以抓持力１ｋｇ为依据进行设计。考虑机械手的工作条件，机械手本体质量小于１０ｋｇ。机械手本体由基座、肩部、大臂、小臂、手腕、末端执行器所组成，共６个自由度，其中前３个自由度用于控制焊枪端部的空间位置，后３个自由度用于控制焊枪的空间姿态。机械手共６个关节，６个关节全部为转动关节，每个关节实现１个自由度，６个关节实现的运动分别是：１－肩部回转；２－大臂俯仰；３－小臂俯仰；４－小臂回转；５－手腕俯仰；６－手腕 ［３］ ［４］ １焊接机械手结构设计 回转，如图１所示。根据机械手的设计要求，对机械手进行整体设计，使用ＵＧ软件进行机械手的三维建模，三维造型如图２所示。 机械手的运动学主要研究机械手 相对于固定参考系的运动，特别是研究机械手末端执行器位置和姿态与关节空间变量的关系。机械手运动学要 ２运动学分析 ［５］Analysis and simulation of kinesiology of simulated welding mechanical hand based on MATLAB
六轴联动机械臂运动学及动力学求解分析 V0.9版 随着版本的不断更新，旧版本文档中的一些笔误得到了修正，同时文档内容更丰富，仿真程序更完善。 作者朱森光 Email zsgsoft@https://www.doczj.com/doc/5117747415.html, 完成时间 2016-02-28
1引言 笔者研究六轴联动机械臂源于当前的机器人产业热，平时比较关注当前热门产业的发展方向。笔者从事的工作是软件开发，工作内容跟机器人无关，但不妨碍研究机器人运动学及动力学，因为机器人运动学及动力学用到的纯粹是数学和计算机编程知识，学过线性代数和计算机编程技术的人都能研究它。利用业余时间翻阅了机器人运动学相关资料后撰写此文，希望能够起到抛砖引玉的作用引发更多的人发表有关机器人技术的原创性技术文章。本文内容的正确性经过笔者编程仿真验证可以信赖。 2机器建模 既然要研究机器人，那么首先要建立一个机械模型，本文将以典型的六轴联动机器臂为例进行介绍，图2-1为笔者使用3D技术建立的一个简单模型。首先建立一个大地坐标系，一般教科书上都是以大地为XY平面，垂直于大地向上方向为Z轴，本文为了跟教科书上有所区别同时不失一般性，将以水平向右方向为X轴，垂直于大地向上方向为Y轴，背离机器人面向人眼的方向为Z轴，移到电脑屏幕上那就是屏幕水平向右方向为X轴，屏幕竖直向上方向为Y轴，垂直于屏幕向外为Z轴，之所以建立这样不合常规的坐标系是希望能够突破常规的思维定势训练在任意空间建立任意坐标系的能力。 图2-1 图2-1中的机械臂，底部灰色立方体示意机械臂底座，定义为关节1，它能绕图中Y轴旋转；青色长方体示意关节2，它能绕图中的Z1轴旋转；蓝色长方体示意关节3，它能绕图中的Z2轴旋转；绿色长方体示意关节4，它能绕图中的X3轴旋转；深灰色长方体示意关节5，它能绕图中的Z4轴旋转；末端浅灰色机构示意关节6即最终要控制的机械手，机器人代替人的工作就是通过这只手完成的，它能绕图中的X5轴旋转。这儿采用关节这个词可能有点不够精确，先这么意会着理解吧。 3运动学分析 3.1齐次变换矩阵 齐次变换矩阵是机器人技术里最重要的数学分析工具之一，关于齐次变换矩阵的原理很多教科书中已经描述在此不再详述，这里仅针对图2-1的机械臂写出齐次变换矩阵的生成过程。首先定义一些变量符号，关节1绕图中Y轴旋转的角度定义为θ0，当θ0=0时，O1点在OXYZ坐标系内的坐标是(x0,y0,0)；关节2绕图中的Z1轴旋转的角度定义为θ1，图中的θ1当前位置值为+90度；定义O1O2两点距离为x1,关节3绕图中的Z2轴旋转的角度定义为θ2，图中的θ2当前位置值为-90度；O2O3两点距离为x2，关节4绕图中的X3轴旋转的角度定义为θ3, 图中的θ3当前位置值为0度；O3O4两点距离为x3，关节5绕图中的Z4轴旋转的角度定义为θ4, 图中的θ4当前位置值为-60度；O4O5两点距离为x4，关节6绕图中的X5轴旋转的角度定义为θ5, 图中的θ5当前位置值为0度。以上定义中角度正负值定义符合右手法则,所有角度定义值均为本关节坐标系相对前一关节坐标系的相对旋转角度值（一些资料上将O4O5两点重合在一起即O4O5两点的距离x4退化为零，本文定义x4大于零使得讨论时更加不失一般性）。符号定义好了，接下来描述齐次变换矩阵。 定义R0为关节1绕Y轴的旋转矩阵 =cosθ0 s0 = sinθ0 //c0 R0 =[c0 0 s0 0 0 1 0 0 0 c0 0 -s0 0 0 0 1] 定义T0为坐标系O1X1Y1Z1相对坐标系OXYZ的平移矩阵 T0=[1 0 0 x0 0 1 0 y0 00 1 0 0 0 0 1] 定义R1为关节2绕Z1轴的旋转矩阵 R1=[c1 –s1 0 0 s1 c1 0 0
注：1）2008年春季讲课用；2）带下划线的黑体字为板书内容；3）公式及带波浪线的部分为必讲内容第3章工业机器人静力学及动力学分析 3.1 引言 在第2章中，我们只讨论了工业机器人的位移关系，还未涉及到力、速度、加速度。由理论力学的知识我们知道，动力学研究的是物体的运动和受力之间的关系。要对工业机器人进行合理的设计与性能分析，在使用中实现动态性能良好的实时控制，就需要对工业机器人的动力学进行分析。在本章中，我们将介绍工业机器人在实际作业中遇到的静力学和动力学问题，为以后“工业机器人控制”等章的学习打下一个基础。 在后面的叙述中，我们所说的力或力矩都是“广义的”，包括力和力矩。 工业机器人作业时，在工业机器人与环境之间存在着相互作用力。外界对手部（或末端操作器）的作用力将导致各关节产生相应的作用力。假定工业机器人各关节“锁住”，关节的“锁定用”力与外界环境施加给手部的作用力取得静力学平衡。工业机器人静力学就是分析手部上的作用力与各关节“锁定用”力之间的平衡关系，从而根据外界环境在手部上的作用力求出各关节的“锁定用”力，或者根据已知的关节驱动力求解出手部的输出力。 关节的驱动力与手部施加的力之间的关系是工业机器人操作臂力控制的基础，也是利用达朗贝尔原理解决工业机器人动力学问题的基础。 工业机器人动力学问题有两类：(1)动力学正问题——已知关节的驱动力，求工业机器人系统相应的运动参数，包括关节位移、速度和加速度。(2)动力学逆问题——已知运动轨迹点上的关节位移、速度和加速度，求出相应的关节力矩。 研究工业机器人动力学的目的是多方面的。动力学正问题对工业机器人运动仿真是非常有用的。动力学逆问题对实现工业机器人实时控制是相当有用的。利用动力学模型，实现最优控制，以期达到良好的动态性能和最优指标。 工业机器人动力学模型主要用于工业机器人的设计和离线编程。在设计中需根据连杆质量、运动学和动力学参数，传动机构特征和负载大小进行动态仿真，对其性能进行分析，从而决定工业机器人的结构参数和传动方案，验算设计方案的合理性和可行性。在离线编程时，为了估计工业机器人高速运动引起的动载荷和路径偏差，要进行路径控制仿真和动态模型的仿真。这些都必须以工业机器人动力学模型为基础。 工业机器人是一个非线性的复杂的动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间。因此，简化求解过程，最大限度地减少工业机器人动力学在线计算的时间是一个受到关注的研究课题。 在这一章里，我们将首先讨论与工业机器人速度和静力学有关的雅可比矩阵，然后介绍工业机器人的静力学问题和动力学问题。