《机械臂模型及旋转矩阵探究》由会员分享，可在线阅读，更多相关《机械臂模型及旋转矩阵探究（22页珍藏版）》请在金锄头文库上搜索。
1、机械臂模型及旋转矩阵探究,东北大学.人工智能研究所. 刘颖,机械臂模型及应用,机械臂的应用,机械臂研究现状,机械臂的模型,机械臂的应用,机械手臂是目前在机械人技术领域中得到最广泛实际应用的自动化机械装置，在工业制造、医学治疗、娱乐服务、军事以及太空探索等领域都能见到它的身影。尽管它们的形态各有不同，但它们都有一个共同的特点，就是能够接受指令，精确地定位到三维（或二维）空间上的某一点进行作业。,机械臂,机器加载,取放操作,焊接,机器加载,喷漆,检测,抽样,装配操作,机械制造,医疗应用,危险环境,水下太空及远程,机械臂研究近状,1、工业机器人性能不断提高(高精度、高速度、 高可靠性、便于操作和维修
2、)。 2、机械结构向模块化、可重构化发展。 3、工业机器人控制系统向基于PC机的开放型控制器方向发展，便于标准化、网络化。 4、虚拟显示在机器人中的作用己从仿真、预演，发展到用于过程控制，如使遥控机器人操作者产生置身于远端作业环境中的感觉来操纵机器人。 5、当代遥控机器人系统的发展特点不是追求全自治系统，而是致力于操作者与机器人的人机交互控制。,几个发展方向：,机械臂研究近状,1、网络远程控制网络远程控制是控制方法与网络结合成果， 是控制领域崭新而非常有前景的发展方向和研 究热点。,系统结构图,机械臂研究近状,2、车载机械臂 我国二期月球探测的科学目标之一是近距离、大 比例尺形貌和地质构造研究
3、。要完成这个科学目标， 要求月球车携带一些能完成就位探测的有效载荷仪器。 当月球车对目标月岩或月壤进行就位分析时，机械臂能 够完成就位有效载荷仪器的放置、定位、操作及撤离等操作。,控制系统结构图,控制器硬件原理图,机械臂研究近状,3、空间柔性机械臂 太空作业机械臂的研究工作最早丌始于前苏联的hnakodLuna空I日J计划，此后，美国、同本、欧洲等各国相继丌展了空间机器人研究与丌发工作。当自订，舱外空间机械臂多安装于航天飞机、国际空间站、太空实验舱和实验卫星上，具有有代表性的空间机械臂如下： 1)航天飞机上机械臂 目前投入使用比较典型的是加拿大1号臂，如图卜1所示，加拿大臂山加拿大斯巴公司生产
4、，安装于美国航天飞机上，目前仍有3套航天飞机机械臂在使用。加拿大1号臂由强度极高的碳纤维材料制造，长152m，直径38cm，总质量为410Kg，在无载荷条件下移动速度可达600m吣，有载荷时移动速度为60mms，无载荷时能移动到距目标点的精度范围为152mm，操作载荷质量可达300looKg,机械臂研究近状,2)国际空间站上机械臂 在空间站舱外机械臂系统中，最具代表性的是国际空问站美国舱段上的加拿大和美国航天局(NASA)联合研制的移动服务系统Mss(Mobileservicin2svstem）。,航天飞机上的机械臂,空间站上的机械臂,机械臂研究近状,柔性机械臂 1）、随着宇航业及机器人业的飞
5、速发展，出现了越来越多地采用由若干个柔性构件组成的多柔体系统。柔性机械臂与刚性机械臂相比较，柔性机械臂具有结构轻、载重与自重比高等特性，因而具有较低的能耗、较大的操作空间和很高的效率，其响应快速而准确，有着很多潜在的优点，在工业、国防等应用领域中有十分重要的地位。 2）、由于柔性机械臂中包含有一些柔性单元(如柔性关节、柔性连杆等)，其在运行过程中会产生扭曲、弹性、剪切等变形，从而给这类柔性机械臂的分析和控制带来了许多困难。 柔性臂建模方法介绍 A、NewtonEuler法 B、agrange方程或Hamilton原理 C、Kane方法和虚位移原理 D、模型辨识的方法,机械臂的模型,1、自由度,
6、X,Y,Z,如图只沿X、Y、Z轴运动的机械臂是三自由度的。如果还能绕X、Y、Z轴旋转那么就是六自由度的。,机械臂的模型,2、旋转矩阵的一种理解已知向量op ，有矩阵,有,x,y,p,o,设op的长度为r,辐角为,机械臂的模型,p,P点在B系中为BP，B系原点在A系中可表示为,机械臂的模型,p (x, y, 0),xA,yA,zA,xB,yB,zB,绕z轴旋转的旋转矩阵如下：,P点在A坐标系中的可表示为：,机械臂的模型,机械臂的工作是由控制器指挥的，关节在每个位置的参数是预先记录好的。当机械臂执行工作任务的时候，控制嚣给出记录好的位置数据，使机械臂按照预定的位置序列运动。机械臂的平动或转动是由关
7、节电机控制关节的位移或转角，其间并不涉及到控制力或控制力矩的大小，这是机械臂控制的一种传统方法，我们也称之为运动学控制。在这里建立机械臂的运动学模型的目的是为动力学建模提供各臂之间的几何关系和运动关系。,机械臂的模型,机器人运动学就是建立各运动构件与末端执行器空间的位置、姿态之间的关系，为运动控制提供分析的手段和方法。机器人运动学包括两类问题：(1)运动学正问题：给定机器人手臂、腕部等构件的几何参数及连接各构件运动的关节变量求机器人末端执行器对于参考坐标系的位姿。(2)运动学逆问题：已知机器人各构件的几何参数和机器人末端执行器相对于参考坐标系的位置和姿态，求解是否存在实现这个位姿的关节变量。,
8、运动学正解问题,运动学逆解问题,末端执行器位姿,关节角,关节角,机械臂的模型,DH坐标法,连杆的DH参数如表： 对于转动关节有连杆变换矩阵如下所示：,机械臂的模型,DH坐标法,建立坐标系时应使连杆变换矩阵的形式简单，一般将0系与1系重合，Z轴沿关节轴方向，X轴沿连杆方向。将各参数带入到一般式，可以得到以下的连杆变换矩阵,机械臂的模型,DH坐标法,将各个连杆的矩阵连乘得到,如下式示：,即得到末端相对于基坐标系的位姿。,机械臂的模型,求解各个关节角,如果对于一个给定的末端位姿，即 要求机械臂的末端到达某一个位置时，要求各个关节的关节角的变量值。即运动学求反解。,由已知的连杆变换矩阵先计算中间果：,
9、然后可以得到：,其中n,a,p代表的是多项式，即是矩阵相乘后的结果。,机械臂的模型,求解各个关节角,对于,即，,因为作为中间结果 可求出，令矩阵两端元素对应相等，可以求出 表达式。对于 到 都可以用矩阵运算的方法得到其表达式。,机械臂的模型,求解及控制机械臂,对于求得的各关节角变量的表达式用MATLAB语言编写对应的程序，在已知末端要到达的位置时可以求出具体的数值。同常六自由度会有8组反解，在考虑机械结构的限制、关节奇异点、路径最短等情况下只选取一组解。再把这组解的表达式编入程序中。在给出要到达的位姿后，程序算出各关节角。得到关节角后就可以控制机械臂动作。,各关节应运动的角度,控制器,驱动各个关节,PWM,Thank You !,
