[发明专利]一种激光位移传感器的光轴坐标系的标定方法有效
申请号: | 202110945683.8 | 申请日: | 2021-08-16 |
公开(公告)号: | CN113607066B | 公开(公告)日: | 2023-09-12 |
发明(设计)人: | 黄志伟;王财先;宁艺文;孙闻博;吴钰屾 | 申请(专利权)人: | 上海发那科机器人有限公司 |
主分类号: | G01B11/02 | 分类号: | G01B11/02 |
代理公司: | 上海申新律师事务所 31272 | 代理人: | 吴轶淳 |
地址: | 201906 *** | 国省代码: | 上海;31 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 激光 位移 传感器 光轴 坐标系 标定 方法 | ||
1.一种激光位移传感器的光轴坐标系的标定方法,其特征在于,预先配置一机器人和设置于固定位置的一激光位移传感器,所述机器人的手臂末端通过一安装接口连接一标定块,且所述标定块的标定面与所述安装接口的安装面平行;所述标定方法具体包括以下步骤:
步骤S1,在所述标定块上建立一工具坐标系,使所述工具坐标系的原点处于所述标定块的几何中心;
步骤S2,通过人工初步示教获取一标定点,将所述标定块的几何中心与所述激光位移传感器射出激光的光斑重合,将所述激光的光轴垂直于所述标定块的标定面,并以所述标定点为原点,以垂直于所述标定面的方向作为Z轴方向生成一第一用户坐标系;
步骤S3,所述机器人的手臂末端基于所述工具坐标系带动所述标定块移动,在移动时保持所述标定块的姿态不变的同时,使得所述标定面的其中两条临边分别沿所述第一用户坐标系的X轴方向和Y轴方向触碰所述激光位移传感器的光轴并记录得到各触碰位置的一第一坐标点数据集合,进而根据所述第一坐标点数据集合,对所述第一坐标系进行处理得到一第二用户坐标系,所述第二用户坐标系的Z轴方向与所述光轴的方向平行;
步骤S4,所述机器人的手臂末端基于所述工具坐标系带动所述标定块移动,使得所述标定面的其中两条临边分别沿所述第二用户坐标系的X轴方向和Y轴方向触碰所述激光位移传感器的光轴并记录得到各触碰位置的一第二坐标点数据集合;
步骤S5,所述机器人的手臂末端基于所述工具坐标系带动所述标定块移动到所述第二用户坐标系的原点,获取所述激光位移传感器的测距结果,并对各所述第二坐标点数据集合、所述测距结果和所述第二用户坐标系进行处理得到所述激光位移传感器的光轴坐标系,完成所述激光位移传感器的标定。
2.根据权利要求1所述的标定方法,其特征在于,所述步骤S3包括:
步骤S31,所述机器人的手臂末端基于所述工具坐标系带动所述标定块移动,使所述标定块上的所述标定面的其中两条临边分别沿所述第一用户坐标系的X轴方向和Y轴方向触碰所述光轴并记录第一触碰位置、第二触碰位置、第三触碰位置和第四触碰位置的坐标点数据加入所述第一坐标点数据集合;
步骤S32,根据所述第一坐标点数据集合处理得到所述光轴的空间向量,并根据所述空间向量处理得到所述光轴与所述第一用户坐标系的Y轴的第一夹角和所述光轴与所述第一用户坐标系的X轴的第二夹角;
步骤S33,根据所述第一夹角和所述第二夹角处理得到一旋转矩阵,并根据所述旋转矩阵和所述第一用户坐标系处理得到所述第二用户坐标系。
3.根据权利要求2所述的标定方法,其特征在于,所述步骤S31包括:
步骤S311,所述机器人的手臂末端基于所述工具坐标系带动所述标定块移动,使所述标定块上的所述标定面的其中一条边沿所述第一用户坐标系的X轴方向触碰所述光轴并记录对应的所述第一触碰位置的一第一坐标点数据加入所述第一坐标点数据集合,然后带动所述标定块沿所述第一用户坐标系的Z轴方向移动一预设距离后,使所述标定面的所述其中一条边沿所述第一用户坐标系的X轴方向触碰所述光轴并记录对应的所述第二触碰位置的一第二坐标点数据加入所述第一坐标点数据集合;
步骤S312,所述机器人的手臂末端基于所述工具坐标系带动所述标定块移动,使所述标定块上的所述标定面的其中另一条临边沿所述第一用户坐标系的Y轴方向触碰所述光轴并记录对应的所述第三触碰位置的一第三坐标点数据加入所述第一坐标点数据集合,然后带动所述标定块沿所述第一用户坐标系的Z轴方向移动所述预设距离后,使所述标定面的所述其中另一条临边沿所述第一用户坐标系的Y轴方向触碰所述光轴并记录对应的所述第四触碰位置的一第四坐标点数据加入所述第一坐标点数据集合。
4.根据权利要求2所述的标定方法,其特征在于,所述步骤S31中,所述标定面的两条临边触碰到所述光轴时,所述激光位移传感器输出一检测信号,所述机器人根据所述检测信号停止移动并分别记录所述第一触碰位置、第二触碰位置、第三触碰位置和第四触碰位置的坐标点数据加入所述第一坐标点数据集合。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于上海发那科机器人有限公司,未经上海发那科机器人有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110945683.8/1.html,转载请声明来源钻瓜专利网。