小型六自由度的工业机械手的控制设计

小型六自由度的工业机械手的控制设计

1、系统设计目的及意义

工业机器人，又称机械臂，在现代化工业生产中正发挥着越来越重要的作用，它被广泛应用到流水生产线上，代替人类从事焊接、喷涂、搬运等许多较繁重的劳动，这不仅大大提高了生产效率，同时也极大地提高了产品的加工精度和产品质量。随着时代的进步，机器臂技术的应用越来越普及，已逐渐渗透到军事、航天、医疗、日常生活及教育娱乐等各个领域，可以说工业机器人的应用对现代工业的发展起到了巨大的推动作用。

论文围绕哈尔滨工程大学自动化学院学生创新实验室购买的教学用小型六自由度机械臂，完成对其关节控制系统的设计开发，开发内容包括硬件系统和软件系统。从而使其能够达到一定的控制精度，为后续的控制算法的研究提供一个完整的平台。

2、主要研究内容

论文的主要内容包括：对机械臂结构的改进、安装合适的控制系统、数学建模、运动学分析，轨迹规划研究、控制算法研究和三维仿真研究等部分。

图2.1 机械臂系统研究内容图

2.1、机械臂结构改造

创新实验室购买的教学用六自由度机械臂存在以下两个明显不足，需要对其

进行较大的改动：

（1）原机械臂包括爪子在内共六个自由度，实际上爪子是机械臂的末端执行器，它不影响位置和姿态，不能作为一个独立自由度；

（2）原机械臂的关节执行器使用的是6个舵机，各关节处没有任何反馈装置，只能做简单开环控制，生产厂家的技术人员证实了这一点。为了完成本次论文的立题要求，需要至少在一个关节上做成闭环控制。

针对以上两点不足，在不破坏机械臂的前提下，作者对机械臂的结构和控制部分做了以下相应改动：

（1）去掉爪部关节，另外增加两个关节，使机械臂达到六个自由度，同时利于建立其数学模型；

（2）将底座舵机换成直流减速电机，增加一定的机械结构来安装角度反馈装置，从而使机械臂能够完成一定的闭环控制，满足论文的立题要求。

图2.2改装后的六自由度机械臂实物图

2.2、数学建模

六自由度链式(6R)机器臂是具有六个关节的空间机构，为描述末端执行器在空间的位置和姿态，可以在每个关节上建立一个坐标系，利用坐标系之间的关系来描述末端执行器的位置。一般采用Denavit-HartenBerg法(D-H法)建立坐标系并推导机械臂的运动方程。D-H法是1995年由Denavit和HartenBerg提出的一种建立相对位姿的矩阵方法。利用齐次变换描述各个连杆相对于固定参考坐标系的空间几何关系，用一个4×4的齐次变换矩阵描述相邻两连杆的空间关系，从而推导出末端执行器坐标系相对于基坐标系的等价齐次坐标变换矩阵，建立机械臂的运动方程。依据D-H法，相邻两坐标系之间的关系表示为：

1

(,)(0,0,)(,0,0)(,)n n n n n n T A Rot z Trans d Trans a Rot x a q -==创

参数定义如下（参考图3坐标系）：

n a 表示沿n x 轴方向1n z -轴与n z 轴之间的距离；

n a 表示绕n x 轴线由1n z -轴到n z 轴所旋转的角度；

n d 表示沿1n z -轴方向1n x -轴到n x 轴的距离；n q 表示绕n z 轴由1

n x -轴到n x 轴所旋转的角度。

图2.3 六自由度机械臂坐标系图

2.3、运动分析 2.

3.1正运动学分析

正运动学的求解过程是根据已知关节变量1q ，2q ，3q ，4q ，5q ，6q 求末端抓持器相对于参考坐标系的位姿的过程。要对机械臂进行分析，首先要对机械臂建

立坐标系，其坐标系如图3所示，各个关节变量分别是：

1q =0，2q =0，3q =0，4q =0，5q =90，6q =0。将参考坐标系设在6R 机械臂的基座上，于是可以从基座开始变换到第一关节，然后到第二关节……,最后到末端抓持器。若把每个变换定义为

n A ，那么6R 机械臂的基座和手之间的总变换为：

012345012345012345R

R H H H T T T T T T T T A A A A A A A ==

A0为基座坐标系到坐标系0（关节一）之间的变换矩阵；A1为坐标系0到坐标系1之间的变换矩阵；A2为坐标系1到坐标系2之间的变换矩阵；A3为坐标系2到坐标系3之间的变换矩阵；A4为坐标系3到坐标系4之间的变换矩阵；A5为坐标系4到坐标系5之间的变换矩阵；AH 为坐标系5到坐标系H 之间的

cos sin cos sin sin cos sin cos cos cos sin sin 0sin cos 0000

n n n n n

n n n

n n n n n n

n n n a a d q q a q a q q q a q a q a a 轾-犏犏-犏=犏犏犏臌

变换矩阵。

010

0001000011

00

01A L 轾犏犏犏=犏犏犏臌

1101010100100

000

1C S S C A 轾犏犏-犏

=犏犏犏臌

222

022

2202200100001C S C L S C S L A 轾-犏犏犏

=犏犏犏臌 3330333303300100001C S C L S C S L A 轾-犏犏犏

=犏犏犏臌

440444

4044401000001C S C L S C S L A 轾-犏犏犏=犏-犏犏臌 55050505001000001C S S C A 轾犏犏-犏

=犏犏犏臌 6600

660001050001H C S S C A L 轾-犏犏犏

=犏犏犏臌

根据六个关节角度以及机械臂的参数，通过以上7个矩阵相乘即可得出期望矩阵：