[发明专利]一种采用框架描述的工业机器人工具位姿控制方法

说明书

技术领域

本发明涉及机器人控制领域，具体的说是一种采用框架描述的工业机器人工具位姿控制方法。

背景技术

随着工业的发展，机器人的应用越来越广泛。实际应用中，机器人是通过在末端安装不同的操作工具来完成各种作业任务。工具参数的准确度直接影响着机器人轨迹精度，所以准确、快速的工具位姿控制对机器人的现场应用具有重要意义。

要进行工具位姿控制，首先要对工具位姿进行描述，对于工具的位姿描述由如下三种：四元数描述、欧拉角描述、框架描述等。

四元数描述是采用超复数进行机器人姿态的描述。四元数的“差”被定义为一个方位到另一个方位的角位移。采用四元数描述可以实现平滑插值、快速连接和角位移求逆、能和矩阵形式快速转换且节省空间。但是四元数可能存在不合法问题、而且难于使用。

欧拉角描述是将角位移分解为绕三个相互垂直轴的三个旋转组成的序列。任意的三个轴和任意的序列都可以，使用笛卡尔坐标系并按一定顺序所组成的旋转序列。采用欧拉角进行机器人位姿描述容易使用、表达方式简洁，但给定的表达方式不唯一且两个角度间插值非常困难。

采用框架方式进行机器人位姿描述，就是列出这个坐标系的基向量，这些基向量是用其他的坐标系来描述的。用这些基向量构成一个3x3矩阵，然后就能用矩阵形式来描述方位。也就是说，能用一个旋转矩阵来描述两个坐标系之间的相对方位，然后用这个旋转矩阵把一个坐标系中的向量转换到另一个坐标系中。此外，坐标系原点位置也采用用其他的坐标系的位置矢量来描述，该位置矢量与上述的表示工具姿态的矩阵形式结合，构成位姿的框架描述形式，采用框架描述形式，可以立即进行向量的平移、旋转，并且可以进行多个角位移的连接。

发明内容

针对工业机器人进行工具位姿控制时，由于采用欧拉角及四元数进行姿态描述，导致角度间插值困难、存在奇异点，甚至不合法等问题，本发明要解决的技术问题是提供一种采用框架描述的工业机器人工具位姿控制方法。

本发明为实现上述目的所采用的技术方案是：一种采用框架描述的工业机器人工具位姿控制方法，包括以下步骤：

工具坐标系标定：确定工具坐标系{T}相对于末端执行器坐标系{E}的变换矩阵；

确定程序段首末端点处工具坐标系的框架形式，即程序段首末端点处工具坐标系{T}相对于基坐标系{B}的原点位置坐标及工具坐标系{T}各坐标轴单位方向矢量的表示

进行工具位姿的四元数插值计算：根据程序段首末端点处的工具坐标系框架，确定变换矩阵T_c，然后将变换矩阵T_c转化为四元数表示形式，利用四元数的几何特征，将四元数表示形式转换为相对于基坐标系的单位法矢量及绕单位法矢量的旋转角度；

计算插值后工具坐标系的框架形式，即插值后工具坐标系{T}相对于基坐标系{B}的原点位置坐标及工具坐标系{T}各坐标轴单位方向矢量的表示；

将工具坐标系中框架形式转化为末端执行器坐标系的框架形式，进行机器人逆向运动学求解，确定各关节位置值。

所述工具坐标系{T}用于定义工具的位置及工具的姿态。

所述末端执行器坐标系{E}为与机器人最后一个连杆固结的坐标系，原点位于机器人末端法兰盘中心。

所述程序段首末端点处工具坐标系的框架形式由工具坐标系{T}相对于末端执行器坐标系{E}和末端执行器坐标系{E}相对于基坐标系{B}的复合变换得到；

其中，工具坐标系{T}相对于末端执行器坐标系{E}的变换矩阵由工具坐标系标定得到；末端执行器坐标系{E}相对于基坐标系{B}的变换矩阵是由机器人运动学正解得到：

矩阵表示末端执行器坐标系{E}到基坐标系{B}的位姿关系；为末端执行器坐标系{E}相对于基坐标系{B}的旋转矩阵，分块为3个方位矢量分别表示{E}的3个单位主矢量相对于{B}的方向余弦；^BP_Eo为末端执行器坐标系{E}的原点相对于基坐标系{B}的位置矢量。

所述根据程序段首末端点处的工具坐标系框架的确定变换矩阵为：

根据公式(2)计算程序段起始点处工具位姿同理根据程序段终点各关节位置值，确定终点处工具位姿态的框架描述根据程序段首末点的框架表示，计算变换矩阵

其中，为程序段起始点处工具位姿的框架描述，为程序段终点处工具位姿的框架描述，M_ij为变换矩阵中i行j列处的元素值。

所述将变换矩阵转化为四元数表示形式：