CN111823230A - 一种基于Scara机器人的非固定式手眼关系标定方法 - Google Patents
一种基于Scara机器人的非固定式手眼关系标定方法 Download PDFInfo
- Publication number
- CN111823230A CN111823230A CN202010563110.4A CN202010563110A CN111823230A CN 111823230 A CN111823230 A CN 111823230A CN 202010563110 A CN202010563110 A CN 202010563110A CN 111823230 A CN111823230 A CN 111823230A
- Authority
- CN
- China
- Prior art keywords
- scara robot
- camera
- joint
- robot
- coordinate system
- 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
- 238000000034 method Methods 0.000 title claims abstract description 30
- 230000000007 visual effect Effects 0.000 claims description 9
- 230000009466 transformation Effects 0.000 claims description 5
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000007792 addition Methods 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- FFBHFFJDDLITSX-UHFFFAOYSA-N benzyl N-[2-hydroxy-4-(3-oxomorpholin-4-yl)phenyl]carbamate Chemical compound OC1=C(NC(=O)OCC2=CC=CC=C2)C=CC(=C1)N1CCOCC1=O FFBHFFJDDLITSX-UHFFFAOYSA-N 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/70—Determining position or orientation of objects or cameras
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于Scara机器人的非固定式手眼关系标定方法,属于Scara机器人手眼标定领域,本发明方法研究4自由度Scara机器人安装在末端之前的相机与机械手臂末端之间的关系,进而可以将相机获得的信息实时转换到手臂末端,以控制手臂完成各种任务。本发明方法计算效率高;给出了各参数的封闭解,容易求解,计算精度高;实现简单;整个过程只需用拍三次图像,运动两次即可完成;扩大应用范围。可进一步推广应用于6自由度机器人中。
Description
技术领域
本发明属于Scara机器人手眼标定领域,具体涉及一种基于Scara机器人的非固定式手眼关系标定方法。
背景技术
随着我国劳动力短缺、市场竞争激烈,人们对机器人的应用要求也越来越高,希望机器人能够完成更多、更复杂的任务,比如:自主识别、定位抓取、自主装配焊接等任务,其中Scara机器人由于其成本低、性能好,在制造业中广受欢迎,并已经结合相机在实际中解决很多问题,所采用的结合方式包括相机独立固定安装到机械臂外部上方和安装在手臂末端两种方式。随着任务和需求增多,一种新的结合方式的需求也越来越多,既将相机安装在手臂末端之前的关节上,这种方式主要是由于以下两个原因引起的,一是为了使机器人完成更多任务,末端手抓结构越来越复杂、切换种类也越来越多,这使得末端安装空间小、负载重,无法再安装相机;二是为了节约成本,不选用大负载、大尺寸的机器人代替现有机器人,而是将相机安装到末端之前以减轻末端负载。但我们知道末端之前的关节与末端之间的关系是实时变化的,属于非固定式手眼关系,应用时一般采用一个位置标定一次,多个位置就需要多次标定,这为该方式的应用带来很多不便,精度也难以保证。因此,解决这一问题将为机器人的应用开辟一个更大、更方便的应用领域。
发明内容
针对现有技术中存在的上述技术问题,本发明提出了一种基于Scara机器人的非固定式手眼关系标定方法,设计合理,克服了现有技术的不足,具有良好的效果。
为了实现上述目的,本发明采用如下技术方案:
一种基于Scara机器人的非固定式手眼关系标定方法,Scara机器人有三个关节,四个自由度,第一关节和第二关节都是旋转关节,第三个关节即能够旋转又能够移动,三个关节的轴线是相互平行的;Scara机器人的第二个关节上安装有相机,相机能够随着第二个关节的运动而运动,此标定方法具体包括如下步骤:
步骤1:假设相机的坐标系为C,Scara机器人的基坐标系为O,Scara机器人的机械手臂末端的坐标系为T,则相机相对于机械手臂末端之间的关系TGc为:
TGc=(oGT)-1oGc (1);
其中,oGT和oGc分别是机械手臂末端和相机相对于Scara机器人基坐标系的变换,oGT能够从Scara机器人的控制器中直接读出,那么只需要求出oGc即能够确定TGc;
步骤2:根据指数积模型知:
oGc=e1e2 oGc(0) (2);
其中:
其中,ωi∈R3×1是Scara机器人第i关节的轴线方向矢量,ri∈R3×1是Scara机器人第i关节轴上的任意一点,称之为旋量参数,变量θi,i=1,2,是关节角度,能够实时从Scara机器人的控制器中获取;oGc(0)∈R4×4是相机与Scara机器人在初始位置时的坐标变换关系;
步骤3:求取oGc(0);具体包括如下步骤:
步骤3.1:利用Scara机器人的末端工具去接触平台面上的目标点,即能够得到这些目标点在Scara机器人基坐标系下的值,记为Xo∈Rn×3,n>=4为目标点的个数;
步骤3.2:控制机械手臂带动相机运动,使目标点进入到相机视野中,对目标点进行拍照,此时目标点在相机坐标系下的值,记为Xc0∈Rn×3,同时,这一拍照位置被记为Scara机器人的初始位置;然后利用先求旋转矩阵后求平移向量的传统两步法获得oGc(0),即得到初始位置时相机与Scara机器人之间的关系;
步骤4:求取旋量参数ωi,ri,i=1,2;具体包括如下步骤:
步骤4.1:从Scara机器人的初始位置开始,转动Scara机器人的第二个关节θ2角度,控制目标点不超出相机的视野范围,然后获得目标点在转动后的相机坐标系下的值Xc2∈Rn×3,根据Xc0与Xc2的关系,利用两步法,得到ω2,r2的封闭解;
步骤4.2:步骤4.1的基础上,紧接着再转动Scara机器人第一个关节θ1角度,控制目标点不超出相机的视野范围,并获得转动后目标点在相机坐标系下的值Xc1∈Rn×3,然后根据Xc1与Xc2的关系,利用两步法,得到ω1,r1的封闭解;
根据公式(2),步骤3求取的oGc(0)以及步骤4求取的旋量参数ωi,ri,i=1,2,即能够实时确定相机与Scara机器人之间的关系。
本发明所带来的有益技术效果:
1、计算效率高。给出了各参数的封闭解,容易求解,计算精度高;
2、实现简单。整个过程只需用拍三次图像,运动两次即可完成;
3、扩大应用范围。可进一步推广应用于6自由度机器人中。
附图说明
图1为机器人结构简图。
图2为参数求解过程示意图。
具体实施方式
下面结合附图以及具体实施方式对本发明作进一步详细说明:
Scara机器人有三个关节,四个自由度,第一关节和第二关节都是旋转关节,第三个关节即可以旋转又可以移动,三个关节的轴线是相互平行的,这样的结构使机器人只能完成平面任务。相机镜头朝下安装在Scara机器人的第二个关节上,并使得光轴与轴线平行,如图1所示。相机可以随着第二个关节的运动而运动,与其相对关系不变。第三个关节与末端手抓固连在一起,可以绕轴转动也可以上下移动。在相机上建立坐标系C,末端工具上建立坐标系T,机器人基座上建立坐标系O,相机坐标系C与工具坐标系T之间的关系是相对变化的,在任务中必须确定它们之间的关系TGc,为此需要借助基座坐标O来获得。相机坐标系C和工具坐标系T分别与基座坐标系O之间的关系可以表示为oGc和oGT,则TGc可以表示为:
TGc=(oGT)-1oGc (1)
其中oGT可以从机器人控制器中直接获得,只需要求出oGc就可以确定TGc。根据指数积模型可知:
oGc=e1e2 oGc(0) (2)
其中
ωi∈R3×1是Scara机器人第i关节的轴线方向矢量,ri∈R3×1是Scara机器人第i关节轴上的任意一点,称之为旋量参数,oGc(0)∈R4×4是相机与Scara机器人在初始位置时的坐标变换关系。根据公式(2)可知,如果知道其中的oGc(0)和旋量参数ωi,ri,既可以实时确定相机与机器人之间的关系,因为里面的变量θi,是关节角度,可以实时从机器人控制器中获取。下面将介绍oGc(0)和旋量参数ωi,ri的求解过程,i=1,2;
第一部分:获得oGc(0)
第1步:利用机器人末端工具去接触平台面上一组点,称之为目标点P,得到这些目标点在机器人坐标系下的值,记为Xo∈Rn×3,n>=4为点的个数;
第2步:控制机械臂带动相机运动,使目标点进入到相机视野中,相机需要事先标定好,一张图像既可以获得此时平面目标点在相机坐标系下的值,记为Xc0∈Rn×3,同时,这一拍照位置被记为机器人初始位置,如图2状态0所示。记表示Xo的齐次表示,表示Xc0的齐次表示,则 和oGc(0)之间存在如下关系:
上式利用先求旋转矩阵后求平移向量的两步法获得相机与机器人之间的关系oGc(0)。
第二部分:求旋量参数ωi,ri,i=1,2
第1步:从机器人初始位置开始,转动第二个关节θ2角度,如图2状态1所示。控制目标点P不超出相机的视野范围,然后获得目标点在转动后的相机坐标系下的值Xc2∈Rn×3,记是Xc2的齐次表示,根据旋量理论与的关系为:
同样利用两步法线性求出ω2,r2;
第2步:在上一步基础上,紧接着再转动第一个关节θ1角度,如图2状态2所示。同样控制目标点不超出相机的视野范围,并获得机器人转动后目标点在相机坐标系下的值Xc1∈Rn×3,记是Xc1的齐次表示,再根据旋量理论与的关系为:
同样利用两步法线性求出ω1,r1。
当然,上述说明并非是对本发明的限制,本发明也并不仅限于上述举例,本技术领域的技术人员在本发明的实质范围内所做出的变化、改型、添加或替换,也应属于本发明的保护范围。
Claims (1)
1.一种基于Scara机器人的非固定式手眼关系标定方法,其特征在于:Scara机器人有三个关节,四个自由度,第一关节和第二关节都是旋转关节,第三个关节即能够旋转又能够移动,三个关节的轴线是相互平行的;Scara机器人的第二个关节上安装有相机,相机能够随着第二个关节的运动而运动,此标定方法具体包括如下步骤:
步骤1:假设相机的坐标系为C,Scara机器人的基坐标系为O,Scara机器人的机械手臂末端的坐标系为T,则相机相对于机械手臂末端之间的关系TGc为:
TGc=(oGT)-1oGc (1);
其中,oGT和oGc分别是机械手臂末端和相机相对于Scara机器人基坐标系的变换,oGT能够从Scara机器人的控制器中直接读出,那么只需要求出oGc即能够确定TGc;
步骤2:根据指数积模型知:
oGc=e1e2 oGc(0) (2);
其中:
其中,ωi∈R3×1是Scara机器人第i关节的轴线方向矢量,ri∈R3×1是Scara机器人第i关节轴上的任意一点,称之为旋量参数,变量θi,i=1,2,是关节角度,能够实时从Scara机器人的控制器中获取;oGc(0)∈R4×4是相机与Scara机器人在初始位置时的坐标变换关系;
步骤3:求取oGc(0);具体包括如下步骤:
步骤3.1:利用Scara机器人的末端工具去接触平台面上的目标点,即能够得到这些目标点在Scara机器人基坐标系下的值,记为Xo∈Rn×3,n>=4为目标点的个数;
步骤3.2:控制机械手臂带动相机运动,使目标点进入到相机视野中,对目标点进行拍照,此时目标点在相机坐标系下的值,记为Xc0∈Rn×3,同时,这一拍照位置被记为Scara机器人的初始位置;然后利用先求旋转矩阵后求平移向量的传统两步法获得oGc(0),即得到初始位置时相机与Scara机器人之间的关系;
步骤4:求取旋量参数ωi,ri,i=1,2;具体包括如下步骤:
步骤4.1:从Scara机器人的初始位置开始,转动Scara机器人的第二个关节θ2角度,控制目标点不超出相机的视野范围,然后获得目标点在转动后的相机坐标系下的值Xc2∈Rn×3,根据Xc0与Xc2的关系,利用两步法,得到ω2,r2的封闭解;
步骤4.2:步骤4.1的基础上,紧接着再转动Scara机器人第一个关节θ1角度,控制目标点不超出相机的视野范围,并获得转动后目标点在相机坐标系下的值Xc1∈Rn×3,然后根据Xc1与Xc2的关系,利用两步法,得到ω1,r1的封闭解;
根据公式(2),步骤3求取的oGc(0)以及步骤4求取的旋量参数ωi,ri,i=1,2,即能够实时确定相机与Scara机器人之间的关系。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010563110.4A CN111823230B (zh) | 2020-06-19 | 2020-06-19 | 一种基于Scara机器人的非固定式手眼关系标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010563110.4A CN111823230B (zh) | 2020-06-19 | 2020-06-19 | 一种基于Scara机器人的非固定式手眼关系标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111823230A true CN111823230A (zh) | 2020-10-27 |
CN111823230B CN111823230B (zh) | 2022-01-07 |
Family
ID=72898036
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010563110.4A Expired - Fee Related CN111823230B (zh) | 2020-06-19 | 2020-06-19 | 一种基于Scara机器人的非固定式手眼关系标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111823230B (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS60151712A (ja) * | 1984-01-19 | 1985-08-09 | Hitachi Ltd | 固定3次元視覚併用ロボットハンドリング装置 |
CN107160380A (zh) * | 2017-07-04 | 2017-09-15 | 华南理工大学 | 一种基于scara机械手的相机标定和坐标变换的方法 |
CN108818536A (zh) * | 2018-07-12 | 2018-11-16 | 武汉库柏特科技有限公司 | 一种机器人手眼标定的在线偏移修正方法及装置 |
CN109159114A (zh) * | 2018-08-16 | 2019-01-08 | 郑州大学 | Scara机械手固定相机视觉***手眼标定的高精度方法 |
US20190015991A1 (en) * | 2016-09-28 | 2019-01-17 | Cognex Corporation | Simultaneous Kinematic and Hand-Eye Calibration |
CN109940626A (zh) * | 2019-01-23 | 2019-06-28 | 浙江大学城市学院 | 一种基于机器人视觉的画眉机器人***及其控制方法 |
CN110000790A (zh) * | 2019-04-19 | 2019-07-12 | 深圳科瑞技术股份有限公司 | 一种SCARA机器人eye-to-hand手眼***的标定方法 |
KR101964332B1 (ko) * | 2017-10-13 | 2019-07-31 | 재단법인대구경북과학기술원 | 핸드-아이 캘리브레이션 방법, 이를 실행하기 위한 컴퓨터 프로그램 및 로봇 시스템 |
CN110103217A (zh) * | 2019-05-09 | 2019-08-09 | 电子科技大学 | 工业机器人手眼标定方法 |
CN110268358A (zh) * | 2017-02-09 | 2019-09-20 | 三菱电机株式会社 | 位置控制装置及位置控制方法 |
CN110355755A (zh) * | 2018-12-15 | 2019-10-22 | 深圳铭杰医疗科技有限公司 | 机器人手眼***标定方法、装置、设备及存储介质 |
-
2020
- 2020-06-19 CN CN202010563110.4A patent/CN111823230B/zh not_active Expired - Fee Related
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS60151712A (ja) * | 1984-01-19 | 1985-08-09 | Hitachi Ltd | 固定3次元視覚併用ロボットハンドリング装置 |
US20190015991A1 (en) * | 2016-09-28 | 2019-01-17 | Cognex Corporation | Simultaneous Kinematic and Hand-Eye Calibration |
CN110268358A (zh) * | 2017-02-09 | 2019-09-20 | 三菱电机株式会社 | 位置控制装置及位置控制方法 |
CN107160380A (zh) * | 2017-07-04 | 2017-09-15 | 华南理工大学 | 一种基于scara机械手的相机标定和坐标变换的方法 |
KR101964332B1 (ko) * | 2017-10-13 | 2019-07-31 | 재단법인대구경북과학기술원 | 핸드-아이 캘리브레이션 방법, 이를 실행하기 위한 컴퓨터 프로그램 및 로봇 시스템 |
CN108818536A (zh) * | 2018-07-12 | 2018-11-16 | 武汉库柏特科技有限公司 | 一种机器人手眼标定的在线偏移修正方法及装置 |
CN109159114A (zh) * | 2018-08-16 | 2019-01-08 | 郑州大学 | Scara机械手固定相机视觉***手眼标定的高精度方法 |
CN110355755A (zh) * | 2018-12-15 | 2019-10-22 | 深圳铭杰医疗科技有限公司 | 机器人手眼***标定方法、装置、设备及存储介质 |
CN109940626A (zh) * | 2019-01-23 | 2019-06-28 | 浙江大学城市学院 | 一种基于机器人视觉的画眉机器人***及其控制方法 |
CN110000790A (zh) * | 2019-04-19 | 2019-07-12 | 深圳科瑞技术股份有限公司 | 一种SCARA机器人eye-to-hand手眼***的标定方法 |
CN110103217A (zh) * | 2019-05-09 | 2019-08-09 | 电子科技大学 | 工业机器人手眼标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111823230B (zh) | 2022-01-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111801198B (zh) | 一种手眼标定方法、***及计算机存储介质 | |
CN110039542B (zh) | 具有速度方向控制的视觉伺服跟踪控制方法及机器人*** | |
WO2023193362A1 (zh) | 一种复合机器人和三维视觉的大型结构件自动焊接***及方法 | |
CN109483516B (zh) | 一种基于空间距离和极线约束的机械臂手眼标定方法 | |
CN107139178B (zh) | 一种无人机及其基于视觉的抓取方法 | |
CN109591011B (zh) | 复合材料三维结构件单边缝合激光视觉路径自动跟踪方法 | |
CN108436909A (zh) | 一种基于ros的相机和机器人的手眼标定方法 | |
CN113146620B (zh) | 基于双目视觉的双臂协作机器人***和控制方法 | |
CN114912287B (zh) | 基于目标6d位姿估计的机器人自主抓取仿真***及方法 | |
CN109291048B (zh) | 一种磨抛工业机器人实时在线编程***及方法 | |
CN113532318B (zh) | 使用多组激光跟踪仪进行定位的三维扫描***及方法 | |
CN110640738A (zh) | 一种动态捕捉的工业机器人平台 | |
CN109059755B (zh) | 一种机器人高精度手眼标定方法 | |
CN111823230B (zh) | 一种基于Scara机器人的非固定式手眼关系标定方法 | |
CN114670199A (zh) | 识别定位装置、***、实时跟踪*** | |
CN113706628A (zh) | 一种智能搬运机器人协作***及其对特征图像的处理方法 | |
CN110533727B (zh) | 一种基于单个工业相机的机器人自定位方法 | |
US20240001557A1 (en) | Robot and robot hand-eye calibrating method | |
CN215701709U (zh) | 一种可配置的手眼标定装置 | |
CN111283676B (zh) | 三轴机械臂的工具坐标系标定方法以及标定装置 | |
CN115409878A (zh) | 一种工件整理归位的ai算法 | |
CN114136239A (zh) | 一种用于舱段对接的在线非接触式测量方法 | |
CN114643577A (zh) | 一种通用型机器人视觉自动标定装置和方法 | |
CN208051932U (zh) | 一种蛇形机械臂的姿态获取*** | |
CN107538466B (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20220107 |