五自由度冗余机械臂运动学分析.docx

?

?

五自由度冗余机械臂运动学分析

?

?

谷雷黄福洋

摘要：为了完成对核聚變试验装置的日常维护工作，通过遥操作机械臂对核聚变实验堆装置进行包层维护是核聚变实验遥操作维护系统的重要任务之一。包层遥操作维护机械臂工作空间狭小，需对机械臂进行特殊设计。设计五自由度冗余机械臂方案，并进行动力学分析和Matlab仿真分析。

关键词：核聚变装置;机械臂;运动学分析;D-H法;Matlab

：TP242??????????????????：A????????????????：1674-957X（2021）12-0073-04

0?引言

煤炭、石油等传统能源的使用带来巨大的污染，对人们的生产、生活造成巨大影响，因此清洁能源的利用显得尤为重要。核聚变反应是一种理想的获得清洁能源的途径[1]，托卡马克是核聚变商用的重要装置。由于对装置的维护工作需在一定的辐射环境下进行，因此采用遥操作机械臂执行相关维护工作是最重要的实现方案[2]，已验证其可行性，如在国际热核聚变实验堆ITER包层维护采用遥操作机械臂顺利完成任务[3]。我国的核聚变项目CFETR中包层的转运任务由遥操作机械臂完成，由于聚变堆内部空间狭小，包层底部锁紧轴销维护机械臂的设计难度增大，结构要求特殊。设计可折叠的五自由度冗余机械臂，可在狭小空间内工作，且避障能力较好，故能够在复杂的聚变装置内执行维护工作[4]。可广泛应用于工作空间狭小、复杂的工作环境，解决人工无法完成的工作，具有一定的避障能力。在汽车生产领域，可取代人工安装螺栓、钻孔等工作，提高工作效率、工作质量;冶炼过程中，代替工人抓取铸造钢坯，避免工人受伤，提高效率;大型锻造过程中，代替人工完成锻造件的转运，保障工人的人身安全，降低风险。

本文选择五自由度冗余机械臂作为研究对象，通过改进型D-H参数法对机械臂进行运动学分析、求解，并通过MATLAB进行仿真分析，为后续机械臂研究提供参考。

1?机械臂结构参数

通过关节坐标结构，机械臂设计为五自由度冗余机械臂，包括四个转动自由度和一个底部移动自由度[5]，最大负载20kg，最大工作半径770+300mm。通过改进型D-H参数法和各关节间的相互关系，建立五自由度冗余机械臂的运动学模型，5个关节建立包括参考坐标系在内的6个坐标系，推导齐次变换矩阵，计算出相关位姿参数，得到各关节坐标系间的位置和姿态[6-8]，从而获得机械臂位姿和运动的状态。根据改进型D-H参数法建立机械臂坐标系，如图1所示，机械臂D-H参数如表1所示。

其中？琢i-1表示绕Xi-1轴旋转使Zi-1轴Zi与轴平行的角度;ai表示沿Xi-1轴方向移动，使得Zi-1轴与Zi轴共面的距离;di表示沿Zi轴方向移动，使得Xi-1轴和Xi轴重合的距离;？兹i表示绕Zi轴旋转使Xi-1轴和Xi轴平行的角度。

2?机械臂运动学正解

机械臂是由一系列连杆和关节组成的。机械臂运动学正解为已知关节角度？兹i（i=1～5），通过计算得出末端执行器的位置和姿态，此过程通过变换矩阵表示。连杆变换矩阵用i-1Ti表示，其表达式为：

得到每个关节的齐次变换矩阵：

得到末端执行器在基坐标系中的位姿：

其中n、o、a表示末端执行器相对于基坐标系运动的三个轴，其中n为垂直轴，o为方向轴，a为接近轴，表达式中的各项分别为：

3?机械臂运动学逆解

逆运动学求解为求解正运动学的逆过程，求解思路为给定机械臂末端执行器一个期望位姿，通过解析法计算得出各个关节的运动参数。

当0T5已知，根据上述公式（2）～公式（7）得？兹i（i=1～5）。

①求解？兹2的值。

已知：

令等式两端矩阵（1，2）、（3，2）元素对应相等，得：

这里的四象限反正切函数Atan2（sin，cos）[9]是机器人中常用的函数，可有效避免计算出错。如式（12）中？兹2采用Atan2（sin，cos）函数的输入参数为角度的值sin和cos值，可以准确的定位到某一确切象限。

②？兹3求解。

令公式（10）两端矩阵（2，4）、（3，4）元素对应相等，得：

整理得，

得，

③求解？兹4的值。

令公式（10）两端矩阵（2，1）、（2，2）元素对应相等，得：

④求解？兹5的值。

令公式（10）两端矩阵（1，1）、（3，3）元素对应相等，得：

4?MATLAB仿真分析

4.1验证正运动学

将机械臂D-H参数输入MATLAB机器人工具箱中L=link（？兹?d?a?？琢）函数生成连杆，利用Robot=SerialLink（）函数生成模拟机械臂，将各关节转角？兹=[pi/2?pi/4?-pi/3?pi/4]、d1=0输入机器人工具箱的T=fkine（）函数计算位姿矩阵，与式（21）进行对比，得出正运动学计算正确。给