CN112923849A - 基于轮廓传感器的空间定位方法及系统 - Google Patents

基于轮廓传感器的空间定位方法及系统 Download PDF

Info

Publication number
CN112923849A
CN112923849A CN202110113792.3A CN202110113792A CN112923849A CN 112923849 A CN112923849 A CN 112923849A CN 202110113792 A CN202110113792 A CN 202110113792A CN 112923849 A CN112923849 A CN 112923849A
Authority
CN
China
Prior art keywords
auxiliary tool
contour
sensor
axis
profile
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
Application number
CN202110113792.3A
Other languages
English (en)
Other versions
CN112923849B (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.)
Jilin Laiheng Industrial Equipment Co ltd
Changchun Hanzhi Technology Co ltd
Original Assignee
Jilin Laiheng Industrial Equipment Co ltd
Changchun Hanzhi Technology 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 Jilin Laiheng Industrial Equipment Co ltd, Changchun Hanzhi Technology Co ltd filed Critical Jilin Laiheng Industrial Equipment Co ltd
Priority to CN202110113792.3A priority Critical patent/CN112923849B/zh
Publication of CN112923849A publication Critical patent/CN112923849A/zh
Application granted granted Critical
Publication of CN112923849B publication Critical patent/CN112923849B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00Measuring arrangements characterised by the use of optical techniques
    • G01B11/002Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00Measuring arrangements characterised by the use of optical techniques
    • G01B11/24Measuring arrangements characterised by the use of optical techniques for measuring contours or curvatures

Abstract

本发明公开了一种基于轮廓传感器的空间定位方法,主要将物体在空间内的移动关系转换成空间矩形在空间内的移动关系,运用空间矩形上的特征点的坐标变化求得空间矩形在三维坐标系内的旋转角度和平移值。本发明还提供了一种基于轮廓传感器的空间定位系统。本发明提供的方法需要特征点少,计算量小;反馈速度快,同时能有效降低基于轮廓传感器测量方法的误差。

Description

基于轮廓传感器的空间定位方法及系统
技术领域
本发明属于空间定位技术领域,特别涉及一种基于轮廓传感器的空间定位方法和系统。
背景技术
随着工业生产自动化程度越来越高。机器人使用越来越来越普及。使得生产效率越来越高,产品质量越来越好的同时也产生了一些新的技术问题需要解决。
传统模式下,生产过程中会将待处理工件放到特定工装夹具上进行固定。机器人按照固定轨迹对工件进行处理。在这个过程中机器人的行走路径是固定不变的,这时就需要待处理工件在空间内的位置是固定不变的。但是在一些生产情况下无法保证待处理工件在空间内的位置的一致性。这时就需要机器人根据待处理工件在空间位置的变化情况改变机器人的运行轨迹以适应待处理工件。保证自动化生产的完成。这个过程中机器人需要知道待处理工件在空间位置的变化情况。这时产生了一个新的问题。即如何测量待处理工件在空间位置的变化情况。
根据测量工具的不同测量系统主要分为两种。轮廓传感器空间测量系统和相机视觉空间测量系统。
(1)相机获得特征点坐标的方式:
相机对工件进行拍照,获得工件的图像信息。根据相机的像素不同。获得图像的像素点也不同。比如5千万像素的相机,获得图像有5千万个像素点规则排列。每个像素点的光学信号也不同。再通过图像信息数据分析软件找到对应的特征点。得到特征点的像素坐标。但是这个特征点的像素坐标是二维的,还需要测得这个特征点的深度信息。通常用双目相机测得特征点的深度信息。远原理就是根据特征点分别在左目相机和右目相机的像素坐标和两相机焦距的距离用算法算得特征点的深度信息。再利用特定的方法和算法将特征点的像素坐标和深度信息转化为基准坐标系base1的三维坐标值。
(2)轮廓传感器获得特征点坐标的方式
轮廓传感器的测量原理:轮廓传感器有发射区和接收区。发射区发射一段激光线。根据传感器分辨率不同,这一段激光线含有的激光点数目也不同。以上海TDA项目为例传感器发射激光线含有1200个激光点。激光线照射到工件表面上,并通过工件反射在传感器接收区接受。传感器直接测得激光点的发射位置和接受位置和从发射到接收的间隔时间和接受激光点的光学信息。传感器通过内部算法算得所有接受激光点相对于传感器本身坐标系的坐标值。由于传感器发射是一条激光线所以只能得到两个维度的坐标值。分别是垂直于发射区平面方向的坐标值和在发射区平面内平行于激光线方向上的坐标值。第三个维度坐标必须有其他方法获得。我们可以调整传感器的摆放位置使传感器发射的激光线垂直于base1的一个坐标轴。
这样激光线上的每一个激光点在base1该轴上的坐标值均是相同且固定的。这样我们可以通过测量传感器在base1中的位置信息得到传感器测量工件上点的第三个维度的坐标值。在通过特定的校正方法使测量点在传感器坐标系中两个维度的坐标值转换为测量点在base1中另外两个轴的坐标值。这样我们就会得到测量点在base1中的三维坐标值。
这两种特征点的坐标采集方式都会存在误差。经过后续的计算会放大这个误差。从而不能准确的进行定位。
发明内容
本发明针对现有技术中存在的问题,提出了一种能够有效降低误差的基于轮廓传感器的空间定位方法。
为实现上述目的,本发明提供一种基于轮廓传感器的空间定位方法,包括以下步骤:
设置辅具建立基准坐标系;
在辅具的底边、顶边和侧边周围分别设置轮廓传感器;通过轮廓传感器分别采集辅具的底边、顶边和侧边上的轮廓特征点在基准坐标系中的坐标值;
通过轮廓传感器分别采集待定位物体的底边、顶边和侧边上的轮廓特征点在基准坐标系中的坐标值;
通过辅具上的轮廓特征点的坐标值和待定位物体的轮廓特征点的坐标值计算出从辅具所在的位置移动到待定位物体所在位置的移动参数。
进一步,以辅具的底边为X轴,辅具的侧边为Y轴,辅具的底边和为Y轴的侧边的交点为坐标原点建立基准坐标系。
其中,在辅具底边的下方固定设置第一轮廓传感器BX1和第二轮廓传感器BX2,在辅具的顶边的上方固定设置第三轮廓传感器BX3,在辅具的一个侧边的外侧固定设置第四轮廓传感器BX4。
更进一步,调整第一轮廓传感器BX1和第二轮廓传感器BX2的角度,使得两个传感器发出激光线在辅具上且与辅具底边垂直,第一轮廓传感器BX1发出激光线与辅具底边交点为第一轮廓特征点,第二轮廓传感器BX2发出激光线与辅具底边交点为第二轮廓特征点;调整第三轮廓传感器BX3角度使得传感器发出激光线在辅具上与辅具顶边垂直,第三轮廓传感器BX3发出激光线与辅具顶边交点为第三轮廓特征点;调整第四轮廓传感器BX4角度使得传感器发出激光线在辅具上与辅具侧边垂直,第四轮廓传感器BX4发出激光线与辅具侧边交点为第四轮廓特征点。
进一步,所述辅具的底边长度与待定位物体的底边长度相同,辅具的侧边长度与带定位物体的侧边长度相同,所述辅具为长方体辅具。
进一步,根据以下公式获得从辅具所在的位置移动到待定位物体所在位置的移动参数:
x=P4_Z*(SINA*SINC-COSA*COSC*SINB)+d*(COSC*SINA+COSA*SINB*SINC)+COSA*COSB*P4_X;
y=P1_Y+n*(P2_Y-P1_Y);
z=P1_Z+n*(P2_Z-P1_Z);
TANA=(P1_Y-P2_Y)/((a-b)^2+(P1_Z-P2_Z)^2)^1/2;
TANB=-(P1_Z-P2_Z)/(a-b);
TANC=((P1_Z-P3_Z)+TANB*(a-c)/COSC)/(P1_Y-P3_Y);
上述公式中,x表示辅具沿X轴平移的距离,y表示辅具沿Y轴平移的距离,z表示辅具沿Z轴平移的距离,A表示辅具围绕Z轴旋转的角度,B表示辅具围绕Y轴旋转的角度,C表示辅具围绕X轴旋转的角度,n=(x-a)/(b-a);a表示第一轮廓特征点到基准坐标系中原点的距离,b表示第二轮廓特征点到基准坐标系中原点的距离,c表示第三轮廓特征点到基准坐标系中Y轴的距离,d表示第四轮廓特征点到基准坐标系中原点的距离;P1_X、P1_Y和P1_Z分别表示第一轮廓传感器BX1观测得到的待定位物体底边上的点在基准坐标系中X轴、Y轴和Z轴上的值;P2_X、P2_Y和P2_Z分别表示第二轮廓传感器BX2观测得到的待定位物体底边上的点在基准坐标系中X轴、Y轴和Z轴上的值;P3_X、P3_Y和P3_Z分别表示第三轮廓传感器BX3观测得到的待定位物体顶边上的点在基准坐标系中X轴、Y轴和Z轴上的值;P4_X、P4_Y和P4_Z分别示第四轮廓传感器BX4观测得到的待定位物体侧边上的点在基准坐标系中X轴、Y轴和Z轴上的值。本发明还提供了一种基于轮廓传感器的空间定位系统,包括第一位置特征点获取模块、第二位置特征点获取模块和移动参数获取模块,其中:第一位置特征点获取模块通过轮廓传感器获得轮廓特征点在第一位置上的坐标;第二位置特征点获取模块通过轮廓传感器获得第二位置上对应的轮廓特征点的坐标;移动参数获取模块通过计算获得第一位置到第二位置上的移动参数。
其中,第一位置特征点获取模块包括辅具和多个轮廓传感器;所述多个轮廓传感器分别固定设置在辅具的周围,用于采集辅具的边缘上轮廓特征点的坐标。
进一步,第一位置特征点获取模块中包括4个轮廓传感器;在辅具底边的下方固定设置第一轮廓传感器BX1和第二轮廓传感器BX2,在辅具的顶边的上方固定设置第三轮廓传感器BX3,在辅具的一个侧边的外侧固定设置第四轮廓传感器BX4。
进一步,第二位置特征点获取模块包括待定位物体,所述第二位置特征点获取模块通过第一位置特征点获取模块中的轮廓传感器获取待定位物体边缘的轮廓特征点坐标。
工作原理:本发明主要将物体在空间内的移动关系转换成空间矩形在空间内的移动关系,运用空间矩形上的特征点的坐标变化求得空间矩形在三维坐标系内的旋转角度和平移值。
假设空间内有一空间矩形。这个空间矩形透明且能任意穿过,这个矩形尺寸和待定位工件的尺寸相当。带定位工件固定在这个矩形上且工件在矩形所在平面内投影在这个矩形内并且这个矩形的底边平行于地面。由于工件确定,尺寸一定。那么这样的矩形一定存在且不唯一。工件固定在这个矩形上,工件和矩形相对位置固定。工件空间内位置变换关系可等效于求这个空间矩形在空间内的位置变换关系。
当一个工件在基准位置放置时,它所在的空间矩形位置也确定了下来。矩形底边为L1,矩形顶边为L2,取任意侧边为L3。先以L1和L3的交点为坐标原点,L1为x轴正方形,L3为y轴正方向建立空间直角坐标系base1作为基准坐标系。对工件进行平移旋转。向x轴平移X、y轴平移Y、z轴平移Z、再以z轴位旋转轴旋转A、再以y轴位旋转轴旋转B、再以x轴位旋转轴旋转C得到实际工件。X,Y,Z,A,B,C为未知变量。这时工件所在空间也确定了下来。假设L1变换后得L4,L2变换后得L5,L3变换后得L6。在L1上取两点O1(a,0,0),O2(b,0,0)。a,b为常量且0<a<b<l且2/3*l<(b-a)。在L2取一点O3(c,h,0),c为常量,h为矩形高,且a<c<b。在L3取一点O4(0,d,0),d为常量,且0<d<h。变换后在L4上存在两点P1(a,P1_Y,P1_Z),P2(b,P2_Y,P2_Z)。a,b为常量且0<a<b<l且2/3*l<(b-a)。在L5存在一点P3(c,P3_Y,P3_Z),c为常量,且a<c<b。在L6存在一点P4(P4_X,d,P4_Z),d为常量,且0<d<h。a、b、c、d、l、h为常量。P1_Y,P1_Z,P2_Y,P2_Z,P3_Y,P3_Z,P4_X,P4_Z为测量系统需要测量的测量值。
X,Y,Z,A,B,C为需要求解的未知变量。O1,O2,O3,O4,P1,P2,P3,P4的坐标值都是特征点在base1中的坐标值。
在空间坐标变换中一般用矩阵乘计算。平移矩阵TX代表沿x轴平移X,平移矩阵TY代表沿y轴平移Y,平移矩阵TZ代表沿z轴平移Z。旋转矩阵TRA代表以z轴旋转A,旋转矩阵TRB代表以y轴旋转B,旋转矩阵TRC代表以x轴旋转C。旋转矩阵TAA代表以z轴旋转-A,旋转矩阵TBB代表以y轴旋转-B,旋转矩阵TCC代表以x轴旋转-C。
平移矩阵:
TX=[1,0,0,X;0,1,0,0;0,0,1,0;0,0,0,1];
TY=[1,0,0,0;0,1,0,Y;0,0,1,0;0,0,0,1];
TZ=[1,0,0,0;0,1,0,0;0,0,1,Z;0,0,0,1];
旋转矩阵:
TRA=[COSA,-SINA,0,0;SINA,COSA,0,0;0,0,1,0;0,0,0,1];
TRB=[COSB,0,SINB,0;0,1,0,0;-SINB,0,COSB,0;0,0,0,1];
TRC=[1,0,0,0;0,COSC,-SINC,0;0,SINC,COSC,0;0,0,0,1];
TAA=[COSA,SINA,0,0;-SINA,COSA,0,0;0,0,1,0;0,0,0,1];
TBB=[COSB,0,-SINB,0;0,1,0,0;SINB,0,COSB,0;0,0,0,1];
TCC=[1,0,0,0;0,COSC,SINC,0;0,-SINC,COSC,0;0,0,0,1]。
BASE1内向量P1_P2=P2-P1,O1_O2=O2-O1根据变换公式。向量O1_O2沿z轴旋转A再沿y轴旋转B的到向量P11_P12,P11_P12=TRB*TRA*O1_O2,由于在BASE1内向量P11_P12与向量P1_P2同向,所以:
P11_P12=TAA*TBB*P1_P2;
P11_P12(1,1)*P1_P2(2,1)=P11_P12(2,1)*P1_P2(1,1);
P11_P12(1,1)*P1_P2(3,1)=P11_P12(3,1)*P1_P2(1,1);
通过上面公式可以到:
TANB=-(P1_Z-P2_Z)/(a-b);
从而可以得到SINB,COSB。
TANA=(P1_Y-P2_Y)*COSB/(a-b);
TANA=(P1_Y-P2_Y)/((a-b)^2+(P1_Z-P2_Z)^2)^1/2;
从而可以得到SINA,COSA。
BASE1内向量P1_P3=P3-P1,O1_O3=O3-O1根据变换公式。向量P1_P3沿x轴旋转-C再沿y轴旋转-B沿z轴旋转-A的到向量P11_P13,P11_P13=TAA*TBB*TCC*P1_P3,在BASE2内向量P11_P13在OXY平面内,从而:
P11_P13=TAA*TBB*TCC*P1_P3;
P11_P13(3,1)=0;
通过上面公式可以到:
COSB*SINC*(P1_Y-P3_Y)-COSB*COSC*(P1_Z-P3_Z)-SINB*(a-c)=0;
TANC=((P1_Z-P3_Z)+TANB*(a-c)/COSC)/(P1_Y-P3_Y);
从而可以得到SINC,COSC。
点P4沿x轴旋转-C再沿y轴旋转-B沿z轴旋转-A的到点P14,
P14=TAA*TBB*TCC*P4,则:
X=P14(1,1)
=P4_Z*(SINA*SINC-COSA*COSC*SINB)+d*(COSC*SINA+COSA*SINB*SINC)+COSA*COSB*P4_X。
平移路径可看作base1原点先移动到P4点在沿L4方向平移到base2原点,P4点到base2原点的平移向量N=[0,0,0,n*(b-a);0,0,0,n*(P2_Y-P1_Y);0,0,0,n*(P2_Z-P1_Z);0,0,0,1];因为X=a+n*(b-a);
X=P14(1,1)=P4_Z*(SINA*SINC-COSA*COSC*SINB)+d*(COSC*SINA+COSA*SINB*SINC)+COSA*COSB*P4_X;所以,
n=(X-a)/(b-a)=(P4_Z*(SINA*SINC-COSA*COSC*SINB)+d*(COSC*SINA+COSA*SINB*SINC)+COSA*COSB*P4_X-a)/(b-a)
Y=P1_Y+n*(P2_Y-P1_Y);
Z=P1_Z+n*(P2_Z-P1_Z)。
上述公式中,P1_Y,P1_Z分别表示P1点在base1坐标系中的Y轴和Z轴上的值;P2_Y,P2_Z分别表示P2点在base1坐标系中的Y轴和Z轴上的值;P3_Y,P3_Z,分别表示P3点在base1坐标系中的Y轴和Z轴上的值;P4_X,P4_Z分别表示P4点在base1坐标系中的X轴和Z轴上的值。
有益效果:与现有技术相比,本发明提供的方法需要特征点少,计算量小;反馈速度快,同时能有效降低基于轮廓传感器测量方法的误差。
附图说明
图1是本发明提供的方法工作示意图。
具体实施方式
下面将结合本发明实例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
本实施例公开了一种基于轮廓传感器的空间定位系统,主要包括第一位置特征点获取模块、第二位置特征点获取模块和移动参数获取模块,其中:第一位置特征点获取模块主要通过轮廓传感器获得四个轮廓特征点在第一位置上的坐标;第二位置特征点获取模块通过轮廓传感器获得第二位置上对应的四个轮廓特征点的坐标;移动参数获取模块通过计算可以获得第一位置到第二位置上移动的位移和旋转的角度。
本实施例中,第一位置是与待定位的物体大小相仿的长方体辅具所在的位置,第二位置是待定位的物体所在的位置,本实施例中以车门为例。由于本实施例中待定位的物体为车门,该车门底边长l,高为h,所以本实施例中采用的长方体辅具的长为l,高为h,厚度为5mm。如图1所示,在长方体辅具底边的下方固定设置第一轮廓传感器BX1和第二轮廓传感器BX2,在长方体辅具的顶边的上方固定设置第三轮廓传感器BX3,在长方体辅具一侧边的外侧固定设置第四轮廓传感器BX4。其中,第一轮廓传感器BX1所在位置为第一测量点B1,第二轮廓传感器BX2所在位置为第二测量点B2,第三轮廓传感器BX3所在位置为第三测量点B3,第四轮廓传感器BX4所在位置为第四测量点B4
采用本实施例提供的基于轮廓传感器的空间定位系统进行空间定位时,主要包括以下步骤:
步骤1:安装长方体辅具建立基准坐标系BASE1。以长方体辅具的底边为X轴,以安装第四轮廓传感器BX4的侧边为Y轴,以长方体辅具底边与该条长方体辅具侧边的交点为坐标原点建立基准坐标系BASE1。
步骤2:建立空间坐标测量系统。本实施例中采用wenglor轮廓传感器但是本方法并不限于wenglor轮廓传感器。
调整第一轮廓传感器BX1和第二轮廓传感器BX2的角度,使得两个传感器发出激光线在长方体辅具上且与长方体辅具底边垂直,第一轮廓传感器BX1发出激光线与辅具底边交点为交点O1,第二轮廓传感器BX2发出激光线与辅具底边交点为交点O2。调整第三轮廓传感器BX3角度使得传感器发出激光线在长方体辅具上与长方体辅具顶边垂直,第三轮廓传感器BX3发出激光线与辅具顶边交点为交点O3。调整第四轮廓传感器BX4角度使得传感器发出激光线在长方体辅具上与长方体辅具侧边垂直,第四轮廓传感器BX4发出激光线与辅具侧边交点为交点O4。测量交点O1到原点的距离为a,交点O2到原点的距离为b,交点O3到Y轴的距离为c,交点O4到原点的距离为d。
在第一轮廓传感器BX1内建立新的直角坐标系,并旋转坐标系Y轴使得坐标系的X轴与辅具上的激光线重合,平移坐标系原点使得第一轮廓传感器BX1测量值BX1_Y为0,BX1_Z为0,即使第一测量点B1在BASE1坐标系中的Y轴的坐标值为0,Z轴的坐标值为0。在第二轮廓传感器BX2内建立新的直角坐标系,并旋转坐标系的Y轴使得坐标系的X轴与辅具上的激光线重合,平移坐标系原点使得传感器测量值BX2_Y为0,BX2_Z为0,即使第二测量点B2在BASE1坐标系中的Y轴的坐标值为0,Z轴的坐标值为0。在第三轮廓传感器BX3内建立新的直角坐标系,并旋转坐标系的Y轴使得坐标系的X轴与辅具上的激光线重合,平移坐标系原点使得传感器测量值BX3_Y为h,BX3_Z为0,即使第一测量点B3在BASE1坐标系中的Y轴的坐标值为h,Z轴的坐标值为0。在第四轮廓传感器BX4内建立新的直角坐标系,并旋转坐标系的Y轴使得坐标系的X轴与辅具上的激光线重合,平移坐标系原点使得传感器测量值BX4_X为0,BX4_Z为0,即使第一测量点B4在BASE1坐标系中的X轴的坐标值为0,Z轴的坐标值为0。从而得到第一测量点B1在BASE1中的坐标为B1(a,0,0),第二测量点B2在BASE1中的坐标为B2(b,0,0),第三测量点B3在BASE1中的坐标为B3(c,h,0),第四测量点B4在BASE1中的坐标为B4(0,d,0)。
步骤3:将车门放置在轮廓传感器可以观测的范围内,分别通过第一轮廓传感器BX1、第二轮廓传感器BX2、第三轮廓传感器BX3和第四轮廓传感器BX4对车门进行观测,得到车门底边上的两个交点P1和P2的坐标,车门顶边上的交点P3的坐标,车门侧边上的交点P4的坐标。在BASE1中的每个交点的坐标分别为P1(P1_X,P1_Y,P1_Z),P2(P2_X,P2_Y,P2_Z),P3(P3_X,P3_Y,P3_Z),P4(P4_X,P4_Y,P4_Z),其中,P1_X、P1_Y和P1_Z分别表示P1点在BASE1坐标系中X轴、Y轴和Z轴上的值;P2_X、P2_Y和P2_Z分别表示P2点在BASE1坐标系中X轴、Y轴和Z轴上的值;P3_X、P3_Y和P3_Z分别表示P3点在BASE1坐标系中X轴、Y轴和Z轴上的值;P4_X、P4_Y和P4_Z分别表示P4点在BASE1坐标系中X轴、Y轴和Z轴上的值。其中,P1_X等于a,P2_X等于b,P3_X等于c,P3_Y等于h,P4_Y等于d,其他值为轮廓传感器的反馈值。
步骤3:通过计算可以获得从长方体辅具到车门所在位置移动的位移和旋转的角度。
其中,
x=P4_Z*(SINA*SINC-COSA*COSC*SINB)+d*(COSC*SINA+COSA*SINB*SINC)+COSA*COSB*P4_X;
y=P1_Y+n*(P2_Y-P1_Y);
z=P1_Z+n*(P2_Z-P1_Z);
TANA=(P1_Y-P2_Y)/((a-b)^2+(P1_Z-P2_Z)^2)^1/2;
TANB=-(P1_Z-P2_Z)/(a-b);
TANC=((P1_Z-P3_Z)+TANB*(a-c)/COSC)/(P1_Y-P3_Y);
上述公式中,x表示长方体辅具沿X轴平移的距离,y表示长方体辅具沿Y轴平移的距离,z表示长方体辅具沿Z轴平移的距离,A表示长方体辅具围绕Z轴旋转的角度,B表示长方体辅具围绕Y轴旋转的角度,C表示长方体辅具围绕X轴旋转的角度,n=(x-a)/(b-a)。
利用本实施例提供的方法可以将多个轮廓传感器的测量值整合到一个坐标系内并与机器人的坐标系一致。为后续计算带来方便。采集的数据直接可用不需要额外处理。在原始数据上减少不必要的误差。受wenglor2D/3D轮廓传感器和编码器精度影响原始数据存在200μm误差。
利用实际物体上的特征轮廓曲线上的点的坐标和空间矩形上特征点的坐标获得标定移动参数的方法,可以降低原始数据个别点扰动数据有波动造成的计算误差。比如物体表面细微凹陷和凸起的部分一致性有差异等。利用这种方法实现的定位效果良好问题误差控制在0.5mm以内。
虽然本发明已以较佳实施例揭露如上,然其并非用以限定本发明。本发明所属技术领域中具有通常知识者,在不脱离本发明的精神和范围内,当可作各种的更动与润饰。因此,本发明的保护范围当视权利要求书所界定者为准。

Claims (10)

1.一种基于轮廓传感器的空间定位方法,其特征在于:包括以下步骤:
设置辅具建立基准坐标系;
在辅具的底边、顶边和侧边周围分别设置轮廓传感器;通过轮廓传感器分别采集辅具的底边、顶边和侧边上的轮廓特征点在基准坐标系中的坐标值;
通过轮廓传感器分别采集待定位物体的底边、顶边和侧边上的轮廓特征点在基准坐标系中的坐标值;
通过辅具上的轮廓特征点的坐标值和待定位物体的轮廓特征点的坐标值计算出从辅具所在的位置移动到待定位物体所在位置的移动参数。
2.根据权利要求1所述的基于轮廓传感器的空间定位方法,其特征在于:以辅具的底边为X轴,辅具的侧边为Y轴,辅具的底边和为Y轴的侧边的交点为坐标原点建立基准坐标系。
3.根据权利要求1所述的基于轮廓传感器的空间定位方法,其特征在于:在辅具底边的下方固定设置第一轮廓传感器BX1和第二轮廓传感器BX2,在辅具的顶边的上方固定设置第三轮廓传感器BX3,在辅具的一个侧边的外侧固定设置第四轮廓传感器BX4。
4.根据权利要求3所述的基于轮廓传感器的空间定位方法,其特征在于:调整第一轮廓传感器BX1和第二轮廓传感器BX2的角度,使得两个传感器发出激光线在辅具上且与辅具底边垂直,第一轮廓传感器BX1发出激光线与辅具底边交点为第一轮廓特征点,第二轮廓传感器BX2发出激光线与辅具底边交点为第二轮廓特征点;调整第三轮廓传感器BX3角度使得传感器发出激光线在辅具上与辅具顶边垂直,第三轮廓传感器BX3发出激光线与辅具顶边交点为第三轮廓特征点;调整第四轮廓传感器BX4角度使得传感器发出激光线在辅具上与辅具侧边垂直,第四轮廓传感器BX4发出激光线与辅具侧边交点为第四轮廓特征点。
5.根据权利要求1所述的基于轮廓传感器的空间定位方法,其特征在于:所述辅具的底边长度与待定位物体的底边长度相同,辅具的侧边长度与带定位物体的侧边长度相同,所述辅具为长方体辅具。
6.根据权利要求4所述的基于轮廓传感器的空间定位方法,其特征在于:根据以下公式获得从辅具所在的位置移动到待定位物体所在位置的移动参数:
x=P4_Z*(SINA*SINC-COSA*COSC*SINB)+d*(COSC*SINA+COSA*SINB*SINC)+COSA*COSB*P4_X;
y=P1_Y+n*(P2_Y-P1_Y);
z=P1_Z+n*(P2_Z-P1_Z);
TANA=(P1_Y-P2_Y)/((a-b)^2+(P1_Z-P2_Z)^2)^1/2;
TANB=-(P1_Z-P2_Z)/(a-b);
TANC=((P1_Z-P3_Z)+TANB*(a-c)/COSC)/(P1_Y-P3_Y);
上述公式中,x表示辅具沿X轴平移的距离,y表示辅具沿Y轴平移的距离,z表示辅具沿Z轴平移的距离,A表示辅具围绕Z轴旋转的角度,B表示辅具围绕Y轴旋转的角度,C表示辅具围绕X轴旋转的角度,n=(x-a)/(b-a);a表示第一轮廓特征点到基准坐标系中原点的距离,b表示第二轮廓特征点到基准坐标系中原点的距离,c表示第三轮廓特征点到基准坐标系中Y轴的距离,d表示第四轮廓特征点到基准坐标系中原点的距离;P1_X、P1_Y和P1_Z分别表示第一轮廓传感器BX1观测得到的待定位物体底边上的点在基准坐标系中X轴、Y轴和Z轴上的值;P2_X、P2_Y和P2_Z分别表示第二轮廓传感器BX2观测得到的待定位物体底边上的点在基准坐标系中X轴、Y轴和Z轴上的值;P3_X、P3_Y和P3_Z分别表示第三轮廓传感器BX3观测得到的待定位物体顶边上的点在基准坐标系中X轴、Y轴和Z轴上的值;P4_X、P4_Y和P4_Z分别示第四轮廓传感器BX4观测得到的待定位物体侧边上的点在基准坐标系中X轴、Y轴和Z轴上的值。
7.一种基于轮廓传感器的空间定位系统,其特征在于:包括第一位置特征点获取模块、第二位置特征点获取模块和移动参数获取模块,其中:第一位置特征点获取模块通过轮廓传感器获得轮廓特征点在第一位置上的坐标;第二位置特征点获取模块通过轮廓传感器获得第二位置上对应的轮廓特征点的坐标;移动参数获取模块通过计算获得第一位置到第二位置上的移动参数。
8.根据权利要求7所述的基于轮廓传感器的空间定位系统,其特征在于:第一位置特征点获取模块包括辅具和多个轮廓传感器;所述多个轮廓传感器分别固定设置在辅具的周围,用于采集辅具的边缘上轮廓特征点的坐标。
9.根据权利要求8所述的基于轮廓传感器的空间定位系统,其特征在于:第一位置特征点获取模块中包括4个轮廓传感器;在辅具底边的下方固定设置第一轮廓传感器BX1和第二轮廓传感器BX2,在辅具的顶边的上方固定设置第三轮廓传感器BX3,在辅具的一个侧边的外侧固定设置第四轮廓传感器BX4。
10.根据权利要求8所述的基于轮廓传感器的空间定位系统,其特征在于:第二位置特征点获取模块包括待定位物体,所述第二位置特征点获取模块通过第一位置特征点获取模块中的轮廓传感器获取待定位物体边缘的轮廓特征点坐标。
CN202110113792.3A 2021-01-27 2021-01-27 基于轮廓传感器的空间定位方法及系统 Active CN112923849B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110113792.3A CN112923849B (zh) 2021-01-27 2021-01-27 基于轮廓传感器的空间定位方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110113792.3A CN112923849B (zh) 2021-01-27 2021-01-27 基于轮廓传感器的空间定位方法及系统

Publications (2)

Publication Number Publication Date
CN112923849A true CN112923849A (zh) 2021-06-08
CN112923849B CN112923849B (zh) 2022-09-13

Family

ID=76167324

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110113792.3A Active CN112923849B (zh) 2021-01-27 2021-01-27 基于轮廓传感器的空间定位方法及系统

Country Status (1)

Country Link
CN (1) CN112923849B (zh)

Citations (29)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004050356A (ja) * 2002-07-19 2004-02-19 Kawasaki Heavy Ind Ltd 可動体の位置および姿勢検出装置
CN101574709A (zh) * 2009-06-12 2009-11-11 东北大学 一种中厚板自动转钢方法
CN101666619A (zh) * 2009-09-27 2010-03-10 长沙长泰输送包装设备有限公司 一种计算工件绝对坐标的方法
US20130162562A1 (en) * 2011-12-22 2013-06-27 Buffalo Inc. Information processing device and non-transitory recording medium storing program
CN103236058A (zh) * 2013-04-25 2013-08-07 内蒙古科技大学 获取四维心脏图像感兴趣体积的方法
KR101360028B1 (ko) * 2012-12-17 2014-02-11 한국과학기술원 최적화 설계를 통한 레이저 센서 기반 6 자유도 운동 측정 장치
CN103954222A (zh) * 2014-04-29 2014-07-30 南京理工大学 一种车辆轮廓及轴距自动测量系统及测量算法
CN105137393A (zh) * 2015-07-31 2015-12-09 石川 一种用于网络的空间多传感器快速定位方法
JP2016080663A (ja) * 2014-10-22 2016-05-16 富士通株式会社 マーカー位置算出装置、マーカー位置算出方法及びマーカー位置算出プログラム
DE102016102589A1 (de) * 2015-10-08 2017-04-13 Msi Computer (Shenzhen) Co., Ltd. Verfahren zur Kalibrierung einer Laserentfernungsmessung und Vorrichtung unter Verwendung desselben
US20170148154A1 (en) * 2015-11-24 2017-05-25 Keyence Corporation Positioning Method, Positioning Apparatus, Program, And Computer Readable Recording Medium
CN107024175A (zh) * 2017-06-20 2017-08-08 长春工程学院 基于多目视觉的大型客车车身关键尺寸检测系统解决方案
CN107389009A (zh) * 2017-07-18 2017-11-24 安徽江淮汽车集团股份有限公司 一种检测支架
CN108000522A (zh) * 2017-12-21 2018-05-08 金翰阳科技(大连)股份有限公司 一种基于单机器人对工件偏移后误差检测补偿方法
CN108444383A (zh) * 2018-03-08 2018-08-24 大连理工大学 基于视觉激光组合式的加工过程一体化测量方法
CN208641114U (zh) * 2017-11-29 2019-03-26 天津丰宁机电制品有限公司 空中三维移动辅具
CN109631754A (zh) * 2018-11-21 2019-04-16 深圳先进技术研究院 一种测量装置坐标系标定的方法及相关装置
JP2019132731A (ja) * 2018-01-31 2019-08-08 ブラザー工業株式会社 位置特定装置及び位置特定方法
CN110332887A (zh) * 2019-06-27 2019-10-15 中国地质大学(武汉) 一种基于特征光标点的单目视觉位姿测量系统及方法
CN110487182A (zh) * 2019-08-26 2019-11-22 大连理工大学 一种基于多维动态标准器的坐标转换方法
CN110906880A (zh) * 2019-12-12 2020-03-24 中国科学院长春光学精密机械与物理研究所 一种物体自动化三维激光扫描系统和方法
CN210282090U (zh) * 2019-06-21 2020-04-10 长春涵智科技有限公司 自浮式复式套筒
CN111028298A (zh) * 2019-12-17 2020-04-17 哈尔滨工业大学 一种用于刚体坐标系空间变换标定的汇聚式双目系统
CN111043963A (zh) * 2019-12-31 2020-04-21 芜湖哈特机器人产业技术研究院有限公司 基于二维激光雷达的车厢容器的三维扫描系统测量方法
CN210954086U (zh) * 2019-12-24 2020-07-07 石家庄铁道大学 一种磁力风速风向传感器
CN111524195A (zh) * 2020-04-28 2020-08-11 河北工程大学 一种掘进机截割头定位中的相机标定方法
US20200309515A1 (en) * 2019-03-28 2020-10-01 Leica Geosystems Ag Surveying systems
WO2020209667A1 (ko) * 2019-04-11 2020-10-15 사회복지법인 삼성생명공익재단 방사선을 이용한 진단 및 치료 장치의 3차원 중심점의 품질 보증 시스템 및 방법
CN111941421A (zh) * 2020-06-22 2020-11-17 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院) 一种基于多机器人协同操作的自适应模糊力跟踪控制方法

Patent Citations (29)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004050356A (ja) * 2002-07-19 2004-02-19 Kawasaki Heavy Ind Ltd 可動体の位置および姿勢検出装置
CN101574709A (zh) * 2009-06-12 2009-11-11 东北大学 一种中厚板自动转钢方法
CN101666619A (zh) * 2009-09-27 2010-03-10 长沙长泰输送包装设备有限公司 一种计算工件绝对坐标的方法
US20130162562A1 (en) * 2011-12-22 2013-06-27 Buffalo Inc. Information processing device and non-transitory recording medium storing program
KR101360028B1 (ko) * 2012-12-17 2014-02-11 한국과학기술원 최적화 설계를 통한 레이저 센서 기반 6 자유도 운동 측정 장치
CN103236058A (zh) * 2013-04-25 2013-08-07 内蒙古科技大学 获取四维心脏图像感兴趣体积的方法
CN103954222A (zh) * 2014-04-29 2014-07-30 南京理工大学 一种车辆轮廓及轴距自动测量系统及测量算法
JP2016080663A (ja) * 2014-10-22 2016-05-16 富士通株式会社 マーカー位置算出装置、マーカー位置算出方法及びマーカー位置算出プログラム
CN105137393A (zh) * 2015-07-31 2015-12-09 石川 一种用于网络的空间多传感器快速定位方法
DE102016102589A1 (de) * 2015-10-08 2017-04-13 Msi Computer (Shenzhen) Co., Ltd. Verfahren zur Kalibrierung einer Laserentfernungsmessung und Vorrichtung unter Verwendung desselben
US20170148154A1 (en) * 2015-11-24 2017-05-25 Keyence Corporation Positioning Method, Positioning Apparatus, Program, And Computer Readable Recording Medium
CN107024175A (zh) * 2017-06-20 2017-08-08 长春工程学院 基于多目视觉的大型客车车身关键尺寸检测系统解决方案
CN107389009A (zh) * 2017-07-18 2017-11-24 安徽江淮汽车集团股份有限公司 一种检测支架
CN208641114U (zh) * 2017-11-29 2019-03-26 天津丰宁机电制品有限公司 空中三维移动辅具
CN108000522A (zh) * 2017-12-21 2018-05-08 金翰阳科技(大连)股份有限公司 一种基于单机器人对工件偏移后误差检测补偿方法
JP2019132731A (ja) * 2018-01-31 2019-08-08 ブラザー工業株式会社 位置特定装置及び位置特定方法
CN108444383A (zh) * 2018-03-08 2018-08-24 大连理工大学 基于视觉激光组合式的加工过程一体化测量方法
CN109631754A (zh) * 2018-11-21 2019-04-16 深圳先进技术研究院 一种测量装置坐标系标定的方法及相关装置
US20200309515A1 (en) * 2019-03-28 2020-10-01 Leica Geosystems Ag Surveying systems
WO2020209667A1 (ko) * 2019-04-11 2020-10-15 사회복지법인 삼성생명공익재단 방사선을 이용한 진단 및 치료 장치의 3차원 중심점의 품질 보증 시스템 및 방법
CN210282090U (zh) * 2019-06-21 2020-04-10 长春涵智科技有限公司 自浮式复式套筒
CN110332887A (zh) * 2019-06-27 2019-10-15 中国地质大学(武汉) 一种基于特征光标点的单目视觉位姿测量系统及方法
CN110487182A (zh) * 2019-08-26 2019-11-22 大连理工大学 一种基于多维动态标准器的坐标转换方法
CN110906880A (zh) * 2019-12-12 2020-03-24 中国科学院长春光学精密机械与物理研究所 一种物体自动化三维激光扫描系统和方法
CN111028298A (zh) * 2019-12-17 2020-04-17 哈尔滨工业大学 一种用于刚体坐标系空间变换标定的汇聚式双目系统
CN210954086U (zh) * 2019-12-24 2020-07-07 石家庄铁道大学 一种磁力风速风向传感器
CN111043963A (zh) * 2019-12-31 2020-04-21 芜湖哈特机器人产业技术研究院有限公司 基于二维激光雷达的车厢容器的三维扫描系统测量方法
CN111524195A (zh) * 2020-04-28 2020-08-11 河北工程大学 一种掘进机截割头定位中的相机标定方法
CN111941421A (zh) * 2020-06-22 2020-11-17 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院) 一种基于多机器人协同操作的自适应模糊力跟踪控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
周虎等: "大尺寸交会测量系统传感器布站优化分析", 《宇航计测技术》 *

Also Published As

Publication number Publication date
CN112923849B (zh) 2022-09-13

Similar Documents

Publication Publication Date Title
CN109029257B (zh) 基于立体视觉和结构光视觉的大型工件位姿测量系统、方法
CN104315995B (zh) 基于虚拟多立方体标准目标的tof深度相机三维坐标标定装置和方法
CN109612390B (zh) 基于机器视觉的大尺寸工件自动测量系统
CN108177143B (zh) 一种基于激光视觉引导的机器人定位抓取方法及系统
CN112781496B (zh) 一种非接触测量系统的测头位姿标定方法
US11548156B2 (en) Device and method for calibrating coordinate system of 3D camera and robotic arm
CN113674345A (zh) 一种二维像素级三维定位系统及定位方法
CN112017248B (zh) 一种基于点线特征的2d激光雷达相机多帧单步标定方法
CN1948896A (zh) 一种动态三维激光扫描测头
CN109712139B (zh) 基于线性运动模组的单目视觉的尺寸测量方法
WO2014035741A1 (en) Localization and tracking system for mobile robots
JP2007533963A (ja) 物体の3d位置の非接触式光学的測定方法及び測定装置
CN110992416A (zh) 基于双目视觉与cad模型的高反光面金属零件位姿测量方法
JPS6332306A (ja) 無接触三次元自動寸法測定方法
So et al. Calibration of a dual-laser triangulation system for assembly line completeness inspection
CN112923849B (zh) 基于轮廓传感器的空间定位方法及系统
CN110458894B (zh) 一种测量机的相机与接触式测头的标定方法
Zhang et al. Improved Camera Calibration Method and Accuracy Analysis for Binocular Vision
JP2003136465A (ja) 検出対象物の3次元位置・姿勢決定方法とロボット用視覚センサ
Higuchi et al. 3D measurement of large structure by multiple cameras and a ring laser
CN112361982B (zh) 一种大幅面工件三维数据提取方法及系统
CN113725108B (zh) 大板扇出型封装芯片的漂移定位测量方法及装置
CN114119771A (zh) 一种毫米波雷达和相机联合标定方法
CN111179221B (zh) 焊接坡口的检测方法、设备及存储介质
WO2020133407A1 (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