CN109719726A - 一种机械臂手眼标定装置及方法 - Google Patents
一种机械臂手眼标定装置及方法 Download PDFInfo
- Publication number
- CN109719726A CN109719726A CN201811649007.0A CN201811649007A CN109719726A CN 109719726 A CN109719726 A CN 109719726A CN 201811649007 A CN201811649007 A CN 201811649007A CN 109719726 A CN109719726 A CN 109719726A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- vertical
- scaling
- laser radar
- disk
- 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.)
- Granted
Links
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 (6)
1.一种机械臂手眼标定装置,其特征在于,所示装置包括:
垂直标定板,垂直标定板由两标定板组成,两标定板垂直固定,两标定板的交线位于标定板的侧边,标定板的表面设有定位点,定位点关于交线对称设立,垂直标定板通过两长度可调节的支撑杆与行架固定;
圆盘,圆盘的一侧设有滑块,滑块与滑轨滑动连接,滑轨垂直于行架设置;
机械臂设于行架的下方,机械臂的末端装有标定头,机械臂通过底座与模组滑动连接,底座上设有激光雷达,激光雷达位于标定板的下方。
2.一种基于权利要求1所述机械臂手眼标定装置的标定方法,其特征在于,所述方法包括如下步骤:
S1、控制机械臂末端的标定头沿垂直标定板上的定位点及交线移动,构建机械臂的局部坐标系R1;
S2、控制激光雷达水平移动,扫描获取垂直标定板的点云图像;
S3、基于点云图像来确定垂直标定板在激光雷达坐标系下的工具坐标系R2;
S4、基于标定点在雷达坐标系R3中的坐标及在工具坐标系R2中的坐标,计算从雷达坐标系R3转换至工具坐标系R2中的旋转矩阵r及平移向量t。
3.如权利要求1所述机械臂手眼标定方法,其特征在于,在步骤S4之后还包括:
S5、将圆盘的靶心移动至位置一;
S6、向机械臂发送靶心当前在局部坐标系中的位置,控制机械臂朝靶心运动,测量机械臂末端的标定头与靶心间的偏差,即检测标定头与靶心间的距离。
4.如权利要求3所述机械臂手眼标定方法,其特征在于,在步骤S5之后还包括:
S7、将圆盘的靶心移动至位置二,执行步骤S6;
S8、将圆盘的靶心移动至位置三,执行步骤S6;
S9、取三次偏差值的平均值作为当前的标定偏差;
所述位置二和位置三关于位置一对称。
5.如权利要求4所述机械臂手眼标定方法,其特征在于,在步骤S9之后还包括:
多次改变垂直标定板与激光雷达间的角度,在每次改变垂直标定板与激光雷达间的角度后,执行步骤S1至步骤S9,将最小偏差对应的旋转矩阵r及平移向量t传递给机械臂。
6.如权利要求4所述机械臂手眼标定方法,其特征在于,在步骤S2之后还包括:
对图像进行滤波与下采样处理。
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 true CN109719726A (zh) | 2019-05-07 |
CN109719726B 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) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110842901A (zh) * | 2019-11-26 | 2020-02-28 | 广东技术师范大学 | 基于一种新型三维标定块的机器人手眼标定方法与装置 |
CN110977987A (zh) * | 2019-12-25 | 2020-04-10 | 浙江省北大信息技术高等研究院 | 机械臂手眼标定方法、装置及*** |
CN111390911A (zh) * | 2020-04-03 | 2020-07-10 | 东莞仕达通自动化有限公司 | 一种机械手位置标定***及标定方法 |
CN113650019A (zh) * | 2021-09-01 | 2021-11-16 | 东莞拓斯达技术有限公司 | 一种机械手工具坐标的标定方法、装置及机器人 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011143576A2 (en) * | 2010-05-14 | 2011-11-17 | 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 | 鸿富锦精密工业(深圳)有限公司 | 机器人标定方法及标定*** |
CN104197831A (zh) * | 2014-08-14 | 2014-12-10 | 四川大学 | 一种六关节工业机器人的精度标定装置 |
CN104655063A (zh) * | 2013-11-20 | 2015-05-27 | 北京信息科技大学 | 关节式坐标测量机的高精度标定方法 |
CN106308946A (zh) * | 2016-08-17 | 2017-01-11 | 清华大学 | 一种应用于立体定向手术机器人的增强现实装置及其方法 |
US20180154523A1 (en) * | 2016-12-07 | 2018-06-07 | Hanwha Techwin Co., Ltd. | Apparatus and method of controlling robot arm |
-
2018
- 2018-12-30 CN CN201811649007.0A patent/CN109719726B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011143576A2 (en) * | 2010-05-14 | 2011-11-17 | 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 | 清华大学 | 一种应用于立体定向手术机器人的增强现实装置及其方法 |
US20180154523A1 (en) * | 2016-12-07 | 2018-06-07 | Hanwha Techwin Co., Ltd. | Apparatus and method of controlling robot arm |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110842901A (zh) * | 2019-11-26 | 2020-02-28 | 广东技术师范大学 | 基于一种新型三维标定块的机器人手眼标定方法与装置 |
CN110977987A (zh) * | 2019-12-25 | 2020-04-10 | 浙江省北大信息技术高等研究院 | 机械臂手眼标定方法、装置及*** |
CN110977987B (zh) * | 2019-12-25 | 2021-07-20 | 杭州未名信科科技有限公司 | 机械臂手眼标定方法、装置及*** |
CN111390911A (zh) * | 2020-04-03 | 2020-07-10 | 东莞仕达通自动化有限公司 | 一种机械手位置标定***及标定方法 |
CN113650019A (zh) * | 2021-09-01 | 2021-11-16 | 东莞拓斯达技术有限公司 | 一种机械手工具坐标的标定方法、装置及机器人 |
Also Published As
Publication number | Publication date |
---|---|
CN109719726B (zh) | 2021-08-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109719726A (zh) | 一种机械臂手眼标定装置及方法 | |
CN101339003B (zh) | 大结构水平二维位移自动测量装置及方法 | |
CN109794938A (zh) | 一种适用于曲面结构的机器人制孔误差补偿装置及其方法 | |
CN108106562B (zh) | 一种接触网测量方法及装置 | |
JP2022039903A (ja) | ラインレーザーセンサ用のキャリブレーションブロック及びハンドアイキャリブレーション方法 | |
CN104865897B (zh) | 曲面零件的加工方法及曲面零件的加工设备 | |
CN104567690B (zh) | 一种激光束现场标定方法及装置 | |
CN106441112B (zh) | 一种可变量程的激光三角法位移测量装置与方法 | |
JP6967140B2 (ja) | 検流計補正システム及び方法 | |
CN108344693B (zh) | 一种面向自动焊接的薄板焊缝错边量视觉测量方法 | |
CN110978056B (zh) | 机器人运动的平面校准***及方法 | |
CN109375195A (zh) | 一种基于正交法向量的多线激光雷达外参数快速标定方法 | |
CN104655024A (zh) | 一种影像测量设备及其快速准确测高装置与方法 | |
CN109798874B (zh) | 一种高铁桥梁竖向动扰度测量方法 | |
CN109738061A (zh) | 一种面向照度计检定的照度计位置自动对准方法及*** | |
CN109541626B (zh) | 目标平面法向量检测装置及检测方法 | |
CN109751987A (zh) | 一种用于机械执行机构的视觉激光定位装置及定位方法 | |
CN105444676A (zh) | 适用于在线扫描测量探头多方位定位装置 | |
CN111883271B (zh) | 核反应堆压力容器自动检测平台精确定位方法及*** | |
CN112557768A (zh) | 片上天线测试***及测试方法 | |
CN111750773B (zh) | 测量不同光斑点在位置敏感探测器上响应的方法 | |
CN116862995A (zh) | 一种用于大间距、无公共视场的相机外参标定装置及方法 | |
JP6500560B2 (ja) | 光学式センサーの校正方法、及び三次元座標測定機 | |
CN106181027A (zh) | 激光焊接头垂直度调整方法及激光焊接头装置 | |
JP2017053793A (ja) | 計測装置、および物品の製造方法 |
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 |