d K K D P W 1 x1 x 1 x1 x1 dt x
F F M1 k M0 c
x0 x1
①
②
③
④
⑤
① Kinetic Energy due to (angular) velocity ② Kinetic Energy due to position (or angle) ③ Dissipation Energy due to (angular) velocity ④ Potential Energy due to position ⑤ External Force or Torque
Newton-Euler Formulation
Articulated Multi-Body Dynamics
Ch.4 Manipulator Dynamics
2
Ch.4 Manipulator Dynamics
Introduction
Manipulator Dynamics considers the forces required to cause desired motion. Considering the equations of motion arises from torques applied by the actuators, or from external forces applied to the manipulator.
Lagrangian dynamic formulation
Lagrangian formulation is an "energy-based" approach to dynamics.
Ch.4 Manipulator Dynamics
4
Ch.4 Manipulator Dynamics
There are two problems related to the dynamics of a manipulator that we wish to solve. Forward Dynamics: given a torque vector, Τ, calculate the resulting motion of the manipulator, , , and . This is useful for simulating the manipulator. Inverse Dynamics: given a trajectory point, , , and , find the required vector of joint torques, Τ. This formulation of dynamics is useful for the problem of controlling the manipulator.
Ch.4 Manipulator Dynamics
6
4.1 Dynamics of a Rigid Body 刚体动力学
Langrangian Function L is defined as:
LK P
Kinetic Energy
Potential Energy
(4.1)
Dynamic Equation of the system (Langrangian Equation): d L L Fi , i 1,2, n (4.2) i qi dt q
7
4.1 Dynamics of a Rigid Body
4.1.1 Kinetic and Potential Energy of a Rigid Body
K
P
1 1 2 M 1 x12 M 0 x0 2 2
1 k ( x1 x 0 ) 2 M 1 gx1 M 0 gx 0 2
F F M1 k M0
图4.1 一般物体的动能与位能
x0 x1 c
D
1 c( x1 x0 ) 2 2
W Fx1 Fx 0
4.1 Dynamics of a Rigid Body
8
4.1.1 Kinetic and Potential Energy of a Rigid Body
x0 0, x1 is a generalized coordinate
机器人学基础
第四章 机器人动力学
中南大学 蔡自兴，谢 斌 zxcai, xiebin@ 2010
Fundamenttents
Introduction to Dynamics
Rigid Body Dynamics
Lagrangian Formulation
i where qi is the generalized coordinates, q represent corresponding velocity, Fi stand for corresponding torque or force on the ith coordinate.
4.1 Dynamics of a Rigid Body
Ch.4 Manipulator Dynamics
5
Contents
Introduction to Dynamics
Rigid Body Dynamics
Lagrangian Formulation
Newton-Euler Formulation
Articulated Multi-Body Dynamics
Ch.4 Manipulator Dynamics
3
Ch.4 Manipulator Dynamics Two methods for formulating dynamics model：
Newton-Euler dynamic formulation
Newton's equation along with its rotational analog, Euler's equation, describe how forces, inertias, and accelerations relate for rigid bodies, is a "force balance" approach to dynamics.