CN110465946A - 简易便捷的像素坐标与机器人坐标关系标定方法 - Google Patents
简易便捷的像素坐标与机器人坐标关系标定方法 Download PDFInfo
- Publication number
- CN110465946A CN110465946A CN201910765693.6A CN201910765693A CN110465946A CN 110465946 A CN110465946 A CN 110465946A CN 201910765693 A CN201910765693 A CN 201910765693A CN 110465946 A CN110465946 A CN 110465946A
- Authority
- CN
- China
- Prior art keywords
- image
- coordinate
- robot
- pixel
- 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
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
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
-
- 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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明提出了一种简易便捷的像素坐标与机器人坐标关系标定方法,包括:将标定完成的相机调整至垂直工作台面,并将标定板放置于工作台上,利用相机进行拍照;根据所述标定板的边长和相机拍照得到图像的边长像素数,计算比例因子s;根据拍照得到的多张图像计算标定板角点的平均像素位置,确定图像上参考坐标系RCimage的原点及坐标系姿态;确定标定板上参考坐标系RCcal原点位置和坐标系姿态在机器人基坐标下的表示。本发明标定原理简单,无需复杂的标定算法,过程中只需要按照工业机器人标定外部工具或工件的标定步骤进行操作即可,无需示教机器人运动到过多位置。
Description
技术领域
本发明涉及工业机器人技术领域,特别涉及一种简易便捷的像素坐标与机器人坐标关系标定方法。
背景技术
由相机和机器人组成的系统中包括几个重要的坐标系,坐标系的概念如下:
(1)像素坐标系:即一幅图像上以像素为单位,描述点的位置信息的坐标系;原点为图像左上角点;横纵坐标u,v以像素为单位。如图3所示。
(2)图像物理坐标系:在像素坐标系下建立的以物理单位(毫米、米等)表示的坐标系。原点位于主点,即图像平面的中心,图3的O1点。x,y分别与u,v平行。
(3)相机坐标系:以光心(即相机透镜的中心)为原点,Xc轴,Yc轴分别与图像的物理坐标系x,y轴平行,Zc轴与光轴重合,与图像平面垂直,如图4所示。
(4)机器人坐标系:即机器人的基坐标系,是机器人进行运动学解算的参考坐标系。机器人运动的目标点坐标便是以基坐标为参考表示。
当相机固定时,相机坐标系和机器人坐标系示意如图5所示。
该类系统很普遍的一个应用是通过相机拍照获取目标点的实际位置信息,并将位置信息发送给机器人,机器人运动到目标点进行某些操作。完成该过程的前提是获取图像的像素坐标系和机器人坐标系的关系baseHimage,然后通过相机获取目标点在图像中的位置信息,通过上述关系,得到目标点在机器人坐标系中的位置,最终发送给机器人控制机器人运动。
相机自身的参数被称为相机内参,包括焦距,主点位置,单个像素的物理大小等,这些参数是相机的固有属性,需要通过相机内参标定的算法进行校准。通过相机内参可以得到相机坐标系和像素坐标系的关系camHimage。经过调研,现有文献大部分是通过“手眼标定”的方法获取相机坐标系和机器人基坐标的关系baseHcam,则像素坐标系和机器人基坐标系之间的关系为:
baseHimage=baseHcam·camHimage。
因此大部分文献对如何进行手眼标定获取相机坐标系和机器人坐标系的关系进行了研究,而手眼标定问题大部分最终归于AX=XB方程中对X的求解,X为二者关系的齐次变换矩阵。Tsai R Y和Lenz R K基于特征向量对方程进行求解,并且通过误差模型的分析减小了标定误差;Daniilidis K和Bayro-Corrochano E通过对偶四元数对方程进行求解,获得了较好的标定结果;Strobl K H和Hirzinger G介绍了基于刚性变换和误差模型的非线性最优估计求解过程;杨世强通过保持旋转矩阵的恒定,简化了AX=XB的求解过程;王君臣和王田苗等介绍了一种基于最大似然估计的非线性最优算法,从新的角度解决了AX=XB的问题,解决了存在观测噪声时,如何最优的进行手眼标定;Ruland T和Pajdla T等人将手眼标定问题转化为分支定界参数空间搜索,从新的角度对手眼标定进行了求解;张召瑞和张旭等通过融合机器人手臂的旋转运动约束信息和纯平移运动约束信息,精确求得手眼变换矩阵各个参数,解决了AX=XB的系数矩阵不满秩情况无法求解的问题。
以上文献均是通过手眼标定求解相机坐标系和机器人基坐标的关系,进而求解像素坐标和机器人基坐标的关系。在对固定的相机进行手眼标定时,需将标定板固定在机器人的抓手上,机器人移动标定板到多个位置,获取机器人抓手位置并拍照获取图像,进而进行计算。该种方法存在以下问题:
(1)求解算法过于复杂,需通过多张图片和机器人多个位置求解,对标定算法的精度要求较高,算法的复杂性较高;
(2)标定过程复杂,需示教机器人移动到多个位置,获取对应位置包含标定板的图像,比较费时。
发明内容
本发明的目的旨在至少解决所述技术缺陷之一。
为此,本发明的目的在于提出一种简易便捷的像素坐标与机器人坐标关系标定方法。
为了实现上述目的,本发明的实施例提供一种简易便捷的像素坐标与机器人坐标关系标定方法,包括如下步骤:
步骤S1,将标定完成的相机调整至垂直工作台面,并将标定板放置于工作台上,利用相机进行拍照;
步骤S2,根据所述标定板的边长和相机拍照得到图像的边长像素数,计算比例因子s;
步骤S3,根据拍照得到的多张图像计算标定板角点的平均像素位置,确定图像上参考坐标系RCimage的原点及坐标系姿态;
步骤S4,确定标定板上参考坐标系RCcal原点位置和坐标系姿态在机器人基坐标下的表示。
进一步,在所述步骤S2中,采用如下方式计算比例因子s:
其中,dcal为标定板单元的边长为,dimage为图像中单元边长像素数。
进一步,在所述步骤S3中,
根据所述标定板角点的平均像素位置,设置参考坐标系的原点Oimage(xp,yp)为一个角点,指定在同一行的角点Cx为RCimageX轴上一点,指定在同一列的角点Cy为RCimage Y轴上一点,根据原点Oimage、Cx和Cy的位置确定RCimage坐标系的姿态,计算RCimage相对于像素坐标系的旋转矩阵Rimage,得到RCimage相对于图像的像素坐标系的齐次坐标变换:
最终确定得到参考坐标系RCimage。
进一步,在所述步骤S4中,
利用已标定的工具标定一个新的外部工具坐标系Ctool,获取Ctool的原点Ocal(x0,y0,z0)信息和描述姿态的RPY角序列得到旋转矩阵Rcal为:
由Ocal和Rcal得到标定板上的参考坐标系RCcal相对于机器人坐标系的齐次坐标变换矩阵:
进一步,设某点在RCimage中的坐标为(xi,yi),则对应RCcal中的坐标(xc,yc)为:
(xc,yc)=s(xi,yi)
因此,设某点在图像像素坐标系中的坐标为(xp,yp),则其在机器人坐标系下的表示为:
由此完成从像素坐标到机器人坐标的标定。
进一步,所述外部工具坐标系Ctool的原点与Oimage对应,Ctool的X,Y轴与RCimage的X,Y轴方向一致。
根据本发明实施例的简易便捷的像素坐标与机器人坐标关系标定方法,具有以下有益效果:
(1)标定原理简单,无需复杂的标定算法;
(2)标定过程简易便捷,过程中只需要按照工业机器人标定外部工具或工件的标定步骤进行操作即可,无需示教机器人运动到过多位置。
本发明附加的方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1为根据本发明实施例的简易便捷的像素坐标与机器人坐标关系标定方法的流程图;
图2为根据本发明实施例的标定板的示意图;
图3为根据本发明实施例的图像的像素坐标系和物理坐标系的示意图;
图4为根据本发明实施例的相机坐标系和图像平面的关系的示意图;
图5为根据本发明实施例的相机和机器人的位置关系的示意图;
图6为根据本发明实施例的确定的像素坐标系下参考坐标系的示意图;
图7为根据本发明实施例的标定中涉及的信息的示意图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
如图1所示,本发明实施例的简易便捷的像素坐标与机器人坐标关系标定方法,包括如下步骤:
步骤S1,将内参标定完成的相机调整至垂直工作台面,并将标定板放置于工作台上,利用相机进行多次拍照。图2为根据本发明实施例的标定板的示意图。
步骤S2,根据标定板的边长和相机拍照得到图像的边长像素数,计算比例因子s。
在步骤S2中,采用如下方式计算比例因子s:
其中,dcal为标定板单元的边长为,dimage为图像中单元边长像素数。
步骤S3,根据拍照得到的多张图像计算标定板角点的平均像素位置,确定图像上参考坐标系RCimage的原点及坐标系姿态。
通过获取的多张图像求得标定板角点的平均像素位置,设置参考坐标系的原点Oimage(xp,yp)为一个角点,指定在同一行的角点Cx为RCimage X轴上一点,指定在同一列的角点Cy为RCimageY轴上一点,根据图像中角点Oimage、Cx和Cy的位置确定RCimage坐标系的姿态,计算RCimage相对于像素坐标系的旋转矩阵Rimage,得到RCimage相对于图像的像素坐标系的齐次坐标变换:
最终确定得到参考坐标系RCimage。图6中示出参考坐标系RCimage的X轴和Y轴。
步骤S4,确定标定板上参考坐标系RCcal原点位置和坐标系姿态在机器人基坐标下的表示。
利用已标定的工具标定一个新的外部工具坐标系Ctool。如图7所示,外部工具坐标系Ctool的原点与Oimage对应,Ctool的X,Y轴与RCimage的X,Y轴方向一致。通过示教器读出获取Ctool的原点Ocal(x0,y0,z0)信息和描述姿态的四元数信息Qcal,将Qcal转化为姿态旋转矩阵Rcal。
获取Ctool的原点Ocal(x0,y0,z0)信息和描述姿态的RPY角序列得到旋转矩阵Rcal为:
由Ocal和Rcal得到标定板上的参考坐标系RCcal相对于机器人坐标系的齐次坐标变换矩阵:
由于相机垂直于工作台面,且标定板上的RCcal和RCimage姿态相同,因此RCimage中的坐标与RCcal坐标只差一个比例因子,设某点在RCimage中的坐标为(xi,yi),则对应RCcal中的坐标(xc,yc)为:
(xc,yc)=s(xi,yi)
因此,设某点在图像像素坐标系中的坐标为(xp,yp),则其在机器人坐标系下的表示为:
由此完成从像素坐标到机器人坐标的标定。
根据本发明实施例的简易便捷的像素坐标与机器人坐标关系标定方法,具有以下有益效果:
(1)标定原理简单,无需复杂的标定算法;
(2)标定过程简易便捷,过程中只需要按照工业机器人标定外部工具或工件的标定步骤进行操作即可,无需示教机器人运动到过多位置。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。本发明的范围由所附权利要求及其等同限定。
Claims (6)
1.一种简易便捷的像素坐标与机器人坐标关系标定方法,其特征在于,包括如下步骤:
步骤S1,将标定完成的相机调整至垂直工作台面,并将标定板放置于工作台上,利用相机进行拍照;
步骤S2,根据所述标定板的边长和相机拍照得到图像的边长像素数,计算比例因子s;
步骤S3,根据拍照得到的多张图像计算标定板角点的平均像素位置,确定图像上参考坐标系RCimage的原点及坐标系姿态;
步骤S4,确定标定板上参考坐标系RCcal原点位置和坐标系姿态在机器人基坐标下的表示。
2.如权利要求1所述的简易便捷的像素坐标与机器人坐标关系标定方法,其特征在于,在所述步骤S2中,采用如下方式计算比例因子s:
其中,dcal为标定板单元的边长为,dimage为图像中单元边长像素数。
3.如权利要求1所述的简易便捷的像素坐标与机器人坐标关系标定方法,其特征在于,在所述步骤S3中,
根据所述标定板角点的平均像素位置,设置参考坐标系的原点Oimage(xp,yp)为一个角点,指定在同一行的角点Cx为RCimageX轴上一点,指定在同一列的角点Cy为RCimageY轴上一点,根据原点Oimage、Cx和Cy的位置确定RCimage坐标系的姿态,计算RCimage相对于像素坐标系的旋转矩阵Rimage,得到RCimage相对于图像的像素坐标系的齐次坐标变换:
最终确定得到参考坐标系RCimage。
4.如权利要求1所述的简易便捷的像素坐标与机器人坐标关系标定方法,其特征在于,在所述步骤S4中,
利用已标定的工具标定一个新的外部工具坐标系Ctool,获取Ctool的原点Ocal(x0,y0,z0)信息和描述姿态的RPY角序列得到旋转矩阵Rcal为:
由Ocal和Rcal得到标定板上的参考坐标系RCcal相对于机器人坐标系的齐次坐标变换矩阵:
5.如权利要求4所述的简易便捷的像素坐标与机器人坐标关系标定方法,其特征在于,设某点在RCimage中的坐标为(xi,yi),则对应RCcal中的坐标(xc,yc)为:
(xc,yc)=s(xi,yi)
因此,设某点在图像像素坐标系中的坐标为(xp,yp),则其在机器人坐标系下的表示为:
由此完成从像素坐标到机器人坐标的标定。
6.如权利要求4所述的简易便捷的像素坐标与机器人坐标关系标定方法,其特征在于,所述外部工具坐标系Ctool的原点与Oimage对应,Ctool的X,Y轴与RCimage的X,Y轴方向一致。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910765693.6A CN110465946B (zh) | 2019-08-19 | 2019-08-19 | 一种像素坐标与机器人坐标关系标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910765693.6A CN110465946B (zh) | 2019-08-19 | 2019-08-19 | 一种像素坐标与机器人坐标关系标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110465946A true CN110465946A (zh) | 2019-11-19 |
CN110465946B CN110465946B (zh) | 2021-04-30 |
Family
ID=68511216
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910765693.6A Active CN110465946B (zh) | 2019-08-19 | 2019-08-19 | 一种像素坐标与机器人坐标关系标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110465946B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111597890A (zh) * | 2020-04-09 | 2020-08-28 | 上海电气集团股份有限公司 | 一种人姿估计坐标纠偏方法 |
CN113296395A (zh) * | 2021-05-14 | 2021-08-24 | 珞石(山东)智能科技有限公司 | 一种特定平面内的机器人手眼标定方法 |
CN113696190A (zh) * | 2021-10-28 | 2021-11-26 | 深圳市越疆科技有限公司 | 一种示教轨迹点采集方法、装置、机械臂、系统及介质 |
CN116787443A (zh) * | 2023-07-26 | 2023-09-22 | 中国科学院宁波材料技术与工程研究所 | 基于单位对偶四元数的并联机构运动学标定方法和系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070081714A1 (en) * | 2005-10-07 | 2007-04-12 | Wallack Aaron S | Methods and apparatus for practical 3D vision system |
CN105014678A (zh) * | 2015-07-16 | 2015-11-04 | 深圳市得意自动化科技有限公司 | 基于激光测距的机器人手眼标定方法 |
CN105234943A (zh) * | 2015-09-09 | 2016-01-13 | 大族激光科技产业集团股份有限公司 | 一种基于视觉识别的工业机器人示教装置及方法 |
CN109829953A (zh) * | 2019-02-27 | 2019-05-31 | 广东拓斯达科技股份有限公司 | 图像采集装置标定方法、装置、计算机设备和存储介质 |
CN109976344A (zh) * | 2019-03-30 | 2019-07-05 | 南京理工大学 | 巡检机器人姿态矫正方法 |
-
2019
- 2019-08-19 CN CN201910765693.6A patent/CN110465946B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070081714A1 (en) * | 2005-10-07 | 2007-04-12 | Wallack Aaron S | Methods and apparatus for practical 3D vision system |
CN105014678A (zh) * | 2015-07-16 | 2015-11-04 | 深圳市得意自动化科技有限公司 | 基于激光测距的机器人手眼标定方法 |
CN105234943A (zh) * | 2015-09-09 | 2016-01-13 | 大族激光科技产业集团股份有限公司 | 一种基于视觉识别的工业机器人示教装置及方法 |
CN109829953A (zh) * | 2019-02-27 | 2019-05-31 | 广东拓斯达科技股份有限公司 | 图像采集装置标定方法、装置、计算机设备和存储介质 |
CN109976344A (zh) * | 2019-03-30 | 2019-07-05 | 南京理工大学 | 巡检机器人姿态矫正方法 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111597890A (zh) * | 2020-04-09 | 2020-08-28 | 上海电气集团股份有限公司 | 一种人姿估计坐标纠偏方法 |
CN111597890B (zh) * | 2020-04-09 | 2024-04-09 | 上海电气集团股份有限公司 | 一种人姿估计坐标纠偏方法 |
CN113296395A (zh) * | 2021-05-14 | 2021-08-24 | 珞石(山东)智能科技有限公司 | 一种特定平面内的机器人手眼标定方法 |
CN113696190A (zh) * | 2021-10-28 | 2021-11-26 | 深圳市越疆科技有限公司 | 一种示教轨迹点采集方法、装置、机械臂、系统及介质 |
WO2023071481A1 (zh) * | 2021-10-28 | 2023-05-04 | 深圳市越疆科技有限公司 | 一种示教轨迹点采集方法、装置、机械臂、系统及介质 |
CN116787443A (zh) * | 2023-07-26 | 2023-09-22 | 中国科学院宁波材料技术与工程研究所 | 基于单位对偶四元数的并联机构运动学标定方法和系统 |
CN116787443B (zh) * | 2023-07-26 | 2023-11-21 | 中国科学院宁波材料技术与工程研究所 | 基于单位对偶四元数的并联机构运动学标定方法和系统 |
Also Published As
Publication number | Publication date |
---|---|
CN110465946B (zh) | 2021-04-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110465946A (zh) | 简易便捷的像素坐标与机器人坐标关系标定方法 | |
CN109658460A (zh) | 一种机械臂末端相机手眼标定方法和系统 | |
JP7237483B2 (ja) | ロボットシステムの制御方法、制御プログラム、記録媒体、制御装置、ロボットシステム、物品の製造方法 | |
CN111127568B (zh) | 一种基于空间点位信息的相机位姿标定方法 | |
CN111801198B (zh) | 一种手眼标定方法、系统及计算机存储介质 | |
CN106393174B (zh) | 一种利用球杆仪标定机器人结构参数的方法 | |
JP6108860B2 (ja) | ロボットシステム及びロボットシステムの制御方法 | |
CN111735479A (zh) | 一种多传感器联合标定装置及方法 | |
CN107808400B (zh) | 一种摄像机标定系统及其标定方法 | |
CN109910016A (zh) | 基于多自由度机械臂的视觉采集标定方法、装置及系统 | |
JP2020116734A (ja) | ロボットモーション用のビジョンシステムの自動ハンドアイ校正のためのシステム及び方法 | |
CN108436909A (zh) | 一种基于ros的相机和机器人的手眼标定方法 | |
WO2006077665A1 (ja) | 投影装置、投影装置の制御方法、複合投影システム、投影装置の制御プログラム、投影装置の制御プログラムが記録された記録媒体 | |
CN105835036B (zh) | 一种并联仿生眼装置及其控制方法 | |
CN110605714A (zh) | 一种基于人眼凝视点的手眼协调抓取方法 | |
JP2019030943A (ja) | キャリブレーション方法、キャリブレーションシステム及びプログラム | |
CN109442171A (zh) | 一种单目立体视觉系统及其使用方法 | |
CN111823233B (zh) | 基于高精度立体光学定位的机械臂手眼标定系统及方法 | |
CN109807937A (zh) | 一种基于自然场景的机器人手眼标定方法 | |
WO2021184890A1 (zh) | 治疗设备及其配准方法、配准装置 | |
JP2019089180A (ja) | ロボット及びロボットシステム | |
JP2001074428A (ja) | 形状測定装置の校正方法及び校正治具 | |
CN109284407B (zh) | 一种用于智能售货柜训练自动标注数据集的装置 | |
CN114833832B (zh) | 一种机器人手眼标定方法、装置、设备及可读存储介质 | |
CN111098306A (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 |