三自由度焊接机器人设计（有全套图纸） .pdf

本科毕业设计（论文）通过答辩 摘摘 要要 随着工业水平的发展,重要的大型焊接结构件的应用越来越多,其中大量的焊接工 作必须在现场作业,如集装箱波纹板焊接机器人、大型舰船舱体、甲板的焊接、大型球 罐(储罐)的焊接等。而这些焊接场合下，焊接机器人要适应焊缝的变化，才能做到提 高焊接自动化的水平。 无疑,将机器人技术和焊缝跟踪技术结合将有效地解决大型结构 件野外作业的自动化焊接难题。因此机器人的设计对于解决这一难题至关重要。 本课题主要完成机器人运动学的逆解、车体的总体设计、电机的选择等方面。主 要从机器人运动学逆解的角度完成一个周期内的运动学逆解，求出三个关节应按照什 么运动规律进行运动，还有三个关节的运动之间的函数关系，进而完成对整个机器人 的总体设计。通过对小车的受力分析完成对车轮、车体的设计。根据实际操作中遇到 的问题对完成对电机的选择。最后对所选的齿轮进行校核，使之能完成具体的操作要 求。 关键词机器人技术机构设计运动学逆解强度校核 本科毕业设计（论文）通过答辩 目目录录 1绪论.1 1.1选题的依据及意义.1 1.2研究现状及发展趋势.1 1.3本课题的研究设计内容及方法.3 1.4课题的完成情况.5 2焊接机器人机构运动学分析.6 2.1运动学分析数学基础-齐次变换（d-h 变换）.6 2.2变换方程的建立.7 2.3运动学分析处理方法.9 2.4逆解过程.10 2.5本章小结.28 3结构设计.30 3.1小车行走结构设计.30 3.2摆动关节电机选择.36 3.3本章小结.36 结束语.38 致谢.39 参考文献.40 附录.41 本科毕业设计（论文）通过答辩 1 1绪论绪论 1.11.1选题的依据及意义选题的依据及意义 这里介绍该课题的选题背景，以及完成该课题的意义。 1.1.1选题的依据 针对集装箱波纹板焊接自动化水平低的现状：目前用于焊接集装箱侧板与顶侧 梁、底侧梁的自动焊专机，由于在焊接过程中，焊枪不能随波形的变化调整与焊枪速 度的夹角（焊接工艺参数也未有变化） ，如图 1.1 所示，在直线段与在波内斜边段， 焊接速度方向恒为水平向右，而焊枪与焊缝保持垂直，故焊枪与焊接速度的夹角不能 保持恒定，直接导致在直线段的焊缝成形与在波内斜边段的焊缝成形不能保持一致， 进而导致在直线段焊接与在波内斜边段焊接的焊缝的质量不一样，进而制约集装箱的 生产质量1。 图 1.1集装箱波纹板示意图 1.1.2选题的意义 通过完成该课题，即设计出集装箱波纹板三自由度焊接机器人及对其进行运动学 分析，能够解决在焊接过程中焊枪不能随波形的变化调整与焊枪速度的夹角这个问 题，使得在直线段与在波内斜边段焊接时，焊枪与焊缝都保持垂直，相对于焊缝的焊 接速度都恒为同一速度，进而能够提高在直线段与在波内斜边段的焊缝成形的一致 性，提高集装箱的生产质量。 1.21.2研究现状及发展趋势研究现状及发展趋势 这里的研究现状及发展趋势包括三个方面：前面也提到这里的集装箱波纹板三自 由度焊接机器人（为移动焊接机器人）是为提高焊接自动化水平的，故这里为移动焊 本科毕业设计（论文）通过答辩 接机器人的研究现状及发展趋势；关于结构设计方面的研究现状及发展趋势；关于运 动学分析的常用方法 5。 1.2.1移动焊接机器人的研究现状及发展趋势 这里所设计的移动机器人为有轨移动焊接机器人，只是现有的移动焊接机器人技 术在集装箱波纹板焊接中的应用，是该领域的焊接自动化水平低的缘故，而当前的移 动焊接机器人技术有相当的发展。 随着工业水平的发展,重要的大型焊接结构件的应用越来越多,其中大量的焊接工 作必须在现场作业,如大型舰船舱体、甲板的焊接、大型球罐(储罐)的焊接等。而这 些焊接场合下，焊接机器人要适应焊缝的变化，才能做到提高焊接自动化的水平。无 疑,将机器人技术和焊缝跟踪技术结合将有效地解决大型结构件野外作业的自动化焊 接难题。 当前国内外在移动焊接机器人方向研制的几个典型移动焊接机器人如下： (1) 韩国 pukyong 国立大学的 kam b o 等研制的舱体格子形构件焊接移动机器人 这种机器人能够在人比较难以达到的狭窄空间自主地实现焊接过程,能够自动寻 找焊缝的起始点。在遇到格子框架的拐角焊缝时,在保证焊接速度不变且焊炬准确对 准焊缝的情况下,能够自动调整机器人本体和十字滑块的位置 4。 (2) 日本庆应大学学者 suga 等为平面薄板焊接研制的自主性移动焊接机器人 该机器人能够直线前进,还可以利用两个轮的差速控制小车的转弯,它装焊枪的 臂可以伸缩，可以检测焊缝的位置并精确的识别焊缝的形状,如是直线焊缝、曲线焊 缝、还是折线焊缝等 5。 (3) 日本庆应大学学者 suga 等研制了管道焊接自主移动机器人 该机器人可以沿着管道移动 ,根据 ccd 摄取的图象信息,在焊前可以自动寻找 并识别焊缝,然后使机器人本体沿管道方向移动达到正确的焊接位置 5。 (4) 清华大学机械工程系与北京石油化工学院装备技术研究所联合研制的球罐磁 吸附轮式移动焊接机器人 该机器人的焊炬跟踪精度可达0.5mm,能够满足实际工程应用 3。 (5) 上海交通大学研制的具有自寻迹功能的焊接移动机器人 该机器人在焊前,小车能够自动寻找焊缝并经过轨迹推算后自动调整小车本体和 焊炬的位姿到待焊状态；在焊接过程中能够进行横向大范围的实时焊缝跟踪 8。 当前绝大多数移动焊接机器人还能焊缝跟踪,焊前必须通过人为的方式,把机器 本科毕业设计（论文）通过答辩 人放到坡口附近合适的位置,并且通过手动将机器人本体、十字滑块等调整到合适的 待焊状态 ,也就是说机器人的自主性还很低,基本上还不具有自主的运动规划能力。 未来的发展趋势为三个方面：选择视觉传感器来进行传感跟踪，因为与图象处理 方面相关的技术得到发展；采用多传感信息融合技术以面对更为复杂的焊接任务；由 于控制技术由经典控制到向智能控制技术的发展，这也将是移动焊接机器人的控制所 采用。 1.2.2焊接机器人机构设计的研究现状及发展趋势 在当前，机器人的机构设计绝大部分还是采用依据具体的情况来设计专用焊接机 器人， 称之为固定结构的传统机器人， 其运动特性使特定机器人仅能适应一定的范围, 不利于机器人的发展。解决这一问题的方法就是利用关节模块和连杆模块,根据具体 的要求开发可重构机器人系统。下面为当前一些人所做的研究： (1) benhabib 等人建立的机器人库,将模块分成模块单元连接器、连杆模块、主 关节模块和末端关节模块四类 13； (2) 1999 年 danielarus 等提出了一种由晶体结构“分子”组成的可自重构机器 人系统 13； (3) 上海交通大学的费燕琼和沈阳航空工业学院的张艳丽等对模块化机器人的 构形设计进行了研究 13。 1.2.3运动学分析的常用方法 机器人逆运动学问题在机器人运动学、动力学及控制中占有非常重要的地位，直 接影响着控制的快速性与准确性。逆运动学问题就是根据已知的末端执行器的位姿 (位置和姿态)，求解相应的关节变量。 目前机器人运动学逆解方法有三种： (1) 以手臂的精确的几何模型为前提研究求解运动学方程的方法（几何法）。 该法只能用于特定结构的机器人。 (2) 通常在假设机器人的雅可比矩阵已知的前提下，利用其逆矩阵来求解逆运动 学（齐次变换法）。 (3) 智能求解方法。 该方法典型的有：基于学习的算法和神经网络算法；基于扩散方程的学习算法。 1.31.3本课题的研究设计内容及方法本课题的研究设计内容及方法 本课题所涉及的内容主要是两块，分别为关于集装箱波纹板三自由度焊接机器人 本科毕业设计（论文）通过答辩 机构的运动学分析，该机器人车体结构的设计。 1.3.1三自由度焊接机器人机构运动学分析 (1) 机构方案 根据实际的集装箱波纹板的焊接条件，我们采用三个运动关节的机器人：左右平 移的焊接机器人本体1、上下平移的十字滑块2和做摆动运动的末端效应器3（如图 1.2） 。 图 1.2三自由度焊接机器人关节模型（俯视图） (2) 证明该方案能够求出三个关节的运动学逆解，并且该解满足一定的约束，能 够有效的解决在集装箱波纹板在直线段中焊接的焊缝成形与在波内斜边段中焊接的 焊缝成形不一致。 (3) 所要解决的问题 熟悉运动学逆解的方法、建立运动学模型、找出变换关系、逆解。 (4) 方法 齐次坐标变换方法。 1.3.2焊接机器人结构设计 由于在这里借用了一个现成的运动关节上下平移的十字滑块，故这里所做的设计 主要为小车行走机构（即左右平移的焊接机器人本体1） 。 所要解决的问题及任务： 小车行走机构：车体结构方案的确定，驱动电机功率的估计，驱动电机的选择传 动的校核。 其它：摆动关节电机的选择等。 本科毕业设计（论文）通过答辩 1.41.4课题的完成情况课题的完成情况 (1) 确定集装箱波纹板焊接机器人总体机构方案，并对该机构存在运动学逆解， 并求出，该解满足集装箱波纹板的焊接要求。 (2) 做出了车体结构设计与校核。 本科毕业设计（论文）通过答辩 2 2焊接机器人机构运动学分析焊接机器人机构运动学分析 机器人运动学分析指的是机器人末端执行部件（手爪）的位移分析、速度分析及 加速度分析。根据机器人各个关节变量 qi（i=1，2，3， ，n）的值，便可计算出机 器人末端的位姿方程，称为机器人的运动学分析（正向运动学） ；反之，为了使机器 人所握工具相对参考系的位置满足给定的要求，计算相应的关节变量，这一过程称为 运动学逆解。从工程应用的角度来看，运动学逆解往往更加重要，它是机器人运动规 划和轨迹控制的基础。 在该课题里，很显然这里是已知末端执行器端点（焊枪）的位移，速度及焊枪与 焊缝间的夹角关系，来求三个关节的协调运动，即三个关节的运动规律，故为运动学 逆解。 2.12.1运动学分析数学基础运动学分析数学基础- -齐次变换（齐次变换（d-hd-h 变换）变换） 2.1.1齐次坐标 将直角坐标系中坐标轴上的单元格的量值 w 作为第四个元素，用有四个数所组成 的列向量 u= w z y x 来表示前述三维空间的直角坐标的点（a,b,c） t ,它们的关系为 a= w x ,b= w y ,c= w c 则（x,y,z,w） t 称为三维空间点（a,b,c） t 的齐次坐标。 这里所建立的直角坐标系的坐标轴上的单元格的量值 w=1，故（a,b,c,1） t 为三维 空间点（a,b,c） t 。 2.1.2齐次变换 对于任意齐次变换 t，可以将其分解为 t= 1000 paaa paaa paaa z333231 y232221 x131211 = 10 aa 1211 （2.1） 本科毕业设计（论文）通过答辩 11 a= 333231 232221 131211 aaa aaa aaa （2.2） 12 a=（ x p, y p, z p） t （2.3） 式 （2.2） 表示活动坐标系在参考系中的方向余旋阵， 即坐标变换中的旋转量； 而式 （2.3） 表示活动坐标系原点在参考系中的位置，即坐标变换中的平移量。 特殊情况有平移变换和旋转变换： 平移变换：transh (c , b ,a) = 1000 c100 b010 a001 (2.4) 旋转变换：rot(, z)= 1000 0100 00cossin 00sincos (2.5) 2.22.2变换方程的建立变换方程的建立 2.2.1机构运动原理 如图 2.1 所示，机器人采用三个运动关节：左右平移的焊接机器人本体 1，前后 平移的十字滑块和做旋转运动的末端效应器 3。通过三个关节之间的协调运动，来保 证末端效应器的姿态发生变化时，焊接速度保持不变，焊枪与焊缝间的夹角保持垂直 关系，来做到直线段与波内斜边段焊缝成形的一致。 图 2.1 三自由度焊接机器人运动简图（俯视图） 2.2.2运动学模型 本科毕业设计（论文）通过答辩 (1) 运动学模型简化 由于该机器人是为了实现这样一种运动： 焊枪末端运动轨迹一定， 焊接速度恒定， 故可以在运动学逆解时，对实际的关节结构进行简化，这里将对其采取等效处理： (a) 将关节 1（左右平移的焊接机器人本体 1）与关节 2（前后移动的十字滑块 2） 之间沿 z 轴的距离和关节 2 与关节 3（做旋转运动的末端效应器 3）的旋转中心点的 距离视为零，这对分析结果是等效的。 (b) 对旋转关节焊枪投影在 x-y 平面上进行等效。 (2) 设定机器人各关节坐标系 据简化后的模型可获得各个坐标系及其之间的关系，各个坐标系的 x，y 方向如 图 2.1 所示，z 方向都垂直该俯视图，且由前面的简化等效思想可知各个关节的运动 都处在 z=0 平面上。 (3) 求其次变换 通过齐次变换矩阵 tmn可以转求m中的某点在n中的坐标值。 根据公式（2.4） 、 （2.5）及图 2.1 可得 10 t= 1000 0100 0010 sl001 10 ， 21 t= 1000 0100 sl010 0001 21 ， 32 t= 1000 0100 l0cossin 00sincos 2 其中 l0,l1,l2分别表示初始时刻（t 0） ，三个坐系原点（oo1 ，o1o2，o 2o3 ）的距离长度，即参考坐标系与设置的动坐标位置矢量。s1为坐标系1原点在一 定时间 t.t0内沿 x 方向的位移， 且d 11 （s）=v , 1 v 为关节 1 的移动速度。 s 2 为坐标系2 点在一定时间 t.t0内沿 y 向的位移，且 22 ()d sv, 2 v 为关节 2 相对关节 1 的移动速度。 (4) 求 t30 由变换方程公式可知 10213230 tttt，带入 32 t ， 21 t ， 10 t 可得： 30 t= 1000 0100 sll0cossin sl0sincos 221 10 （2.6） 其几何意义为空间某一点相对于坐标系0及3的坐标值之间的变换矩阵。 本科毕业设计（论文）通过答辩 即： 1 z y x 0 0 0 = 1000 0100 sll0cossin sl0sincos 221 10 1 z y x 3 3 3 （2.7） (5) 求变换方程 在任意时刻 t，焊枪末端点的空间位置失量为（0,r,0,1）t，代入公式（2.7）可得 变换方程： 2210 100 cos sin sllry slrx （2.8） 2.32.3运动学分析处理方法运动学分析处理方法 2.3.1替换处理 转折点处用一半径为 r 的圆弧代替，其中半径 r 的大小受角的影响，角越大， r 越小；反之亦然。这样方能使运动的连续成为可能。 2.3.2衔接处理 在直线段与波内斜边段划出一小段来为过渡运动更加顺利的完成，这样过渡运动 过程运动分三小阶段。 现利用以上两处理方法处理第一个转折点的过渡运动，这一阶段是衔接两种运动 的过渡阶段： (1) 旋转关节的转角：0 到的过渡。 (2) 焊接速度 vw的方向：水平方向到与水平方向呈的夹角的过渡。 下面是该过渡阶段的运动示意图： t w tatbtatb 本科毕业设计（论文）通过答辩 ttatbtatb 图 2.2旋转关节在过渡处的运动示意图 2.3.3逆解函数 这里所求逆解都是以时间为自变量，由于这里焊接速度相对焊缝是恒定的 (tvs w )，故与以焊枪末端点的自然坐标系的位移为自变量是一致的，求解较方 便。 2.42.4逆解过程逆解过程 这台机器人焊接时，其运动存在三个约束：焊接速度恒定，焊接轨迹曲线一定， 焊枪与焊缝保持垂直。在这里，由前面的分析处理思想及方法可知，在过渡运动过程 中放弃了第三个约束，由于这么一小段位移比较短，不然的话，会导致无解，因为旋 转关节的角速度的必然连续。 这里将取波纹的一个周期进行运动学逆解， 求出三个关节应按照什么运动规律进 行运动，还有三个关节的运动之间的函数关系(波纹的一个周期的各个运动阶段的分 段示意图,如图 2.3)。 本科毕业设计（论文）通过答辩 图 2.3波纹的一个周期的各个运动阶段的分段示意图 这里假设 a 处为运动起始时刻，为字母（a，a ，b， ，h）代表焊接轨迹上的 点，t为焊枪末端点运动到该点处的时间， （x,y）代表该点在基坐标系上的坐标。 2.4.1ab 段（过渡段 1） 前面已经介绍过这里的处理方法，这一阶段是衔接两种运动的过渡阶段。这里又 细分三个小阶段：aa 直线段,a b 圆弧段，b b 直线段。为了提高焊接质量， 该过渡阶段仍然保留焊接速度相对于焊缝为恒定，而放弃焊枪与焊缝保持垂直关系， 不然会导致无解。 其中，aa 直线段旋转关节逆时针旋转2，a b 圆弧段旋转关节不旋转， b b 直线段旋转关节又逆时针旋转2。 (1)a a 直线段 该小阶段旋转关节逆时针旋转2，并保证焊接速度 vw相对于焊缝为恒定。 根据图 2.4 可得： a wa yy ttvxx 0 00 )( （2.9） 本科毕业设计（论文）通过答辩 图 2.4 aa 直线段焊接点位置关系示意图 将式（2.9）带入变换方程（2.8）得 221 100 cos sin)( sllry slrttvx a wa （2.10） 将以上两式对 t 求导并整理可得： sinrv cosrvv 2 w1 （t aa tt ）(2.11) 其中旋转关节 3 的运动规律(.t,.t)如图 2.5 所示： ttatta a t ( ) t( ) t a t 2 4 图 2.5aa 直线段旋转关节的运动规律示意图 (2)ab圆弧段 该小阶段旋转关节不旋转，0, 2，)(t所示角如图 2.6。 本科毕业设计（论文）通过答辩 图 2.6a b 圆弧段焊接点位置关系示意图 根据图 2.6 及平面几何知识可得： )(cos1 )(sin 0 0 tryy trxx a a （2.12） 将其带入变换方程（2.8）得： 221 10 cos)(cos1 sin)(sin sllrtry slrtrx a a （2.13） 将以上两式对 t 求导并整理可得： )()(sin )()(cos 2 1 ttrv ttrv （2.13） 又由速度合成知识可得： 22 2 2 1w vvv，带入上式可解得： r v t w ) (。 将这结果带入式（2.13）可转化为： )(sin )(cos 2 1 tvv tvv w w （ ba ttt ）（2.14） 其中)(t的运动规律如图 2.7 所示： 本科毕业设计（论文）通过答辩 图 2.7a b 圆弧段)(t的运动规律 (3)bb 斜线段 该直线段旋转关节又逆时针旋转2角度。 根据图 2.8 可得： sin)( cos)( 0 0 bwb bwb ttvyy ttvxx （2.15） 图 2.8b b 直线段焊接点位置关系示意图 将式（2.15）带入变换方程（3.8）得： 221 10 cossin)( sincos)( sllrttvy slrttvx bwb bwb （2.16） 将以上两式对 t 求导并整理可得： sinrsinvv cosrcosvv w2 w1 （ bb ttt ）（2.17） 其中旋转关节的运动规律(.t,.t)如图 2.9 所示： 本科毕业设计（论文）通过答辩 ttb t tbb t 3 4 ( ) t 2 b t ( ) t 图 2.9b b 斜线段旋转关节的运动规律示意图 2.4.2bc 段（波内斜边段 1） 这一阶段旋转关节 3 不转动，0,。 根据图 2.10 可得： sin)( cos)( 0 0 bwb bwb ttvyy ttvxx （2.18） 图 2.10b c 波内斜边段焊接点位置关系示意图 将式（2.18）带入变换方程（2.8）得： 221 10 cossin)( sincos)( sllrttvy slrttvx bwb bwb （2.19） 本科毕业设计（论文）通过答辩 将以上两式对 t 求导并整理可得： sin cos 2 1 w w vv vv （ cb ttt）（2.20） 2.4.3cd 段（过渡段 2） 这一阶段里的处理思想方法与过渡段 1 是一样的。 其中，cc 斜线段旋转关节顺时针旋转2角度， c d 圆弧段旋转关节不旋 转，d d 直线段旋转关节又顺时针旋转2角度。 (1) cc 斜线段 该小阶段旋转关节顺时针旋转2，并保证焊接速度 vw相对于焊缝为恒定。 根据图 2.11 可得： sin)( cos)( 0 0 cwc cwc ttvyy ttvxx （2.21） 图 2.11cc 斜线段焊接点位置关系示意图 将式（2.21）带入变换方程（2.8）得： 221 10 cossin)( sincos)( sllrttvy slrttvx cwc cwc （2.22） 将以上两式对 t 求导并整理可得： sinrsinvv cosrcosvv w2 w1 （ cc ttt ）（2.23） 其中旋转关节的运动规律(.t,.t)如图 2.12 所示： 本科毕业设计（论文）通过答辩 图 2.12cc 斜线段旋转关节的运动规律示意图 (2) c d 圆弧段 该小阶段旋转关节不旋转，0, 2。 根据图 2.13 及平面几何知识可得： )(cos1 )(sin 0 0 tryy trxx d d （2.24） 图 2.13c d 圆弧段焊接点位置关系示意图 将式（2.24）带入变换方程（3.8）得： 221 10 cos)(cos1 sin)(sin sllrtry slrtrx d d （2.25） 将以上两式对 t 求导并整理可得： 本科毕业设计（论文）通过答辩 )()(sin )()(cos 2 1 ttrv ttrv （2.26） 又由速度合成知识可得： 22 2 2 1w vvv，带入上式可解得： w vrt)(。 将这结果带入式（2.13）可转化为： )(sin )(cos 2 1 tvv tvv w w （ dc ttt ）（2.27） 其中)(t的运动规律如图 2.14 所示： 图 2.14c d 圆弧段)(t的运动规律 (3) d d 直线段 该小阶段旋转关节又顺时针旋转2，并保证焊接速度 vw相对于焊缝为恒定。 根据图 2.15 可得： d dwd yy ttvxx 0 0 )( （2.28） 本科毕业设计（论文）通过答辩 图 2.15 d d 直线段焊接点位置关系示意图 将式（2.28）带入变换方程（3.8）得 221 10 cos sin)( sllry slrttvx d dwd (2.29) 将以上两式对 t 求导并整理可得： sinrv cosrvv 2 w1 （ dd ttt ）(2.30) 其中旋转关节 3 的运动规律(.t,.t)如图 2.16 所示： 图 2.16d d 直线段旋转关节的运动规律示意图 2.4.4de 段（直线段 1） 这一阶段旋转关节 3 不转动，0,0。 又根据约束（焊枪与焊缝垂直，相对于焊缝焊接速度恒定，焊缝轨迹为水平直线） 和运动合成知识可得出： 0 2 1 v vv w （ ed ttt）(2.31） 2.4.5ef 段（过渡段 3） 这一阶段里的处理思想方法与过渡段 1 是一样的。 其中，ee 斜线段旋转关节顺时针旋转2角度， e f 圆弧段旋转关节不旋 转，f f 直线段旋转关节又顺时针旋转2角度。 (1) ee 直线段 本科毕业设计（论文）通过答辩 该小阶段旋转关节顺时针旋转2，并保证焊接速度 vw相对于焊缝为恒定。 根据图 2.17 可得： e ewe yy ttvxx 0 0 )( (2.32） 0 o 0 y 0 x ee w w v 图 2.17 ee 直线段焊接点位置关系示意图 将式（2.32）带入变换方程（3.8）得 221 10 cos sin)( sllry slrttvx e ewe (2.33） 将以上两式对 t 求导并整理可得： sinrv cosrvv 2 w1 （ ee ttt ）(2.34) 其中旋转关节 3 的运动规律(.t,.t)如图 2.18 所示： 图 2.18ee 直线段旋转关节的运动规律示意图 本科毕业设计（论文）通过答辩 (2) e f 圆弧段 该小阶段旋转关节不旋转，0, 2。 根据图 2.19 及平面几何知识可得： )(cos1 )(sin 0 0 tryy trxx e e (2.35） 图 2.19e f 圆弧段焊接点位置关系示意图 将式（2.35）带入变换方程（2.8）得： 221 10 cos)(cos1 sin)(sin sllrtry slrtrx e e (2.36） 将以上两式对 t 求导并整理可得： )()(sin )()(cos 2 1 ttrv ttrv (2.37） 又由速度合成知识可得： 22 2 2 1w vvv，带入上式可解得： w vrt ) (。 将这结果带入式（2.37）可转化为： )(sin )(cos 2 1 tvv tvv w w （ fe ttt ）(2.38） 其中)(t、)(t的运动规律如图 2.20 所示： 本科毕业设计（论文）通过答辩 图 2.20e f 圆弧段)(t的运动规律 (3) f f 斜线段 该小阶段旋转关节又顺时针旋转2，并保证焊接速度 vw相对于焊缝为恒定。 根据图 2.21 可得： sin)( cos)( 0 0 fwf fwf ttvyy ttvxx (2.39） 图 2.21f f 斜线段焊接点位置关系示意图 将式（2.39）带入变换方程（2.8）得： 221 10 cossin)( sincos)( sllrttvy slrttvx fwf fwf （2.40） 将以上两式对 t 求导并整理可得： sinrsinvv cosrcosvv w2 w1 （ ff ttt ）（2.41） 其中旋转关节的运动规律(.t,.t)如图 2.22 所示： 本科毕业设计（论文）通过答辩 图 2.22f f 斜线段旋转关节的运动规律示意图 2.4.6fg 段（波内斜边段 2） 该阶段：0,；并满足焊接速度相对焊缝恒定，焊枪与焊缝保持垂直关 系。 因此根据速度合成知识（如图 2.23 所示）可得： sin cos 2 1 w w vv vv （ gf ttt）（2.42） 1 v 2 v w v 图 2.23fg 段波内斜边段的速度合成图 2.4.7gh 段（过渡段 4） 这一阶段里的处理思想方法与过渡段 1 是一样的。 这里分三个小运动阶段，其中，gg 斜线段旋转关节逆时针旋转2角度，g h 圆弧段旋转关节不旋转，h h 直线段旋转关节又逆时针旋转2角度。 本科毕业设计（论文）通过答辩 (1) gg 斜线段 该小阶段旋转关节逆时针旋转2，并保证焊接速度 vw相对于焊缝为恒定。 根据图 2.24 可得： sin)( cos)( 0 0 gwg gwg ttvyy ttvxx （2.43） 图 2.24gg 斜线段焊接点位置关系示意图 将式（2.43）带入变换方程（3.8）得： 221 10 cossin)( sincos)( sllrttvy slrttvx gwg gwg （2.44） 将以上两式对 t 求导并整理可得： sinrsinvv cosrcosvv w2 w1 （ gg ttt ）（2.45） 其中旋转关节的运动规律(.t,.t)如图 2.25 所示： 图 2.25gg 斜线段旋转关节的运动规律示意图 本科毕业设计（论文）通过答辩 (2) g h 圆弧段 该小阶段旋转关节不旋转，0, 2。 根据图 2.26 及平面几何知识可得： )(cos1 )(sin 0 0 tryy trxx h h （2.46） 图 2.26g h 圆弧段焊接点位置关系示意图 将式（2.46）带入变换方程（2.8）得： 221 10 cos)(cos1 sin)(sin sllrtry slrtrx h h （2.47） 将以上两式对 t 求导并整理可得： )()(sin )()(cos 2 1 ttrv ttrv （2.48） 又由速度合成知识可得： 22 2 2 1w vvv，带入上式可解得： w vrt)(。 将这结果带入式（2.48）可转化为： )(sin )(cos 2 1 tvv tvv w w （ hg ttt ）（2.49） 其中)(t、)(t的运动规律如图 2.27 所示： 本科毕业设计（论文）通过答辩 图 2.27c d 圆弧段)(t的运动规律 (3) h h 直线段 该小阶段旋转关节又逆时针旋转2，并保证焊接速度 vw相对于焊缝为恒定。 根据图 2.28 可得： h hwh yy ttvxx 0 0 )( （2.50） 图 2.28h h 直线段焊接点位置关系示意图 将式（2.50）带入变换方程（3.8）得 221 10 cos sin)( sllry slrttvx h hwh （2.51） 将以上两式对 t 求导并整理可得： sinrv cosrvv 2 w1 （ hh ttt ）(2.52) 其中旋转关节 3 的运动规律(t ,t )如图 2-29 所示： 本科毕业设计（论文）通过答辩 图 2.28 h h 直线段旋转关节的运动规律示意图 2.4.8hi 段（直线段 2） 该阶段运动：0,0；并满足焊接速度相对于焊缝保持恒定，焊枪与焊缝的 夹角保持垂直关系。 根据速度合成知识可得： 0 2 1 v vv w （ ih ttt）（2.53） 以上即为焊接集装箱一个周期波纹板的运动学逆解。 2.52.5本章小结本章小结 由逆解过程可以看出三自由度焊接机器人三个运动关节按照一定的运动规律协 调动作，即可以保证焊枪以一定的位姿与焊接速率进行焊接，将较好的解决波纹直线 焊缝与波内斜边焊缝成形不能保持一致的难题。各段关节的运动规律如下： ab 段（过渡段 1） (1) a a 直线段 该小阶段旋转关节逆时针旋转2，并保证焊接速度 vw相对于焊缝为恒定。 (2) ab圆弧段 该小阶段旋转关节不旋转，0, 2 (3) bb 斜线段 该直线段旋转关节又逆时针旋转2角度。 bc 段（波内斜边段 1） 本科毕业设计（论文）通过答辩 这一阶段旋转关节 3 不转动，0,。 cd 段（过渡段 2） 这一阶段里的处理思想方法与过渡段 1 是一样的。 其中， cc 斜线段旋转关节顺时针旋转2角度， c d 圆弧段旋转关节不旋 转，d d 直线段旋转关节又顺时针旋转2角度。 de 段（直线段 1） 这一阶段旋转关节 3 不转动，0,0。 ef 段（过渡段 3） 这一阶段里的处理思想方法与过渡段 1 是一样的。 其中， ee 斜线段旋转关节顺时针旋转2角度， e f 圆弧段旋转关节不旋 转，f f 直线段旋转关节又顺时针旋转2角度。 fg 段（波内斜边段 2） 该阶段：0,；并满足焊接速度相对焊缝恒定，焊枪与焊缝保持垂直关 系。 gh 段（过渡段 4） 这一阶段里的处理思想方法与过渡段 1 是一样的。 这里分三个小运动阶段，其中，gg 斜线段旋转关节逆时针旋转2角度，g h 圆弧段旋转关节不旋转，h h 直线段旋转关节又逆时针旋转2角度。 hi 段（直线段 2） 该阶段运动：0,0；并满足焊接速度相对于焊缝保持恒定，焊枪与焊缝的 夹角保持垂直关系。 同时，所求焊接过渡段中的过渡运动能较好的衔接直线段与波内斜边段的运动。 本科毕业设计（论文）通过答辩 3 3结构设计结构设计 3.13.1小车行走结构设计小车行走结构设计 这里主要是做了三方面的工作：对小车行走机构的结构方案的比较与选择；对电 机功率的估计并选择出小车的驱动电机；对根据结构设计的齿轮、齿条传动的接触疲 劳强度、弯曲疲劳强度校核。 3.1.1车体结构方案的比较与选择 根据一些移动机器人本体设计的研究文献及直动关节的知识可获得两个车体结构 方案。这两个方案的示意图如图所示： 方案 1：其中传动顺序为：电机齿轮箱车轮轴上齿轮（通过车轮轴）驱动 轮。这也是在移动机器人本体结构设计上较为常用的一种车体结构方案，布置比较对 称合理。 方案 2：其中传动顺序为：电机圆柱齿轮固定齿条（通过反推动）车体结 构。 这里的设计有借鉴将旋转运动转化为直线运动里有齿轮、 齿条这么一种传动方式， 结构比较简单，设计比较容易。 方案间的比较： 表 1两车体机构方案的比较 本科毕业设计（论文）通过答辩 方案比较方案 1方案 2 设计方面较复杂较简单 结构方面稍复杂稍简单 布置方面对称点有点偏移 效率方面较低较高 精度方面高稍差 用材方面一般有长齿条 根据实际的工作条件：希望设计能够比较简单，结构比较简单，焊接小车的移动 效率高一点，精度要求并不是很高， 。故可从表 1 可选择出方案 2 作为该小车的设计 结构方案。 3.1.2小车驱动电机功率的确定 (1) 电机功率的估计 根据机器人的重量、小车运行速度、轮胎直径来确定驱动电机的功率。 假定小车在轨道上行走，不考虑小车行驶中的空气阻力，分析小车的受力情况， 以便估计小车所需的驱动力矩。此时，应把轮胎看成一个弹性体来考虑。 前面也提到了，在这里，由于电机的驱动是通过齿轮、齿条的啮合来驱动，故该 小车的四轮都为从动轮。 这里先分析车轮的受力情况： 本科毕业设计（论文）通过答辩 图 3.1 车轮受力简图 假设在运动过程中，轮子做纯滚动。 设小车运动时的加速度为 dv dt ，相应的车轮角加速度为 dw dt 。 根据 v w r 可推得： 1dwdv dtr dt 其中 v 为小车速度，w 为车轮角速度，r 为车轮的半径。 图 3.1 画出了该小车的车轮在运动过程中的受力简图，图中 p 车轮上的载荷，m 车轮的质量，n 地面对车轮的法向反作用力，u 为车轮的切向 反作用力，x 车轮轴的车轮的推力。 根据平衡条件有 dv xum dt （3.1） f dw urmj dt （3.2） f m 为车轮滚动阻力矩，其值为n；j 为车轮的转动惯量。 根据式（3.1） 、 （3.2）有 2 f m jdv xm rrdt （3.3） 由此可知，推动车轮前进要克服两种阻力，即车轮的滚动阻力和车轮的加速阻力。 本科毕业设计（论文）通过答辩 而后者又由平移质量产生的加速阻力 dv m dt 和由旋转质量产生的加速阻力 2 jdv rdt 所组 成。 齿轮、齿条传动作为该小车的驱动机构，故驱动力矩设为 d m ， 进而可将 d m r 理 解为小车的实际驱动力，r为齿轮的半径。