用平面二连杆机器人为例贯穿运动学、雅可比、动力学、轨迹规划甚至控制与编程分析
- 格式:doc
- 大小:2.30 MB
- 文档页数:13
空间二连杆机器人的动力学建模及其动态过程仿真作者:td一引言1.机器人机械臂的运动学与动力学分析方法目录空间二连杆机器人的动力学建模 (1)及其动态过程仿真 (1)作者:td (1)一引言 (1)1.1用户界面模块(ADAMS/View) (4)1.2求解器模块(ADAMS/Solver) (5)1.3后处理模块(ADAMS/PostProcessor) (6)二.空间二连杆机器人adams建模仿真 (6)2.1空间二连杆串联机器人 (6)在ADAMS中用长方形连杆模拟机械臂,对两自由度的机械臂分别进行运动学分析动力学分析。
(6)2.1.1运动学分析 (6)2.1.2运动学分析 (9)机器人的运动学和动力学既包含有一般机械的运动学、动力学内容,又反映了机器人的独特内容。
工业机器人的运动学主要讨论了运动学的正问题和逆问题。
假设一个构型已知的机器人,即它的所有连杆长度和关节角度()1q t ,()2q t ,()3q t …()n q t ,…都是已知的,其中n 为自由度数,那么计算机器人末端执行器相对于参考坐标系的位姿就称为运动学的正问题分析。
换言之,如果已知机器人所有的关节变量,用正运动学方程就能计算任一瞬间机器人的位姿。
然而,如果希望机器人的末端执行器到达一个期望的位姿,就必须要知道机器人操作臂每一个连杆的几何参数和所有关节的角矢量()12,,T n q q q q =⋅⋅⋅利用操作臂连杆几何参数和末端执行器期望的位姿来求解关节角矢量是运动学逆问题。
运动学正问题可以利用齐次变换法来求解。
设i 杆坐标系相对于基座坐标系的位姿齐次变换矩阵是b i T ,则1231b i n n T A A A A A -=⋅⋅⋅⋅⋅⋅ ()11-式中i A 为i 杆坐标系相对于1i -杆坐标系的坐标变换矩阵。
相对于正运动学方程,机器人逆运动学方程显得更为重要。
由于按给定末端执行器的位姿求解关节变量是在关节空间中进行非线性方程的求解,其中涉及多值性和奇异现象,因此,这一逆问题成为机器人运动学中的一个重要内容。
一、平面二连杆机器人手臂运动学平面二连杆机械手臂如图1所示,连杆1长度1l ,连杆2长度2l 。
建立如图1所示的坐标系,其中,),(00y x 为基础坐标系,固定在基座上,),(11y x 、),(22y x 为连体坐标系,分别固结在连杆1和连杆2上并随它们一起运动。
关节角顺时针为负逆时针为正。
图1平面双连杆机器人示意图 1、用简单的平面几何关系建立运动学方程连杆2末段与中线交点处一点P 在基础坐标系中的位置坐标:)sin(sin )cos(cos 2121121211θθθθθθ++=++=l l y l l x p p (1)2、用D-H 方法建立运动学方程假定0z 、1z 、2z 垂直于纸面向里。
从),,(000z y x 到),,(111z y x 的齐次旋转变换矩阵为:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=100010000cos sin 00sin cos 111101θθθθT (2) 从),,(111z y x 到),,(222z y x 的齐次旋转变换矩阵为:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=100010000cos sin 0sin cos 2212212θθθθl T (3) 从),,(000z y x 到),,(222z y x 的齐次旋转变换矩阵为:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡+++-+=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-⋅⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=⋅=10000100sin 0)cos()sin(cos 0)sin()cos(1000010000cos sin 0sin cos 1000010000cos sin 00sin cos 112121112121221221111120102θθθθθθθθθθθθθθθθθθl l l T T T (4)那么,连杆2末段与中线交点处一点P 在基础坐标系中的位置矢量为:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡++++=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⋅⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡+++-+=⋅=110)sin(sin )cos(cos 10010000100sin 0)cos()sin(cos 0)sin()cos(212112121121121211121212020p p p z y x l l l l l l l P T P θθθθθθθθθθθθθθθθ (5)即,)sin(sin )cos(cos 2121121211θθθθθθ++=++=l l y l l x p p (6)与用简单的平面几何关系建立运动学方程(1)相同。
精心整理一、平面二连杆机器人手臂运动学平面二连杆机械手臂如图1所示,连杆1长度1l ,连杆2长度2l ,连杆3长度为3l 。
建立如图1所示的坐标系,其中,),(00y x 为基础坐标系,固定在基座上,),(11y x 、),(22y x 、33(,)x y 为连体坐标系,分别固结在连杆1、连杆2、连杆3上并随它们一起运动。
关节角顺时针为负逆时针为正。
1θ图11112123123p p x y 2、用D-H 方法建立运动学方程假定0z 、1z 、2z 垂直于纸面向外。
从),,(000z y x 到),,(111z y x 的齐次旋转变换矩阵为:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=100010000cos sin 00sin cos 111101θθθθT (2)从),,(111z y x 到),,(222z y x 的齐次旋转变换矩阵为:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=100010000cos sin 0sin cos 2212212θθθθl T (3) 从222(,,)x y z 到333(,,)x y z 的齐次旋转变换矩阵为:33212cos sin 0l T θθ-⎡⎤⎢⎥=从(003T =003P =结论:(6)与用简单的平面几何关系建立运动学方程(1)相同。
补充:正解用于仿真,逆解用于控制建立以上运动学方程后,若已知个连杆的关节角123θθθ、、,就可以用运动学方程求出机械手臂末端位置坐标,这可以用于运动学仿真。
3、平面二连杆机器人手臂逆运动学二、平面二连杆机器人手臂的速度雅可比矩阵速度雅可比矩阵的定义:从关节速度向末端操作速度的线性变换。
现已二连杆平面机器人为例推导速度雅可比矩阵。
上面的运动学方程两边对时间求导,得到下面的速度表达式:111212123123123111212122123123sin sin()()sin()()cos cos()()cos()()p p dx l l l dt dy l l l dtθθθθθθθθθθθθθθθθθθθθθθθθ=-⋅-+⋅+-++⋅++=⋅++⋅++++⋅++(17)把上式写成如下的矩阵形式:⎥⎦⎤⎢⎣⎡⎥⎦⎤⎢⎣⎡++++-+--=⎥⎦⎤⎢⎣⎡212122121121221211)cos()cos(cos )sin()sin(sin θθθθθθθθθθθθ l l l l l l y x p p (18) 令上式中的末端位置速度矢量Xx p =⎥⎤⎢⎡, 矩阵11l l ⎢⎣⎡-(1θJ1(J θ212222211211θ∂J J J J 由此可知雅可比矩阵的定义:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡∂∂∂∂∂∂=⎥⎦⎤⎢⎣⎡=21212221121121),(θθθθθθp p p pJ y y x x J J JJ (21) 三、平面二连杆机器人手臂的动力学方程推倒动力学方程的方法很多,各有优缺点。
一、平面二连杆机器人手臂运动学平面二连杆机械手臂如图1所示,连杆1长度1l ,连杆2长度2l ,连杆3长度为3l 。
建立如图1所示的坐标系,其中,),(00y x 为基础坐标系,固定在基座上,),(11y x 、),(22y x 、33(,)x y 为连体坐标系,分别固结在连杆1、连杆2、连杆3上并随它们一起运动。
关节角顺时针为负逆时针为正。
1θ图1平面双连杆机器人示意图 1、用简单的平面几何关系建立运动学方程连杆2末段与中线交点处一点P 在基础坐标系中的位置坐标:112123123112123123cos cos()+cos()sin sin()+sin()p p x l l l y l l l θθθθθθθθθθθθ=++++=++++(1)2、用D-H 方法建立运动学方程假定0z 、1z 、2z 垂直于纸面向外。
从),,(000z y x 到),,(111z y x 的齐次旋转变换矩阵为:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=100010000cos sin 00sin cos 111101θθθθT (2) 从),,(111z y x 到),,(222z y x 的齐次旋转变换矩阵为:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=100010000cos sin 0sin cos 2212212θθθθl T (3) 从222(,,)x y z 到333(,,)x y z 的齐次旋转变换矩阵为:3323312cos sin 0sin cos 000010001l T θθθθ-⎡⎤⎢⎥⎢⎥=⎢⎥⎢⎥⎣⎦(3)从),,(000z y x 到333(,,)x y z 的齐次旋转变换矩阵为:11221332112233001231231231231121cos sin 00cos sin 0cos sin 0sin cos 00sin cos 00sin cos 00001000100010000100010001cos()sin()0cos cos(l l T T T T l l θθθθθθθθθθθθθθθθθθθθ---⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥=⋅⋅=⋅⋅⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦++-+++=212312311212)sin()cos()0sin sin()00100001l l θθθθθθθθθθ+⎡⎤⎢⎥++++++⎢⎥⎢⎥⎢⎥⎣⎦(4)那么,连杆2末段与中线交点处一点P 在基础坐标系中的位置矢量为:12312311212312312311212003311212312311212cos()sin()0cos cos()sin()cos()0sin sin()00010000011cos cos()cos()sin sin()l l l l l P T P l l l l l θθθθθθθθθθθθθθθθθθθθθθθθθθθ++-++++⎡⎤⎡⎤⎢⎥⎢⎥++++++⎢⎥⎢⎥=⋅=⋅⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦+++++++=3123sin()011p p p x l y z θθθ⎡⎤⎡⎤⎢⎥⎢⎥+++⎢⎥⎢⎥=⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦(5) 即,112123123112123123cos cos()+cos()sin sin()+sin()p p x l l l y l l l θθθθθθθθθθθθ=++++=++++ (6)结论:(6)与用简单的平面几何关系建立运动学方程(1)相同。
平面两自由度关节机器人算法平面两自由度关节机器人是工业制造中常见的一种机器人,它具有两个旋转关节,可以在平面内进行自由运动。
这种机器人在自动化生产线上扮演着重要角色,能够完成各种复杂的操作任务。
在设计和控制平面两自由度关节机器人时,算法起着至关重要的作用。
其中,运动规划算法是其中的重要一环。
通过合理的运动规划,可以使机器人在空间内快速、精准地完成各种任务。
在平面两自由度关节机器人中,常用的运动规划算法包括插补算法和路径规划算法。
插补算法是指在机器人运动过程中,通过对两个关节的角度进行插值计算,从而实现平滑的运动轨迹。
常用的插补算法有线性插补、圆弧插补和样条插补等。
这些算法可以根据机器人的速度、加速度等参数,合理地计算出每个时间点的关节位置,从而实现平滑、高效的运动。
另一个重要的算法是路径规划算法。
路径规划算法是指在给定起始点和目标点的情况下,寻找一条最优路径,使机器人能够在空间内避开障碍物,快速到达目标点。
常用的路径规划算法有最短路径算法、A*算法和D*算法等。
这些算法可以根据地图信息和机器人的动态参数,快速地找到一条最优路径,帮助机器人实现高效的运动。
除了运动规划算法外,碰撞检测算法也是平面两自由度关节机器人中不可或缺的一部分。
碰撞检测算法可以通过对机器人和周围环境的建模,实时地检测机器人是否会与障碍物相撞。
一旦发现潜在碰撞危险,算法可以及时做出调整,避免机器人发生碰撞,确保生产线的安全运行。
总的来说,平面两自由度关节机器人算法是机器人控制领域中的重要研究方向。
通过不断优化算法,可以使机器人在自动化生产中发挥更大的作用,提高生产效率,降低劳动成本。
期待未来,算法将继续发展,为平面两自由度关节机器人的智能化和自主化提供更多可能。
机器人动力学雅克比-概述说明以及解释1.引言1.1 概述机器人动力学是研究机器人运动过程中的力学和动力学特性的学科,主要涉及机器人的姿态、速度、加速度、力和力矩等相关物理量。
机器人动力学一直以来都是机器人领域的关键问题之一,对于机器人的运动控制和路径规划具有重要的指导意义。
雅克比矩阵是机器人动力学中一项关键的工具,用于描述机器人多自由度系统中各关节之间的运动传递关系。
通过雅克比矩阵,我们可以计算出机器人末端执行器在给定关节角速度下的线速度和角速度,从而实现对机器人运动的精确控制。
机器人动力学的研究在实际应用中有着广泛的意义。
首先,深入理解机器人的动力学特性可以帮助我们设计出更加高效、灵活的机器人控制算法,从而提升机器人的运动精度和速度。
其次,机器人动力学的研究还可以为机器人路径规划、障碍物避障等问题提供重要的理论支持和指导。
此外,随着机器人应用领域的拓展,如医疗、教育、家庭服务等,机器人动力学的研究也将在未来发挥更加重要的作用。
总结起来,机器人动力学是研究机器人运动特性的学科,雅克比矩阵则是机器人动力学中的重要工具。
通过研究和应用机器人动力学,我们可以实现对机器人运动的精确控制,提升机器人的运动效率和准确性,并且为机器人的应用和发展打下坚实的基础。
未来,机器人动力学的研究将随着机器人技术的不断发展而不断探索新的方向,并为更广泛的机器人应用提供理论支持和指导。
1.2 文章结构文章结构部分的内容应当包括对整篇文章的组织和章节安排进行介绍。
可以按照以下方式编写文章结构的内容:2. 文章结构本文共分为以下几个部分:引言、正文和结论。
2.1 引言部分将对机器人动力学的概念进行概述,介绍机器人动力学的背景和意义。
在此部分还将阐述本文的目的和结构。
2.2 正文部分将重点讨论雅克比矩阵的概念和应用。
首先,将介绍雅克比矩阵的定义和性质,以及其在机器人动力学中的重要作用。
接着,将探讨雅克比矩阵在路径规划、运动控制和力学分析等方面的应用。
构建平面双连杆机械臂动态模型1. 平面双连杆机械臂的分析图1 平面双连杆机械臂平面双连杆机械臂如图1,图中θ1 为关节1 转角,θ2 为关节2 转角,l1 为杆1 的长度,l2为杆2 的长度,r1 为关节1 到杆1 质心的距离,r2 为关节2 到杆2 质心的距离,M1为负载质量。
以图中的O 为原点的00y x -为基坐标。
2. 数学建模2.1寻找动力学末端坐标)cos(cos 21211θθθ++=l l x pl )sin(sin 21211θθθ++=l l y pl根据雅克比矩阵的形式⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡=2121θθθθdy dy dx dx J对末端坐标进行微分得到末端速度方程)sin()(sin 21212111θθωωθω++--=l l x pl & )cos()(cos 21212111θθωωθω+++-=l l y pl &其中11θω&=,22θω&=,将(3)、(4)两式联立整理成速度雅克比矩阵形式 ⎥⎦⎤⎢⎣⎡+---=1221221112212211c l c l c l s l s l s l J其中1s =1sin θ,1c =1cos θ,22sin θ=s ,22cos θ=c ,12s =)sin(21θθ+,12c =)cos(21θθ+。
在机器人基础坐标系中的速度与各关节速度间的关系以及手部与外界接触力与对应各关节间的关系可以利用雅克比矩阵来建立。
对机械臂末端速度方程(3) 、方程(4) 进行求导得到末端加速度方程如下[]1221222122211221121221122112)()(c l c l c l c l s l s l s l x pl ωωωωαα+++-=+++&& []1221222122211221121221122112)()(s l s l s l sl s l s l s l y pl ωωωωαα+++-=+++&&其中1α=1θ&&,2α=2θ&&,上述推导的方程构成了进行动力学仿真的基础,它们表明了有效负荷的加速度与 两节点处电动机的角速度和角加速度之间的关系。
平面2自由度并联机器人的运动学和动力学研究林协源1刘冠峰1(1.广东工业大学广州)摘要:本文面向高速高精LED电子封装设备设计了一种高速高精2自由度平面并联机构(2-PPa并联机器人)。
该机构由一个动平台和两个对称分布的完全相同的支链组成,每个支链中都有一个移动副(驱动关节)和一个由平面平行四边形组成的特殊转动动副。
首先推导出该机器人的运动学模型包括正反解;其次结合焊线机实际工艺要求提出多项机构性能指标对该机构的几何参数进行多目标优化;然后基于Euler-Lagrange 方程建立该机器人的动力学方程,最后通过算例分析两个移动副在动平台按照一定轨迹运动时其速度、加速度和驱动力的变化规律。
这些为接下来研究该机器人的动态性能和系统解耦控制等都具有重要意义。
关键词:2自由度平面并联机器人运动学动力学Kinematic and Dynamic Analysis of a PlanarTwo-degree-freedom Parallel ManipulatorLIN Xieyuan1LIU Guanfeng1(1.Guangdong University of Technology Guangzhou )Abstract:In this paper,a type of planar 2-DOF parallel manipulator is proposed for uses in design of high- speed and high-accuracy LED packaging machines. The manipulator consists of a moving platform and two identical subchains. Each subchain is made of a prismatic joint (actuator) and a parallelogram with four passive revolute joints. We first derive the kinematic model of the manipulator. Then, we determine the optimal geometric parameters of the manipulator by solving a multi-goal optimization problem based on performance indices. We compute the dynamic equation use Euler-Lagrange formulation and use it to analyze the relationship between velocity, acceleration and driving torque of joints. This analysis is important for further study of the dynamic performance and the decoupling control methods for the manipulator.Key words:2-DOF Planar parallel manipulator Kinematics Dynamics0 前言在电子、包装和食品等轻工业场合中,机器人只需要3到4个自由度即可满足使用要求。
二连杆机器人动力学方程简介二连杆机器人是一种常见的机器人结构,由两个连接在一起的杆件组成,类似人的上肢结构。
动力学方程是描述机器人运动的重要工具,可以用于控制机器人的运动以及研究机器人的力学性能。
本文将介绍二连杆机器人的动力学方程,并对其推导过程进行详细阐述。
动力学方程的推导首先,我们需要定义二连杆机器人的几何参数和状态变量。
假设机器人的两个杆件的长度分别为L1和L2,重力加速度为g。
假设机器人的关节角度分别为θ1和θ2,关节角速度分别为ω1和ω2,关节角加速度分别为α1和α2。
接下来,我们需要推导机器人的运动学方程。
根据运动学关系,可以得到杆件末端的位置坐标为:x = L1cos(θ1) + L2cos(θ1+θ2) y = L1sin(θ1) + L2sin(θ1+θ2)其次,我们需要推导机器人的动力学方程。
根据牛顿第二定律,可以得到机器人的动力学方程为:M1α1 + M2α2 + C1ω1 + C2ω2 + G1 + G2 = τ1 I1α1 + I2α2 + C3ω1 + C4ω2 + G3 + G4 = τ2其中M1和M2分别为杆件1和杆件2的质量,I1和I2分别为杆件1和杆件2的转动惯量,C1、C2、C3和C4分别为相关的离心力和科里奥利力系数,G1、G2、G3和G4分别为相关的重力分量,τ1和τ2分别为关节的扭矩。
重力分量的计算可以根据重力加速度和杆件的质量进行计算:G1 = (m1 + m2)g L1sin(θ1) + m2g L2sin(θ1+θ2) G2 = m2g L2*sin(θ1+θ2) G3 = 0 G4 = 0离心力和科里奥利力的计算可以根据关节角速度进行计算:C1 = -0.5m1L1ω1sin(2θ1) - m2L1ω1sin(2θ1) - 0.5m2L2ω2sin(2(θ1+θ2)) C2 = -0.5m2L2ω2sin(2(θ1+θ2)) C3 = 0.5m1L1ω1sin(2θ1) + m2L1ω1sin(2θ1) +0.5m2L2ω2sin(2(θ1+θ2)) C4 = 0.5m2L2ω2sin(2(θ1+θ2))最后,我们可以将运动学方程和动力学方程联立,得到关于加速度的线性方程组,即动力学方程。
二连杆机器人动力学方程二连杆机器人是一种简单的机器人系统,由两根连接在一起的连杆构成,可以用于模拟人体运动、机器人运动等。
其动力学方程可以通过Lagrange方法进行推导。
首先,定义系统的广义坐标,例如,可以选择两个连杆的角度(θ₁、θ₂)以及两个连杆的角速度(ω₁、ω₂)作为广义坐标。
然后,定义连杆的质量(m₁、m₂)、长度(l₁、l₂)、重心距离(d₁、d₂)等参数。
接下来,可以利用Lagrange方法推导出机器人的动力学方程。
Lagrange方法是一种基于能量的方法,用于描述系统的动力学。
步骤如下:1.计算连杆的动能(T)和势能(V)。
连杆的动能等于其质点的动能之和,连杆的势能等于其质点的势能之和。
2.根据广义坐标,构建系统的Lagrange函数(L = T - V)。
3.使用Euler-Lagrange方程,对Lagrange函数取关于广义坐标的偏导数,得到广义力(F)。
4.对广义力进行整理和简化,推导出动力学方程。
最终的动力学方程可以写成类似于以下形式的方程:(M(q) \cdot \ddot{q} + C(q, \dot{q}) \cdot \dot{q} + G(q) = \tau) 其中,(M(q))是系统的惯性矩阵,描述了系统的质量和几何特性;(\ddot{q})是广义加速度的二阶导数;(C(q, \dot{q}))是科里奥利力-禧维特力矩阵,描述了由于速度和加速度引起的惯性力效应;(G(q))是重力矩阵,描述了由于重力作用而引起的力矩;(\tau)是外部施加的关节力矩。
这样, 通过求解动力学方程,可以得到机器人系统在给定的广义力矩下的运动变化情况。
需要注意的是,具体的推导过程以及方程的形式会根据系统结构和约束条件的不同而有所差异。
串联机器人运动学分析及轨迹规划陈卓;苏卫华;李彬;秦晓丽【摘要】Objective To select a safe, flexible and lightweight manipulator and to execute its kinematic analysis and trajectory planning, so as to improve the application of serial robot in the treatment of hazardous biochemical products. Methods The kinematic modeling was carried out for the manipulator, and the kinematic and inverse kinematic formulas were deduced and verified.Differential transform method was used to obtain the Jacobian matrix of the manipulator,and the trajectory planning was implemented for the manipulator at joint and cartesian spaces.Results An ideal motion curve was formed by the trajectory planning of serial robot to realize its stable and high-efficiency motion at spaces.Conclusion Serial robot is facilitated to execute the treatment of hazardous biochemical products, and references are provided to other researches on serial robot.%目的:针对串联机器人在危险生化品处理方面的应用,选取一种安全系数高、灵活轻量的机械臂并对其进行运动学建模和轨迹规划.方法:先对机械臂进行运动学建模,之后推导并验证正运动学和逆运动学公式,然后利用微分变换法求取机械臂的雅可比矩阵,最后对机械臂在关节空间和直角坐标空间进行轨迹规划.结果:通过对串联机器人的轨迹规划,可使其形成光滑连续的理想运动曲线,使串联机器人在空间上的运动更加平稳高效.结论:该研究有助于使串联机器人更好地应用于危险生化品处理的场景,也可以为串联机器人的其他相关研究提供参考.【期刊名称】《医疗卫生装备》【年(卷),期】2018(039)001【总页数】6页(P5-10)【关键词】串联机器人;运动学分析;雅可比矩阵;轨迹规划【作者】陈卓;苏卫华;李彬;秦晓丽【作者单位】天津理工大学机械工程学院,天津300384;军事科学院系统工程研究院卫勤保障技术研究所,天津300161;军事科学院系统工程研究院卫勤保障技术研究所,天津300161;天津理工大学机械工程学院,天津300384;军事科学院系统工程研究院卫勤保障技术研究所,天津300161【正文语种】中文【中图分类】R318;TP2420 引言近10 a,串联机器人在工业生产、日常生活和医疗服务等方面得到了广泛应用。
一、平面二连杆机器人手臂运动学平面二连杆机械手臂如图1所示,连杆1长度1l ,连杆2长度2l 。
建立如图1所示的坐标系,其中,),(00y x 为基础坐标系,固定在基座上,),(11y x 、),(22y x 为连体坐标系,分别固结在连杆1和连杆2上并随它们一起运动。
关节角顺时针为负逆时针为正。
图1平面双连杆机器人示意图 1、用简单的平面几何关系建立运动学方程连杆2末段与中线交点处一点P 在基础坐标系中的位置坐标:)sin(sin )cos(cos 2121121211θθθθθθ++=++=l l y l l x p p (1)2、用D-H 方法建立运动学方程假定0z 、1z 、2z 垂直于纸面向里。
从),,(000z y x 到),,(111z y x 的齐次旋转变换矩阵为:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=100010000cos sin 00sin cos 111101θθθθT (2) 从),,(111z y x 到),,(222z y x 的齐次旋转变换矩阵为:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=100010000cos sin 0sin cos 2212212θθθθl T (3) 从),,(000z y x 到),,(222z y x 的齐次旋转变换矩阵为:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡+++-+=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-⋅⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=⋅=10000100sin 0)cos()sin(cos 0)sin()cos(1000010000cos sin 0sin cos 1000010000cos sin 00sin cos 112121112121221221111120102θθθθθθθθθθθθθθθθθθl l l T T T (4)那么,连杆2末段与中线交点处一点P 在基础坐标系中的位置矢量为:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡++++=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⋅⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡+++-+=⋅=110)sin(sin )cos(cos 10010000100sin 0)cos()sin(cos 0)sin()cos(212112121121121211121212020p p p z y x l l l l l l l P T P θθθθθθθθθθθθθθθθ (5)即,)sin(sin )cos(cos 2121121211θθθθθθ++=++=l l y l l x p p (6)与用简单的平面几何关系建立运动学方程(1)相同。
建立以上运动学方程后,若已知个连杆的关节角21θθ、,就可以用运动学方程求出机械手臂末端位置坐标,这可以用于运动学仿真。
3、平面二连杆机器人手臂逆运动学建立以上运动学方程后,若已知个机械臂的末端位置,可以用运动学方程求出机械手臂二连杆的关节角21θθ、,这叫机械臂的逆运动学。
逆运动学可以用于对机械臂关节角和末端位置的控制。
对于本例中平面二连杆机械臂,其逆运动学方程的建立就是已知末端位置),(p p y x 求相应关节角21θθ、的过程。
推倒如下。
(1)问题)sin(sin )cos(cos 2121121211θθθθθθ++=++=l l y l l x p p已知末端位置坐标),(p p y x ,求关节角21θθ、。
(2)求1θ由(6)式得到:22211211)sin ()cos (l l y l x p p =-+-θθ (7) 整理得到:)sin cos (2111222122θθp p p p y x l l l y x +=-++ (8)令pp p pp tg y x θθθcos sin == (9)由(8)式得到:)sin sin cos (cos cos 2111222122p p p p p p x l l l y x θθθθθ+=-++)cos(cos 211222122p pp p p x l l l y x θθθ-=-++ (10)由此可解出1θ。
p p p p p p x y arctg x l l l y x +⎥⎥⎦⎤⎢⎢⎣⎡-++=θθcos 2arccos 12221221 (11)(3)求2θ 由(6)式得到:2122122212)]sin([)]cos([l l y l x p p =+-++-θθθθ (12)整理得到:)]sin()cos([221212212222θθθθ+++=-++p p p p y x l l l y x (13) 令pp p pp tg y x θθθcos sin == (14)由(14)式得到:)cos(cos 2]sin )sin(cos )[cos(cos 221221212212222p pp p p p p p p x l x l l l y x θθθθθθθθθθθ-+=+++=-++ (15)由此可解出2θ。
122122222cos 2arccos θθθ-+⎥⎥⎦⎤⎢⎢⎣⎡-++=p p p p p p x y arctg x l l l y x (16)二、平面二连杆机器人手臂的速度雅可比矩阵速度雅可比矩阵的定义:从关节速度向末端操作速度的线性变换。
现已二连杆平面机器人为例推导速度雅可比矩阵。
)sin(sin )cos(cos 2121121211θθθθθθ++=++=l l y l l x p p上面的运动学方程两边对时间求导,得到下面的速度表达式:)()cos(cos )()sin(sin 2121211121212111θθθθθθθθθθθθ +⋅++⋅=+⋅+-⋅-=l l dtdy l l dt dx p p (17)把上式写成如下的矩阵形式:⎥⎦⎤⎢⎣⎡⎥⎦⎤⎢⎣⎡++++-+--=⎥⎦⎤⎢⎣⎡212122121121221211)cos()cos(cos )sin()sin(sin θθθθθθθθθθθθ l l l l l l y x p p (18) 令上式中的末端位置速度矢量Xy x p p =⎥⎦⎤⎢⎣⎡, 关节角速度矢量Θ=⎥⎦⎤⎢⎣⎡ 21θθ, 矩阵),()cos()cos(cos )sin()sin(sin 212122121121221211θθθθθθθθθθθθJ l l l l l l =⎥⎦⎤⎢⎣⎡++++-+--),(21θθJ 就是速度雅可比矩阵,实现从关节角速度向末端位置速度的转变。
(18)式可以写成:Θ⋅= ),(21θθJ X 速度雅可比矩阵可以进一步写成:⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡++++-+--=22211211212212112122121121)cos()cos(cos )sin()sin(sin ),(J J Jl l l l l l J J θθθθθθθθθθθθ (19)其中,)cos()cos(cos )sin()sin(sin 2122222121112121221221211111θθθθθθθθθθθθθθ+=∂∂=++=∂∂=+-=∂∂=+--=∂∂=l y J l l y J l x J l l x J p p p p (20)由此可知雅可比矩阵的定义:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡∂∂∂∂∂∂=⎥⎦⎤⎢⎣⎡=21212221121121),(θθθθθθp p p pJ y y x x J J J J (21) 三、平面二连杆机器人手臂的动力学方程推倒动力学方程的方法很多,各有优缺点。
拉格朗日方法思路清晰、不考虑连杆之间的内力,是推倒动力学方程的常用方法。
下面推导图1所示的平面双连杆机器人的动力学方程。
图1中所示连杆均为均质杆,其转动惯量分别是1I 和2I 。
1、求两连杆的拉格朗日函数 (1)求系统总动能连杆1的动能为:212112121121161)31(2121θθθ l m l m I K A ===(21)求连杆2质心D 处的线速度:对连杆2质心位置求导得到其线速度。
连杆2质心位置为:)sin(21sin )cos(21cos 2121121211θθθθθθ++=++=l l y l l x D D (22)连杆2质心速度为:)()cos(21cos )()sin(21sin 2121211121212111θθθθθθθθθθθθ +⋅++⋅=+⋅+-⋅-=l l Y l l x D D (23)21221222222212212221222)cos 21(41)cos 41(θθθθθθ l l l l l l l l y x V D D D +++++=+=(24)连杆2的动能:21221222222222122122212212212222222122122212221222222212)cos 32(2161)cos 31(21])cos 21(41)cos 41[(21))(121(2121)(21θθθθθθθθθθθθθθθθ l l l m l m l l l l m l l l l l l l l m l m V m I K D D +++++=+++++++=++=(25) 系统总动能:212212222222222122122222112122122122222222212212221221)cos 2131(61)cos 21616121()cos 32(2161)cos 31(21θθθθθθθθθθθθ l l m l m l m l l m l m l m l m l l l m l m l l l l m K K K ++++++=+++++=+= (26) (2)求系统总势能 系统总势能为:))sin(21sin (sin 21212112111θθθθ+++=l l g m gl m P (27)(3)求拉格朗日函数)]sin(21sin [sin 21)cos 2131(61)cos 21616121(21211211121221222222222212212222211212θθθθθθθθθθ++--++++++=-=l l g m gl m l l m l m l m l l m l m l m l m PK L (28) (4)列写动力学方程按照拉格朗日方程,对应关节1、2的驱动力矩分别为:222111θθτθθτ∂∂-∂∂∂∂=∂∂-∂∂∂∂=L L t LL t (29)22212222122122222112121)cos 2131()cos 3131(θθθθθ l l m l m l l m l m l m l m L +++++=∂∂22221221221222212222122122222112121sin 21sin )cos 2131()cos 3131(θθθθθθθθθθ l l m l l m l l m l m l l m l m l m l m L t --+++++=∂∂∂∂ )cos(21cos )21(212211211θθθθ+-+-=∂∂gl m gl m m L )cos(21cos )21(sin 21sin )cos 2131()cos 3131(2122112122221221221222212222122122222112121θθθθθθθθθθθθτ++++--+++++=gl m gl m m l l m l l m l l m l m l l m l m l m l m (30)同理:1221222222222)cos 2131(31θθθθ l l m l m l m L ++=∂∂ 2122122222122122222sin 2131)cos 2131(θθθθθθθ l l m l m l l m l m L t -++=∂∂∂∂ )cos(21sin 21sin 2121222122122122122θθθθθθθθ+---=∂∂gl m l l m l l m L )cos(21sin 2131)cos 2131(21222122122222122122222θθθθθθθτ+++++=gl m l l m l m l l m l m (31)联合(30)、(31)式,将动力学方程写成如下矩阵形式:⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡+++++⎥⎦⎤⎢⎣⎡⎥⎦⎤⎢⎣⎡-+⎥⎦⎤⎢⎣⎡⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡-+⎥⎦⎤⎢⎣⎡⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡+++++=⎥⎦⎤⎢⎣⎡)cos(21)cos(21cos )21(000sin 0sin 21sin 21031cos 2131cos 2131cos 3131212221221121212122122221221222122122222122222212222221222221121221θθθθθθθθθθθθθθθθθθθττgl m gl m gl m m l l m l l m l l m l m l l m l m l l m l m l l m l m l m l m (32)四、平面二连杆机器人手臂的轨迹规划轨迹规划就是已知起点和终点的位置速度加速度等参数确定中间点的相应参数的过程。