1、南昌航空大学科技学院学士学位论文1第一章绪论11 引言机器人技术是综合了计算机、控制论、机构学、信息和传感技术、人工智能、仿生学等多门学科而形成的高新技术。其本质是感知、决策、行动和交互四大技术的综合，是当代研究十分活跃，应用日益广泛的领域。机器人应用水平是一个国家工业自动化水平的重要标志。工业机器人既具有操作机(机械本体)、控制器、伺服驱动系统和检测传感装置，是一种仿人操作、自动控制、可重复编程、能在三维空间完成各种作业的自动化生产设备。目前机器人应用领域主要还是集中在汽车工业，它占现有机器人总数的2.89%。其次是电器制造业，约占 16.4%，而化工业则占 11.7%。此外，工业机器人在食
2、品、制药、器械、航空航天及金属加工等方面也有较多应用。随着工业机器人的发展，其应用领域开始从制造业扩展到非制造业，同时在原制造业中也在不断的深入渗透，向大、异、薄、软、窄、厚等难加工领域深化、扩展。而新开辟的应用领域有木材家具、农林牧渔、建筑、桥梁、医药卫生、办公家用、教育科研及一些极限领域等非制造业。一般来说，机器人系统可按功能分为下面四个部分川:l)机械本体和执行机构:包括机身、传动机构、操作机构、框架、机械连接等内在的支持结构。2)动力部分:包括电源、电动机等执行元件及其驱动电路。3)检测传感装置:包括传感器及其相应的信号检测电路。4)控制及信息处理装置:由硬件、软件构成的机器人控制系统
3、。全套设计，联系 153893706南昌航空大学科技学院学士学位论文212 国内外机器人领域研究现状及发展趋势(1)工业机器人性能不断提高(高速度、高精度、高可靠性、便于操作和维修)，而单机价格不断下降，平均单机价格从 91 年的 10.3 万美元降至 2005 年的 5 万美元。2)机械结构向模块化、可重构化发展。例如关节模块中的伺服电机、减速机、检测系统三位一体化;由关节模块、连杆模块用重组方式构造机器人整机;国外己有模块化装配机器人产品问市。(3)工业机器人控制系统向基于 CP 机的开放型控制器方向发展，便于标准化、网络化:器件集成度提高，控制柜日见小巧，且采用模块化结构;大大提高了系统
4、的可靠性、易操作性和可维修性。(4)机器人中的传感器作用日益重要，除采用传统的位置、速度、加速度等传感器外，装配、焊接机器人还应用了视觉、力觉等传感器，而遥控机器人则采用视觉、声觉、力觉、触觉等多传感器的融合技术来进行环境建模及决策控制;多传感器融合配置技术在产品化系统中己有成熟应用。(5)虚拟现实技术在机器人中的作用己从仿真、预演发展到用于过程控制，如使遥控机器人操作者产生置身于远端作业环境中的感觉来操纵机器人。(6)当代遥控机器人系统的发展特点不是追求全自治系统，而是致力于操作者与机器人的人机交互控制，即遥控加局部自主系统构成完整的监控遥控操作系统，使智能机器人走出实验室进入实用化阶段。美
5、国发射到火星上的“索杰纳”机器人就是这种系统成功应用的最著名实例。(7)机器人化机械开始兴起。从 1994 年美国开发出“虚拟轴机床”以来，这种新型装置己成为国际研究的热点之一，纷纷探索开拓其实际应用的领域。1.3 SCARA 机器人简介SCARA 机器人(如图 1 一 1 所示)很类似人的手臂的运动，它包含肩关节、肘关节和腕关节来实现水平和垂直运动，在平面内进行定位和定向，是一种固定式的工业机器人。它具有四个自由度，其中，三个是旋转自由度，一个是移动自由度。3 个旋转关节，其轴线相互平行，手腕参考点的位置是由两个旋转关节的角位移 p，和 pZ，及移动关节的位移 Z 来决定的。这类机器人结构轻
6、便、响应快，例如 Adeptl 型 SCARA 机器人的运动速度可达 10m/S，比一般的关节式南昌航空大学科技学院学士学位论文3机器人快数倍。它能实现平面运动，全臂在垂直方向的刚度大，在水平方向的柔性大，具有柔顺性。图 1 一 1SCARA 机器人图 1 一 2 SCARA 机器人装配线图 1 一 3 SCARA 机器人SCARA 机器人最适用于平面定位，广泛应用于垂直方向的装配。广泛应用南昌航空大学科技学院学士学位论文4于需要高效率的装配、焊接、密封和搬运等众多应用领域，具有高刚性、高精度、高速度、安装空间小、工作空间大的优点。由于组成的部件少，因此工作更加可靠，减少维护。有地面安装和顶置
7、安装两种安装方式，方便安装于各种空间。可以用它们直接组成为焊接机器人、点胶机器人、光学检测机器人、搬运机器人、插件机器人等，效率高，占地小，基本免维护。1.4 平面关节型装配机器人关键技术1.4.1 操作机的机构设计与传动技术由于机器人运行速度快，定位精度高，需要进行运动学与动力学设计计算，解决好操作机结构设计与传动链设计。包括:(l)重量轻、刚性好、惯性小的机械本体结构设计和制造技术一般采用精巧的结构设计及合理的空间布局，如把驱动电机安装在机座上，就可减少臂部惯量、增强机身刚性;在不影响使用性能的情况下，各种部件尽量采用空心结构。此外，材料的选择对整机性能也是至关重要的。(2)精确传动轴系的
8、设计、制造及调整技术由伺服电机直接驱动，实现无间隙、无空回、少摩擦、少磨损，提高刚性、精度、可靠性; 各轴承采用预紧措施以保证传动精度和稳定性。(3)传动平稳、精度高、结构紧凑且效率高的传动机构设计、制造和调整技术由于在解决机械本体结构问题时，往往会对传动机构提出更高要求，有时还存在多级传动，因此要达到上述目的，常采用的方法有:钢带传动，实现无摩擦无间隙、高精度传动;滚珠丝杠传动，可提高传动效率且传动平稳，起动和低速性能好，摩擦磨损小;采用 Rv 减速器，可缩短传动链。同时合理安排检测系统位置，进一步提高系统精度1.4.2 机器人计算机控制技术由于自动生产线和装配精度的要求及周边设备的限制，使
9、装配机器人的控制过程非常复杂，并要求终端运动平稳、位姿轨迹精确。现阶段机器人的控制方式主要有两种:一是采用专用的控制系统，如 MOTOMAN、FANUC、NACH 工等;二是基于 PC 机的运动控制架构，如 KUKA，ABB，工 RCS 等。在控制领域常涉及的关键技术包括:(l)点位控制与轨迹控制的双重控制技术一般为装配机器人安装高级编程语南昌航空大学科技学院学士学位论文5言和操作系统。常用的编程方式有示教编程与离线编程。另一方面，合理选择关节驱动器功率和变速比、终端基点密度和基点插补方式，以使运动精确、轨迹光滑。(2)装配机器人柔顺运动控制技术由于机器人柔顺运动控制是一种关联的、变参数的非线
10、性控制，能使机器人末端执行器和作业对象或环境之间的运动和状态符合给定要求。这种控制的关键在于选择一种合适的控制算法。(3)误差建模技术在机器人运动中，机械制造误差、传动间隙、控制算法误差等会引起机器人末端位姿误差。因此有必要对机器人运动进行误差补偿，建立合理可靠的误差模型，进行公差优化分配，对系统进行误差的标定并采用合适的误差补偿环节。(4)控制软件技术将诸如减振算法、前馈控制、预测算法等先进的现代控制理论嵌入到机器人控制器内使机器人具有更精确的定位、定轮廓、更高的移动速度、更短的调整时间，即使在刚性低的机器人结构中也能达到无振动运动等特性，有助于提高机器人性能。.1.4.3 检测传感技术检测
11、传感技术的关键是传感器技术，它主要用于检测机器人系统中自身与作业对象、作业环境的状态，向控制器提供信息以决定系统动作。传感器精度、灵敏度和可靠性很大程度决定了系统性能的好坏。检测传感技术包含两个方面的内容:一是传感器本身的研究和应用，二是检测装置的研究与开发。包括:(1)多维力觉传感器技术多维力觉传感器目前在国际上也是一个热点，涉及内容多、难度大。它能同时检测三维空间的全力信息，在精密装配、双手协调、零力示教等作业中，有广泛应用。它包括弹性体、传感器头、综合解藕单元、数据处理单元及专用电源等。(2)视觉技术视觉技术与检测传感技术的关系类似于人的视觉与触觉的关系，与触觉相比，视觉需要复杂的信息处
12、理技术与高速运算能力，成本较高，而触觉则比较简单，南昌航空大学科技学院学士学位论文6可靠且较易实现。但在有些情况下，视觉可完成对作业对象形状和姿态的识别，可比较全面的获得周围环境数据，在一些特殊装配场合有很大优越性，如在无定位、自主式装配、远程遥控装配、无人介入装配等情况下特别适用。因此如何采用合适的硬件系统对信息进行采集、传输，并对数据进行分析、处理、识别，以得到有用信息用于控制也是一个关键问题。(3)多路传感器信息融合技术由于装配机器人中运用多种传感器来采集信息，得到的信息也是多种多样，必须用有效的手段对这些信息进行处理，才能得到有用信息。因此，信息融合技术也成为制约检测技术发展的瓶颈。(
13、3)检测传感装置的集成化和智能化技术检测传感装置的集成化能形成复式传感器或矩阵式传感器，而把传感器和测量装置集成则能形成一体化传感器。这些方法都能使传感器功能增加、体积变小、并使检测传感系统性能提高，更加稳定可靠。检测传感装置的智能化则是在检测传感装置中添加微型机或微处理器，使其具有自动判断，自动处理和自动操作等功能。加快系统响应速度、消除或减小环境因素影响、提高系统精度、延长平均无故障时间。1.5 项目的主要研究内容1.5.1 项目研究的主要内容、技术方案及其意义本课题是要设计一个教学 SCARA 机器人。作为工业机器人的 SCARA 己有很多成熟的产品，但大多驱动装置采用伺服电机，传动系统
14、采用 RV 减速机，由这些部件构成的整机价格昂贵，不适宜于作为教学用途。而教学机器人相对而言对运动精度的要求要比工业场合用的机器人所要求的精度低，对运动速度和稳定性的要求也不高，它只需具备机器人的基本元素，达到一定的精度即可。实际上由步进电机构成的开环系统精度已经很高，能满足教学用途，而且成本比伺服电机构成的闭环、半闭环系统低很多。谐波传动也是精度高、传动平稳并且很成熟的一项传动技术。因此自主开发低成本的教学机器人很有意义。对本机器人的研制，拟采用步进电机作为动力装置，采用谐波减速机作为传动链的主要部件，同时辅以同步齿形带和滚珠丝杠等零部件来构成机器人的机械本体。控制系统采用基于 CP 的运动
15、控制架构，研究机器人关节空间的轨迹规划算法和南昌航空大学科技学院学士学位论文7笛卡儿空间的直线轨迹规划算法，利用控制卡提供的运动控制库函数在windows 环境下用 visu1aC+6.0 开发控制系统的软件。项目研究的总体步骤是:选出最优传动方案一一关键零部件选型一一机械系统三维建模一一零部件工程图和总装图一一控制系统设计一一运动学分析及位姿误差建模一一控制软件的开发以及轨迹规划算法的研究。1.5.2 拟解决的关键问题(1)抗倾覆力矩问题的解决。SCARA 机器人的大臂和小臂重量大，悬伸也大，造成很大的倾覆力矩，影响机器人的性能，通过合理的机械结构设计来加以解决。(2)机器人的运动学分析以及
16、位姿误差建模方法的研究。根据运动学参数法，建立通用机器人位姿变换方程，在位姿变换方程的基础上建立机器人位姿误差的数学模型，采用矩阵变换直接推导出机器人末端位姿误差与运动学参数误差的函数关系式。 (3)机器人轨迹规划算法的研究。包括给定起点和终点的关节轨迹规划(PTP运动)算法，以及给定起点和终点的直线轨迹规划(CP 运动)算法。第二章 SCAAR 机器人的机械结构设计近年来，工业机器人有一个发展趋势:机械结构模块化和可重构化。例如关节模块中的伺服电机、减速机、检测系统三位一体化;由关节模块、连杆模块用重组方式构造机器人整机;国外己有模块化装配机器人产品问市。本章介绍模块化的设计方法在 SCAR
17、A 机器人的结构设计中的应用。2.1 SCARA 机器人的总体设计2.1.1 SCARA 机器人的技术参数(1) 抓重：1kg(2) 自由度：4(3) 运动参数：大臂：100。(回转角度)，角速度1.8rad/s南昌航空大学科技学院学士学位论文8小臂：50。(回转角度)，角速度1.8rad /s手腕回转：100。(回转角度)，角速度1.8rad。/s手腕升降：100mm(升降距离)，线速度0.01m/s2.1.2 SCARA 机器人外形尺寸与工作空间依据设计要求，SCARA 机器人的外形尺寸如图 2 一 1 所示，工作空间如图 2一 2。图 2 一 1 SCARA 机器人的结构图图 2 一 2
18、 SCARA 机器人的轴侧图南昌航空大学科技学院学士学位论文9图 2 一 3 SCARA 机器人的轴侧图2.1.3 SCARA 机器人的总体传动方案目前，机器人的传动系统中主要是使用 VR 减速器或谐波减速器。VR 减速器是近几年发展起来的以两级减速和中心圆盘支撑为主的全封闭式摆线针轮减速器，与其它减速方式相比，VR 减速器具有减速比大、同轴线传动、传动精度高、刚度大、结构紧凑等优点，适用于重载、高速和高精度场合。谐波减速器也具有传动比大，承载能力大，传动精度高，传动平稳，传动效率高，结构简单、体积小，重量轻等优点，而且相对于 VR 减速器而一言，其制造成本要低很多，所以在本设计中采用谐波减速
19、机。SCARA 机器人大小臂均要承受轴向压力和倾覆力矩，所以大臂和小臂均采用谐波减速机加推力向心交叉短圆柱滚子轴承结构。而推力向心交叉短圆柱滚子轴承刚度高，能承受轴向压力与径向扭矩，与谐波减速机配合正符合 SCAAR 机器人大小臂高刚性及高的抗倾覆力矩的要求。这样有利于缩短传动链，简化结构设计伙，。由于主轴处于机器人小臂末端，相对线速度大，对重量与惯量特别敏感，所以传动方式要求同时实现 Z 轴方向直线运动和绕 Z 轴的回转运动，并要求结构紧凑、重量轻。经过比较，选择同步齿形带加滚珠丝杠来实现 Z 轴上下运动，而用同步齿形带加带键的滑动轴套来实现 Z 轴旋转运动。南昌航空大学科技学院学士学位论文
20、10大臂回转:步进电机 1 一谐波减速器一大臂小臂回转:步进电机 2 一谐波减速器一小臂主轴垂直直线运动:步进电机 3 一同步齿形带一丝杠螺母一主轴主轴旋转:步进电机 4 一同步齿形带一花键一主轴2.2 机器人关键零部件设计计算2.2.1 减速机的设计计算大臂的转动速度为角速度1.8rad/s，电机初选四通步进电机，两相混合式 86BYG250B 一 0402。最高转速为 30OORPM，设计电机按 1500RPM 工作，则:0936151RPMi=初选谐波减速器为北京中技克美谐波传动有限责任公司的机型为 60 的 XB3扁平型谐波减速器，其传动比可以是 100(XB3 一 60 系列组件的规
21、格和额定数值见下表)表 2 一 2XB3 一 60 一 100 的规格和额定数值表最高输入转速 rpm 输入转速 3000rpm机型 速比半流体润滑脂油润滑 输入功率Kg输出功率kg输出扭矩N.m60 100 30000 50000 0.145 30 30南昌航空大学科技学院学士学位论文112.2.2 电机的设计计算1Z轴(机座旋转轴)的等效转动惯量为 2221330.8CCBZMRRJKgmJ=+d123P()0.48W式中:初拟机座的外径为 150mm，内径为 100mm，带轮直径 60mm，宽 40mm.设谐波减速器转动惯量4-32xBJ=70Kg/m3(.6) 0.m1=4kg.c电机
22、的转子惯量 86BYG250B 一 0402 电机的转子惯量 15409.2cZJ因此自由度弓传动系统上所有惯量折算到电机轴 1 上的等效惯量 1为2 421221/cm/ .0.ziXBDjJJ kgi 电机轴扭矩为 T= .EfwTt+因为所选材料的摩擦系数 f=0.002取响应时间T=o.045，则 -421.57/T =2.x 00.4radsKgmxNm所选两相混合式步进电机 86BYG25OBN 一 0402 电机在 3O00rpm 时扭矩为06N.m，满足要求，其余几个电机的选择计算类似，第二自由度选择86BYG25OAN，第三和第四自由度是两个 56BYG25OB。表 2 一
23、3 步进电机技术数据序号型号 相数步距角（。）静态相流（A）相电电阻相电感(mH)保持转矩(Nm)定位转矩(Nm)重量(Kg)1 86BYG250BN 2 0.9/1.8 4 1.1 11 5.0 0.08 2.62 86BYG250BN 2 0.9/1.8 3.6 0.9 7.2 0.4 0.08 1.53 56BYG250B 2 0.9/1.8 2.4 0.9 2.4 0.65 0.03 0.482.2.3 同步齿型带的设计计算考虑到整体结构，选择一对直径 60unll 左右的带轮同步齿型带传递的设计功率随载荷性质、速度增减和张紧轮的配置而变化。令凡为考虑载荷性质和运转时间的工况修正系数，
24、KZ 为考虑增速的修正系数，K。为考虑张紧轮的修正系数。 123.40,36查 表 知 ，南昌航空大学科技学院学士学位论文12设计功率为:d123P()01.4280KW(2)选择带型和带轮节径及齿数参照“同步带选型图”选择带型为 L 型，则选择带轮 20L050，节1201210210.7()()85439()cos80arin()pCdmmdLdC126.4.)9370.4962()8.70pLd121()655bmpzZentCFN24 41/3.810/6.25.5zKkn kfEIdFNnL00ydxzAiyxz(3)径 60.64unll，外径 5988mm，齿数为 20，节距 P
25、。=9.525mm。接下来验算带速，同步带传动速度为 13.460.154.76/60dnv ms查表知 L 型带带速限制为 Vmax=4050m/S.所以带轮满足要求。(3)同步带的节线长度 Lp，齿数 Zb 及传动中心距初选中心距 12012.7()()dCd08543mC取 9南昌航空大学科技学院学士学位论文1321210()()2cos80pddLC10arin()6.4.)29370.4962pL1()dC=89.7702(4)确定实际啮合齿数 Zm121()6bmpzZent(5)确定实际同步带宽度选取同步带的宽度为 12.7mm，带轮宽度为 14+2mm2.2.4 滚珠丝杠副的设
26、计计算(1)最大工作载荷计算。工作最大负载 F z =15N，沿 Z 轴方向，即丝杠轴向。因此，滚珠丝杠的进给抗力，即最大工作载荷 Fm 为mZyf设横向工作载荷为月 Fy=0.5Fz=7.5N 为导杆和轴套之间的摩擦系数，f=0.15。f因此，丝杠最大工作载荷为 157.016.25mFN(2)最大动负载 C 校核滚珠丝杠最大动负载24 41/3.810/6.25.5zKkn kfnEIdFNnLL 为工作寿命，L=60Nt/ ;n 为丝杠转速，T 为额定使用寿命(h)，取0/25/4msvrpm=T=60x3000x15000/ =2700. 为运转状态系数，无冲击， =1.2，因此f m
27、f3271.68.96cN，查表知 FF1204-3 的额定动负载 4aCKN，安全裕度为 。静载校核因工作载荷很小，肯定满足条件。因此，340.7.5x=南昌航空大学科技学院学士学位论文14对于该自由度的传动系统的计算及校核可以省略。(3)刚度验算丝杠的拉压变形量为 1= 式中:L 为滚珠丝杠在支撑间的受力长()mFLEA度，取 L=1mm;E=20.6x MPa;丝杠底径 dl 近似为外径和滚珠直径之差，即410=d- ，丝杠外径 d= -(0.2 一 0.25) ，丝杠名义直径已知 12mm，查表知1dwdwd滚珠直径 =2.38lmm，因此丝杠底径为 =9.5mm,A= ，于是1229
28、.5/470.8m=拉压变形量为 1=16.125x120/(20.6x x70.84)=1.326x 该变量可以忽略不401-计，因工作载荷很小，滚道接触变形量从略。(4)压杆稳定性验算。失稳时的临界载荷2zKfnEIFL=采用两端固定的支承方式，查表知支承方式系数关刃.25;I 为截面惯性矩，I= /64=1091.18 41d4mL=12Omm。因此，Fk=0.25xxx20.6x 1091.18/120=3.85 x N，410410因工作负载很小，压杆不会失稳。4/3.850/16.25._kKn kFxNn=(5)传动效率计算=tg 入/tg(入十 )根据初选滚珠丝杠型号查表只知螺
29、旋升角入=433，摩擦角一般约为 10，则=tg4033/tg4433=0.96，传动效率高。2.3 大臂和小臂机械结构设计如图 2 一 5 大臂装配结构图所示，机器人大臂 10 的驱动电机 8 和谐波减速器 7 直联后安装在机器人大臂内部。谐波减速器 7 的输出轴铣成方形插入底座14 内，底座 14 通过螺栓 13 固定在机座 1 上。同时推力向心交叉短圆柱滚子轴承的内圈通过螺栓 n 与连接板 5 联结在一起，连接板通过螺栓 6 联结在大臂上，推力向心交叉短圆柱滚子轴承的外圈通过螺栓 2 与机座 1 联结在一起。当电机轴旋转时，受到固定限制的减速器输出轴不能转动，从而电机和减速器以及大臂反向
30、旋转。这样机器人大臂就可以绕机座中心轴相对固定机座转动，但转动方向与减速机输出轴转向相反。同时在圆周方向，固定基座应该安装两个极限行程开关 4 和两个限位挡块，而运动体则要安装压板和行程触发块 12，以限制南昌航空大学科技学院学士学位论文15大臂在规定范围内转动，以免机器人小臂部分在运动空间之外与其他设备或部件碰撞【g。图 2 一 5 大臂装配结构图图 2-6 小臂装配结构图采用模块化设计方法，小臂与大臂装配结构类似。机器人小臂电机也安装在小臂内部，这样虽然增加了小臂惯量，但有利于简化结构设计和零部件制造南昌航空大学科技学院学士学位论文16工艺。传动原理及结构设计与大臂类似，小臂装配结构图略。
31、由于三四关节所有导线都要通过关节二外壳罩，所以在小臂与三四关节壳罩之间增加一段导线管用来通三四关节导线72.4 腕部机械结构设计图 2 一 7 腕部装配结构图1.下端盖 2.滑块 3.轴承套 4.丝杆 5.导杆 6.步进电机 7.滚珠螺母及导轨滑块 8.腕部机壳 9.步进电机 10.同步齿形带 11.腕部上端机壳 12.制动块 13.导杆 14.同步齿形带 15.轴承套 16.密封圈 17.主轴腕部装配结构图如图 2 一 7 所示。为了便于加工及保证精度，把安装滚珠丝杠一端的端盖 3 及支撑上端盖的壳体(图中未标出)设计成分离式结构，依靠壳体两端面与小臂及上端盖配合面来保证丝杠与主轴平行度。由
32、于同步齿形带要能调整中心距及带张紧力，因此电机 6 先安装在电机连接板上，然后再把连接板及上端盖固定在一起，上端盖用来连接电机连接板的四个孔，螺栓在两个带轮中心线方向上可以进行微调。这样在装配时可对两带轮中心距及带张紧力进行调整。对于电机 13 直接连接在滚珠螺母与导杆滑套上，这样电机可随着主轴一起做直线运动。由于滚珠丝杠没有自锁功能，Z 轴方向又是负载作用力主南昌航空大学科技学院学士学位论文17方向，受结构尺寸限制无法在电机 6 上加抱闸，因此在滚珠丝杠顶端安装一个制动器来锁住滚珠丝杠，断电时自动锁死，避免滚珠丝杠在断电时发生滑动。滚珠丝杠两端都选用向心推力球轴承，此类轴承存在轴向游隙，可以
33、防止丝杠轴向跳动，提高主轴传动精度。滚珠螺母与滚珠螺母支架相连接，主轴通过两个推力球轴承安装在滚珠螺母支架上，主轴顶端用两个小圆螺母加以锁紧。导柱 2,是否需要还有待实验进一步验证。主轴升降通过限位开关控制其行程，所以在螺母支架上安装有一挡块，在上端相应位置安装有接近开关，这样主轴离端盖一定距离时就有信号通知运动控制器，限制该方向运动。在滚珠丝杠下端添加一个防撞的橡胶垫圈，避免滚珠螺母与小臂上表面发生刚性碰撞。2.5 小结SCARA 机器人大臂和小臂结构相同，基本上实现模块化设计，符合发展趋势; 三个模块相互独立、结构简单、零部件少、精度高、可靠性高，不仅适用于 S 以 AR 平面关节式装配机
34、器人设计，其一二关节模块结构同样适用于其他关节式机器人前端转动关节设计。三四关节模块结构紧凑，充分利用结构空间，能同时实现高速旋转运动与直线运动，主轴直线运动距离为 100mm，而整个模块在主轴方向高度约为 4O0mm 左右。同时，三四关节的电机轴与主轴不在同一直线上，也有利于结构布局，所以该模块也可应用在一些对精度和结构尺寸都有要求的组合运动结构设计中。第三章 SCARA 机器人的位姿误差建模设计一个开放式的机器人系统，其中关键技术之一就是对相应的机器人本体的运动学进行分析并建立相应的运动学模型。本章系统地描述了平面关节型ScARA 机器人的运动学和位姿误差模型的建立。在 Denavit 一
35、 Hartenberg 参数法建立的机器人末端位姿变换方程的基础上，利用机构通用精度算法建立了机器人末端位姿误差模型。通过矩阵运算，建立了机器人末端位姿误差与各杆件运动学参数误差之间的函数关系式。用此方法建立的误差模型进行误差标定和补偿，可以提高机器人的定位精度。这对开发开放式机器人系统有重要的参考价值。南昌航空大学科技学院学士学位论文183.1 基于机构精度通用算法的机器人位姿误差建模机器人位姿误差建模方法归纳为矩阵法和矢量法两大类型，其中矢量法又分为矢量分析及螺旋变换法和摄动法，运用精度平衡方程式和回转变换张量方法等【2】【5】机器人运动学 Denvait 一 Hartenberg 参数法
36、坐标变换中坐标变换矩阵 A，及手臂变换矩阵笋都是不考虑各运动学参数误差的理想变换，但实际应用中，无论机器人制造精度多高，都会由于各种原因引起机器人运动学参数误差，影响机构通用精度算法是一种既不需要求导也不需要建立机构传动方程的通用算法，具有通用性广，计算量小和精确度高等优点，由于其算法模型与前面所建立的机器人位姿变换模型正好适合，因此，利用这种算法建立机器人位姿误通用精度算法基本思路是:任何具有精度要求的机构系统是一个有机联系差模型。整体，如果系统构件中有原始误差存在，必然要影响从动件运动轨迹，从而产生机构位置误差，而任何原始误差影响均可视为构件本身坐标系产生微小转动或移动，至于机械系统精度通
37、用数学模型可以应用空间坐标变换原理，并通过所对应的构件运动变换矩阵与位置误差矩阵连乘叠加来表达。通用精度算法的坐标变换推导过程完全类似于机器人坐标变换坐标推导过程，这里不再叙述，仅给出其结论，并将其结论进行整理变化后应用于机器人位姿误差计算，建立机器人位姿误差变换模型3.2 机构精度通用算法设某个机构由 n 个运动构件和一个固定构件组成，若将起始坐标系 S。建立在固定构件上，坐标系 S，建立在运动构件(ii=，2l，n)上。运动构件 n的坐标系凡，为目标坐标系。坐标系又_，与 s;间变换矩阵为 A，以向量价二x(，y，习)(与机器人齐次变换矩阵规定一样)表示点 P 在坐标系 s，中位置，则由坐
38、标间位姿变换可知目标坐标系况，中某点 P 在各坐标系 S，中的向量乙，应有如下关系式:南昌航空大学科技学院学士学位论文191223230111()nn nminrArArr Ar (3.2)1()miA为目标坐标系 nS与起始坐标系之间运动变换矩阵。对于坐标系 0， 1， ，中的任意一个坐标系 ，若存在若干种误差，则is使坐标系 iS变成 iA，司原点在 iS中位置坐标为(dx，dy，dz)，其三个坐标轴相对i三个坐标轴分别有偏转角 (,)xyz，则坐标系 iSA与 i的变换矩阵为 (,),)(,(,)(,)xyzTrasxdrsyTrasdRottRot (3.2.2)展开上式，考虑到各误差
39、项数值比较小。所以取coscos1,in,si,sinxyzxyz，并忽略二阶及三阶以上误差项，可得误差矩阵 A 00zdxyAiyz（3.2.3） 所以点 P 在 ，中坐标向量式 与 关系为isirAi1()01i iizydxr rEryzA式中:E 一单位矩阵。其中:1）： 相当于坐标系 绕本身轴 X，Y，Z 微小转角。,xyziS2）： 相当于坐标系 沿本身轴 X，Y，Z 微小偏移量。di若各坐标系 均存在误差矩阵 Ai，则使目标坐标系中点 P 变成 pA，其iS南昌航空大学科技学院学士学位论文20在各坐标系 中的坐标向量 ir，应具有如下关系:iS12111()()()nnnnnrA
40、ErAEA （3.2.5）0111122()()()()nnrrrEr 将表达式展开，并略去高阶误差项。可得01211231 nnnjjrArAAr （3.2.6）00121231 111( )()()nnjjnnijij ir rAr (3.2.7)上式即为机构精度通用计算公式。3.2.2 通用机器人位姿误差模型3.2.2.1 机构通用精度模型与机器人位姿误差模型的联系上面虽推导出机构精度的通用计算公式，但由于位置向量 ir =x(，y，z，1)只包含机构的位置，在一般的机构分析中并不需要姿态向量，所以包含位置向量也就够用，但在机器人位姿表达中，除了位置外还必须包含姿态.所以必须对上述通用精
41、度计算公式进行扩展，以符合机器人位姿表达前面介绍的坐标变换矩阵 A，及手臂变换矩阵名 T 都是不考虑各关节运动学参数误差的理想变换，而在实际应用中，各运动学参数还是存在误差，因此可以把机器人位姿误差转化为这些运动学参数误差，认为机器人位姿误差中静态部分都是由于这些参数误差引动。沿用上面推导思想，只是不再直接用向量 ir =x(，y，z，1)来表示坐标系iS中参考点 P 在坐标系 1iS中位置，而是先考虑点 P 所在坐标系 iS原点在坐标系1i中位姿，求由于杆件 i 运动学参数误差所造成又原点在坐标系 i中位姿误差。利用与上面相同思想推导出末端关节坐标系原点在基坐标系 0中位姿误差.最后再乘以点
42、 P 在坐标系 nS中位姿变换(也用矩阵 iA表示)即得到点 p 的误差表达南昌航空大学科技学院学士学位论文21式。在建立机器人运动学误差模型时，这个点 p 即为工具坐标系 t 的原点(设这个原点为工具作用点).最后所得 p 在基坐标系 0S中位姿误差即为工具(末端执行器)作用点位姿误差。3.2.2 机器人位姿误差模型的建立用 iA及 i分别代表连杆 i 的理想变换矩阵和实际变换矩阵， ()idA代表理想变换矩阵和实际变换矩阵之差，则考虑误差影响时相邻坐标系的真实变换矩阵为: 1iid（3.2.8）设没有误差时，杆件 i 坐标系变换后的坐标系为 iS，类似公式(3.2.4)推导过程，由于存在若
43、干种误差，坐标系 iS又进行一次变换，变成坐标系 iS，这时坐标系 iS相对 i存在位姿误差 ,()xyzxyzd即 i原点在 i坐标系为(,)dzxy其三个坐标轴相对 i的三个坐标轴分别有偏转角 (,)xyz由公式(.3.22)可得坐标系 iS相对 i的变换矩阵为 iA。00zyxziyxzdA而 iS相对杆件 I 一 1 坐标系 1iS的变换矩阵应左乘以 iS相对 1i，的实际变换矩阵 iA，考虑到误差比较小，在这里可以用 iA来替代 i，所以由误差引起的误差变换矩阵为iiiAA（3.2.9）把公式(3.2.9)代入(3.2.8)，则杆件 i 误差模型为:()iiiidA（3.2.10）所
44、以1()iiid（3.2.11）式中 ()i可由公式（3.2.10)求得南昌航空大学科技学院学士学位论文2211()iiiiiiiAAdAd（3.2.12）机器人末端连杆相对于基础坐标系的实际变换矩阵( 表示实际变换矩表示理想变换矩阵)，忽略二阶及二阶以上误差项的高阶项后为:0011112(nn nTdAAdAdA ） ） ）2 1211()jnnii ijjjI r i=1（3.2.13）由公式(3.2.13) 可得0011()()jnnn ijjjjdTAA（3.2.14）上式只是机器人第 n 个关节(与末端执行器固接)坐标系原点位姿误差矩阵，要计算末端执行器位姿误差，必须右乘一个工具坐标
45、系 t 相对第 n 个关节坐标系的变换矩阵 ，因为末端执行器坐标系相对关节 n 坐标系是固定不动，则假定变换矩阵 不存在误差，机器人末端执行器位姿误差矩阵为00 11()()jnnn ijjjjdTAAA（3.2.15）这时与通用机构精度计算公式就统一了，若假定末端执行器坐标系相对第n个关节坐标系的运动学参数也存在误差，则变换矩阵 存在误差，只要把式(14)中 n 改为 n+1 即可，这里 n+1 代表末端执行器。在式(3.2.15)中虽然有结果，但这个结果表达式太复杂，不利于理解与后面标定时应用，下面直接用矩阵推导进行计算，类似式(3.2.10)推导，由式(3.2.15)可得00nndT（3
46、.2.16）为 的误差矩阵，其表达式为:00nzyxnzyxzdT（3.2.17）南昌航空大学科技学院学士学位论文23其中:ndP,nTnnTxyzxyzd为机器人末端位置、姿态误差，其具体表达式推导如下：由公式 11(,)(0,)(,0)(,)ii ii iARotzransransRotxa求得 11111(,)(,)(,)(,)i ii iitxTTdtz111 100ii iiiii icsscAc （3.2.18由1()iiidA得 111100iiiiiii iii icsdc cdsd （3.2.19）可以认为是由微分运动矢量 ,Ti xyze所组成，其中 ie得前三个元素为位置
47、误差，后三个元素为姿态误差。矢量 ie为11 111 10000iiiii iiiiixii iyzddxcscsyzesdscc iid（3.2.20）用 1,TiiiixddA了来表示杆件的实际误差，则上式可表示为iieG（3.2.21）其中 i为误差系数矩阵。上式(3.2.21)表示由于杆件 i 运动学参数误差所造成的微分变化，由于要对机器人末端手臂工具坐标系进行实际测量。需将误差 ie变换到手臂末端工具南昌航空大学科技学院学士学位论文24坐标系上，由于杆件 i 到手臂末端工具坐标系的微分变换可将式(3.2.21)误差ie变换到手臂末端工具坐标系上。若有杆件 i 到手臂末端工具坐标系的
48、T 变换矩阵如下:1201nopxxyylTAiilzz （3.2.22）则有杆件 i 到末端工具坐标系的微分变换将 e，变换到手臂末端工具坐标系:()()()0xyzxyzxyzxyzx xyzy zzdnpnpnoooyaaaz （3.2.23）记为:iilleJ（3.2.24）式中 il表杆件 i 运动学参数误差变换到手臂末端工具坐标系 t 上的误差矢量。ie表杆件 i 运动学参数误差所造成的微分变化。ilJ称为杆件 i 到手臂末端工具坐标系 t 的雅可比微分变换矩阵。其中， ,TTTxyzxyzPpnn则有()()()yzpnp,yzyzxzxyx 所以 ()()()0xyzxyzxyzxyzil xyzznpnpnoooaaaJ （3.2.25）南昌航空大学科
