[发明专利]一种手眼标定方法在审
申请号: | 202011441781.X | 申请日: | 2020-12-08 |
公开(公告)号: | CN112454366A | 公开(公告)日: | 2021-03-09 |
发明(设计)人: | 李文龙;金硕;成巍;戈海龙;王俊 | 申请(专利权)人: | 山东省科学院激光研究所 |
主分类号: | B25J9/16 | 分类号: | B25J9/16 |
代理公司: | 济南诚智商标专利事务所有限公司 37105 | 代理人: | 王敏 |
地址: | 272000 山东省济宁市*** | 国省代码: | 山东;37 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 手眼 标定 方法 | ||
1.一种手眼标定方法,其特征在于,所述的方法包括以下步骤:
步骤S1:建立转换矩阵D、转换矩阵A、转换矩阵X之间的转换关系,其中,转换矩阵A为机械手坐标系相对于基坐标系下的转换矩阵,转换矩阵D为相机坐标系与世界坐标系之间的转换矩阵,转换矩阵X为相机坐标系相对于工具坐标系的位姿矩阵;
步骤S2:分别计算转换矩阵A和转换矩阵D;
步骤S3:利用Tasi两步法计算转换矩阵X;
步骤S4:利用上述步骤的计算结果,将模型三维坐标转换至机械手坐标系下,完成手眼标定。
2.根据权利要求1所述的一种手眼标定方法,其特征在于,步骤S1的具体实现方法为:
设B为机械手基坐标系,C为相机坐标系,E为工具坐标系,W为世界坐标系,机械手从位置1运动到位置2,机械手工具坐标系从E1变换到E2,相机坐标系从C1变换到C2,PB表示机械手基坐标系下的P点,PC表示相机坐标系下的P点,PE表示工具坐标系下的P点,PW表示世界坐标系下的P点,表示E坐标系相对于B坐标系的位姿矩阵,表示C坐标系相对于E坐标系的位姿矩阵,表示W坐标系相对于C坐标系的位姿矩阵,则
建立矩阵位置转换关系为:
其中,分别表示E1、E2坐标系相对于B坐标系的位姿矩阵,表示C1坐标系相对于E1坐标系的位姿矩阵,表示C2坐标系相对于E2坐标系的位姿矩阵,分别表示相机坐标系C1、C2下的P点,PB表示机械手基坐标系下的P点;
建立相机坐标系C与世界坐标系W之间的位置转换关系为:
其中,PC表示相机坐标系下的P点,表示W坐标系相对于C坐标系的位姿矩阵,PW表示世界坐标系下的P点;
将公式(2)带入(1)得:
基于基坐标系下的点PB不变,将公式(3)化简得:
对公式(4)变换形式得:
由于相机固定于机械手上,相机相对于机械手坐标系转换关系不变得:
设则公式(5)变为:
AX=XD (6)。
3.根据权利要求1所述的一种手眼标定方法,其特征在于,步骤S2中,通过张正友标定法获取转换矩阵D。
4.根据权利要求3所述的一种手眼标定方法,其特征在于,在张正友标定法实现过程中,采用15-20组棋盘格数据进行系统标定转换。
5.根据权利要求3或4所述的一种手眼标定方法,其特征在于,通过张正友标定法获取转换矩阵D的具体方法为:
首先,分别计算和其中,为通过张正友标定法对相机坐标系C1下的相机标定得到的外参矩阵,为通过张正友标定法对相机坐标系C2下的相机标定得到的外参矩阵;其次,根据计算转换矩阵D。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于山东省科学院激光研究所,未经山东省科学院激光研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011441781.X/1.html,转载请声明来源钻瓜专利网。