二自由度机械臂动力学分析

平面二自由度机械臂动力学分析

姓名：黄辉龙 专业年级：13级机电 单位：汕头大学

摘要：机器臂是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，这里主要对平面二自由度机械臂进行动力学研究。拉格朗日方程在多刚体系统动力学的应用方法分析平面二自由度机械臂的正向动力学。经过分析，得出平面二自由度机械臂的动力学方程，为后续更深入研究做铺垫。

关键字：平面二自由度 动力学方程 拉格朗日方程

相关介绍

机器人动力学的研究有牛顿-欧拉（Newton-Euler ）法、拉格朗日(Langrange)法、高斯（Gauss ）法等，但一般在构建机器人动力学方程中，多采用牛顿-欧拉法及拉格朗日法。

欧拉方程又称牛顿-欧拉方程，应用欧拉方程建立机器人机构的动力学方程是指研究构件质心的运动使用牛顿方程，研究相对于构件质心的转动使用欧拉方程，欧拉方程表征了力、力矩、惯性张量和加速度之间的关系。

在机器人的动力学研究中，主要应用拉格朗日方程建立机器人的动力学方程，这类方程可直接表示为系统控制输入的函数，若采用齐次坐标，递推的拉格朗日方程也可以建立比较方便且有效的动力学方程。

在求解机器人动力学方程过程中，其问题有两类：

1)给出已知轨迹点上•

••θθθ、及、

，即机器人关节位置、速度和加速度，求相应的关节力矩矢量τ。这对实现机器人动态控制是相当有用的。

2)已知关节驱动力矩，求机器人系统相应各瞬时的运动。也就是说，给出关节力矩矢量τ，求机器人所产生的运动•

••θθθ、及、

。这对模拟机器人的运动是非常有用的。

平面二自由度机械臂动力学方程分析及推导过程

1、机器人是结构复杂的连杆系统，一般采用齐次变换的方法，用拉格朗日方程建立其系统动力学方程，对其位姿和运动状态进行描述。机器人动力学方程的具体推导过程如下：

1) 选取坐标系，选定完全而且独立的广义关节变量n r ,,2,1,r ⋅⋅⋅=θ。

2) 选定相应关节上的广义力r F ：当r θ是位移变量时，r F 为力；当r θ是角度变量时，r F 为力矩。

3)求出机器人各构件的动能和势能，构造拉格朗日函数。

4) 代入拉格朗日方程求得机器人系统的动力学方程。

2、下面以图1所示说明机器人二自由度机械臂动力学方程的推导过程。

1）如图1，设

2

1

,θ

θ是广义坐标，

2

1

,Q

Q是广义力。

2）分别求出两杆的动能和势能

1

1

1

1

2

1

1

1

1

1

1

sin

,

2

1

2

1

:1θ

θ

c

c

c

T

c

gl

m

U

I

v

v

m

E=

+

=

•

杆

（1-1）

]

sin

[

,

2

1

2

1

:2

2

1

1

2

2

2

2

1

2

2

2

2

2

）

（

）

（

杆θ

θ

θ

θ+

=

+

+

=

•

•

l

g

m

U

I

v

v

m

E

c

c

T

c

（1-2）

式中，

1c

v是杆1质心)

,

(

1

1

1c

c

y

x

C的速度向量，

2c

v是杆2质心)

,

(

2

2

2c

c

y

x

C的速度向量。它们可以根据质心

2

1

,C

C的位置方程导出。

3）分别求出两杆的速度

⎥

⎥

⎥

⎦

⎤

⎢

⎢

⎢

⎣

⎡

=

⎥

⎥

⎥

⎦

⎤

⎢

⎢

⎢

⎣

⎡

=

)

sin

(

)

cos

(

1

1

1

1

1

1

1

θ

θ

l

dt

d

l

dt

d

dt

dy

dt

dx

v

c

c

c

（1-3）

[]

[]⎥⎥

⎥

⎦

⎤

⎢

⎢

⎢

⎣

⎡

+

+

+

+

=

⎥

⎥

⎥

⎦

⎤

⎢

⎢

⎢

⎣

⎡

=

)

sin(

sin

)

cos(

cos

2

1

2

1

1

2

1

2

1

1

2

2

2

θ

θ

θ

θ

θ

θ

c

c

c

c

c

l

l

dt

d

l

l

dt

d

dt

dy

dt

dx

v