专利名称：六关节机械臂逆运动学问题的快速求解方法
技术领域：
本发明涉及一种机械臂逆运动学方程的快速求解方法。
背景技术：
自1962年第一台工业机器人应用于General Motor公司的生产线以来，机器人技术不断发展、完善和成熟，目前已广泛应用于制造业、服务业、娱乐业、科学探索、医学、军事和航天等各个领域。工业机器人可以代替人类完成大量高质量要求的工作，如汽车制造，家电产品制造，化工及食品包装，物料的搬运等。汽车制造业利用机器人在汽车自动化生产线完成焊接、喷漆、装配等工作。在服务业中，各种服务用智能机器人如导游机器人、护士助手、步行功能训練机器人、导盲机器人等已逐渐进入市场。21世纪的服务用智能机器人除了可以为家庭从事简单的家务劳动和健康护理工作外，还可以从事一些劳动强度大，工作重复性强的工作，如环境保护，打扫以及公共交通服务等。在医学方面机器人主要作为医疗设备辅助医生和医务工作者从事医疗、诊断、医学研究和教学。如远程手术机器人、医用微型机器人等。机器人在军事领域的应用包括代替士兵执行拆除炸弹、扫雷、侦察和攻击等各种任务。20世纪70年代，美国率先提出了在宇宙空间利用机器人系统的概念，旨在通过机器人的应用进行设备的组装、回收、维修，以及在极其恶劣的空间环境下完成一些人类难以完成的舱外活动。目前，空间机器人研究主要集中在卫星、航天飞机以及国际空间站上使用的空间机械臂。机器人之所以能够胜任各种工作靠的是机械臂，而机械臂的每一个动作又是由人类预先编制好的程序控制的。机器人的智能和功能以及灵巧程度决定于相应的程序，而这些程序又与机械臂的逆运动学方程的求解方法密不可分。传统的机械臂的逆运动学方程的求解通常是求出多个解，然后在其中选择最优者。这就严重影响了机器人的响应速度，使机器人的运动更加迟钝。本发明旨在针对最常用的6关节机械臂，给出一种直接获取最优解， 并且运算更加简单的方法，以提高机械臂快速响应能力。
发明内容
本发明的目的是对最常用的6关节机械臂，给出一种直接获取逆运动学最优解， 并且运算更加简单的方法，以提高机械臂快速响应能力。本发明的目的是通过以下技术方案实现的本发明的有益效果在于不需要先列出机械臂“正”运动学方程的解，再根据此方程求逆运动学方程的全部解，然后从中选择最优解，而是根据对末端的姿态和位置的要求， 直接求出最优解，即先求出第5个坐标系的坐标原点和第4、5、6个关节角的旋转角度，再根据第5个坐标系原点的坐标以及第4、5、6个关节角的旋转角度求出第1、2、3个关节角的旋转角度。
图1是6关节机械臂结构及其各关节坐标系示意图，图中，各坐标系均为右手系； Z1, Y2, Y3, Y4, Z5, X6与相应的转轴平行J1，X2，X3，Y4，X5, &与相应的链杆平行；坐标系O-X5Y5Z5 的原点位于^cy1平面之内。
具体实施例方式机械臂的结构如图1所示。以Ο,Ορ…，O6分别表示第1，2，…，6个坐标系的原点，且假定OO1 = Cl1, O2O3 = a2, O5O6 = a4Y3和Y4所在直线之间的距离为a3，05在)(71平面内。按照如此的机械臂结构，对于给定的末端位置(χ，γ，ζ)，滚动角、俯仰角、方位角分别为P、θ、Ψ，求解逆运动学方程可分为两步，即根据末端姿态求解θ4，95和θ 6以及根据末端姿态求解0(5，Υ5，Ζ5)并由此求出关节角度Q1, 02和θ3。1)、(X5，Y5，Z5)的确定由于机械臂末端相对于o-ΧΛΛ的滚动角、俯仰角、方位角分别为0、θ、ψ，则由坐标系O-XtlY^l到末端坐标系的变换矩阵为
权利要求
1.一种六关节机械臂逆运动学问题的快速求解方法，其特征在于根据对末端的姿态和位置的要求，直接求出最优解，即先求出第5个坐标系的坐标原点和第4、5、6个关节角的旋转角度，再根据第5个坐标系原点的坐标以及第4、5、6个关节角的旋转角度求出第1、2、 3个关节角的旋转角度。
2.根据权利要求1所述的6关节机械臂逆运动学问题的快速求解方法，其特征在于如图1所示，0，O1,…，O6分别表示第1，2，…，6个坐标系的原点，且假定
全文摘要
传统的机械臂运动控制技术需要先求出机械臂的运动学方程，再根据此方程运动学方程求相应的逆运动学方程的全部解并从中选择最优解。这种运动控制技术运算复杂，实时性差，严重影响了机械臂的灵巧性。本发明针对6关节机械臂，给出一种运算更加简单的直接获取逆运动学最优解的方法，以提高机械臂快速响应能力。本发明的特点在于根据对末端的姿态和位置的要求，直接求出最优解，即先求出第5个坐标系的坐标原点和第4、5、6个关节角的旋转角度，再根据第5个坐标系原点的坐标以及第4、5、6个关节角的旋转角度求出第1、2、3个关节角的旋转角度。
文档编号G06F17/10GK102243620SQ20111015829
公开日2011年11月16日 申请日期2011年6月2日 优先权日2011年6月2日
发明者安凯, 安培亮, 安宏亮, 王晓英 申请人:安凯