CN109719726B - 一种机械臂手眼标定装置及方法 - Google Patents

一种机械臂手眼标定装置及方法 Download PDF

Info

Publication number
CN109719726B
CN109719726B CN201811649007.0A CN201811649007A CN109719726B CN 109719726 B CN109719726 B CN 109719726B CN 201811649007 A CN201811649007 A CN 201811649007A CN 109719726 B CN109719726 B CN 109719726B
Authority
CN
China
Prior art keywords
calibration
mechanical arm
coordinate system
calibration plate
eye
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201811649007.0A
Other languages
English (en)
Other versions
CN109719726A (zh
Inventor
王磊
樊旋
陈健
曹雏清
高云峰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuhu Hit Robot Technology Research Institute Co Ltd
Original Assignee
Wuhu Hit Robot Technology Research Institute Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Wuhu Hit Robot Technology Research Institute Co Ltd filed Critical Wuhu Hit Robot Technology Research Institute Co Ltd
Priority to CN201811649007.0A priority Critical patent/CN109719726B/zh
Publication of CN109719726A publication Critical patent/CN109719726A/zh
Application granted granted Critical
Publication of CN109719726B publication Critical patent/CN109719726B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

本发明适用于机器人视觉技术领域,提供了一种机械臂手眼标定装置及方法,装置包括:垂直标定板,垂直标定板由两标定板组成,两标定板垂直固定,两标定板的交线位于标定板的侧边,标定板的表面设有定位点,定位点关于交线对称设立,垂直标定板通过两长度可调节的支撑杆与行架固定;圆盘,圆盘的一侧设有滑块,滑块与滑轨滑动连接,滑轨垂直于行架设置;机械臂设于行架的下方,机械臂的末端装有标定头,机械臂通过底座与模组滑动连接,底座上设有激光雷达,激光雷达位于标定板的下方。标定板设计为垂直状,便于建立工具坐标系,标定板上设计了定位点,提供了工具坐标系的准确创建位置;设计了用于检测标定误差的圆盘,提供当前手眼标定精度。

Description

一种机械臂手眼标定装置及方法
技术领域
本发明属于机器人视觉技术领域,提供了一种机械臂手眼标定装置及方法。
背景技术
在视觉领域,机械臂需要根据视觉信号给出相应路径规划操作,但机械臂坐标系与视觉坐标系分别为两个独立的模块,所以当需要实现联合操作时,机械臂坐标系需要与视觉坐标系间形成一定的转化统一关系(手眼标定),当转化关系十分精确时就可实现机械臂与视觉间的联合。
手眼工业机械臂系统主要有eye-in-hand和eye-to-hand两类系统,其中,eye-in-hand系统中,激光雷达固定在机械臂的一个固定位置,其可以随同机械臂从不同方位观察标定板,因雷达扫描点云时存在噪声以及点云自身分布不均衡等因素影响,最终标定精度不够高。
发明内容
本发明实施例提供一种机械臂手眼标定方法,旨在提高三维视觉中激光雷达与机械臂的标定精度。
为了解决上述目的,本发明提供一种机器人手眼标定的装置,该装置包括:
垂直标定板,垂直标定板由两标定板组成,两标定板垂直固定,两标定板的交线位于标定板的侧边,标定板的表面设有定位点,定位点关于交线对称设立,垂直标定板通过两长度可调节的支撑杆与行架固定;
圆盘,圆盘的一侧设有滑块,滑块与滑轨滑动连接,滑轨垂直于行架设置;
机械臂设于行架的下方,机械臂的末端装有标定头,机械臂通过底座与模组滑动连接,底座上设有激光雷达,激光雷达位于标定板的下方。
为了解决上述目的,本发明提供一种机器人手眼标定方法,所述方法包括如下步骤:
S1、控制机械臂末端的标定头沿垂直标定板上的定位点及交线移动,构建机械臂的局部坐标系R1
S2、控制激光雷达水平移动,扫描获取垂直标定板的点云图像;
S3、基于点云图像来确定垂直标定板在激光雷达坐标系下的工具坐标系R2
S4、基于标定点在雷达坐标系R3中的坐标及在工具坐标系R2中的坐标,计算从雷达坐标系R3转换至工具坐标系R2中的旋转矩阵r及平移向量t。
进一步的,在步骤S4之后还包括:
S5、将圆盘的靶心移动至位置一;
S6、向机械臂发送靶心当前在局部坐标系中的位置,控制机械臂朝靶心运动,测量机械臂末端的标定头与靶心间的偏差,即检测标定头与靶心间的距离。
进一步的,在步骤S5之后还包括:
S7、将圆盘的靶心移动至位置二,执行步骤S6;
S8、将圆盘的靶心移动至位置三,执行步骤S6;
S9、取三次偏差值的平均值作为当前的标定偏差;
所述位置二和位置三关于位置一对称。
进一步的,在步骤S9之后还包括:
多次改变垂直标定板与激光雷达间的角度,在每次改变垂直标定板与激光雷达间的角度后,执行步骤S1至步骤S9,将最小偏差对应的旋转矩阵r及平移向量t传递给机械臂。
进一步的,在步骤S2之后还包括:
对图像进行滤波与下采样处理。
本发明提供的机械臂手眼标定装置及方法具有如下有益效果:
1.标定板设计为垂直状,便于建立机械臂的局部坐标系;
2.在垂直标定板上设计了定位点,提供了工具坐标系的准确创建位置;
3.设计了用于误差检测的圆盘,将最小误差的标定赋予机械臂,提高了标定精度。
附图说明
图1为本发明实施例提供的机械臂手眼标定装置的结构示意图;
图2为本发明实施例提供的图1的A区局部放大图;
图3为本发明实施例提供的垂直标定板的结构示意图;
图4为本发明实施例提供的激光雷达与垂直标定板间的夹角确定示意图;
图5为本发明实施例提供的标定头的结构示意图;
图6为本发明实施例提供的机械臂手眼标定方法流程图;
1.模组、2.垂直标定板、3.激光雷达、4.圆盘、5.机械臂、6.行架、7.滑轨、8、标定头、9.底座、10.支撑杆、11.标定点。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
图1为本发明实施例提供的机械臂手眼标定装置的结构示意图,为了便于说明,仅示出于本发明实施例相关的部分,该装置包括:
垂直标定板2,垂直标定板2由两块标定板组成,两标定板垂直固定,两标定板的垂直交线位于标定板的侧边,标定板的外侧设有定位点11,定位点11关于交线对称设置,如图3所示,垂直标定板2通过两长度可调节的支撑杆10与行架6固定,如图2所示;
在本发明实施例中,在行架6上设置有两支撑杆10,两支撑杆10的长度可调节,在两标定板的内侧设有定位块,定位块上设有与支撑杆顶部相适配的定位孔,定位孔与支撑杆的配合即实现了垂直标定板2的固定,通过调节两支撑杆的长度,可以控制垂直标定板2与激光雷达之间的夹角,如图4给出了垂直标定板与激光雷达间夹角的确定方法,如图4中的d所示。
圆盘4,圆盘4的底部设有滑块,滑块与滑轨7滑动连接,滑轨7垂直于行架6设置,在滑轨7上的位置一、位置二及位置三分别设有标识,位置二和位置三关于位置一对称设置,如图3中的A位置、B位置及C位置。
设于行架下方的机械臂5,机械臂5的末端设置有标定头8,机械臂5通过底座9与模组1滑动连接,底座9上设有激光雷达3,激光雷达3位于垂直标定板2的下方,
在本发明实施例中,标定头9的圆柱状,圆柱的一端呈倒锥形,通过圆柱的另一端与机械臂5的末端固定,标定头9的结构示意图如图5所示,底座9上设有电机,通过电机驱动底座沿模组1方向运动;
图6为本发明实施例提供的机械臂手眼标定方法的流程图,该方法包括如下步骤:
S1、控制机械臂末端的标定头沿垂直标定板上的定位点及交线移动,构建机械臂的局部坐标系R1
行架,将机械臂末端的标定头移动至垂直标定板处,控制标定头沿垂直标定板上的各定位点移动,从而建出y坐标轴和z坐标轴,再以垂直标定板的交线为基准线移动机械臂的标定头建立出x轴线坐标,三坐标轴相交之处为坐标原点,即为机械臂的局部坐标系R1
S2、控制底座沿模组水平移动,激光雷达随底座的水平移动,激光雷达扫描获取垂直标定板的点云图像,对图像进行滤波与下采样处理,获取均匀的标定板表面点云;
S3、基于垂直标定板的点云图像确定垂直标定板在激光雷达坐标系下的工具坐标系R2
在本发明实施例中,垂直标定板的工具坐标系R2是指局部坐标系R1的X轴、Y轴及Z轴映射到雷达坐标系R3下所形成的。
S4、基于标定点在雷达坐标系R3中的坐标及在工具坐标系R2中的坐标,计算从雷达坐标系R3转换至工具坐标系R2中的旋转矩阵r及平移向量t,
因所建的工具坐标系R2与激光雷达坐标系R3相对位置确定,所以两者之间存在固定转化关系,可通过坐标转化计算获取两者之间的坐标转化矩阵,将计算所得的转化矩阵传递给机械臂即可实现手眼标定。
因R2是在R3的坐标系中建立,所以R2的每个坐标轴在R3中可看作为一个向量,R2的原点在R3中是一个具体的位置点;通过这三个向量和位置点可由公式R3=r·R2+t计算出转化矩阵。
若工具坐标系R2与机械臂建立局部坐标系R1重合,则仅需将基于点云建立的工具坐标系与雷达坐标系转化关系传递给机械臂即可,此时称为完全标定,即标定不存在任何误差,实际情况无法满足两工具坐标系完全重合,只能在允许的误差范围内实现合理标定,标定误差的确定具体如下:
S5、将圆盘的靶心移动至位置一,向机械臂发送靶心当前在局部坐标系中的位置,控制机械臂朝靶心运动,测量机械臂末端的标定头与靶心间的偏差,即标定头与靶心间的距离;
S6、将圆盘的靶心移动至位置二,执行步骤S5,将圆盘的靶心移动至位置三,执行步骤S5;位置二与位置三关于位置一对称,取三次偏差的平局值作为当前的标定偏差;
S7、多次改变垂直标定板与激光雷达间的角度,在每次改变垂直标定板与激光雷达间的角度后,均执行步骤S1至步骤S6,将最小偏差对应的转换矩阵r及平移向量t传递给机械臂。
在本发明实施例中,垂直标定板与激光雷达间的角度通过两支撑杆的高度来调节,每次改变设定角度(10度),且位置一、位置二及位置三在局部坐标系中的位置是事先标定的。
本发明提供的机械臂手眼标定装置及方法具有如下有益效果:
1.标定板设计为垂直状,便于建立机械臂的局部坐标系;
2.在垂直标定板上设计了定位点,提供了工具坐标系的准确创建位置;
3.设计了用于误差检测的圆盘,将最小误差的标定赋予机械臂,提高了标定精度。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。

Claims (5)

1.一种机械臂手眼标定方法,其特征在于,机械臂手眼标定装置包括:
垂直标定板,垂直标定板由两标定板组成,两标定板垂直固定,两标定板的交线位于标定板的侧边,标定板的表面设有定位点,定位点关于交线对称设立,垂直标定板通过两长度可调节的支撑杆与行架固定;
圆盘,圆盘的一侧设有滑块,滑块与滑轨滑动连接,滑轨垂直于行架设置;
机械臂设于行架的下方,机械臂的末端装有标定头,机械臂通过底座与模组滑动连接,底座上设有激光雷达,激光雷达位于标定板的下方;
所述机械臂手眼标定方法包括如下步骤:
S1、控制机械臂末端的标定头沿垂直标定板上的定位点及交线移动,构建机械臂的局部坐标系R1
S2、控制激光雷达水平移动,扫描获取垂直标定板的点云图像;
S3、基于点云图像来确定垂直标定板在激光雷达坐标系下的工具坐标系R2
S4、基于标定点在雷达坐标系R3中的坐标及在工具坐标系R2中的坐标,计算从雷达坐标系R3转换至工具坐标系R2中的旋转矩阵r及平移向量t。
2.如权利要求1所述机械臂手眼标定方法,其特征在于,在步骤S4之后还包括:
S5、将圆盘的靶心移动至位置一;
S6、向机械臂发送靶心当前在局部坐标系中的位置,控制机械臂朝靶心运动,测量机械臂末端的标定头与靶心间的偏差,即检测标定头与靶心间的距离。
3.如权利要求2所述机械臂手眼标定方法,其特征在于,在步骤S5之后还包括:
S7、将圆盘的靶心移动至位置二,执行步骤S6;
S8、将圆盘的靶心移动至位置三,执行步骤S6;
S9、取三次偏差值的平均值作为当前的标定偏差;
所述位置二和位置三关于位置一对称。
4.如权利要求3所述机械臂手眼标定方法,其特征在于,在步骤S9之后还包括:
多次改变垂直标定板与激光雷达间的角度,在每次改变垂直标定板与激光雷达间的角度后,执行步骤S1至步骤S9,将最小偏差对应的旋转矩阵r及平移向量t传递给机械臂。
5.如权利要求1所述机械臂手眼标定方法,其特征在于,在步骤S2之后还包括:
对图像进行滤波与下采样处理。
CN201811649007.0A 2018-12-30 2018-12-30 一种机械臂手眼标定装置及方法 Active CN109719726B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811649007.0A CN109719726B (zh) 2018-12-30 2018-12-30 一种机械臂手眼标定装置及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811649007.0A CN109719726B (zh) 2018-12-30 2018-12-30 一种机械臂手眼标定装置及方法

Publications (2)

Publication Number Publication Date
CN109719726A CN109719726A (zh) 2019-05-07
CN109719726B true CN109719726B (zh) 2021-08-20

Family

ID=66299516

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811649007.0A Active CN109719726B (zh) 2018-12-30 2018-12-30 一种机械臂手眼标定装置及方法

Country Status (1)

Country Link
CN (1) CN109719726B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110842901B (zh) * 2019-11-26 2021-01-15 广东技术师范大学 基于一种新型三维标定块的机器人手眼标定方法与装置
CN110977987B (zh) * 2019-12-25 2021-07-20 杭州未名信科科技有限公司 机械臂手眼标定方法、装置及系统
CN111390911A (zh) * 2020-04-03 2020-07-10 东莞仕达通自动化有限公司 一种机械手位置标定系统及标定方法
CN113650019B (zh) * 2021-09-01 2023-04-07 东莞拓斯达技术有限公司 一种机械手工具坐标的标定方法、装置及机器人

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102294695A (zh) * 2010-06-25 2011-12-28 鸿富锦精密工业(深圳)有限公司 机器人标定方法及标定系统
WO2011143576A3 (en) * 2010-05-14 2012-08-09 Cognex Technology And Investment Corporation System and method for robust calibration between a machine vision system and a robot
CN104197831A (zh) * 2014-08-14 2014-12-10 四川大学 一种六关节工业机器人的精度标定装置
CN104655063A (zh) * 2013-11-20 2015-05-27 北京信息科技大学 关节式坐标测量机的高精度标定方法
CN106308946A (zh) * 2016-08-17 2017-01-11 清华大学 一种应用于立体定向手术机器人的增强现实装置及其方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101864329B1 (ko) * 2016-12-07 2018-06-05 한화에어로스페이스 주식회사 로봇 암 제어 시스템 및 방법

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011143576A3 (en) * 2010-05-14 2012-08-09 Cognex Technology And Investment Corporation System and method for robust calibration between a machine vision system and a robot
CN102294695A (zh) * 2010-06-25 2011-12-28 鸿富锦精密工业(深圳)有限公司 机器人标定方法及标定系统
CN104655063A (zh) * 2013-11-20 2015-05-27 北京信息科技大学 关节式坐标测量机的高精度标定方法
CN104197831A (zh) * 2014-08-14 2014-12-10 四川大学 一种六关节工业机器人的精度标定装置
CN106308946A (zh) * 2016-08-17 2017-01-11 清华大学 一种应用于立体定向手术机器人的增强现实装置及其方法

Also Published As

Publication number Publication date
CN109719726A (zh) 2019-05-07

Similar Documents

Publication Publication Date Title
CN109719726B (zh) 一种机械臂手眼标定装置及方法
CN111735390B (zh) 一种用于线激光传感器的标定块及手眼标定方法
CN105303560B (zh) 机器人激光扫描式焊缝跟踪系统标定方法
CN108827155B (zh) 一种机器人视觉测量系统及方法
CN110906863B (zh) 一种用于线结构光传感器的手眼标定系统及标定方法
CN104197960B (zh) 一种激光跟踪仪视觉导引摄像机的全局标定方法
CN108801142A (zh) 一种特大尺寸工件双移动测量机器人系统及方法
CN210741384U (zh) 二维传感器与三维传感器融合的机器人视觉测量系统
CN108267133B (zh) 一种激光式反射板坐标系冗余标定方法及激光导航系统
CN109764805B (zh) 一种基于激光扫描的机械臂定位装置与方法
CN103063135B (zh) 一种三维激光扫描仪姿态高精度标定方法与装置
CN109571471B (zh) 一种用于双机器人相对空间位置标定的方法
CN113781558B (zh) 一种姿态与位置解耦的机器人视觉寻位方法
CN108249307B (zh) 一种大型起重机的移动测量与反馈控制系统及方法
US20130286375A1 (en) High precise laser rangefinder
CN110127521B (zh) 钢卷中心坐标检测装置及其方法
CN106182088A (zh) 工业机器人及格子间的定位方法、装置
CN215449579U (zh) 标定验证组件及系统
CN113960564B (zh) 一种用于水下检测的激光综合参考系统及测距和标定的方法
CN111412888B (zh) 一种建筑物尺寸测量方法
CN106767678A (zh) 车载光电经纬仪测角误差修正方法
CN106898854A (zh) 一种高精度微波传输线的安装校准工装及其安装校准工艺
JPH03259705A (ja) 折曲機の角度計測装置
CN113982276A (zh) 现浇墙体机器人精确定位方法及装置
CN211317227U (zh) 一种用于型材轮廓尺寸测量的三维标定装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant