第6章_机器人动力学分解
X Z H W L Y
4
Z H
I xx y z dv
2 2 V
H
0
y
L W 0 0
2
z dxdydz
2
W X L
Y
W
H
0
y
L 0
2
z 2 dydz W
H
0
L / 3 Lz dz
3 2
HL3 LH 3 M 2 W ( ) (L H 2 ) 3 3 3 M M 同理可以得到另外两个惯性矩, I yy (W 2 H 2 ), I zz (W 2 L2 ) 3 3 下面计算惯性积, H L W H L I xy xy dv xydxdydz yW 2 / 2dydz
I xz I yz I zz
I zz x 2 y 2 dv
I xz xz dv I yz yz dv
V
其中dv表示单元体,表示单元体密度,单元体的位置Ar =[x y z]T。 惯性张量中Ixx,Iyy和Izz称为惯性矩,交叉项Ixy,Ixz和Iyz称为惯性积。 惯性张量中元素的数值与坐标系的选择有关,一般存在某个坐标系,使得交 叉项全为0。称其坐标轴为惯性主轴,该坐标系称为惯性主轴坐标系。 对于质量均匀分布的规则物体,惯性主轴就是物体的对称轴。 例6-2 如图6-4所示质量均匀分布的长方形刚体,密 度为r,质量为M,计算其惯性张量。 解:单元体dv=dxdydz,根据(6-8)得:
I r 2 dm
V
R
0
2
0
例6-1 如图6-2 所示匀质杆,质量为M,杆长为L, 计算绕质心的惯性矩。 解:匀质杆的线密度=M/L,取微元体 dx,则
4 4 R M R 1 2 r 2 rdrd 2 2 MR 4 R2 4 2
Z
x dx
X
I
5
A A
I zz C I zz M ( xc2 yc2 ) I xy C I xy M ( xc yc )
式中是[xc yc zc]T是刚体质心在{A}坐标系下的坐标。需要说明的是,在使用平行 移轴定理时,{A}坐标系和质心坐标系{C}的姿态必须相同。 例6-3 如图6-4所示质量均匀分布的长方形刚体在质心坐标系(原点位于质心, 坐标系姿态与原坐标系姿态相同)下表示的惯性张量。 xc W 解:根据平行移轴定理计算,其中 y 1 L c 2 因此得, z H
f mv
1
Y
下面以图6-1所示质量为M半径为R的均匀圆盘绕过 圆心的Z轴的惯性矩计算问题给出惯性矩的定义:
r
X
I r 2 dm
V
图6-1 圆盘绕过圆心轴惯性矩
(6-3)式给出了任意刚体绕固定轴惯性矩的定义,其中dm是微元体质量,r是 微元体到转轴的距离,V是刚体的体积,因此(6-3)表示在整个体积上积分。 对于图6-1所示均匀圆盘,面密度=M/(R2),取极坐标微元体,则
V 0 0 0 0 0
4 0 同理可以得到另外两个惯性积,
对于惯性张量的计算问题,平行 移轴定理也是成立的,下面给出 其中两个表达式,其余的四个表 达式与此类似:
W 2 L2
H
dz
W 2 L2 H
4 M M I xz WH , I yz HL 4 4
A A
M WL 4
I zz C I zz M ( xc2 yc2 ) I xy C I xy M ( xc yc )
L /2
L /2
x 2dm 2
L /2
0
x 2 dx 2
( L / 2) 3
3
图6-2 匀质杆绕质心惯性矩
2
M L3 1 2 ML2 L 3 8 12
平行移轴定理:刚体绕任意平行于质心轴的惯性矩为 I C I Md 2 (6-5) 其中CI 表示刚体绕质心轴的惯性矩,M为刚体质量,d为两轴之间的距离。 若已知刚体绕质心轴的惯性矩,则刚体绕任意平行轴的惯性矩可以非常方便 地利用平行移轴定理(6-5)进行计算。 例如,计算图6-2所示匀质杆绕杆端点的惯性矩,根据平行移轴定理, 1 L 1 I C I Md 2 ML2 M ( )2 ML2 12 2 3 dv {A} 可以验证,与采用积分方法计算的结果相同。
刚体的惯性张量
Z
A
r
对于在三维空间自由运动的刚体,存在无穷多 个可能转轴,计算绕所有转轴的惯性矩显然是 V 不现实的。 因此需要考虑这样的问题: Y X 是否存在一个量,它能够表示刚体绕任意转轴的 答案是肯定的,该量就是刚体的惯性张量。 图6-3 空间刚体的惯性张量 惯性矩? 它描述了刚体的三维质量分布,若惯性张量在某坐标系下表示出来,它 是一个3阶对称矩阵。定义了固连的坐标系{A},在坐标系{A}中惯性张量为:
3
惯性张量是一个对称矩阵,各元素的值为,
I xx y z 2 dv
V V
V
I xy xy dv
V V
I xx A I I xy I xz
I xy I yy I yz
(6-8)
刚体定轴转动与惯性矩
I 刚体定轴转动微分方程: (6-1) 其中I称为绕固定轴的惯性矩(也称为转动惯量),是作用在固定轴上的 合外力矩。 质量为m的质点,其在直线上运动的动力学问题可以用牛顿第二定律描述:
f (6-2) 或者 mx 比较(6-1)和(6-2)式可以发现,刚体定轴转动和质点的直线运动的动力 学方程的形式是完全相同的。因此,I可以看成刚体定轴转动的惯性质量。
第6章 机器人动力学
机器人的运动是通过在关节轴上施加驱动力来实现的。机器人运动与驱动 力的关系称为机器人动力学,是本章要讨论的主要问题。 机器人动力学问题分为两类: 一类是已知作用在机器人上驱动力随时间的变规律,求机器人的运动规 律(位置、速度和加速度轨迹),称为机器人正动力学问题;
另一类是已知机器人随时间的运动规律,求期望的驱动力,称为机器人 逆动力学问题。