《工业机器人第六章操作臂动力学课件.ppt》由会员分享，可在线阅读，更多相关《工业机器人第六章操作臂动力学课件.ppt（61页珍藏版）》请在三一办公上搜索。
1、与动力学有关的两个问题:已知一个轨迹点, , 希望 求出期望的关节力矩矢量 .计算在施加一组关节力矩的情况下机构如何运动.,在任一瞬时，对刚体的线速度和角速度进行求导，可分别得到线加速度和角加速度: 同速度一样，当微分的参考坐标系为世界坐标系U时，可用下列符号表示刚体的速度，即:,1. 线加速度 描述了坐标系 A下的速度矢量，当坐标系A和坐标系B的原点重合时: 因为两个坐标系的原点重合，因此可以将上式改写为: 对 求微分 , 得到 相对于A的加速度： 因为:,所以有 当两个坐标系原点不重合时:,当 是常数， 加速度的推导公式化简为: 对于旋转关节的操作臂，上式为操作臂连杆的线加速度. 对于移动
2、关节，常用 (*)式.,2. 角加速度 假设 B相对于A以 转动，同时 C 相对于 B 以 转动.求 在A中进行矢量叠加: 求导， 得到: 因为有 于是得到操作臂连杆的角加速度.,惯性张量可以在任意坐标系中定义，但一般在固连在刚体上的坐标系中定义惯性张量. 坐标系 A 中的惯性张量可用 33 矩阵表示: 矩阵中的各元素如下:,式子中刚体由单元体 组成 单元体的密度为 . 每个单元体的位置由矢量 确定. -The elements are called the mass moments of inertia. We are integrating the mass elements, , tim
3、es the squares of the perpendicular distances from the corresponding axis. -The elements with mixed indices are called the mass products of inertia.,例: 求图中坐标系中长方体的惯量张量. 已知长方体密度均匀，其大小 解：计算 : Permuting the terms:,图示物体的惯性张量阵: 惯性张量是坐标系位姿的函数.,平行移轴定理 : 矢量 表示刚体质心在坐标系A中的位置。矢量矩阵形式：,例: 当坐标系原点在刚体质心时，求图中刚体的惯性张量
4、. 运动平行移轴定理: Next, we find:,其它参量由对称性得出：,惯性张量的其他性质: -如果由坐标系的两个坐标轴构成的平面为刚体质量分布的对称平面，则正交于这个对称平面的坐标轴与另一个坐标轴的惯量积为0. -惯量距永远是正值，而惯量积可能正，可能负. -三个惯量距的和保持不变. -惯性张量的特征值为刚体的主惯量距，相应的特征矢量为主轴。.,大多数操作臂连杆的几何形状及结构比较复杂，一般使用测量装置来测量。,大多数操作臂连杆的几何形状及结构比较复杂，一般使用测量装置来测量。,刚体的转动惯量的测量,转动体系由承物台和塔轮组成，空承物台转动时，体系对转轴的转动惯量为J0，另有待测物放在
5、承物台上时，总转动惯量为：,若分别测出J和J0，则待测物体的转动惯量Jx为：,刚体系受外力矩有：绳子的张力作用力矩MT和摩擦力矩M。由转动定律知：,为角加速度。,即：,可见，测量转动惯量J的关键是测量角加速度和摩擦力矩！,J 是转动体系的转动惯量， 是角加速度，m 是下落砝码的质量，r 是绕线轮的半径，M 是摩擦力矩。,1. 牛顿欧拉方程 要使连杆运动，必须对连杆进行加速和减速运动，连杆运动所需的力是关于连杆期望加速度及其质量分布的函数。牛顿方程以及描述旋转运动的欧拉方程描述了力、惯量和加速度之间的关系。. 牛顿方程: 欧拉方程,2. 向外迭代为了计算作用在连杆上的惯性力，需要计算操作臂每个连
6、杆在某一时刻的角速度、线加速度和角加速度. 可应用迭代方法完成这些计算。首先对连杆1进行计算，接着计算下一个连杆，这样一直向外迭代到连杆n计算出每个连杆质心的线加速度和角加速度之后，运动牛顿欧拉公式计算出作用在连杆质心上的惯性力和力矩 .,角速度在连杆之间的“传递问题”: 连杆之间的角加速度变换方程: 当第 i+1个关节是移动关节, 上式简化为:,每个连杆坐标系原点的线加速度: 对于i+1是移动关节时:,每个连杆质心的线加速度: 假设坐标系 Ci固连于连杆i上,坐标系原点位于连杆质心，且各坐标轴方位与原连杆坐标系i方位相同。 注意，第1个连杆的方程非常简单，因为 .,计算出每个连杆质心的线加速
7、度和角加速度之后，运动牛顿欧拉公式计算出作用在连杆质心上的惯性力和力矩 :,3. 向内迭代法列出力平衡和力矩平衡方程. 每个连杆都受到相邻连杆的作用力和力矩以及附加的惯性力和力矩. 计算出每个连杆上的力和力矩之后，计算关节力矩.,将所有作用在连杆i上的力相加，得到力平衡方程: 将所有作用在质心上的力矩相加，并且令它们的和为零，得到力平衡方程: 最后重新排列力和力矩方程，形成相邻连杆从高序号向低序号排列的迭代关系：,在静力学中，可通过计算一个连杆施加于相邻连杆的力矩在 方向的分量求得关节力矩: 注意对一个在自由空间中运动的机器人来说, 和 等于零.,牛顿-欧拉迭代动力学算法 由关节运动计算关节力
8、矩的完整算法由两部分组成: -对每个连杆应用牛顿-欧拉方程，从连杆1到连杆n向外迭代计算连杆的速度和加速度. -从连杆n到连杆1向内迭代计算连杆间的相互作用力和力矩以及关节驱动力矩.,对于转动关节，该算法归纳如下: -外推: i: 0 5,-内推: i: 6 1考虑重力：令,例: 计算二连杆操作臂的动力学方程. 假设质量分布非常简单：每个连杆的质量都集中在连杆的末端，设其质量分别为 和 . 首先，确定牛顿欧拉迭代公式中各参量的值:,旋转矩阵: 对连杆 1 向外迭代:,对连杆 2 向外迭代:,对连杆 2 向内迭代: 对连杆 1 向内迭代:,取 中的 方向分量, 得关节力矩: 将驱动力矩表示为关于
9、关节位置、速度和加速度的函数.,1. 迭代形式与封闭形式的动力学方程 迭代形式的动力学方程有两个作用: -进行数值计算. -作为一种分析方法用于符号方程的推导. 我们经常需要对方称的结构进行研究。 2. 状态空间方程 当用牛顿-欧拉方程对操作臂进行分析时，动力学方程可以写成如下形式:这里 是 nn 操作臂的质量矩阵, 是n1的离心力和哥氏力矢量， 是n1重力矢量.,包含了所有与关节速度有关的项. 例:,: n1 Coriolis 项. 包含了所有与关节速度有关的项 是与离心力有关的项，因为它是速度的平方. 是与哥氏力有关的项，它总是包含两个不同关节速度的乘积. : n1 与重力加速度有关的项,
10、 只与 有关，与它的导数无关 : nn 质量矩阵, 的函数.,3. 位形空间方程 将速度项写成另一种形式: -nn(n-1)/2 哥氏力系数矩阵. -nn 离心力系数矩阵. 动力学方程随着操作臂的运动不断更新.,4. Inclusion of nonrigid body effects It is important to realize that the dynamic equations we have derived do not encompass all the effects acting on a manipulator. They include only these forc
11、es which arise from rigid body mechanism. The important source of forces that are not included is friction. The forces due to friction can actually be quite largeperhaps equaling 25% of the torque required to move the manipulator in typical situations. Viscous friction: is proportional to the veloci
12、ty of joint motion: Coulomb friction: is constant except for a sign dependence on the joint velocity:,A reasonable model is to include both: Friction also diaplays a dependence on the joint position. A major cause of this effect might be gears that are not perfectly roundtheir eccentricity would cau
13、se friction. So a fairly complex friction model: So the more complete manipulators model: We dont consider bending effects (which give rise to resonances), it is extremely difficult to model.,拉格朗日力学是基于能量项对系统变量及时间的微分的，运用该方法比运用牛顿力学更繁琐，但随着系统复杂程度的增加，运用拉格朗日力学将变得相对简单。,第 6 章: 操作臂动力学 6.6 拉格朗日方程,L是拉格朗日函数，K是系
14、统动能，P是系统势能,式中F是线运动中的所有外力之和，T是转动中的所有外力矩之和，X是系统变量。,第 6 章: 操作臂动力学 6.6 拉格朗日方程,第 6 章: 操作臂动力学 6.6 拉格朗日方程,操作臂的动能表达式: 整个操作臂的动能是各个连杆动能之和: 操作臂的动能可以描述为关节位置和速度的标量函数： 操作臂的质量矩阵一定是正定矩阵,The potential energy of the ith link can be expressed as: where is the 31 gravity vector, is the vector locating the center of mas
15、s of the link, and is a constant chosen so that the minimum value is zero. The total potential energy stored in the manipulator is the sum of the potential energy in the individual links: We see that the potential energy of a manipulator can be described by a scalar formula as a function of joint po
16、sition.,The Lagrangian dynamic formulation provides a means of deriving the equations of motion from a scalar function called the Lagrangian: The equations of the motion for the manipulator are then given by: where is the n1 vector of actuator torques. In the case of a manipulator, this equation bec
17、omes:,Example: The links of an RP manipulator have inertia tensors: and total mass and . The center of mass of link1 is located at a distance from the joint-1 axis, and the center of mass of link2 is at the variable distance from the joint-1 axis. Use Lagrangian dynamics to determine the equation of
18、 the motion for this manipulator.,Write the kinemic energy of link 1 as: the kinetic energy of link 2 as: Hence, the totle kinetic energy is given by: Write the potential energy of link 1 as:,Potential energy of link 2 as: Total potential energy is given by: Then,Finally:,第 6 章: 操作臂动力学 6.6 拉格朗日方程,We
19、 developed dynamic equations in joint space because we could use the serial-link nature of the mechanism to advantage in deriving the equations. In this section, we discuss the formulation of the dynamic equations that relate acceleration of the end-effector expressed in Cartesian space to Cartesian
20、 forces and moments acting at the end-effector.,1. 笛卡尔状态空间方程 应用笛卡尔变量的一般形式建立操作臂的动力学方程: -F 作用于机器人末端的力和力矩矢量 - 能够恰当表达末端执行器位姿的笛卡尔矢量. - 笛卡尔质量矩阵. - 笛卡尔空间的速度项矢量. - 笛卡尔空间的重力项矢量.,F用关节驱动力表示:,Substituting: The expressions for the terms in Cartesian dynamics: Note that, the Jacobian is written in the same frames
21、 as , the choice of this frame is arbitrary. When the manipulator approaches a singularity, certain quantities in the Cartesian dynamics become infinite.,例子： 两连杆平面机械臂的笛卡尔空间形式的动力学方程.,We can get: When , the manipulator is in a singular position. For example, when , the effective Cartesian mass of the
22、end-effector becomes infinite in the direction of the link-2 tip frame. In general, at a singular configuration there is a certain direction, the singular direction in which motion is impossible, but general motion in the subspace “orthgonal” to this direction is possible.,2. 笛卡尔位形空间的力矩方程 利用笛卡尔空间动力学方程写出等价的关节力矩: 改写为: where is a matrix of Coriolis coefficients. is a matrix of centrifugal coefficients. Note that, is the same as in the joint-space equation, but in general:,课后题P157, 6.20： 用拉格朗日法推导两自由度机器人手臂的运动方程，连杆的质心位于连杆的中心，其质量分别为 和 ，转动惯量分别为 和 .,
