《毕业设计论文基于手脚融合的多足步行机器人的运动精度研究.doc》由会员分享，可在线阅读，更多相关《毕业设计论文基于手脚融合的多足步行机器人的运动精度研究.doc（44页珍藏版）》请在三一办公上搜索。
1、基于手脚融合的多足步行机器人的运动精度研究河南工程学院本科毕业设计（论文）题 目 基于手脚融合的多足步行机器人的运动精度研究学生姓名 专业班级 机设06-4班 学 号 号 院 （系） 机电工程学院 指导教师 （教授） 完成时间 2010年5月30日 III基于手脚融合的多足步行机器人的运动精度研究摘 要机器人运动误差是衡量机器人性能的重要指标之一，直接影响到机器人的工作质量，对多足步行机器人的运动精度研究是一项重要而富有意义的工作。本文以四足步行机器人为研究对象，通过分析机器人的正运动学和逆运动学运动方程和误差方程，对步行机器人的精度分析问题进行了比较深入的理论研究。首先，结合国内外多足步行机
2、器人现状和误差分析现状以及多足步行机器人的机构特点，分析了运动误差的主要来源。其次，在多足步行机器人正逆运动学的求解过程的基础上，运用微分的方法计算运动机器人正逆运动的误差方程。最后，在MATLAB环境下编制相应的误差分析程序，通过实例仿真验证误差分析的正确性。关键词： 多足步行机器人/正运动学/逆运动学/误差分析HAND-FOOT-INTEGRATED MECHANUSM THE MORE WALKING ROBOT FUSION ACCURACY OF MOVEMENTABSTRACTThe motion error is one of the important indexes robo
3、t performances, which affect the working quality of the multilegged walking robot directly, for much of the motion precision walking robot research is an important and meaningful work. Based on four walking robot for research object, through the analysis of the robot kinematics and inverse kinematic
4、s is in error equations equation and the walking robot, precision analysis problem, deeply theoretical research.First, combined with the domestic and foreign many walking robot present situation and the error analysis, as well as the characteristics of the walking robot, the error analysis of moveme
5、nt error is the main reason for the difference.Secondly, in walking robot is the inverse kinematic solution process, using the differential method of inverse robot motion equation of movement error. Finally, in the MATLAB environment corresponding error analysis program compiled by example to prove
6、the correctness of the error analysis.Keywords:multi-legged walking robot，forward kinematics，inverse kinematics，Error analysis 目 录摘 要IABSTRACTII1绪论11.1引言11.2课题来源、目的及意义11.3国内外研究现状21.4本文研究内容72多足步行机器人的正运动学分析和误差分析92.1引言92.2研究对象的介绍102.3影响运动误差的主要因素112.4机器人正运动学分析和误差分析132.4.1串联机械手的正运动学132.4.2机器人抓取时的正运动学分析16
7、2.4.3算例192.5本章小结213多足步行机器人的逆运动学分析和误差分析223.1机器人的逆运动学分析和误差分析223.2算例263.3本章小结28结论29致谢30参考文献31附 录33附录133附录2371 绪论1.1 引言在自然界和人类社会中,存在一些人类无法到达的地方和可能危及人类生命的特殊场合,如行星表面、灾难发生矿井、防灾救援和反恐斗争等,对这些危险环境进行不断地探索和研究,寻求一条解决问题的可行途径成为科学技术发展和人类社会进步的需要。具有仿生特征的移动机器人，因为能够代替人在一些非结构性环境中作业而成为了学者们研究和关注的热点。传统的移动机器人主要包括履带式、足式、轮式、混合
8、式等多种运动形式。其中，履带式和轮式机器人结构较简单，其运动能力受到环境因素的限制。相对于轮式、履带式机器人而言，多足步行机器人在非结构化、存在不确定性的环境内移动虽具有较大的优势，但现有的多足步行机器人通常作为一种单纯的移动平台,或者配置特定的机械臂才能完成作业。如果能够在腿/臂融合结构基础上，把多足机器人的腿设计成具有手脚融合功能的结构形式，可使其能在在更多特殊环境和场合中使用,因而该类机器人具有广阔的应用前景。鉴于此，为了拓展多足步行机器人的实际应用,在世界范围内的科研人员对多足步行机器人的结构及所配工具开展了广泛的研究，如日本东京工业大学开发了TITAN-IX型排雷四足步行机器人。瞄准
9、国内外机器人技术的前沿，为了给我国步行机器人的研究提供理论平台和关键技术，开展多足机器人的技术和相关理论研究具有重要的科学意义和应用价值。1.2 课题来源、目的及意义课题来源于国家自然科学基金（编号：50875246）：本文是分析多足步行机器人运动时误差产生的原因，建立误差分析的模型，对误差参数经行分析。步行机器人(walking robot)或步行车辆(walking vehicle)简称步行机,是一种智能型机器人,它是涉及到生物科学、仿生学、机构学、传感技术及信息处理技术等的一门综合性高科技。在崎岖路面上,步行机器人优于轮式或履带式车辆。步行机器人腿式系统具有很大的优越性：较好的机动性,崎
10、岖路面上乘坐的舒适性,对地形的适应能力强。所以,这类机器人在军事运输、海底探测、矿山开采、星球探测、残疾人的轮椅、教育及娱乐等众多行业,有非常广阔的应用前景,多足步行机器人技术一直是国内外机器人领域的研究热点之一。定位精度是衡量多足机器人性能的一个重要指标，因此，无论在理论上还是在实验当中都受到了国内外学者的广泛关注。目前，由于工业机器人的广泛应用，针对其误差的研究已经受到了广大学者的关注，而多足步行机器人尚未能像工业机器人那样大规模的应用,其基础理论的研究比较滞后,关于其位姿误差分析的研究自今很少涉及。通过多足步行机器人的位姿误差分析，可以得到各个误差源对机器人机构输出位姿的影响程度，从而可
11、以发现机构中的关键环节，明确提高机器人精度的重点和方向，为改善机器人的设计质量和提高机器人的设计水平提供准确可靠的资料和依据。因此，在多足步行机器人领域对精度进行研究是一项重要而富有实际意义的工作。本课题的研究将介绍一种多足步行机器人的误差分析的方法，以四足步行机器人为例，通过仿真验证该方法的可行性。该课题的研究将会促进多足步行机器人向实用化迈进。1.3 国内外研究现状1.3.1多足步行机器人的研究现状多足步行机器人的发展最早可追溯到中国古代三国时的“木牛流马”。有据可查的是在1893年Rygg设计的机械马，历经一个多世纪的发展，特别是随着20世纪后期计算机技术、电子技术、人工智能技术、生物工
12、程的飞速发展，多足步行机器人的研究已经取得了长足的进步。20世纪60年代初，由美国的Shigley和Baldwin设计出了比履带车或轮式车更为灵活的步行机。比较典型的是由Mosher（美国）在1968年设计的“WalkingTruck”四足车1，如图1-1所示。其四条腿采用液压驱动，手臂和脚安装有位置传感器，具有步行和爬越障碍的功能，因此，“WalkingTruck”被视为步行机发展史上一个里程碑。在1976年，日本的Shiego Hirose 成功研制了世界上第一台四足步行机器人KUMO，如图1-2所示。它的外形像一个蜘蛛，有四条腿，能够爬行2。1983年由美国研制的 “ODEX-I” 六足
13、步行机器人，6条腿沿圆周均布,且每条腿有3个自由度,适于在狭小空间里运动,还可以上下台阶。1984-1986年东京大学的Shimoyama和Miura研制了Collie-l四足机器人，如图l-3所示。在1986-1988又研制了Collie-23，如图l-4所示。Collie-2每条腿有5个关节，且每个关节都装有电位器。该机器人装有实时操作系统，实现了trot和pace步态。1984-1986年东京大学的Shimoyama和Miura研制了Collie-l四足机器人，如图l-3图 11步行机“WalkingTruck”图 12第一台四足步行机器人KUMO所示。在1986-1988又研制了Col
14、lie-23，如图l-4所示。Collie-2每条腿有5个关节，且每个关节都装有电位器。该机器人装有实时操作系统，实现了trot和pace步态。图 13Colliel图 14Collie-2图 15“Spider-robot”图 16 “Attila”美国NASA研制的微型爬行机器人“Spider-bot”，如图1-5所示,机器人外形象蜘蛛, 重量轻,体积只有人头部的一半大小,可以在不规则的星球表面爬行。1990年初由美国MIT AI Lab完成的仿昆虫有腿行走机器人Attila,如图1-6所示。Attila采用了模块化设计, 头、腿、身体都有各自的驱动器、传感器和子处理器，有19个自由度。S
15、.Hirose等研制的TITAN系列四足步行机器人历经了八代。TITAN-III4，其足由形状记忆合金组成，且装有信号处理系统和传感器，可以自动检测与地面接触的状态。1994年研制了TITAN-VII，其能够躲避障碍和在陡峭和崎岖的地方步行。1996年研制的四足机器人TITAN-VIII，如图1-7所示，它具有很高的地面适应能力，腿能够作为工作臂，用于排雷和探测地雷5。图 17TITAN-VIII图 18Scout-I加拿大McGill大学研制了四足机器人Scout-I 6，如图1-8所示，机器人只有四个自由度，每条腿有一个转动关节。能转弯、步行和跨台阶，但可靠性较差。Scout-II 7，如
16、图1-9所示，能完成奔跑和步行等运动。图 19Scout-II图 110BISAM1995年，日本的安達、小谷内等研究了手脚统一型步行机器人MELMANTIS8,能将脚的移动和手臂的操作统一起来。该机器人可进行地雷探测、森林采伐和拆除作业等。1998年由德国开发的四足机器人BISAM9，如图1-10所示。该机器人4条腿完全相同，每条腿之间由3个转动关节相连，另一个转动关节连接躯干和腿部。该机器人实现了实时控制。西班牙开发的四足机器人SIL04，如图1-11所示。机器人每条腿有3个回转关节，并装有倾角器、编码器、力传感器和电位器。能在不平地面上行走，并能躲避障碍物。图 111SIL04图 112
17、ASTERISK2005年由大阪大学的新井健生、田窪明仁等研制成功的新型手脚统一型步行机器人ASTERISK8，如图1-12所示。该机器人有6条腿, 且每条腿有4个自由度，具有用手搬运物品及用脚移动或进行作业的双重机能，具有全方向移动的机能和全方位均等的作业空间，可悬吊于天花板进行作业或在不平地面上移动。采用电机驱动，有6个CCD摄像机和11个传感器。国内从20世纪80年代末90年代初开始研究步行机8。 近年来,对多足步行机器人相关技术的研究取得了一系列成果。1980年,中国科学院研制成功了八足步行机器人。1989年,北京航空航天大学研究成功了四足步行机器人。1990年,中国科学院沈阳自动化研
18、究所研制出了六足步行机器人10。同年,清华大学也研制成功了全方位三足步行机器人DTWN。1991年,上海交通大学研制了四足步行机器人JTUWM系列11。2000年,上海交通大学研制了微型双三足步行机器人MDTWR。2002年,上海交通大学研制了微型六足仿生机器人12。华中科技大学研制的4+2多足步行机器人13。从目前国内外多足步行机器人的研究现状可看出，多足步行机器人多作为一种移动平台，很难实现复杂的操作功能。对有手脚融合功能的多足步行机器人的研究极少涉及。2005年由大阪大学的新井健生、田窪明仁等研制成功的新型手脚统一型步行机器人ASTERISK8，如图1-12所示。该机器人有6条腿, 且每
19、条腿有4个自由度，具有用手搬运物品及用脚移动或进行作业的双重机能，具有全方向移动的机能和全方位均等的作业空间，可悬吊于天花板进行作业或在不平地面上移动。采用电机驱动，有6个CCD摄像机和11个传感器。国内从20世纪80年代末90年代初开始研究步行机8。 近年来,对多足步行机器人相关技术的研究取得了一系列成果。1980年,中国科学院研制成功了八足步行机器人。1989年,北京航空航天大学研究成功了四足步行机器人。1990年,中国科学院沈阳自动化研究所研制出了六足步行机器人。同年,清华大学也研制成功了全方位三足步行机器人DTWN。1991年,上海交通大学研制了四足步行机器人JTUWM系列。2000年
20、,上海交通大学研制了微型双三足步行机器人MDTWR。2002年,上海交通大学研制了微型六足仿生机器人。华中科技大学研制的4+2多足步行机器人14。从目前国内外多足步行机器人的研究现状可看出，多足步行机器人多作为一种移动平台，很难实现复杂的操作功能。对有手脚融合功能的多足步行机器人的研究极少涉及。1.3.2行机器人误差研究的现状机器人的实到位姿与理论位姿之间的偏差，称为机器人的位姿误差，这个指标直接影响到多足步行机器人定位精度。在很多应用场合，多足步行机器人机身可作为作业平台搭载仪器设备，因此其定位精度直接影响到机器人的工作质量。目前，有很多学者对并联机器人误差进行了研究，由于多足步行机器人在瞬
21、时类似于具有冗余驱动的并联机构，因此，对并联机器人的误差分析理论也可用于多足步行机器人的误差研究中。在国外，已有不少学者对机器人误差建模进行了研究。早在1978年，K J Waldron和A Kuman就提出了操作机器人的位置误差问题。次年，他们又对机器人位置精度提出了机器人位姿误差建模的矩阵法，在D-H坐标系中，采用两个33旋转变换矩阵和一个3维平移列矢量作为相邻构件之间的转换矩阵，并假设结构参数已知，且不存在任何误差，建立了机器人末端执行器的位置误差表达式。后来，A Kuman和S Prakash引入结构参数误差，导出了综合考虑运动变量误差和结构参数误差的机器人末端执行器的位置误差表达式。
22、Chi-haur Wu将机器人机构运动速度分析方法应用到静态误差分析中来，导出了由于构件结构参数误差和关节运动变量误差引起的末端执行器位置误差变化规律。Wang S M和Ehmann利用坐标转换方法，针对并联机构驱动器误差、铰链自身误差及铰链定位误差建立可以直接微分的输入输出方程然后进行直接微分，进行误差建模。Timo提出一种分析机器人精度的方法，根据输入输出方程微分推导求得输出误差与驱动误差与尺寸误差的关系方程。Han S Kim对Stewart平台的并联机器人运动误差范围作了分析与综合,通过对误差模型特征值问题的分析，研究了特征值与位姿误差和铰点误差界限的关系，提出了Stewart平台误差
23、界限正逆解问题的分析方法，并以双三角Stewart平台为仿真对象，分析了动平台平移和转动时特征值的变化情况。在国内，关于并联机器人的误差理论已成为学者的研究热点15-20。黄真教授21采用螺旋理论对并联机器人位姿误差进行了分析，其研究内容是分析已知尺寸误差，控制误差以及运动副间隙对末端位姿误差的影响。汪劲松教授22将Stewart平台的各分支作为假想的单开链，利用串联机器人运动学D-H方法，结合从运动学方程微分得到的结论，推导出Stewart平台并联机器人终端运动误差和铰链间隙误差间的映射关系。徐卫良23则通过直接对各个原始误差的微小位移矢量进行合成，建立了机器人手部位姿误差的数学模型。利用蒙
24、特卡洛技术模拟服从某种概率分布的原始误差，抽样计算机器人手部位姿误差，然后在数值上完成了机器人在其可达工作空间内的位姿误差的各种概率分析。在误差概率分析的基础上，建立了以连杆参数公差为设计变量、公差制造成本为目标函数、绝对位姿误差满足设计精度为约束条件的机器人机构精度优化设计的数学模型。洪林24从典型结构Stewart平台出发，运用并联机器人输入输出微分关系，建立了机器人输出位姿误差正解的数学模型，全面分析了结构参数和位姿参数对输出位姿误差的影响问题，研究了不同参数下奇异位形和机器人位姿正负偏差最大值出现的位置，结合对位姿正负偏差最大值的控制，提出了结构参数合理取值以有效避开误差敏感区的可行方
25、法。焦国太25在刚性机器人精度分析的基础上，结合柔性机器人的研究成果，对机器人位姿误差的分析，充分考虑了连杆和关节柔性以及静态误差对机器人末端执行器位姿精度的影响，将刚性机器人的精度分析方法和柔性机器人的运动学和动力学研究相结合，建立了机器人的位姿误差分析模型。祃琳36以3HSS型并联机床为对象，利用空间矢量链模型建立零部件制造误差与动平台位姿误差的映射关系，当给定零部件制造公差后，利用该模型即可预估出动平台的位姿误差。在此基础上，根据灵敏度分析结果，提出一种在给定刀具位姿允差条件下，以零部件制造公差加权欧氏范数最大为目标，以角性公差和线性公差在同一精度等级下达到均衡为约束条件的精度设计方法。
26、1.4 本文研究内容本文以四足步行机器人为研究对象，在讨论其运动学的基础上，提出了误差建模与分析的方法，并结合实验验证该方法的可行性.本文的研究对于提高多足步行机器人的定位精度，运动稳定性和优化多足步行机器人的设计具有重要意义。根据机器人的理论模型设计一条直线步态，通过对机器人在该步态下实际运动中机体轨迹误差数据的测量，通过机器人的误差模型，计算出站立腿驱动关节参数误差值。将该误差值的负值作为驱动关节参数的补偿量，按补偿后的关节参数重新驱动多足步行机器人运动该步态实验结果表明：机器人机体轨迹的运动精度显著提高。本文主要结构如下：(1) 绪论。(2) 简述步行机器人发展现状及机器人误差分析的研究
27、现状。(3) 多足步行机器人的运动学介绍。计算手脚融合状态下的正运动学和逆运动学的误差，建立机器人误差分析模型。(4) 利用Matlab开发机器人的运动误差分析程序。(5) 将以前述的误差分析为基础，对由多种因素引起的机器人的综合位姿误差进行探讨，并对实例进行实验,验证了误差分析方法的正确性402 多足步行机器人的正运动学分析和误差分析2.1 引言多足步行机器人的运动学计算是求解机器人的输入变量与输出构件（机身平台）之间的位置关系，是机器人运动分析最基本的任务，也是机器人速度、加速度、受力分析、工作空间分析、误差分析、动力分析等的基础。在多足步行机器人运动过程中，各条腿按顺序抬起和放下，从瞬时
28、性角度来看，多足步行机器人就是一个具有冗余自由度的并联机构。由于多足步行机器人结构复杂，对其进行运动学计算要比一般的移动机器人的运动学计算要复杂的多。已知机器人主动件的位置，求解机器人输出件的位置和姿态称为正运动学求解，若已知输出件的位置和姿态，求解机器人输入件的位置称逆运动学求解。类似于并联机器人，多足步行机器人的正运动求解比逆运动学求解要复杂得多。本文将对正运动学和逆运动学分别求解。并联机器人运动学分析主要有数值法和解析法。数值法的优点是它可以应用于任何结构的并联机器人，计算方法简单，但不能保证获得全部解，存在局部极小点问题，计算时间较长。本章将以四足步行机器人为研究对象介绍一种解析法求解
29、多足步行机器人正运动学的方法。图 2.1 步行机器人MiniQuad的关节布置示意图2.2 研究对象的介绍MiniQuad是由郑州轻工业学院开发的四足机器人样机,它是一种具有腿臂融合、模块化特征的小型多足步行机器人。MiniQuad由机体和四条腿组成。机器人机体是一个矩形平台。每条腿通过一个旋转关节与矩形平台相连。为了保证机器人的机动性，旋转关节的轴线与矩形平台垂直。图2.1给出了MiniQuad的一般简图。其腿类似于同一机器人机体上的四个机械手。每条腿由一个平面连杆机构、一个旋转机构和一只脚组成。通常，除了一些自由或被动关节以外，每条腿还有三个执行关节，其中代表旋转关节，而和代表平面连杆机构
30、中的关节。如图2.1所示,每条腿上的活动关节通常都由直流电机驱动。由于机器人的重量都集中在其机体上，旋转机构的关节支撑连接着腿和机体，所以可以根据几何对称性假设机器人的重心与其几何中心近似一致。当一条腿与地面接触时，该腿定义为站立腿，并假设该接触点是不可动的。如果腿处于摆动状态，该腿就被定义为摆动腿。将腿与地面通过运动学耦合，从而该机构系统就相当于一个并联机械手。对于多足机器人静态稳定的步行运动，最基本的步行模式是三条腿同时支撑于地面上，其余的腿向前摆动。机器人步行时它的运动机构可以看作一个是由机器人机体（运动平台）、地面（固定平台）和三条站立腿构成的并联机械手和摆动腿组合而成。图2.2给出了
31、其中一条腿处于摆动状态时四足机器人的结构简图。图 2.2 四足机器人瞬时步行状态其中代表参考坐标系，在这里我们选定自然坐标系作为参考坐标系，代表固定在机器人机体上、原点与机器人几何中心重合的坐标系，机器人矩形机体的两边尺寸为和。2.3 影响运动误差的主要因素多足步行机器人的运动学D-H参数法坐标变换中坐标变换矩阵及平台位姿变换矩阵都是不考虑各运动学参数误差的理想变换，但在实际应用中，无论机器人制造精度多高，都会由于各种原因引起机器人运动学参数误差，影响运动平台定位精度。机器人的位姿精度取决于很多因素，其因素主要包括机器人零部件的加工制造误差，机器人的安装，传动机构的误差，机器人连杆和关节的柔性
32、及机器人工作环境等因素。影响多足步行机器人位姿精度的因素可分为静态因素和动态因素。所谓静态因素是在机器人运动过程中始终保持不变的因素，所谓动态因素是指在机器人运动过程中随时间变化的因素。静态因素包括：1.多足步行机器人连杆结构参数和运动变量误差。由于制造及装配的误差使机器人腿关节的实际参数与其名义值之间产生偏差,从而引起机器人位姿误差；2.环境因素。如工作环境温度的变化将导致机器人连杆的长度尺寸误差；3.关节误差、位置传感器误差、控制系统的误差等；4.环境变化所引起的立足点位置误差。动态因素主要包括：由自重、外力、惯性力等引起的腿部连杆和关节的弹性变形及振动。其中，对多足步行机器人定位精度影响
33、最大的误差因素包括：（1）机器人的连杆参数误差多足步行机器人腿部各关节都是旋转关节，对于旋转关节有3个结构参数,即D-H参数,和,其误差主要是由于机器人在制造和安装过程中产生的，或则体现为步行机器人连杆（腿）的长度尺寸。机器人腿部连杆长度尺寸误差可导致机器人平台的位姿误差。通常引起连杆长度误差（）的因素主要有连杆的加工误差及因周围环境温度变化而引起的连杆长度尺寸误差，则表述为式中为机器人连杆的加工误差，它由机械加工水平所决定。为环境温度所引起的连杆的长度变化，对于长度为的连杆，当环境温度变化量为时，其引起连杆长度变化量为式中为连杆材料的热延伸系数。对于多足步行机器人，由于工作环境的不同，环境温
34、度所引起的杆长变化量亦不同，在温差较大的环境中，该变化量可成为杆长误差的主要因素，在恒温状态下工作的机器人，该变化量则可以忽略。（2）立足点位置误差由于工作环境的非结构化，机器人立足点的位置会偏离预期的位置，立足点位置误差（）也会造成机器人机体位姿误差，还会对机器人的稳定性造成影响。立足点位置误差可表示为（3）机器人的关节运动变量误差机器人腿部转动关节的运动变量（）误差使机器人平台的位姿产生误差。导致关节的运动变量产生误差的主要静态因素有：1.电机控制系统的工作误差；2.传动机构的运动误差；3.传动机构的间隙。因此，由静态因素引起的机器人关节的运动变量误差可表示为式中，为电机控制系统的误差；为
35、传动机构的误差；为传动机构的间隙。（4）机器人关节柔性误差机器人的关节一般存在一定的柔性，在机器人自身重力、外力、及惯性力作用下，使机器人平台产生位姿误差。机器人支撑腿各关节的柔性实际上将导致关节产生相应的运动变量误差（）表示，由关节的柔性所造成的运动变量误差的计算公式式中：为关节的刚度系数；为作用于机器人支撑腿上的外力矢量沿、轴上的分量；为外力矢量的作用位置矢量。为作用于机器器人腿上的外力矢量数目。将支撑腿关节的柔性对机器人位姿误差的影响归结为机器人腿部关节运动变量误差可通过机器人静态位姿误差分析模型来计算由关节柔性引起的机器人平台的位置误差。（5）支撑腿连杆柔性误差焦国太51介绍了分析腿部
36、连杆柔性所引起的机器人位姿误差的结构矩阵分析方法。应用该方法可求得机器人平台由腿部连杆所引起的位置和姿态误差，需要注意其姿态误差按照固定坐标系分别绕、轴的微小转角给出，为统一使用欧拉角来表示机器人末端的姿态误差，必须对其进行变换。假定在某时刻由机器人支撑腿连杆柔性所引起的机器人平台位姿误差为：，则由微分变化算子可得从而得到机器人机身的坐标系和固定坐标系之间的相对变换矩阵根据上式,求得考虑连杆柔性时机器人平台的实际位置和姿态，实际位姿和名义位姿的差即为经过变换后由腿部连杆柔性所引起的机器人平台位姿误差：将支撑腿连杆柔性所引起的机器人平台位姿误差进行转换后即可和由静态误差和关节柔性引起的机器人平台
37、的误差进行迭加,得到机器人平台的综合位姿误差。由上述分析可知,多足步行机器人平台的位姿误差由很多因素引起,如果将这些因素作为孤立的因素,分别加以考虑,会使位姿误差的分析变得十分的复杂。可行的方法就是将所有因素引起的位姿误差都归结为支撑腿各连杆的运动变量误差引起的位姿误差、各组成连杆的结构参数误差引起的位姿误差以及立足点误差所引起的机器人位姿误差。从误差分析和传递的情况分析，机器人平台的位姿误差与支撑腿各组成连杆的运动变量、结构参量和立足点之间存在函数关系，就是将各因素引起的平台位姿误差归结为各组成连杆的D-H参数误差和立足点误差引起的，这样将简化多足步行机器人误差分析的模型，为误差分析带来方便
38、。2.4 机器人正运动学分析和误差分析2.4.1串联机械手的正运动学具有手脚融合功能的机械手由4 个回转关节组成，包括：髋关节、大腿关节、小腿关节和腕关节。其关节结构简图如图2.3所示。机械手的正运动学就是已知机械手连杆参数和关节变量，求末端执行器相对于参考坐标系的位置和姿态。图2.3 机械手结构简图1324机体采用D-H法建立机械手坐标系，该方法通过在每个连杆上固定一个坐标系，用阶的齐次变换矩阵描述两个杆件的空间关系（位置和姿态），从而推导出机械手末端坐标系相对于参考系的等价齐次变换矩阵D-H坐标系规定：在机械手的各个主要构件上固定坐标系。坐标系的Z轴可与运动副的轴线重合，而X轴则沿着相邻两
39、个Z轴的公垂线，至于Y轴可由右手坐标系法则来确定58-59。对回转连接的两杆件,在 D-H方法中连杆构件坐标系的选择及参数的规定如下：由原点Oi和坐标轴Xi、Yi、Zi定义的坐标系Fi，Fi被固结在第i-1个连杆上，其中i=1,2,n+1。1)Zi坐标轴是沿着i+1关节方向的运动轴。2)Xi轴是沿着Zi-1和Zi的公垂线方向的坐标轴，方向是前者指向后者(见图2.4a)，如果Zi-1和Zi相交,Xi的正方向就不确定,可以任意指定。如果Zi-1和Zi平行(见图2.4c),Xi的位置就不确定。为保证定义唯一,规定Xi通过第i-1个坐标系的原点。3)公垂线ai是Zi-1和Zi两轴间的最小距离，一般ai
40、称为连杆长度。图2.4 D-H坐标系4)两公垂线ai-1和ai之间的距离di，di称为连杆距离。5)Zi-1和Zi之间的夹角定义为,以绕Xi轴右旋为正, 称为扭转角。6)Xi-1和Xi之间的夹角定义为i,以绕Zi-1轴右旋为正,一般称i为连杆的夹角。根据图2.3的关节布置及D-H法则，建立各连杆的坐标系，如图2.5所示。这里的参考坐标系固定在髋关节上， 为固连于机械手手部的坐标系，根据以下原则确定的：图2.5 机械手的参数坐标系取手部中心点为原点，关节轴方向的单位矢量为轴，手指连线方向的单位矢量为轴，轴则按右手法则来确定。根据所建立的连杆坐标系，可以确定连杆坐标参数，如表2-1所示。表2-1
41、连杆参数杆件号关节转角（变量）扭角杆长距离102030040为求解运动学方程式，用齐次变换矩阵描述第i坐标系相对于第（i-1）坐标系的位置和方位，即连杆变换通式： （2-1） 由连杆变换通式及连杆参数可得到各连杆变换矩阵。为书写方便，令。各连杆变换矩阵为： 根据图4-6，将各连杆变换矩阵相乘可得到末端执行器坐标系相对于的齐次变换阵。 将各连杆变换矩阵代入，可求得 （2-2）式中2.4.2机器人抓取时的正运动学分析A1A2A3B1B2B3B4图2.6 机器人整体坐标系建立机器人在抓取物体时的整体坐标系，如图2.6所示。其中为参考坐标系，为固定在机器人机体上、原点与机器人几何中心重合的坐标系，为机
42、身与髋关节连接处的坐标系，为末端执行器坐标系。由所建立的坐标系可以得到各坐标系的相对齐次变换矩阵。由图2.6可以得到各坐标系的相对齐次变换矩阵。 (2-3) (2-4)末端执行器相对于的齐次变换阵，即机器人在抓取物体时的运动学方程为： （2-5）根据所建立的坐标系可以求得末端执行器坐标系相对地面坐标系的齐次变换矩阵，该矩阵描述了末端执行器在地面坐标系的位置和姿态。即机器人在抓取物体时的运动学方程为： （2-6）将（2-2）、（2-3）、（2-4）代入（2-6）式，可以求得末端执行器在地面坐标系的位姿。 (2-7)式中 通过对正运动学分析所得的方程微分求出误差方程为：2.4.3算例在此我们在MA
43、TLAB中调用名为forward_hand的M文件，其中Theta，il，Rc，dRc，m，n，d4，d_Theta，P_0_c，d_P_0_c，dm,dn，idl为输入参数，其中Theta为连杆夹角il是一个的矩阵，表示多足步行机器人腿长的理论值；Rc是一个的矩阵，表示多足步行机器人机体动平台的状态，其意义式为m,n为机体尺寸d4表示第四根杆的距离P_0_c是一个的矩阵，表示多足步行机器人质心点的理论位置，意义为；下面用一组数据为例，并以此做为误差分析的一种在理论上的证明：调用附录1中的M文件中的函数，其输出参数的结果会出现在命令窗体中，输入如下参数：Theta=0,0,0;0,-30,90
44、;0,0,0;0,0,0;il=65,200,266;d4=180;Rc=1,0,0;0,1,0;0,0,1;dRc=0.30,0,0;0,0.50,0;0,0,0.20;d_Theta=0,0,0.40,0;P_0_c=-40,80,266;m=197;n=140;d_P_0_c=0,0,0.20;idl=0,0.75,0;dm=2;dn=1;forward_hand(Theta,il,Rc,dRc,m,n,d4,d_Theta,P_0_c,d_P_0_c,dm,dn,idl);得出的结果如下：解得的手的位置如下 0.4268 -0.8515 -0.3048 171.7707 0 0 0 2
45、20.0000 0.1366 -0.2725 0.9524 716.9482 0 0 0 1.0000机械臂正运动学误差d_F=d_F = 0.0734 -0.4017 -0.4724 54.0373 0 0 0 0 0 0.2861 0.0686 52.6028以上结果显示了正运动学方程在MATLAB的计算中的误差的正确性2.5 本章小结本章首先对基于手脚融合的多足步行机器人做了简单的介绍，并分析了多足步行机器人的误差产生的原因主要包括机器人零部件的加工制造误差，机器人的安装，传动机构的误差，机器人连杆和关节的柔性及机器人工作环境等因素。详细介绍了几种对多足步行机器人运动精度影响最大的误差因素。最后我们介绍了机器人串联手的正运动学，对机器人抓取时的正运动学分析做了详细分析，导出机器人正运动学误差方程，并通过实例验证误差方程的正确性。3 多足步行机器人的逆运动学分析和误差分析3.1 机器人的逆运动学分析和误差分析在第2章中我们介绍了机器人正运动学的运动学分析和误差分析的推导方程，从工程应用角度
