【技术实现步骤摘要】
本专利技术涉及机器人领域，特别是涉及一种工具在机器人法兰坐标系上的标定方法及装置。
技术介绍
在机器人编程中，通常需要将对工件的操作任务定义在机器人的法兰坐标系等坐标系下，因此在对工件进行加工前需要事先确定固定在工具上的工具坐标系与固定工具的末端关节所在的法兰坐标系的关系，即进行工具坐标系的标定，工具坐标系的标定为确定工具中心点在法兰坐标系中的坐标以及工具坐标系相对法兰坐标系的坐标轴方向。其中，对工具坐标系的标定过程中现有技术通常采用四点标定法确定工具中心点在法兰坐标系中的坐标，四点标定法具体为：使待进行工具坐标系标定的工具的中心点分别从四个不同的方向运动至同一标定参考点，从而获取工具中心点四次运动过程中机器人各关节对应的旋转角度；再根据获得的旋转角度以及四点标定算法获得工具中心点在法兰坐标系中的坐标值。本申请专利技术人在长期研发中发现，现有技术的四点标定法中工具中心点需从四个方向运动至标定参考点，需选取的运动路径较多，即在实际标定操作过程中每个工具中心的标定均至少需要进行四次工具中心点向标定参考点运动的操作，标定操作较繁琐而使得工具坐标系的标定效率较低，进而影响工件的加工效率。
技术实现思路
本专利技术主要解决的技术问题是提供一种工具在机器人法兰坐标系上的标定方法及装置，能够减少所需的工具中心点运动路径数量，标定操作较简单而使得工具坐标系的标定效率较高。为解决...
【技术保护点】
一种工具在机器人法兰坐标系上的标定方法，其特征在于，包括：获取固定在机器人末端关节安装部上的待标定工具移动至所述待标定工具的中心点与标定参考点重合时所述机器人各关节的旋转角度；获取已标定工具的中心点在所述机器人法兰坐标系上的标定信息；根据所述已标定工具的中心点的标定信息和所述待标定工具的旋转角度完成所述待标定工具的中心点在所述机器人法兰坐标系上的标定。
【技术特征摘要】
1.一种工具在机器人法兰坐标系上的标定方法，其特征在于，包
括：
获取固定在机器人末端关节安装部上的待标定工具移动至所述待
标定工具的中心点与标定参考点重合时所述机器人各关节的旋转角度；
获取已标定工具的中心点在所述机器人法兰坐标系上的标定信息；
根据所述已标定工具的中心点的标定信息和所述待标定工具的旋
转角度完成所述待标定工具的中心点在所述机器人法兰坐标系上的标
定。
2.根据权利要求1所述的标定方法，其特征在于，
所述获取已标定工具的中心点在机器人法兰坐标系上的标定信息
的步骤包括：
获取所述已标定工具的旋转角度和已标定工具的中心点在机器人
法兰坐标系中的坐标，所述已标定工具的旋转角度为当所述已标定工具
被固定在所述机器人末端关节的安装部上时，其移动至所述已标定工具
的中心点与标定参考点重合时所述机器人各关节的旋转角度。
3.根据权利要求2所述的标定方法，其特征在于，仅所述已标定
工具的旋转角度是预先存储在存储器中的，所述已标定工具的中心点在
机器人法兰坐标系中的坐标是根据所述预先存储在存储器中的已标定
工具的旋转角度即时计算得到的；
或者，所述已标定工具的中心点在机器人法兰坐标系中的坐标和已
标定工具的旋转角度均是预先存储在存储器中的。
4.根据权利要求1所述的标定方法，其特征在于，
所述获取已标定工具的中心点在机器人法兰坐标系上的标定信息
的步骤包括：
获取第一个已标定工具的中心点在机器人法兰坐标系上的标定信
息；
所述根据已标定工具的中心点的标定信息和所述待标定工具的旋
转角度完成所述待标定工具的中心点在机器人法兰坐标系上的标定的
\t步骤包括：
根据第一个已标定工具的中心点的标定信息和所述待标定工具的
旋转角度完成所述待标定工具的中心点在机器人法兰坐标系上的标定。
5.根据权利要求1所述的标定方法，其特征在于，
所述获取已标定工具的中心点在机器人法兰坐标系上的标定信息
的步骤包括：
获取上一个已标定工具的中心点在机器人法兰坐标系上的标定信
息；
所述根据已标定工具的中心点的标定信息和所述待标定工具的旋
转角度完成所述待标定工具的中心点在机器人法兰坐标系上的标定的
步骤包括：
根据上一个已标定工具的中心点的标定信息和所述待标定工具的
旋转角度完成所述待标定工具的中心点在机器人法兰坐标系上的标定。
6.根据权利要求1所述的标定方法，其特征在于，
所述获取已标定工具的中心点在机器人法兰坐标系上的标定信息
的步骤包括：
获取之前至少两个已标定工具的中心点在机器人法兰坐标系上的
标定信息，并对所述标定信息做加权平均；
所述根据已标定工具的中心点的标定信息和所述待标定工具的旋
转角度完成所述待标定工具的中心点在机器人法兰坐标系上的标定的
步骤包括：
根据加权平均后的已标定工具的中心点的标定信息和所述待标定
工具的旋转角度完成所述待标定工具的中心点在机器人法兰坐标系上
的标定。
7.根据权利要求2至6任意一项所述的标定方法，其特征在于，
所述根据已标定工具的中心点的标定信息和所述待标定工具的旋
转角度完成所述待标定工具的中心点在机器人法兰坐标系上的标定的
步骤包括：
将已标定工具的旋转角度和待标定工具的旋转角度分别代入已知
\t的机器人正运动学方程，获得机器人法兰坐标系相对于世界坐标系的转
换矩阵F已、F待，并建立如下等式⑤，
其中，(X待Y待Z待)为所述待标定工具中心点在所述法兰坐标系中的坐
标，所述已标定工具中心点在所述法兰坐标系中的坐标为(X已Y已Z已)，
机器人法兰坐标系相对于世界坐标系的转换矩阵F待具体如下式⑥，
将式⑥代入式⑤得到式⑦，求得所述待标定工具中心点在所述法兰
坐标系中的坐标(X待Y待Z待)，
其中，且F'待为正交矩阵。
8.根据权利要求7所述的标定方法，其特征在于，
所述获取已标定工具的中心点在机器人法兰坐标系中坐标的步骤
包括：
获取第一旋转角度和第二旋转角度，所述第一旋转角度和第二旋转
角度是所述已标定工具分别沿第一方向和第二方向移动至所述已标定
工具的中心点与标定参考点重合时机器人各关节的旋转角度；
将第一旋转角度、第二旋转角度分别代入已知的机器人正运动学方
程，获得机器人法兰坐标系相对于世界坐标系的转换矩阵F1、F2，并建
立等式①，
F1T0001=F2T0001=XYZ1]]>①，
式①中，T为已标定工具坐标系相对于法兰坐标系的变换矩阵，
(XYZ1)为标定参考点在世界坐标系中的坐标；
根据式②求得已标定工具的中心点在机器人法兰坐标系中的坐标
(X已Y已Z已)，
9.根据权利要求8所述的标定方法，其特征在于，
所述根据式②求得已标定工具的中心点在机器人法兰坐标系中的
坐标(X已Y已Z已)的步骤之后还包括：
获取第三旋转角度和第四旋转角度，所述第三旋转角度和第四旋转
角度是所述已标定工具分别沿第三方向和第四方向移动至所述已标定
工具的中心点与标定参考点重合时机器人各关节的旋转角度；
将第三旋转角度和第四旋转角度分别代入已知的机器人正运动学
方程，获得机器人法兰坐标系相对于世界坐标系的转换矩阵F3、F4，建
立等式③，
F3T0001=F4T0001=XYZ1]]>③，
式③中，T为已标定工具坐标系相对于法兰坐标系的变换矩阵，
(XYZ1)为标定参考点在世界坐标系中的坐标；
根据式③整理得到式④，根据式④再次求得已标定工具的中心点在
机器人法兰坐标系中的坐标(X'已Y′已Z'已)，
根据(X已Y已Z已)...
【专利技术属性】
技术研发人员：穆文锋，
申请(专利权)人：北京配天技术有限公司，
类型：发明
国别省市：北京;11
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。