一种采用框架描述的工业机器人工具位姿控制方法技术

技术编号:15025128 阅读:207 留言:0更新日期:2017-04-05 01:46
本发明专利技术涉及一种采用框架描述的工业机器人工具位姿控制方法,该方法主要步骤包括:工具坐标系标定;确定程序段首末端点处工具坐标系的框架形式;工具位姿的四元数插值计算;计算插值后工具坐标系的框架形式;将工具坐标系中框架形式转化为末端执行器坐标系的框架形式,进行机器人逆向运动学求解,确定各关节位置值。该方法能够准确、可靠实现机器人工具位姿控制,避免了由于采用欧拉角及四元数进行姿态描述所导致的角度间插值困难、存在奇异点等问题,且该发明专利技术由于采用四元数进行插补可以实现机器人的平滑运动控制。

【技术实现步骤摘要】

本专利技术涉及机器人控制领域,具体的说是一种采用框架描述的工业机器人工具位姿控制方法
技术介绍
随着工业的发展,机器人的应用越来越广泛。实际应用中,机器人是通过在末端安装不同的操作工具来完成各种作业任务。工具参数的准确度直接影响着机器人轨迹精度,所以准确、快速的工具位姿控制对机器人的现场应用具有重要意义。要进行工具位姿控制,首先要对工具位姿进行描述,对于工具的位姿描述由如下三种:四元数描述、欧拉角描述、框架描述等。四元数描述是采用超复数进行机器人姿态的描述。四元数的“差”被定义为一个方位到另一个方位的角位移。采用四元数描述可以实现平滑插值、快速连接和角位移求逆、能和矩阵形式快速转换且节省空间。但是四元数可能存在不合法问题、而且难于使用。欧拉角描述是将角位移分解为绕三个相互垂直轴的三个旋转组成的序列。任意的三个轴和任意的序列都可以,使用笛卡尔坐标系并按一定顺序所组成的旋转序列。采用欧拉角进行机器人位姿描述容易使用、表达方式简洁,但给定的表达方式不唯一且两个角度间插值非常困难。采用框架方式进行机器人位姿描述,就是列出这个坐标系的基向量,这些基向量是用其他的坐标系来描述的。用这些基向量构成一个3x3矩阵,然后就能用矩阵形式来描述方位。也就是说,能用一个旋转矩阵来描述两个坐标系之间的相对方位,然后用这个旋转矩阵把一个坐标系中的向量转换到另一个坐标系中。此外,坐标系原点位置也采用用其他的坐标系的位置矢量来描述,该位置矢量与上述的表示工具姿态的矩阵形式结合,构成位姿的框架描述形式,采用框架描述形式,可以立即进行向量的平移、旋转,并且可以进行多个角位移的连接。
技术实现思路
针对工业机器人进行工具位姿控制时,由于采用欧拉角及四元数进行姿态描述,导致角度间插值困难、存在奇异点,甚至不合法等问题,本专利技术要解决的技术问题是提供一种采用框架描述的工业机器人工具位姿控制方法。本专利技术为实现上述目的所采用的技术方案是:一种采用框架描述的工业机器人工具位姿控制方法,包括以下步骤:工具坐标系标定:确定工具坐标系{T本文档来自技高网
...

【技术保护点】
一种采用框架描述的工业机器人工具位姿控制方法,其特征在于,包括以下步骤:工具坐标系标定:确定工具坐标系{T}相对于末端执行器坐标系{E}的变换矩阵;确定程序段首末端点处工具坐标系的框架形式,即程序段首末端点处工具坐标系{T}相对于基坐标系{B}的原点位置坐标及工具坐标系{T}各坐标轴单位方向矢量的表示进行工具位姿的四元数插值计算:根据程序段首末端点处的工具坐标系框架,确定变换矩阵Tc,然后将变换矩阵Tc转化为四元数表示形式,利用四元数的几何特征,将四元数表示形式转换为相对于基坐标系的单位法矢量及绕单位法矢量的旋转角度;计算插值后工具坐标系的框架形式,即插值后工具坐标系{T}相对于基坐标系{B}的原点位置坐标及工具坐标系{T}各坐标轴单位方向矢量的表示;将工具坐标系中框架形式转化为末端执行器坐标系的框架形式,进行机器人逆向运动学求解,确定各关节位置值。

【技术特征摘要】
1.一种采用框架描述的工业机器人工具位姿控制方法,其特征在于,...

【专利技术属性】
技术研发人员:孙维堂李忠琪刘荫忠杨东升
申请(专利权)人:中国科学院沈阳计算技术研究所有限公司
类型:发明
国别省市:辽宁;21

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1