CN109443207A - 一种光笔式机器人原位测量系统与方法 - Google Patents
一种光笔式机器人原位测量系统与方法 Download PDFInfo
- Publication number
- CN109443207A CN109443207A CN201811377538.9A CN201811377538A CN109443207A CN 109443207 A CN109443207 A CN 109443207A CN 201811377538 A CN201811377538 A CN 201811377538A CN 109443207 A CN109443207 A CN 109443207A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- light pen
- workpiece
- probe
- robot
- 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 28
- 238000012625 in-situ measurement Methods 0.000 title claims abstract description 15
- 239000000523 sample Substances 0.000 claims abstract description 65
- 238000005259 measurement Methods 0.000 claims abstract description 37
- 230000003287 optical effect Effects 0.000 claims description 45
- 239000011159 matrix material Substances 0.000 claims description 28
- 230000009466 transformation Effects 0.000 claims description 22
- 230000008569 process Effects 0.000 claims description 9
- 238000013519 translation Methods 0.000 claims description 8
- 238000011065 in-situ storage Methods 0.000 claims description 5
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000004891 communication Methods 0.000 claims description 2
- 230000001960 triggered effect Effects 0.000 claims description 2
- 230000009471 action Effects 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000003754 machining Methods 0.000 description 3
- 230000000007 visual effect Effects 0.000 description 3
- 230000006872 improvement Effects 0.000 description 2
- 238000000691 measurement method Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000012958 reprocessing Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 238000003384 imaging method Methods 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
- 238000012805 post-processing Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/002—Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明属于精密测量的领域,并具体公开了光笔式机器人原位测量系统与方法。该系统主要包括工业机器人、光笔测量单元、双目视觉单元和工业计算机,在光笔测量单元中设置有光笔、探针、弹簧和力传感器。采用工业机器人夹持光笔测量单元按照规划的路径运动,使得探针在弹簧的作用下与被测工件柔性接触,同时采用双目视觉单元按照设定的帧率实时采集光笔图像,传输到工业计算机中进行图像处理,运用双目视觉三维重建原理计算光笔上探针球心的位置,并在此基础上基于力传感器采集的接触力合力方向进行探针球头半径误差补偿,进而获得工件表面的测量结果。本发明中光笔测量单元按照规划的路径进行自动化测量,有效地提高了轮廓测量的效率和精度。
Description
技术领域
本发明属于精密测量领域,更具体地,涉及一种光笔式机器人原位测量系统与方法。
背景技术
产品型面尺寸测量是产品生产过程中非常重要的一个环节,目前工业中常采用三坐标测量机进行测量。三坐标测量机具有测量精度高、范围广的特点,但是三坐标测量机由于具有精密的运动平台和光栅单元,需要安放在恒温恒湿的洁净室中,工件的测量必须经过“加工-拆卸-装夹-测量-拆卸-装夹-再加工”几个过程,使得测量和再加工过程中不可避免的会引入二次装夹误差,这不仅降低了工件的加工精度,还严重影响了加工效率。除了传统的接触式测量之外,采用激光和结构光等视觉测量方法可以实现工件的原位测量,能显著提高测量效率,快速获得大量的点云特征数据,但是视觉测量方法对于隐性特征如孔、槽等也无法实现精确测量,无法精确获得单个特征点的三维坐标,无法适用于曲面的反光部分的测量,而且采集到的大量点云数据会导致计算复杂。
近几年的研究中,国内外研究人员将接触式测量和视觉非接触式测量结合起来,采用手持光笔式测量实现零件的快速精确测量。光笔式测量即在接触式探针上设置特征点,采用视觉的方式捕捉特征点的位置,从而建立光笔坐标系,通过标定即可得到探针中心相对于光笔坐标系的位置。采用这种方法既可以实现零件各种特征的测量,还能有效较少测量数据量,提高测量效率。国内相关方面的研究较多,专利CN1570547A(天津大学)提出了一种光笔式测量单元,设计了包含3个光靶标的光笔,采用单目视觉和计算机单元实现光笔的位姿反馈,其光笔上探针球心与光靶标的圆心在同一个直线上;专利CN105423912A提出了基于精密二轴转台的光笔跟踪单元,采用单目视觉和计算机单元实现光笔的位姿反馈,并通过计算机控制二轴精密转台运动,增大相机的测量范围。
上述光笔式测量的专利均采用手持的方式使光笔与工件接触,触发单目视觉相机采集图片,通过透视成像原理计算探针球心的位置。该方案需要对光笔上的特征点的位置关系进行精确标定才能实现透视变换计算,且采用人工手持的测量方式根据人的经验选点测量,无法对工件表面的特征进行合理测量,尤其是针对复杂曲面类零件的测量,合理的规划测量路径是提高测量精度和效率的关键步骤之一。
发明内容
针对现有技术的以上缺陷或改进需求,本发明提供了一种光笔式机器人原位测量系统与方法,其目的在于,通过将光笔设于工业机器人末端,并通过双目视觉单元实时进行坐标采集和变换,实现光笔的测量轨迹控制,由此避免了个人经验带来的测量误差,即使针对复杂曲面类零件也能够实现合理的路径规划,同时提升测量效率。
为实现上述目的,按照本发明的一个方面,提供了一种一种光笔式机器人原位测量系统,包括:工业机器人、光笔测量单元、双目视觉单元和工业计算机;
工业机器人用于夹持并带动光笔测量单元运动;
光笔测量单元包括力传感器、光笔和探针;力传感器固定于工业机器人末端,用于检测探针与工件的接触力信号,并将接触力信号传输至工业计算机;光笔一端直接或间接连接力传感器,另一端固定探针,光笔上设置有特征圆,用于确定光笔坐标系;
双目视觉单元包含两个工业相机,两个工业相机同步触发,并与工业计算机实时通讯;两个工业相机用于按照设定的帧率同步采集光笔的图像,并传输至工业计算机;
工业计算机用于根据接收到的光笔图像进行特征圆的坐标提取并完成光笔与探针的三维重建、根据接收到的接触力信号确定探针球心坐标的半径补偿向量的方向,以及根据被测工件拟合工业机器人运动轨迹规划,驱动工业机器人带动光笔测量单元运动完成工件原位测量。
进一步地,光笔测量单元还包括:法兰、挡圈、滑块、导槽、弹簧和导杆;
法兰安装在工业机器人末端;力传感器安装在法兰与挡圈之间,通过法兰连接工业机器人;滑块设于导槽内部并能够沿导槽前后滑动,导槽的后端固定在挡圈上;导杆的后端从导槽前端插入导槽内部,并与滑块连接;光笔固定于导杆前端,探针固定于光笔前端;滑块与导槽的前端内壁面之间,以及导杆的前端凸台与导槽的前端外壁面之间的至少一处设有弹簧,以使探针与工件表面柔性接触。
为了实现上述目的,本发明还提供了一种基于上述光笔式机器人原位测量系统对工件进行原位测量的方法,包括以下步骤:
S1:对工业机器人末端的光笔坐标系进行标定,计算出光笔坐标系相对于机器人坐标系的变换矩阵;在被测工件上选取特征点,对工件坐标系进行标定,计算出工件坐标系相对于机器人坐标系的变换矩阵;从而获得工件坐标系到光笔坐标系的变换关系;
S2:使用标定好的两个工业相机拍摄光笔图像并传输到工业计算机,分别计算两幅图像中各个特征圆和探针球头圆轮廓的中心点坐标,进而求出特征圆和探针球头圆心点在世界坐标系中的三维坐标;随后,通过拟合特征圆圆心建立光笔坐标系,计算出世界坐标系到光笔坐标系的变换矩阵,并确定探针球心在光笔坐标系中的位置;
在工件坐标系上寻找正交的特征平面,在平面上分别贴上靶点,用两个工业相机采集靶点图片并按照上述计算圆心点坐标的过程计算靶点的三维坐标,并拟合建立工件坐标系,计算世界坐标系到工件坐标系的变换矩阵,进而结合世界坐标系到光笔坐标系的变换矩阵获得光笔坐标系到工件坐标系的变换矩阵;
S3:在工业计算机上设定被测工件的测量轨迹,并将工件坐标系中测量轨迹上的离散坐标点按照步骤S1获得的变换关系变换到光笔坐标系中,光笔坐标系中的离散坐标点即为工业机器人的测量路径,根据工业机器人的运行轨迹生成机器人的运动控制程序,驱动工业机器人按照测量路径运动,以使探针与被测工件接触,进行原位测量。
进一步地,步骤S1包括如下步骤:
对工业机器人末端的光笔坐标系o1-x1y1z1进行标定,计算出光笔坐标系o1-x1y1z1相对于机器人坐标系oR-xRyRzR的变换矩阵则:
其中,分别为光笔坐标系相对于机器人坐标系的旋转矩阵和平移矩阵;
在被测工件上选取特征点,对工件坐标系o0-x0y0z0进行标定,计算出工件坐标系o0-x0y0z0相对于机器人坐标系oR-xRyRzR的变换矩阵则:
其中,分别为工件坐标系相对于机器人坐标系的旋转矩阵和平移矩阵;
从而获得工件坐标系o0-x0y0z0到光笔坐标系o1-x1y1z1的变换关系为:
进一步地,步骤S2包括如下步骤:
使用标定好的工业相机拍摄光笔图像并传输到工业计算机,提取特征圆轮廓和探针球头的圆形轮廓,分别计算左右两个工业相机所获取的两幅图像中各个圆轮廓的中心点坐标(uL,vL)和(uR,vR);
根据双目视觉投影原理可得:
d=(uL-uR)s (7)
其中,Tx表示左右相机之间的距离,(u0,v0)表示相机图像坐标系原点在像素坐标系中的位置,s表示单个图像像素所表示的物理尺寸,d为各圆形轮廓的圆心在两幅图像像素坐标系中的视差,(x,y)表示圆心在左图图像坐标系下的坐标值,f表示相机的焦距,(cx,cy)表示左图中的光心位置;
根据式(4)~(7)可得:
则圆心点在世界坐标系中的三维坐标(xw,yw,zw)可表示为
(xw,yw,zw)=(X/W,Y/W,Z/W) (9)
根据公式(4)~(9)对光笔上的特征圆和探针球头进行三维重建,得到圆心的三维坐标;通过拟合特征圆的圆心建立光笔坐标系o1-x1y1z1,计算世界坐标系ow-xwywzw到光笔坐标系o1-x1y1z1的变换矩阵并确定探针球心在光笔坐标系中的位置,则有:
其中,分别为世界坐标系到光笔坐标系的旋转矩阵和平移矩阵;
在工件坐标系上寻找正交的特征平面,在特征平面上分别设置靶点,用两个工业相机采集图片并按照上述计算圆心点坐标的过程计算靶点的三维坐标,通过拟合建立工件坐标系o0-x0y0z0,计算世界坐标系ow-xwywzw到工件坐标系o0-x0y0z0的变换矩阵则有:
其中,分别为世界坐标系到工件坐标系的旋转矩阵和平移矩阵;
因此光笔坐标系o1-x1y1z1到工件坐标系o0-x0y0z0的转换关系为:
进一步地,步骤S3中还包括如下半径补偿步骤:
探针与被测工件的接触力采用力传感器采集并上传至工业计算机;使用标定好的两个工业相机按照设定好的帧率实时采集光笔图像,反馈给工业计算机;按照S2的方法拟合建立光笔坐标系并计算探针球心的位置,并在探针球心坐标上增加一个半径补偿向量的大小等于探针的球头半径,的方向为力传感器所采集到的当前时刻的接触力合力方向;补偿后的结果为被测工件表面在光笔坐标系中的实际坐标,将该坐标转换到工件坐标系,即获得最终的测量结果。
总体而言,通过本发明所构思的以上技术方案与现有技术相比,能够取得下列有益效果:
1、本发明通过将光笔式测量安装到工业机器人末端,使光笔式测量能按照预定的测量路径对工件进行测量,实现了高度自动化,相对于传统的手动测量,具有更高的测量精度;
2、本发明通过在光笔测量单元中设置弹簧,使得探针与工件表面的柔性接触,既能满足实时接触的测量需求,又不会对工件表面产生破坏;
3、本发明通过双目视觉对探针球心的位置进行标定,具有更高的标定精度和效率;
4、本发明通过力传感器采集探针与工件的接触力,基于力信息进行探针球头半径误差补偿,具有更高的测量精度。
附图说明
图1是本发明优选实施例的光笔式机器人原位测量系统简图;
图2是本发明优选实施例的光笔结构示意图;
图3是本发明的三个坐标系的转换关系示意图;
图4是双目视觉投影原理图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
如图1所示,本发明实施例提供的光笔式机器人原位测量系统包括工业机器人1、光笔测量单元2、双目视觉单元和工业计算机4,其中:
如图2所示,光笔测量单元2包括法兰5、力传感器6、挡圈7、滑块8、导槽9、弹簧10、导杆11、光笔12和探针13,其中,法兰5安装在工业机器人1末端,力传感器6安装在法兰5与挡圈7之间,挡圈7和导槽9通过螺钉连接,其中的圆柱形空间供滑块8滑动,滑块8与导杆11通过螺纹连接,滑块8、导杆11和导槽9之间设置有两段弹簧10,光笔12安装在导杆11上,其上设置有特征圆,光笔12上安装有探针13。双目视觉单元包含两个工业相机3,两个工业相机3之间实现了同步触发,并与工业计算机4实时通讯。测量工件如叶片时,在工业计算机4上进行工件测量轨迹规划,并生成工业机器人1的运动控制程序,工业机器人1夹持光笔测量单元2按照规划的路径运动,使得探针13与工件接触,同时采用双目视觉单元按照设定的帧率同步采集光笔12的图像,在工业计算机4上完成图像处理、特征圆坐标提取、三维重建和数据后处理。
由于工业机器人1末端重复精度不高,且标定过程也存在一定的误差,不可能使规划的轨迹能与被测工件表面完全重合,因此为了避免探针13与被测工件接触不上或者划伤工件,在导杆11、滑块8和导槽9之间设置了两段弹簧10,探针13与被测工件接触后,在弹簧10作用下推动导杆11和滑块8在导槽9中滑动,保证探针13与被测工件稳定接触。
进一步的,本发明还提供了光笔式机器人原位测量系统的方法,包括以下步骤:
S1:如图3所示,在工业机器人1的工作空间内设置标定杆,采用四点法对所述工业机器人末端的光笔坐标系o1-x1y1z1进行标定,计算出光笔坐标系o1-x1y1z1相对于机器人坐标系oR-xRyRzR的变换矩阵则
并在被测工件上找特征点,采用四点法对工件坐标系o0-x0y0z0进行标定,计算出工件坐标系o0-x0y0z0相对于机器人坐标系oR-xRyRzR的变换矩阵则
因此工件坐标系o0-x0y0z0到光笔坐标系o1-x1y1z1的变换关系为
S2:使用标定好的工业相机3拍摄光笔12图像,将图像传输到工业计算机3,进行立体校正和图像处理,提取特征圆轮廓和探针球头的圆形轮廓,分别计算两幅图像中各个圆轮廓的中心点坐标(uL,vL)和(uR,vR)。
如图4所示,根据双目视觉投影原理可得
d=(uL-uR)s (7)
其中,Tx表示左右相机之间的距离,(u0,v0)表示相机图像坐标系原点在像素坐标系中的位置,s表示单个图像像素所表示的物理尺寸,d为圆心在两幅图像像素坐标系中的视差,(x,y)表示圆心在左图图像坐标系下的坐标值,f表示相机的焦距,(cx,cy)表示左图中的光心位置。
根据上式可得
则圆心点在世界坐标系中的三维坐标(xw,yw,zw)可表示为
(xw,yw,zw)=(X/W,Y/W,Z/W) (9)
通过上述过程分别对光笔12上的特征圆和探针球头进行三维重建,得到圆心的三维坐标。通过拟合特征圆圆心建立光笔坐标系o1-x1y1z1,计算世界坐标系ow-xwywzw到光笔坐标系o1-x1y1z1的变换矩阵并确定探针13球心在光笔坐标系中的位置。则有
在工件坐标系上寻找正交的特征平面,在平面上分别贴上靶点,用两个工业相机3采集图片并按照上述过程计算靶点的三维坐标,通过拟合建立工件坐标系o0-x0y0z0,计算世界坐标系ow-xwywzw到工件坐标系o0-x0y0z0的变换矩阵则有
因此光笔坐标系o1-x1y1z1到工件坐标系o0-x0y0z0的转换关系为
S3:在工业计算机4上设定被测工件的测量轨迹,并将工件坐标系o0-x0y0z0中测量轨迹上的离散坐标点采用S1所述方法变换到光笔坐标系o1-x1y1z1中,光笔坐标系o1-x1y1z1中的离散坐标点即为工业机器人1需要运行的轨迹,采用工业机器人1后处理软件生成机器人的运动控制程序,驱动工业机器人1按照测量路径运动,探针13在弹簧10作用下与被测工件柔性稳定接触,探针13与被测工件的接触力采用力传感器6采集。
使用标定好的两个工业相机3按照设定好的帧率实时采集光笔图像,反馈给工业计算机4,按照S2所述的方法拟合建立光笔坐标系o1-x1y1z1并计算探针13球心的位置,在探针13球心坐标上增加一个半径补偿向量 的大小等于探针13的球头半径,方向为力传感器6所采集到的当前时刻的接触力合力方向,则补偿后的结果为被测工件表面在光笔坐标系中的实际坐标,将该坐标值转换到工件坐标系o0-x0y0z0,即为最终的测量结果。
总而言之,本发明采用工业机器人夹持光笔测量单元,按照规划好的测量路径运动,使探针与工件稳定接触,同时采用双目视觉单元反馈光笔的位置,通过设置在光笔测量单元中的力传感器采集探针与工件的接触力,基于力信息进行探针误差的补偿,本发明能够实现高效、高精度的三维尺寸测量。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.一种光笔式机器人原位测量系统,其特征在于,包括:工业机器人(1)、光笔测量单元(2)、双目视觉单元(3)和工业计算机(4);
工业机器人(1)用于夹持并带动光笔测量单元(2)运动;
光笔测量单元(2)包括力传感器(6)、光笔(12)和探针(13);力传感器(6)固定于工业机器人(1)末端,用于检测探针(13)与工件的接触力信号,并将接触力信号传输至工业计算机(4);光笔(12)一端直接或间接连接力传感器(6),另一端固定探针(13),光笔上设置有特征圆,用于确定光笔坐标系;
双目视觉单元(3)包含两个工业相机,两个工业相机同步触发,并与工业计算机(4)实时通讯;两个工业相机用于按照设定的帧率同步采集光笔(12)的图像,并传输至工业计算机(4);
工业计算机(4)用于根据接收到的光笔图像进行特征圆的坐标提取并完成光笔与探针的三维重建、根据接收到的接触力信号确定探针(13)球心坐标的半径补偿向量的方向,以及根据被测工件拟合工业机器人(1)运动轨迹规划,驱动工业机器人(1)带动光笔测量单元(2)运动完成工件原位测量。
2.如权利要求1所述的一种光笔式机器人原位测量系统,其特征在于,光笔测量单元(2)还包括:法兰(5)、挡圈(7)、滑块(8)、导槽(9)、弹簧(10)和导杆(11);
法兰(5)安装在工业机器人(4)末端;力传感器(6)安装在法兰(5)与挡圈(7)之间,通过法兰(5)连接工业机器人(4);滑块(8)设于导槽(9)内部并能够沿导槽(9)前后滑动,导槽(9)的后端固定在挡圈(7)上;导杆(11)的后端从导槽(9)前端插入导槽(9)内部,并与滑块(8)连接;光笔(12)固定于导杆(11)前端,探针(13)固定于光笔(12)前端;滑块(8)与导槽(9)的前端内壁面之间,以及导杆(11)的前端凸台与导槽(9)的前端外壁面之间的至少一处设有弹簧(10),以使探针(13)与工件表面柔性接触。
3.一种基于权利要求1或2所述的光笔式机器人原位测量系统对工件进行原位测量的方法,其特征在于,包括以下步骤:
S1:对工业机器人末端的光笔坐标系进行标定,计算出光笔坐标系相对于机器人坐标系的变换矩阵;在被测工件上选取特征点,对工件坐标系进行标定,计算出工件坐标系相对于机器人坐标系的变换矩阵;从而获得工件坐标系到光笔坐标系的变换关系;
S2:使用标定好的两个工业相机拍摄光笔图像并传输到工业计算机,分别计算两幅图像中各个特征圆和探针球头圆轮廓的中心点坐标,进而求出特征圆和探针球头圆心点在世界坐标系中的三维坐标;随后,通过拟合特征圆圆心建立光笔坐标系,计算出世界坐标系到光笔坐标系的变换矩阵,并确定探针球心在光笔坐标系中的位置;
在工件坐标系上寻找正交的特征平面,在平面上分别贴上靶点,用两个工业相机采集靶点图片并按照上述计算圆心点坐标的过程计算靶点的三维坐标,并拟合建立工件坐标系,计算世界坐标系到工件坐标系的变换矩阵,进而结合世界坐标系到光笔坐标系的变换矩阵获得光笔坐标系到工件坐标系的变换矩阵;
S3:在工业计算机上设定被测工件的测量轨迹,并将工件坐标系中测量轨迹上的离散坐标点按照步骤S1获得的变换关系变换到光笔坐标系中,光笔坐标系中的离散坐标点即为工业机器人的测量路径,根据工业机器人的运行轨迹生成机器人的运动控制程序,驱动工业机器人按照测量路径运动,以使探针与被测工件接触,进行原位测量。
4.如权利要求3所述的方法,其特征在于,步骤S1包括如下步骤:
对工业机器人末端的光笔坐标系o1-x1y1z1进行标定,计算出光笔坐标系o1-x1y1z1相对于机器人坐标系oR-xRyRzR的变换矩阵则:
其中,分别为光笔坐标系相对于机器人坐标系的旋转矩阵和平移矩阵;
在被测工件上选取特征点,对工件坐标系o0-x0y0z0进行标定,计算出工件坐标系o0-x0y0z0相对于机器人坐标系oR-xRyRzR的变换矩阵则:
其中,分别为工件坐标系相对于机器人坐标系的旋转矩阵和平移矩阵;
从而获得工件坐标系o0-x0y0z0到光笔坐标系o1-x1y1z1的变换关系为:
5.如权利要求3所述的方法,其特征在于,步骤S2包括如下步骤:
使用标定好的工业相机拍摄光笔图像并传输到工业计算机,提取特征圆轮廓和探针球头的圆形轮廓,分别计算左右两个工业相机所获取的两幅图像中各个圆轮廓的中心点坐标(uL,vL)和(uR,vR);
根据双目视觉投影原理可得:
d=(uL-uR)s (7)
其中,Tx表示左右相机之间的距离,(u0,v0)表示相机图像坐标系原点在像素坐标系中的位置,s表示单个图像像素所表示的物理尺寸,d为各圆形轮廓的圆心在两幅图像像素坐标系中的视差,(x,y)表示圆心在左图图像坐标系下的坐标值,f表示相机的焦距,(cx,cy)表示左图中的光心位置;
根据式(4)~(7)可得:
则圆心点在世界坐标系中的三维坐标(xw,yw,zw)可表示为
(xw,yw,zw)=(X/W,Y/W,Z/W) (9)
根据公式(4)~(9)对光笔上的特征圆和探针球头进行三维重建,得到圆心的三维坐标;通过拟合特征圆的圆心建立光笔坐标系o1-x1y1z1,计算世界坐标系ow-xwywzw到光笔坐标系o1-x1y1z1的变换矩阵并确定探针球心在光笔坐标系中的位置,则有:
其中,分别为世界坐标系到光笔坐标系的旋转矩阵和平移矩阵;
在工件坐标系上寻找正交的特征平面,在特征平面上分别设置靶点,用两个工业相机采集图片并按照上述计算圆心点坐标的过程计算靶点的三维坐标,通过拟合建立工件坐标系o0-x0y0z0,计算世界坐标系ow-xwywzw到工件坐标系o0-x0y0z0的变换矩阵则有:
其中,分别为世界坐标系到工件坐标系的旋转矩阵和平移矩阵;
因此光笔坐标系o1-x1y1z1到工件坐标系o0-x0y0z0的转换关系为:
6.如权利要求3~5任意一项所述的方法,其特征在于,步骤S3中还包括如下半径补偿步骤:
探针与被测工件的接触力采用力传感器采集并上传至工业计算机;使用标定好的两个工业相机按照设定好的帧率实时采集光笔图像,反馈给工业计算机;按照S2的方法拟合建立光笔坐标系并计算探针球心的位置,并在探针球心坐标上增加一个半径补偿向量 的大小等于探针的球头半径,的方向为力传感器所采集到的当前时刻的接触力合力方向;补偿后的结果为被测工件表面在光笔坐标系中的实际坐标,将该坐标转换到工件坐标系,即获得最终的测量结果。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811377538.9A CN109443207B (zh) | 2018-11-19 | 2018-11-19 | 一种光笔式机器人原位测量系统与方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811377538.9A CN109443207B (zh) | 2018-11-19 | 2018-11-19 | 一种光笔式机器人原位测量系统与方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109443207A true CN109443207A (zh) | 2019-03-08 |
CN109443207B CN109443207B (zh) | 2019-10-08 |
Family
ID=65554605
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811377538.9A Active CN109443207B (zh) | 2018-11-19 | 2018-11-19 | 一种光笔式机器人原位测量系统与方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109443207B (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111035454A (zh) * | 2019-12-26 | 2020-04-21 | 苏州微创畅行机器人有限公司 | 可读存储介质以及手术机器人 |
CN111238999A (zh) * | 2020-01-08 | 2020-06-05 | 王盛麟 | 一种基于机器视觉的探针与试样表面接触时机检测方法及系统 |
CN111409075A (zh) * | 2020-04-22 | 2020-07-14 | 无锡中车时代智能装备有限公司 | 简单方便的机器人手眼标定系统和标定方法 |
CN111750776A (zh) * | 2020-06-22 | 2020-10-09 | 新拓三维技术(深圳)有限公司 | 一种检具测量方法、测量装置及探针光笔结构 |
CN112184653A (zh) * | 2020-09-23 | 2021-01-05 | 之江实验室 | 一种基于双目内窥镜的病灶三维尺寸测量及显示方法 |
CN113126024A (zh) * | 2019-12-31 | 2021-07-16 | 广东博智林机器人有限公司 | 坐标转换方法、设备及设备终端、定位基站、存储介质 |
CN113670203A (zh) * | 2021-08-26 | 2021-11-19 | 天津大学 | 一种pnp算法结合接触式测量的螺纹孔中心定位装置及方法 |
CN113916128A (zh) * | 2021-10-11 | 2022-01-11 | 齐鲁工业大学 | 一种基于光笔式视觉测量系统的提高精度的方法 |
CN114088012A (zh) * | 2022-01-20 | 2022-02-25 | 杭州思看科技有限公司 | 测量装置的补偿方法、装置、三维扫描系统和存储介质 |
CN114353693A (zh) * | 2021-12-28 | 2022-04-15 | 中国航空工业集团公司北京长城航空测控技术研究所 | 一种大尺度三维空间整体测量定位仪专用手持矢量杆 |
CN114674222A (zh) * | 2022-02-17 | 2022-06-28 | 成都飞机工业(集团)有限责任公司 | 一种飞机复材部件与成型工装坐标系对齐方法 |
CN114963988A (zh) * | 2022-06-10 | 2022-08-30 | 南京工程学院 | 一种用于高精度大范围测量的光笔测量系统及测量方法 |
CN115235340A (zh) * | 2022-07-14 | 2022-10-25 | 河南埃尔森智能科技有限公司 | 一种臂载式视觉传感器快速校正方法 |
CN116558425A (zh) * | 2023-07-12 | 2023-08-08 | 无锡万耐特自动化设备股份公司 | 一种雨刮器非接触光学镜头自动检测装置及其检测方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH04120614A (ja) * | 1990-09-11 | 1992-04-21 | Nec Gumma Ltd | 座標指示ペン |
JPH10269007A (ja) * | 1997-03-26 | 1998-10-09 | Seiko Epson Corp | 筆記具型座標入力装置 |
CN201120528Y (zh) * | 2007-12-04 | 2008-09-24 | 深圳市星辰激光技术有限公司 | 激光标刻机辅助对焦装置 |
CN107610178A (zh) * | 2017-07-27 | 2018-01-19 | 北京航天计量测试技术研究所 | 一种工业摄影测量系统相机参数移动式标定方法 |
CN107756408A (zh) * | 2017-11-22 | 2018-03-06 | 浙江优迈德智能装备有限公司 | 一种基于主动红外双目视觉的机器人轨迹示教装置及方法 |
-
2018
- 2018-11-19 CN CN201811377538.9A patent/CN109443207B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH04120614A (ja) * | 1990-09-11 | 1992-04-21 | Nec Gumma Ltd | 座標指示ペン |
JPH10269007A (ja) * | 1997-03-26 | 1998-10-09 | Seiko Epson Corp | 筆記具型座標入力装置 |
CN201120528Y (zh) * | 2007-12-04 | 2008-09-24 | 深圳市星辰激光技术有限公司 | 激光标刻机辅助对焦装置 |
CN107610178A (zh) * | 2017-07-27 | 2018-01-19 | 北京航天计量测试技术研究所 | 一种工业摄影测量系统相机参数移动式标定方法 |
CN107756408A (zh) * | 2017-11-22 | 2018-03-06 | 浙江优迈德智能装备有限公司 | 一种基于主动红外双目视觉的机器人轨迹示教装置及方法 |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111035454B (zh) * | 2019-12-26 | 2021-09-10 | 苏州微创畅行机器人有限公司 | 可读存储介质以及手术机器人 |
US11690681B2 (en) | 2019-12-26 | 2023-07-04 | Suzhou MicroPort Orthobot Co., Ltd. | Method for bone registration and surgical robot |
CN111035454A (zh) * | 2019-12-26 | 2020-04-21 | 苏州微创畅行机器人有限公司 | 可读存储介质以及手术机器人 |
WO2021128755A1 (zh) * | 2019-12-26 | 2021-07-01 | 苏州微创畅行机器人有限公司 | 骨注册方法、手术机器人及可读存储介质 |
CN113126024A (zh) * | 2019-12-31 | 2021-07-16 | 广东博智林机器人有限公司 | 坐标转换方法、设备及设备终端、定位基站、存储介质 |
CN111238999A (zh) * | 2020-01-08 | 2020-06-05 | 王盛麟 | 一种基于机器视觉的探针与试样表面接触时机检测方法及系统 |
CN111409075A (zh) * | 2020-04-22 | 2020-07-14 | 无锡中车时代智能装备有限公司 | 简单方便的机器人手眼标定系统和标定方法 |
CN111750776A (zh) * | 2020-06-22 | 2020-10-09 | 新拓三维技术(深圳)有限公司 | 一种检具测量方法、测量装置及探针光笔结构 |
CN112184653A (zh) * | 2020-09-23 | 2021-01-05 | 之江实验室 | 一种基于双目内窥镜的病灶三维尺寸测量及显示方法 |
CN113670203A (zh) * | 2021-08-26 | 2021-11-19 | 天津大学 | 一种pnp算法结合接触式测量的螺纹孔中心定位装置及方法 |
CN113670203B (zh) * | 2021-08-26 | 2022-07-22 | 天津大学 | 一种pnp算法结合接触式测量的螺纹孔中心定位装置及方法 |
CN113916128A (zh) * | 2021-10-11 | 2022-01-11 | 齐鲁工业大学 | 一种基于光笔式视觉测量系统的提高精度的方法 |
CN114353693A (zh) * | 2021-12-28 | 2022-04-15 | 中国航空工业集团公司北京长城航空测控技术研究所 | 一种大尺度三维空间整体测量定位仪专用手持矢量杆 |
CN114353693B (zh) * | 2021-12-28 | 2023-11-28 | 中国航空工业集团公司北京长城航空测控技术研究所 | 一种大尺度三维空间整体测量定位仪专用手持矢量杆 |
CN114088012A (zh) * | 2022-01-20 | 2022-02-25 | 杭州思看科技有限公司 | 测量装置的补偿方法、装置、三维扫描系统和存储介质 |
CN114674222A (zh) * | 2022-02-17 | 2022-06-28 | 成都飞机工业(集团)有限责任公司 | 一种飞机复材部件与成型工装坐标系对齐方法 |
CN114963988A (zh) * | 2022-06-10 | 2022-08-30 | 南京工程学院 | 一种用于高精度大范围测量的光笔测量系统及测量方法 |
CN115235340A (zh) * | 2022-07-14 | 2022-10-25 | 河南埃尔森智能科技有限公司 | 一种臂载式视觉传感器快速校正方法 |
CN115235340B (zh) * | 2022-07-14 | 2024-07-26 | 河南埃尔森智能科技有限公司 | 一种臂载式视觉传感器快速校正方法 |
CN116558425A (zh) * | 2023-07-12 | 2023-08-08 | 无锡万耐特自动化设备股份公司 | 一种雨刮器非接触光学镜头自动检测装置及其检测方法 |
CN116558425B (zh) * | 2023-07-12 | 2023-09-22 | 无锡万耐特自动化设备股份公司 | 一种雨刮器非接触光学镜头自动检测装置及其检测方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109443207B (zh) | 2019-10-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109443207B (zh) | 一种光笔式机器人原位测量系统与方法 | |
CN111775146B (zh) | 一种工业机械臂多工位作业下的视觉对准方法 | |
CN109029257B (zh) | 基于立体视觉和结构光视觉的大型工件位姿测量系统、方法 | |
CN106981083B (zh) | 双目立体视觉系统摄像机参数的分步标定方法 | |
CN103292695B (zh) | 一种单目立体视觉测量方法 | |
CN105252341B (zh) | 五轴数控机床动态误差视觉测量方法 | |
CN111127568B (zh) | 一种基于空间点位信息的相机位姿标定方法 | |
CN104990515B (zh) | 大型物体三维形状测量系统及其测量方法 | |
US9279661B2 (en) | Information processing apparatus and information processing method | |
CN105793695B (zh) | 用相机探头探查物体的方法 | |
CN105547153B (zh) | 基于双目视觉的插件元件针脚视觉定位方法及装置 | |
CN106097300A (zh) | 一种基于高精度运动平台的多相机标定方法 | |
Wang et al. | An efficient calibration method of line structured light vision sensor in robotic eye-in-hand system | |
CN106179885B (zh) | 一种基于立体视觉引导的复杂工件点胶方法及装置 | |
CN102589437A (zh) | 光笔式便携三坐标测量系统中测头中心位置的标定方法 | |
CN111633643A (zh) | 一种基于tcp坐标系下平移运动的旋转矩阵标定方法 | |
CN111707189B (zh) | 基于双目视觉的激光位移传感器光束方向标定方法 | |
CN109015110A (zh) | 一种机床回转轴位置误差建模与辨识方法 | |
CN109712139B (zh) | 基于线性运动模组的单目视觉的尺寸测量方法 | |
CN110370316A (zh) | 一种基于垂直反射的机器人tcp标定方法 | |
CN113724337B (zh) | 一种无需依赖云台角度的相机动态外参标定方法及装置 | |
CN105716547A (zh) | 一种机械工件平面度快速测量装置及方法 | |
JP2019049467A (ja) | 距離計測システムおよび距離計測方法 | |
CN114459345B (zh) | 基于视觉空间定位的飞机机身位置姿态检测系统及方法 | |
CN112001945B (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 |