机械臂的轨迹规划

机械臂运动的轨迹规划摘要空间机械臂是一个机、电、热、控一体化的高集成的空间机械系统。随着科技的开展，特别是航空飞机、机器人等的诞生得到了广泛的应用，空间机械臂作为在轨迹的支持、效劳等以备受人们的关注。本文将以空间机械臂为研究对象，针对空间机械臂的直线运动、关节的规划、空间直线以及弧线的轨迹规划几个方面进行研究，对机械臂运动和工作空间进行了分析，同时对机械臂的轨迹规划进行了验证，利用MATLAB软件对机械臂的轨迹进行仿真，验证算法的正确性和可行性，同时此路径规划方法可以提高机械臂的作业效率，为机械臂操作提高理论指导，为机器人更复杂的运动仿真与路径规划打下根底。本文一共分为四章：第一章，首先总结了机械臂运动控制与轨迹规划问题的研究现状及研究方法，归纳了各种轨迹规划的算法及其优化方法，阐述了机械臂的研究背景和主要内容。第二章，对机械臂的空间运动进行分析研究，采用抽样求解数值法—蒙特卡洛方法，进行机械臂工作空间求解，同时在MATLAB中进行仿真，直观展示机械臂工作范围，为下一章的轨迹规划提供理论根底；同时通过D-H参数法对机械臂的正、逆运动分析求解，分析两者的区别和联系。第三章，主要针对轨迹规划的一般性问题进行分析，利用笛卡尔空间的轨迹规划方法对机械臂进行轨迹规划，同时利用MATLAB对空间直线和空间圆弧进行轨迹规划，通过仿真验证算法的正确性和可行性。第四章，总结全文，分析本文应用到机械臂中的控制算法，通过MATLAB结果可以得出本文所建立的算法正确性，能够对机械臂运动提供有效的路径，而且改良了其他应用于空间机械臂的路径规划问题。【关键词】运动分析工作空间算法研究轨迹规划ABSTRACTSpacemanipulatorisamachine,electricity,heat,chargedwithhighintegrationofspacemechanicalsystemintegration.Withthedevelopmentofscienceandtechnology,especiallythebirthofaviationaircraft,arobothasbeenwidelyused,thetrajectoryofspacemanipulatorasthesupportandservicestopeople'sattention.Thisarticlewillspacemanipulatorastheresearchobject,accordingtothelinearmotionofthespacemanipulator,jointplanning,spaceofthestraightlineandcurve,thetrajectoryplanningofseveralaspectsofmechanicalarmmovementandworkingspaceareanalyzed,andthetrajectoryplanningofmanipulatorisverified,thetrajectoryofmanipulatoristomakeuseofMATLABsoftwaresimulation,verifythecorrectnessandfeasibilityofthealgorithm,atthesametimethispathplanningmethodcanimprovetheefficiencyofmechanicalarm,improvethetheoreticalguidanceformechanicalarmoperation,simulationandpathplanningforrobotmorecomplicatedmovement.Thisarticleisdividedintofourchaptersaltogether:Thefirstchapter,firstsummarizesthemechanicalarmmotioncontrolandpathplanningproblemresearchstatusandresearchmethods,summarizesthevarietyoftrajectoryplanningalgorithmandthemethodofoptimization,andexpoundstheresearchbackgroundandmaincontentofmechanicalarm.Thesecondchapter,thepaperstudiedthespacemotionofmechanicalarm,thenumericalmethod,montecarlomethodarededucedwiththemethodofsampling,theworkspaceformechanicalarmis,atthesametimethesimulationinMATLAB,intuitivedisplaymechanicalarmworkscope,providingtheoreticalbasisforthenextchapteroftrajectoryplanning.Atthesametimethroughd-hmethodofpositiveandinversekinematicanalysisofthemechanicalarm,analyzethedifferenceandcontact.Thethirdchapter,mainlyaimsatthegeneralproblemoftrajectoryplanningisanalyzed,usingcartesianspacetrajectoryplanningmethodfortrajectoryplanning,mechanicalarmatthesametime,MATLABisusedtoanalysethespatialstraightlineandarctrajectoryplanning,throughthesimulationverifythecorrectnessandfeasibilityofthealgorithm.Thefourthchapter,summarizesthefulltext,analysisofthecontrolalgorithmisappliedtothemechanicalarminthispaper,throughtheMATLABresultscanbeconcludedthatthecorrectnessofalgorithm,canprovideeffectivepathofmechanicalarmmovement,andimprovedtheotherusedinspacemanipulatorpathplanningproblem.[keywords]motionanalysis,workspace,trajectoryplanning,algorithmresearch目录TOC\o"1-3"\h\u21160摘要-1-15441ABSTRACT-2-1144第一章绪论-5-10703第一节研究背景及意义-5-22744第二节国内外开展现状-6-25921一、国内现状-6-20324二、国外现状-6-3859第二章机械臂的运动分析-8-4398第一节机械臂的正运动学分析-8-21782第二节机械臂的逆运动学求解-10-16802第三章五轴机械臂轨迹规划与仿真-11-20063第一节轨迹规划一般问题-11-32630第二节关节空间的轨迹规划-12-15096一、三次多项式插值法-12-24075二、五次多项式插值-15-28217第三节笛卡尔空间的轨迹规划-17-8942一、空间直线轨迹规划-18-8386二、空间圆弧的轨迹规划-21-12384三、一般空间轨迹规划-25-3948第四章总结与展望-30-3333参考文献-31-第一章绪论第一节研究背景及意义随着宇宙空间的开发，70年代美国提出了在宇宙空间利用机器人系统的概念，并且在航天飞机上实施。当初的空间机器人是由航天飞机舱内的宇航员通过电视画面操纵的。随着空间技术的进一步开展使得未来空间操作任务急剧增加，空间站的建立、维修，卫星的回收、释放等工作会越来越多。如果所有这些工作都依靠宇航员来完成，其本钱将十分高昂，也是十分危险的，因为恶劣的太空环境会给宇航员的空间作业带来巨大的威胁。宇航员的舱外作业需要庞大而复杂的环境控制系统、生命保障系统、物质供应系统、救生系统等的支持，这些系统不但具有很高的技术难度，而且本钱巨大。用空间机器人代替宇航员进行太空作业不仅可以使宇航员防止在恶劣太空环境中工作时可能受到的伤害，还可以降低本钱，提高空间探索的效益。空间机械臂是空间机器人的一种，已被考虑在未来的空间活动中承当大型空间站的在轨安装及对失效飞行器的的捕捉与维修，土壤和岩石的取样等；并期望其在无人状态下承当未来空间实验室或工厂的日常工作。根据空间作业的需要，空间机器人上一般都安装了一个或多个模仿人手臂的多自由度机器臂。随着我国国民经济与国防工业技术的迅速开展，对航天器的需求量日益增加，对其能力的要求日臻提高。特别是空间站在轨效劳、深空探测等空间技术领域的迅速开展，对于空间机械臂技术的需求越来越迫切，而且对其工作能力和性能要求越来越高，对其平安性、寿命等方面也提出了越来越高的要求。此外，受国外在高技术领域的技术限制与封锁，使得我们必须坚持自力更生、独立自主的高技术研发道路，坚持自主创新的思想，加速并加强空间机械臂技术的研发工作[1]。将机器人用于空间效劳，一项关键技术就是路径规划。路径规划研究是机器人研究领域中的一个重要分支,是机器人导航中最重要的任务之一。对静态环境中机器人路径规划的研究已经进行了将近40年，路径规划问题的研究有很大的价值。多年的研究工作在取得进展的同时，愈加证明了路径规划是一个复杂的难题。路径规划算法的计算量取决于任务、环境的复杂性以及对规划路径质量的要求，一个好的路径规划算法应该兼顾对规划速度和路径质量的期望。随着研究的深入，各种新的路径规划方法层出不穷，使路径规划研究一直活泼在机器人学领域。目前国内对空间机械臂研究还处于起步阶段，因此开展空间机械臂相关领域的研究将极大促进我国空间科学试验、空间维护与建设、深空探测等空间技术的开展。本论文根据课题的技术要求，将空间机械臂路径规划作为切入点，研究路径规划问题，其研究成果具有重要的理论指导意义和工程应用价值。第二节国内外开展现状一、国内现状我国的工业机器人从80年代“七五”科技攻关开始起步，目前已根本掌握了机器人操作机的设计制造技术、控制系统硬件和软件设计技术、运动学和轨迹规划技术，生产了局部机器人关键元件，开发出喷漆、弧焊、点焊、装配、搬运等机器人；但总的来看，我国工业机器人技术及其工程应用的水平和国外比还是有一定的距离，如：可靠性低于国外产品；机器人应用工程起步较晚，应用领域窄，生产线系统技术与国外比有差距。我国的智能机器人和特种机器人在“863”方案的支持下，也取得不少成果。其中最突出的是水下机器人，6000米水下无缆机器人的成果居世界领先水平，还开发出直接遥控机器人、双臂协调控制机器人、爬壁机器人、管道机器人等机种；在机器人视觉、力觉、触觉、声觉等根底技术的开发应用上开展了不少工作，有一定的开展根底。但是在多传感器信息融合控制技术、遥控加局部自主系统遥控机器人、只能装配机器人、机器人化机械等的开发应用方面那么刚刚起步，与国外先进水平差距较大。二、国外现状美国是机器人的诞生地，早在1962年就研制出世界上第一台工业机器人，比起号称“机器人王国”的日本起步至少早五六了年。1971年，通用汽车公司又第一次用机器人进行点焊。西欧时仅次于日美机器人的生产基地，也是日美机器人的重要市场。早在1966年，美国Unimation公司的尤尼曼特机器人和AMF公司的沃莎特兰机器人就进入英国市场。接着，英国HallAutomation公司研制出自己的机器人RAMP。德国工业机器人的总数占世界第三。德国对于一些有危险、有毒、有害的工作岗位，必须以机器人替代普通人的劳动。同时提出了1985年以后要向高级的、带感觉的智能型机器人转移目标。1954年：美国人戴沃尔制造了世界第一台可编程的机械手。1959年：戴沃尔与美国创造家英格伯格联手制造出第一台工业机器人。1962年：美国AFM公司生产出万能搬运机器人，与Unimation公司生产的万能伙伴机器人一样成为真正商业化的工业机器人。1967年：日本川崎重工公司与丰田公司分别从美国购置了工业机器人Unimat和Verstran的生产许可，开始对机器人的研究和制造。1968年：美国斯坦福研究所公布他们研制的机器人Shakey。1973年：世界上机器人和小型计算机第一次携手合作，诞生了机器人T3。1979年：日本山梨大学创造了平面关节机器人SCARA。1984年：英格伯格在此推出机器人Helpmate，这种机器人能在医院为病人送饭送药和送邮件。1996年：本田公司推出仿人型机器人P2，双足行走机器人的研究到达了一个新的高度。2002年：美国iRobot公司推出了吸尘器机器人Roombar，为世界上商业化最成功的家用机器人。2006年：微软公司推出MicrosoftRobiticsStudio机器人，从此机器人模块化平台同一化的趋势越来越明显。在工业机器人技术方面，工业机器人有操作机(机械本体)、控制器、伺服驱动系统和检测传感器装置构成，是一种仿人操作、自动控制、可重复编程、能在三维空间完成各种作业的机电一体化自动化生产设备。第二章机械臂的运动分析机械臂的运动是其轨迹出现的直接原因。所以轨迹规划的前提是机械臂的运动分析[1]。本文通过对机械臂的正运动学和逆运动学进行求解，分析两者的区别和联系。通过对五轴机械臂关于坐标系几何关系，针对常见轨迹规划方案中起始和终止阶段进行研究，分析研究结果。第一节机械臂的正运动学分析机械臂从关节空间到末端笛卡尔空间的变换是正向运动学描述。由坐标系中的各个关节角度，求解机械臂末端相对应于原点坐标系的位置和位姿。设矩阵A表示机械臂连杆的齐次变换：(2-1)由于机械臂全是旋转关节。对于文中采用的机械臂而言有五个其次变换矩阵，那么末端连杆坐标系相对于基坐标系的齐次变换矩阵(2-2)式即为机械臂的运动方程，它反响各关节变量与机械臂末端位姿之间的关系，上式左边的五个矩阵含有五个关节变量。方程右边为描述机械臂末端关节位置和姿态的齐次矩阵，由刚体姿态的描述可知，，，，，，，，分别为机械臂末关节坐标系的三个坐标轴与机械臂基坐标系三个坐标轴的方向余弦，，，为机械臂末关节的坐标原点在机械臂基坐标系中的三维坐标。机械臂正运动学求解就是各连杆的关节变量求解末端连杆的位姿矩阵。即关节变量，求解上式机械臂运动学方程中等式右边矩阵各元素的值[10]。将上式中的机械臂五个关节的齐次变换矩阵带入，即计算出中各元素值为：(2-3)其中：其中，，，，。第二节机械臂的逆运动学求解机械臂的逆运动学解是对其运动学正解的反解，因而量和求解量相反，即机械臂末端的位置姿态对机械臂进行驱动，使各个关节从此刻的姿态运动到与末端位姿相对应的位置，进而得到关节变量[11]。机械臂的运动学正、逆求解实质是机械臂关节空间与工作空间之间的非线性映射关系，两者可相互转换。关系图如下所示。图1关节空间与工作空间的关系机械臂的逆运动学问题，指机械臂的末端位姿，即齐次变换矩阵，求解各转动关节的角度。机械臂的逆运行学问题，可以理解为通过运动学方程：(2-4)求解。整理式，将含有的局部移到方程的左边(2-5)将转置，上式可以表达成为：(2-6)假设上式的两边元素和式相等，得到：(2-7)可以得出的解。第三章五轴机械臂轨迹规划与仿真目前关于空间轨迹规划的方法主要有三种，三次多项式插值，高阶多项式插值以及样条曲线等方法。主要讨论轨迹在关节空间中的位移、速度与加速度等变量的关系。规划实质是根据需求，计算出预定的轨迹曲线，在轨迹规划时可以再运动学与动力学的根底上进行规划，所以规划是建立在运动学和动力学根底上的。图2机械臂的matlab生成第一节轨迹规划一般问题轨迹规划的一般方法是在机械臂末端的初始和目标位置之间用多项式函数“内插”来抵近给定的路径，并沿着时间轴产生一系列的可供操作机使用的“控制设定点”[3]。其中关节坐标和笛卡尔坐标都可以对路径端点进行给出。一般是在笛卡尔坐标中给出，由于在笛卡尔坐标中机械臂末端形态更容易观察。所以通常采用笛卡尔方法。在给定的两端之间，常有多条可能路径。可以沿着直线和光滑多项式曲线运动。本文将讨论插值法，研究满足路径约束的简单轨迹规划[3]。第二节关节空间的轨迹规划机械臂关节空间的轨迹规划解决机械臂从起始位姿到终止位姿去取放物体的问题.机械臂末端移动的过程并不重要，只要求运动是平滑的且没有碰撞产生.在关节空间中进行轨迹规划时，算法简单、工具移动效率高、关节空间与直角坐标空间连续的对应关系是不存在的，因此机构的奇异性问题一般不会发生。对于无路径的要求，应尽量在关节空间进行轨迹规划。一、三次多项式插值法三次多项式与其一阶导数函数，总计有四个待定系数，对起始点和目标点两者的角度、角角速度同时给出约束条件，本文采用的是三次多项式插值法[5]。可以对通过空间的个点进行分析并进行轨迹规划，让速度和加速度在运动过程中保持轨迹平滑。本文算法可以实现对段中的每一段三次多项式系数求解，为了方便，对其进行归一化处理。(1)时间标准化算法根据三次多项式轨迹规划流程，对每个关节进行轨迹规划时需要对段的轨迹进行设计，为了能对个轨迹规划方程进行同样处理，本文首先设计了时间标准化算法将时间进行处理，经过处理后的时间。首先定义：：标准化时间变量，；：未标准化时间，单位为秒；：第段轨迹规划结束的未标准化时间，；机械臂执行第段轨迹所需要的实际时间：，其中。时间归一化后的三次多项式为：(2)机械臂轨迹规划算法实现过程①初始位置为；②给定初始速度为0；③第一个中间点位置，它也是第一运动段三次多项式轨迹的终点；④为了保证运动的连续性，需要设定所在点为三次多项式轨迹的起点，以确保运动的连续；⑤为了保证处速度连续，三次多项式在处一阶可导；⑥为了保证处加速度连续，三次多项式在处二阶可导；⑦以此类推，每一个中间点的位置，都一定要在其原运动段轨迹的终点，并且也是它后运动段的起点。⑧的速度保持连续；⑨的加速度保持连续；⑩点位置。给定终点速度，设其为0。(3)约束条件第一个三次曲线为：第二个三次曲线为：第三个三次曲线为：．．．．．．第个三次曲线为：在同一时间段内，三次曲线每次的起始时刻，停止时刻，其中。①在标准化时间处，设定为第一条三次多项式运动段的起点，可以得出：；②在标准化时间处，三次多项式运动段第一条的初始速度是变量，所以得出：；③第一中间点位置与第一条三次多项式运动段在标准化时间时的终点相同，所以可以得出：；④第一中间点位置与第一运动段在标准化时间时起点相同，所以得出：；⑤三次多项式在处一阶可导，因此可得出：；⑥三次多项式在处二阶可导，因此可得出：；⑦第二个空间点的位置与第二运动段在标准化时间时的终点相同，所以有：；⑧第二个中间点的位置应与第三运动段在标准化时间时起点相同，所以有：；⑨三次多项式在处一阶可导，从而有：；⑩三次多项式在处二阶可导，从而有：；．．．．．．⑪第个中间点位置和第运动段在标准化时间时的终点相同，所以有：。⑫第个中间点位置应与下一运动段在标准化时间时的起点位置相同，所以有；⑬三次多项式在第个中间点处一阶可导，从而：(3-1)⑭三次多项式在第个中间点处二阶可导，从而：(3-2)⑮因此可以得出所有轨迹终点在标准化时间时的位置为：(3-3)⑯因此可以得出所有轨迹终点在标准化时间时的速度为：(3-4)以上公式改写为矩阵为：。由该矩阵计算可以求出轨迹规划的全部参数，(由五轴机械臂运动学逆解求出)于是求得段的运动方程，从而使五轴机械臂末端执行器经过所给定的位置坐标。通过以上分析可以确定机械臂在满足速度要求的两个位姿之间运动时各个关节轴的角度变化曲线。如下列图3所示是MATLAB仿真分析三次多项式插值：机械臂某关节角在4秒内由初始点A经过中间点B到达终点C的变化情况。三个位置点的速度和角速度如下所示：图中实线为角度变化曲线，虚线为角速度变化曲线。关节角度曲线平滑，而速度曲线在中间点B处出现突变。图3三次多项式插值法二、五次多项式插值五次多项式共有六个待定系数，要想六个系数得到确定，至少需要六个条件。五次多项式可以看作是关节角度的时间函数，因此其一阶可导和二阶可导分别可以看作是关节角速度和关节角加速度的时间函数。五次多项式及一阶、二阶导数公式如下：(3-5)(3-6)(3-7)为了求得待定系数,对起始点和目标点同时给出关于角度和角加速度的约束条件：(3-8)(3-9)(3-10)(3-11)(3-12)(3-13)式中、分别表示起始点和目标点的关节角，、分别表示起始点和目标点的关节角速度，、分别表示起始点和目标点的关节角加速度。将起始时间设为0，即得到解为：(3-14)为了比照三次多项式关节插值算法和五次多项式插值算法的效果，同样要求机械臂从起始点开始运动，经过4秒到达终点，仿真时起始点和目标点的关节角速度为0。中间点的关节角加速度还可以对相邻两段轨迹角加速度进行平均值求解，使该值为中间点的瞬时加速度[12]。利用MATLAB对五次多项式插值进行仿真，将结果与三次多项式插值进行比照，发现三个位置点的速度、角速度两种方法相同，同时增加角加速度约束：仿真结果如图4所示，图中实线和虚线分别表示角度变化曲线、角速度变化曲线。点线那么表示角加速度曲线。其中关节角度和角速度曲线显示的都相对平滑，而角加速度曲线在中间点B处变化稍大。结果分析得出，多项式插值法虽然计算量有所增加，但是其关节空间轨迹平滑、运动稳定，且阶数越高满足的约束项越多。图4五次多项式插值法第三节笛卡尔空间的轨迹规划在机械臂的笛卡尔空间轨迹规划中，中间点即插补点的坐标可以通过插补算法得到。得到中间点后，在把中间点的位姿转换成相应的关节角，再通过对关节角的控制，使得机械臂的末端能按照预先规划的路径运动。机械臂的笛卡尔空间轨迹规划位姿控制过程大致如下所示：图5机械臂笛卡尔空间轨迹规划控制过程空间直线和空间弧线的轨迹规划是笛卡尔空间中不可或缺的两局部。因为空间的曲线可以分割为许多直线和弧线；但是也有会出现直线或弧线连接处尖角问题，为了使运动轨迹连续平滑，本文采用圆弧过度来平滑尖角。在笛卡尔空间中，空间直线和空间弧线的轨迹规划是最常见的两局部，其他空间曲线可以通过这两者来逼近。一、空间直线轨迹规划所谓空间直线插补就是在该直线起始点位姿的情况下，对轨迹中间点(插补点)的位姿坐标进行求解[6]。直线插补法：①设起始点的位置坐标分别为：，，和为相对根底坐标系计算其长度：(3-15)②求间隔内行程，需要分匀速、加速、减速三种情况进行讨论：匀速：设速度为，那么插补周期内行程为；加速：设加速度为，起始点速度为，那么在插补周期内的行程为：；整个加速度的路程为：，时间记为[6]：；③计算总时间：；④计算插补点数：；⑤对插补点所在段进行判断(匀速段、加速段、减速段)，使各轴的增量得到确定，对各插补点坐标进行实时计算。⑥根据坐标值，通过运动学逆解求出各关节角。⑦利用五次多项式插值法对关节角的插值计算。⑧从以上各式分析可以看出，机械臂完成一个空间轨迹的过程，是实现估计离散点的过程。让其尽量逼近，使机械臂轨迹尽可能的符合规划好的运动轨迹，本次采用定时插补法。⑨为了使机械臂的性能更好，让末端执行器的轨迹更平滑，在相邻两个插值点的关节角间选取插补函数使关节轴运动更加稳定。此方法将笛卡尔空间、关节空间相结合。如：工具末端沿着一个直线运动，通过上面的计算把直线段上插补199次即整体直线轨迹分为200个点，每个坐标点进行逆运动学求解得到200组关节角度值。最后通过关节空间轨迹规划的方法将相邻的两组关节角之间进行角度插补，从而使工具末端的轨迹平滑且能很好的控制每个关节的角速度和角加速度[8]。在MATLAB中利用上述直线插补方法对机械臂进行正方形轨迹规划仿真，机械臂的末端由起始点A，经过B点、C点、D点返回A点。其中点A、B、C、D的位姿分别用齐次变换矩阵表示为：(3-16)(3-17)正方形的每个边长为120mm，每个边上插补30步，总仿真时间为120s。正方形轨迹的仿真结果如图6所示，通过运动学求解得到五个关节角的位移数据并生成相关的数据曲线，如图7所示。图6关节角位移轨迹曲线图7关节角速度与加速度轨迹仿真图由上述仿真图可以看出，每个关节角度曲线均可划分为4段，每段关节角度变化平稳光滑，只在正方形四个顶点出变化最大，故还需要对顶点附近的关节角进行空间轨迹规划。二、空间圆弧的轨迹规划在笛卡尔空间圆弧轨迹规划中，为了计算方便，运用坐标变换，即先在圆弧所在平面建立一个新的直角坐标系，在这个直角坐标系中计算圆弧的各插补点在新坐标系中的值。然后再将这些值返回到原来的坐标系中，算出各插补点在原来坐标系中的值。圆弧插补的位移曲线也是采用抛物线过度的线性函数，归一化因子的求解与上述一样[8]。三点确定一段弧。设机械臂末端执行器从起始位置经过中间点到达终点，如果这三点不共线，就一定存在从起始点经过中间点到达终点的圆弧轨迹规划算法。具体算法如下：①先求得圆弧的圆心和半径。、和三点确定平面M，其方程为：(3-18)将其展开可得：(3-19)图8空间圆弧插补示意图过的中点且与垂直的平面T的方程为：(3-20)过点的中点且垂直的平面S的方程为：(3-21)联立上式，求得圆心。圆弧的半径为：(3-22)②以圆心为原点建立圆弧所在平面的新坐标，U轴为坐标系原点与点的连线。单位方向向量为；③W轴为平面T与平面S的交线，其单位方向向量为：；根据右手法那么，V轴在W轴和U轴的叉乘方向，其单位向量为[13]：(3-23)根据齐次坐标变换可得齐次坐标矩阵为：(3-24)其逆矩阵可以根据齐次变换矩阵求解逆得到：(3-25)可以得到：；④将点、、以及圆心从原来坐标系中的值转换到圆心所在新坐标系中。设原来的坐标系中的值分别为、、、，在新坐标中值分别为、与，那么求解：(3-26)由上式推到知，；⑤求圆弧角度。由于在MATLAB中内部函数Math.Atan2(x,y)的求解范围在-1800-1800之间。那么：当时，那么(3-27)⑥将插补结果返回到原坐标中，设点在原坐标系中坐标值为，那么有：(3-28)由以上结果可以得到圆弧上各插补点的位置，各插补点的三个位姿角度可以各自按照位移曲线为抛物线过度的线性函数求得。把每个插补点的位姿通过运动学逆解，就可以得到各插补点对应的关节角。空间三点的位姿、和可以分别用下式表示：(3-29)通过空间弧线的插补法，插补步数设为N=200，仿真时间40s，在MATLAB中进行空间圆弧的仿真，如图9所示，同时获得机械臂关节角度的数据曲线，如图10所示。机械臂的自由度数目应与所要完成的任务相匹配，空间圆弧在M平面上，机械臂的关节数对于空间圆弧轨迹而言是冗余的。第五关节轴线与末端的工具轴线重合，关节五的角度并不影响空间圆弧的轨迹规划中工具的位置和姿态，所以图10中没有第五关节的角度曲线。图9圆弧轨迹插值三、一般空间轨迹规划在大多数情况下，可将TCP的目标运动轨迹划分成假设干段圆弧轨迹和直线轨迹的连接，从而在每个对应的小区段使用直线插值或圆弧插值的方法完成整条TCP的目标运动轨迹的插值。但是，对于复杂程度相对较高的目标轨迹曲线，直线段加上圆弧段的组合在曲线精度方面并不理想，常常难以满足用户需求。而且，将复杂程度高的轨迹曲线划分为假设干段微小的直线和圆弧的组合，是非常困难的工作，特别是还要保证直线段和圆弧段交接点处过渡平滑的条件。因此，对于任意复杂的轨迹，使用更高级的插值方法势在必行。较为常用的复杂轨迹插值方法有：多项式插值法、分段线性插值法、分段多项式法、B样条插值法等等。要保证较高的插值精度，往往需要给定更密集的插值点序列，而且，如果使用的是多项式插值法，为获得高精度，多项式的次数也需要高。但是，当次数高时，会产生龙格现象，即在插值区间两端，会产生剧烈的震荡现象，导致插值点不收敛于目标轨迹。三次样条就是通过全部样点且具有连续二阶导的函数，因此，选择三次样条插值对机械臂轨迹曲线进行规划[10]。假设三次样条曲线所经过的个插值样点序列的X轴坐标为、、．．．、。那么待求的三次样条曲线参数方程是通过所有样点，而且具有连续二阶导数的分段三次多项式，即满足条件：(1)在每两个样点之间的函数表达式是小于或等于三次多项式；(2)在除起点和终点外的所有内点处都有直到二阶的连续导数。假设在每两个插值样点之间的三次多项的表达式为：(3-30)其中上式中的系数为常数。那么：(3-31)所以，需要求得组位置常数系数，才能得到完整的三次样条参数方程表达式。假设在每个插值样点出的值为，...，又因为每两个插值样点之间的三次多项式的二阶导师一次多项式，所以有：(3-32)对分别做一重和二重积分可得[14]：(3-33)再把插值样点的坐标和分别代入上式中，可得：，，代入上式得出：(3-34)由求得的易知在函数中，总共含有个待求未知数：，，...。因此只要求得未知数，并且相互独立的个方程，才能确定函数的全部未知数。图10三次样条轨迹插值图11直线和姿态匀速轨迹仿真图图12圆弧轨迹插值仿真图图13三样条轨迹仿真图通过仿真分析，针对简单且不复杂的目标轨迹曲线，一般采用直线轨迹规划或者圆弧轨迹规划，较复杂的可以采用直线轨迹规划和圆弧轨迹规划相结合的规划方法，可以得到较好的效果，但是对于复杂程度相对较高的目标轨迹曲线，直线段加上圆弧段的组合在曲线精度方面并不理想，常常难以满足用户需求。而且，将复杂程度高的轨迹曲线划分为假设干段微小的直线和圆弧的组合，是非常困难的工作，特别是还要保证直线段和圆弧段交接点处过渡平滑的条件。因此，对于任意复杂的轨迹，使用更高级的插值方法势在必行，要保证较高的插值精度，往往需要给定更密集的插值点序列，而且，如果使用的是多项式插值法，为获得高精度，多项式的次数也需要高。但是，当次数高时，会产生龙格现象，即在插值区间两端，会产生剧烈的震荡现象，导致插值点不收敛于目标轨迹。三次样条就是通过全部样点且具有连续二阶导的函数，所以采用三次样条轨迹规划的方法能够到达要求的效果。第四章总结与展望空间机械臂作为是一个机、电、热、控一体化的高集成度的空间机电系统，有着广阔的应用前景和很强的技术牵引与带动作用。它的的开展将拓展并支撑空间飞行器的在轨操作和任务完成能力，同时可以带动相关行业以及技术领域的开展。启动空间机械臂的工程性研究，对于我国载人航天具有极其重要的意义。本文深入分析空间机械臂的自身运动