CN108592838A - 工具坐标系的标定方法、装置以及计算机存储介质 - Google Patents
工具坐标系的标定方法、装置以及计算机存储介质 Download PDFInfo
- Publication number
- CN108592838A CN108592838A CN201810644149.1A CN201810644149A CN108592838A CN 108592838 A CN108592838 A CN 108592838A CN 201810644149 A CN201810644149 A CN 201810644149A CN 108592838 A CN108592838 A CN 108592838A
- Authority
- CN
- China
- Prior art keywords
- tool coordinates
- coordinates system
- preset
- matrix
- calibration
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
-
- 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)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
一种工具坐标系的标定方法、装置以及计算机存储介质,所述方法包括:确定机器***在测量范围内的基准点;获取N组测量数据,所述N组测量数据在所述机器***移动过程中得到,且每一组测量数据包括:所述机器***上的第一预设点与所述基准点的距离,所述机器***上第二预设点的位置;在所述N组测量数据中,两个所述第一预设点的位置连成的直线经过所述基准点,至少三个所述第二预设点的位置构成一个确定的平面;N≥3;确定工具坐标系的原点,根据所述N组测量数据,完成所述工具坐标系的标定。采用上述技术方案,工具坐标系标定的过程简洁、快速,使用所述工具坐标系得到的测量值的精确度高。
Description
技术领域
本发明涉及机械领域,尤其涉及一种工具坐标系的标定方法、装置以及计算机存储介质。
背景技术
当前工业生产中机器***的应用,例如机器人在工业生产中的应用,正在占据越来越大的比例。同时,机器***的应用已经向批量更大,精度更高,结构更复杂的方向发展。因此,机器***在实际进行工业应用过程中,需要将工件测量值与机器***基准坐标系进行耦合来应对复杂的工业应用场景。
现有技术中,通过在机器***上设置激光测距传感器,使用机器定位保证激光测距传感器的测量方向与机器***某已知坐标系的一个轴平行,令传感器的原点与坐标系原点有固定的位置关系,来对工件测量值与机器***基准坐标系进行耦合。或者,使用机器人某个已知的工具坐标系接触标定点,得到标定点的具***置,再通过将激光测距传感器的光斑对准标定点,从而计算出机器人工具坐标系。
然而,在采用上述方法对工件测量值与机器***基准坐标系进行耦合时,工具坐标系标定过程复杂,得到的工件测量值的测量精度较差。
发明内容
本发明解决的是工具坐标系标定过程复杂,得到的工件测量值的精确度较差。
为解决上述技术问题,本发明实施例提供一种工具坐标系的标定方法,包括:
确定机器***在测量范围内的基准点;获取N组测量数据,所述N组测量数据在所述机器***移动过程中得到,且每一组测量数据包括:所述机器***上的第一预设点与所述基准点的距离,所述机器***上第二预设点的位置;在所述N组测量数据中,两个所述第一预设点的位置连成的直线经过所述基准点,至少三个所述第二预设点的位置构成一个确定的平面;N≥3;
确定工具坐标系的原点,根据所述N组测量数据,完成所述工具坐标系的标定。
可选的,确定所述工具坐标系的坐标原点为所述第一预设点。
可选的,基于预设的机器***对应的基准坐标系,确定旋转矩阵RLT和平移矩阵PLT来完成所述工具坐标系的标定;
按照以下公式基于ZYX欧拉角顺序计算旋转矩阵RLT和平移矩阵PLT:
P(x,y,z)=[x y z]T,
其中,x为第二预设点的位置的X轴坐标,y为第二预设点的Y轴坐标,z为第二预设点的Z轴坐标;第二预设点与所述基准坐标系的原点连线为交点线,a为所述交点线与Z轴间的夹角,b为所述交点线与Y轴间的夹角,c为所述交点线与X轴间的夹角,T表示矩阵的转置。
可选的,所述旋转矩阵RLT包括以下参数:
其中,在基准坐标系中,XP0为所述机器***置于第一位置时所述第二预设点的位置数据;保持所述第一预设点与所述基准点之间的测距方向,所述机器***从第一位置移动至第二位置,XP1为所述机器***置于第二位置时所述第二预设点的位置数据;所述机器***从第一位置或第二位置移动至第三位置,XPH为所述机器***置于第三位置时所述第二预设点的位置数据。
可选的,所述平移矩阵PLT按照如下公式计算:
其中,PLi为根据所述机器***处于第二位置或第三位置时,第一预设点与所述基准点的距离Li得到的参数矩阵,n=N。
可选的,以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的X轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[Li 0 0]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
可选的,以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Y轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[0 Li 0]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
可选的,以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Z轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[0 0 Li]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
可选的,所述工具坐标系的标定误差按照以下公式计算:
本发明还提供一种工具坐标系的标定装置,包括:基准点确定单元,用于确定机器***在测量范围内的基准点;测量数据获取单元,用于获取N组测量数据,所述N组测量数据在所述机器***移动过程中得到,且每一组测量数据包括:所述机器***上的第一预设点与所述基准点的距离,所述机器***上第二预设点的位置;在所述N组测量数据中,两个所述第一预设点的位置连成的直线经过所述基准点,至少三个所述第二预设点的位置构成一个确定的平面;N≥3;工具坐标系标定单元,用于确定工具坐标系的原点,根据所述N组测量数据,完成所述工具坐标系的标定。
可选的,所述工具坐标系标定单元,还用于确定所述工具坐标系的坐标原点为所述第一预设点。
可选的,所述工具坐标系标定单元,还用于基于预设的机器***对应的基准坐标系,确定旋转矩阵RLT和平移矩阵PLT来完成所述工具坐标系的标定;
按照以下公式基于ZYX欧拉角顺序计算旋转矩阵RLT和平移矩阵PLT:
P(x,y,z)=[x y z]T,
其中,x为第二预设点的位置的X轴坐标,y为第二预设点的Y轴坐标,z为第二预设点的Z轴坐标;第二预设点与所述基准坐标系的原点连线为交点线,a为所述交点线与Z轴间的夹角,b为所述交点线与Y轴间的夹角,c为所述交点线与X轴间的夹角,T表示矩阵的转置。
可选的,所述工具坐标系标定单元在计算所述旋转矩阵RLT时采用以下参数:
其中,在基准坐标系中,XP0为所述机器***置于第一位置时所述第二预设点的位置数据;保持所述第一预设点与所述基准点之间的测距方向,所述机器***从第一位置移动至第二位置,XP1为所述机器***置于第二位置时所述第二预设点的位置数据;所述机器***从第一位置或第二位置移动至第三位置,XPH为所述机器***置于第三位置时所述第二预设点的位置数据。
可选的,所述工具坐标系标定单元在计算所述平移矩阵PLT按照如下公式计算:
其中,PLi为根据所述机器***处于第二位置或第三位置时,第一预设点与所述基准点的距离Li得到的参数矩阵,n=N。
可选的,所述工具坐标系标定单元,还用于以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的X轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[Li 0 0]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
可选的,所述工具坐标系标定单元,还用于以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Y轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[0 Li 0]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
可选的,所述的工具坐标系标定单元,还用于以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Z轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[0 0 Li]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
可选的,所述工具坐标系标定单元,还用于按照以下公式计算所述工具坐标系的标定误差:
本发明还提供一种计算机可读存储介质,其上存储有计算机指令,所述计算机指令运行时执行上述任一种所述的工具坐标系的标定方法的步骤。
本发明还提供一种工具坐标系的标定装置,包括存储器和处理器,所述存储器上存储有计算机指令,所述计算机指令运行时所述处理器执行上述任一种所述的工具坐标系的标定方法的步骤。
与现有技术相比,本发明的技术方案具有以下优点:通过自定义基准点、测距起始点与位置记录点,记录相关数据,并根据记录的相关数据基于机器***自带的基准坐标系标定工具坐标系,所述工具坐标系的标定过程简洁、快速,使用所述工具坐标系得到的测量值的精确度高。
进一步,根据记录的相关数据,计算标定的工具坐标系的误差,进一步提高使用所述工具坐标系得到的测量值的精确度。
附图说明
图1是本发明实施例中的一种工具坐标系的标定方法的流程图;
图2是本发明实施例中的一种机器***的结构示意图;
图3是本发明实施例中的一种机器***移动示意图;
图4是本发明实施例中的一种工具坐标系的标定装置的结构示意图。
具体实施方式
现有技术中,对工件进行测量的技术方案一:通过在机器***上设置激光测距传感器,使用机器定位保证激光测距传感器的测量方向与机器***某已知坐标系的一个轴平行,令传感器的原点与坐标系原点有固定的位置关系,来对工件测量值与机器***基准坐标系进行耦合。
技术方案二:使用机器人某个已知的工具坐标系接触标定点,得到标定点的具***置,再通过将激光测距传感器的光斑对准标定点,从而计算出机器人工具坐标系。
然而,上述技术方案一存在的问题是,简单的机械定位会出现误差,但误差无法被量化和补偿,导致精度较差。技术方案二存在的问题是,需要使用某个已知的机器***坐标系,当该坐标系的标定不精确时会出现累计误差。
本发明通过自定义基准点、测距起始点与位置记录点,记录相关数据,并根据记录的相关数据基于机器***自带的基准坐标系标定工具坐标系,所述工具坐标系的标定过程简洁、快速,使用所述工具坐标系得到的测量值的精确度高,进一步,根据记录的相关数据,计算标定的工具坐标系的误差,进一步提高使用所述工具坐标系得到的测量值的精确度。
为使本发明的上述目的、特征和有益效果能够更为明显易懂,下面结合附图对本发明的具体实施例做详细的说明。
本发明提供一种工具坐标系的标定方法,参阅图1,通过以下具体步骤进行说明
步骤S101,确定机器***在测量范围内的基准点。
在本发明实施例中,可以基于机器***自带的基准坐标系标定工具坐标系。其中,工具坐标系的标定需要采集数据,而数据的采集需要设定一基准点作为参考物以确定采集的数据的物理意义。
在本发明实施例中,数据的采集可以由机器***本身或其他工具协助机器***完成,因此,所述基准点需要设定在机器***的传感器的测量范围内,或者其他工具的传感器的测量范围内。
步骤S102,获取N组测量数据。
在具体实施中,所述N组测量数据在所述机器***移动过程中得到,且每一组测量数据包括:所述机器***上的第一预设点与所述基准点的距离,所述机器***上第二预设点的位置;在所述N组测量数据中,两个所述第一预设点的位置连成的直线经过所述基准点,至少三个所述第二预设点的位置构成一个确定的平面;N≥3。
在本发明实施例中,为了标定工具坐标系,至少需要获取三组测量数据。每组测量数据包括长度数据和坐标数据。所述长度数据为在所述机器***上第一预设点与所述基准点的距离,所述第一预设点可以为所述机器***上任意一点。所述长度数据的采集可以通过外界工具协助采集,也可以通过所述机器***上的激光测距传感器采集。
在实际应用中,参阅图2,给出了本发明实施例中的一种机器***的结构示意图。在图2中,采用所述机器***法兰末端的激光测距传感器进行长度数据采集。可以理解的是,激光测距传感器可以设置在所述机器***的任意位置。在这种采用激光测距传感器的情况下,激光测距传感器的激光发射点即为第一预设点。
在本发明实施例中,所述坐标数据为第二预设点的位置的坐标数据,所述第二预设点可以是所述机器***上任意一点。所述测量数据中所有的第二预设点的坐标数据的采集标准需要一致,即测量数据的采集需要在同一坐标系下完成,用于采集所述测量数据的坐标系可以通过外界工具协助设定;也可以使用所述机器***自带的基准坐标系完成。
在本发明实施例中,所述N组测量数据中,存在两个所述第一预设点的位置连成的直线经过所述基准点,至少三个所述第二预设点的位置构成一个确定的平面。即在移动所述机器***的过程中,一次移动过程后,所述第一预设点的位置在测量数据中的某个第一预设点与所述基准点的连线上。一次移动过程后,测量数据中存在三个所述第二预设点的位置不在同一直线上。
参阅图3,其中位置31、位置32和位置33符合所述测量数据的要求。其中,位置32相对与位置31没有改变机器***的姿态,即从位置31移动到位置32的过程中,保持所述第一预设点与所述基准点之间的测距方向;位置33相对于位置31或位置32改变了机器***的姿态。
可以理解的是,N的值越大,获取的有意义数据量多,工具坐标系标定的精准度高,且所述测量数据中,可以仅存在两个所述第一预设点的位置连成的直线经过所述基准点,即仅在一次移动中所述机器***保持所述机器***的姿态,在之后的机器***的移动过程中,均改变所述机器***的姿态。
步骤S103,确定工具坐标系的原点,根据所述N组测量数据,完成所述工具坐标系的标定。
在本发明实施例中,在获得N组测量数据后,可以进行工具坐标系的标定。进行工具坐标系的标定的第一步为确定工具坐标系的原点,所述工具坐标系的原点可以设定在任意位置。在确定坐标系原点后,根据N组测量数据计算完成所述工具坐标系的标定,所述工具坐标系的标定基于的坐标系为用于测量所述第二预设点位置的坐标系。
在本发明实施例中,为了方便对工件的测量和工具坐标系的标定,工具坐标系的原点可以设定于第一预设点的位置,参阅图2,在使用激光测距传感器的情况下,工具坐标系标定结果之一如图所示。
在本发明实施例中,为了完成对于工具坐标系的标定,需要计算得到旋转矩阵和平移矩阵,通过旋转矩阵和平移矩阵完成工具坐标系的标定,所述工具坐标系的标定基于测量所述第二预设点位置的坐标系。为了方便计算,可以使用机器***的基准坐标系,使用所述基准坐标系测量所述第二预设点位置,在上述情况下,所述工具坐标系的标定基于所述基准坐标系。
在本发明实施例中,基于基准坐标系标定工具坐标系,可以按照以下公式按照ZYX欧拉角顺序计算旋转矩阵RLT和平移矩阵PLT:
P(x,y,z)=[x y z]T,
其中,x为第二预设点的位置的X轴坐标,y为第二预设点的Y轴坐标,z为第二预设点的Z轴坐标;第二预设点与所述基准坐标系的原点连线为交点线,a为所述交点线与Z轴间的夹角,b为所述交点线与Y轴间的夹角,c为所述交点线与X轴间的夹角,T表示矩阵的转置。公式XP按照Z-Y-X欧拉角顺序进行转换。可以理解的是,本发明同样可以按照其他欧拉角或者偏航角进行计算,此处不赘述。
在本发明实施例中,所述旋转矩阵RLT包括以下参数:
其中,基准坐标系可以是机器***自带的坐标系,采用的公式为
XP0代入的坐标数据为所述机器***置于第一位置时所述第二预设点的位置数据,保持所述第一预设点与所述基准点之间的测距方向,所述机器***从第一位置移动至第二位置,XP1代入的坐标为所述机器***置于第二位置时所述第二预设点的位置数据,所述机器***从第一位置或第二位置移动至第三位置,XPH代入的坐标为所述机器***置于第三位置时所述第二预设点的位置数据。
在本发明实施例中,保持所述第一预设点与所述基准点之间的测距方向,所述机器***从第一位置移动至第二位置,可以理解为移动过后,所述第一预设点的位置在移动前所述第一预设点与所述基准点的连线上。所述机器***分别在第一位置、第二位置和第三位置时的三个所述第二预设点的位置可以构成一个确定的平面。
在本发明实施例中,所述平移矩阵PLT按照如下公式计算:
其中,PLi为根据所述机器***处于第二位置或第三位置时,第一预设点与所述基准点的距离Li得到的参数矩阵,即可以不采用所述机器***处于第一位置时所述第一预设点与所述基准点的距离,n=N,Ri为通过公式
代入相应的所述第二预设点的位置数据得到,Pi为通过公式P(x,y,z)=[x y z]T代入相应的第二预设点的位置数据得到。
在本发明实施例中,工具坐标系的原点可以设定于第一预设点的位置,以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的X轴,所述旋转矩阵RLT按照以下公式计算:
或
其中,在以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的X轴后,所述工具坐标系的其他两轴没有确定,因此旋转矩阵RLT有两个可选。
在本发明实施例中,在确定工具坐标系的X轴后,所述平移矩阵PLT中的参数PLi可以确定,所述参数矩阵PLi=[Li 0 0]T。
在本发明实施例中,工具坐标系的原点可以设定于第一预设点的位置,以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Y轴,所述旋转矩阵RLT按照以下公式计算:
或
其中,在以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Y轴后,所述工具坐标系的其他两轴没有确定,因此旋转矩阵RLT有两个可选。
在本发明实施例中,工具坐标系的原点可以设定于第一预设点的位置,在确定工具坐标系的Y轴后,所述平移矩阵PLT中的参数PLi可以确定,所述参数矩阵PLi=[0 Li 0]T。
在本发明实施例中,以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Z轴,所述旋转矩阵RLT按照以下公式计算:
或
其中,在以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Z轴后,所述工具坐标系的其他两轴没有确定,因此旋转矩阵RLT有两个可选。
在本发明实施例中,在确定工具坐标系的Z轴后,所述平移矩阵PLT中的参数PLi可以确定,所述参数矩阵PLi=[0 0 Li]T。
在本发明实施例中,通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
在本发明实施例中,在完成工具坐标系的标定后,所述工具坐标系的标定误差按照以下公式计算:
根据该公式可以计算得到工具坐标系的误差,因此可以进一步提升工具坐标系标定的精确度。
参阅图4,本发明另一方面还提供一种工具坐标系的标定装置40,所述工具坐标系的标定装置40包括:基准点确定单元401,用于确定机器***在测量范围内的基准点;测量数据获取单元402,用于获取N组测量数据,所述N组测量数据在所述机器***移动过程中得到,且每一组测量数据包括:所述机器***上的第一预设点与所述基准点的距离,所述机器***上第二预设点的位置;在所述N组测量数据中,两个所述第一预设点的位置连成的直线经过所述基准点,至少三个所述第二预设点的位置构成一个确定的平面;N≥3;工具坐标系标定单元403,用于确定工具坐标系的原点,根据所述N组测量数据,完成所述工具坐标系的标定。
所述工具坐标系标定单元403,还用于基于所述基准坐标系,确定旋转矩阵RLT和平移矩阵PLT来完成所述工具坐标系的标定;
按照以下公式基于ZYX欧拉角顺序计算旋转矩阵RLT和平移矩阵PLT:
P(x,y,z)=[x y z]T,
其中,x为第二预设点的位置的X轴坐标,y为第二预设点的Y轴坐标,z为第二预设点的Z轴坐标;第二预设点与所述基准坐标系的原点连线为交点线,a为所述交点线与Z轴间的夹角,b为所述交点线与Y轴间的夹角,c为所述交点线与X轴间的夹角。
所述工具坐标系标定单元403在计算所述旋转矩阵RLT时采用以下参数:
其中,基于基准坐标系,XP0代入的坐标数据为所述机器***置于第一位置时所述第二预设点的位置数据,保持所述第一预设点与所述基准点之间的测距方向,所述机器***从第一位置移动至第二位置,XP1代入的坐标为所述机器***置于第二位置时所述第二预设点的位置数据,所述机器***从第一位置或第二位置移动至第三位置,XPH代入的坐标为所述机器***置于第三位置时所述第二预设点的位置数据。
所述工具坐标系标定单元403在计算所述平移矩阵PLT按照如下公式计算:
其中,PLi为根据所述机器***处于第二位置或第三位置时,第一预设点与所述基准点的距离Li得到的参数矩阵,n=N。
所述工具坐标系标定单元403,还用于以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的X轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[Li 0 0]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
所述工具坐标系标定单元403,还用于以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Y轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[0 Li 0]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
所述的工具坐标系标定单元403,还用于以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Z轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[0 0 Li]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
所述工具坐标系标定单元403,还用于按照以下公式计算所述工具坐标系的标定误差:
本发明还提供一种计算机可读存储介质,其上存储有计算机指令,其特征在于,所述计算机指令运行时执行上述任一种所述的工具坐标系的标定方法的步骤。
本发明还提供一种工具坐标系的标定装置,包括存储器和处理器,所述存储器上存储有计算机指令,所述计算机指令运行时所述处理器执行上述任一种所述的工具坐标系的标定方法的步骤。
本领域普通技术人员可以理解上述实施例的各种方法中的全部或部分步骤是可以通过程序来指示相关的硬件来完成,该程序可以存储于一计算机可读存储介质中,存储介质可以包括:ROM、RAM、磁盘或光盘等。
虽然本发明披露如上,但本发明并非限定于此。任何本领域技术人员,在不脱离本发明的精神和范围内,均可作各种更动与修改,因此本发明的保护范围应当以权利要求所限定的范围为准。
Claims (20)
1.一种工具坐标系的标定方法,其特征在于,包括:
确定机器***在测量范围内的基准点;
获取N组测量数据,所述N组测量数据在所述机器***移动过程中得到,且每一组测量数据包括:所述机器***上的第一预设点与所述基准点的距离,所述机器***上第二预设点的位置;在所述N组测量数据中,两个所述第一预设点的位置连成的直线经过所述基准点,至少三个所述第二预设点的位置构成一个确定的平面;N≥3;
确定工具坐标系的原点,根据所述N组测量数据,完成所述工具坐标系的标定。
2.根据权利要求1所述的工具坐标系的标定方法,其特征在于,所述确定工具坐标系的原点,包括:
确定所述工具坐标系的坐标原点为所述第一预设点。
3.根据权利要求2所述的工具坐标系的标定方法,其特征在于,所述根据所述N组测量数据,完成所述工具坐标系的标定,包括:
基于预设的机器***对应的基准坐标系,确定旋转矩阵RLT和平移矩阵PLT来完成所述工具坐标系的标定;
按照以下公式基于ZYX欧拉角顺序计算旋转矩阵RLT和平移矩阵PLT:
P(x,y,z)=[x y z]T,
其中,x为第二预设点的位置的X轴坐标,y为第二预设点的Y轴坐标,z为第二预设点的Z轴坐标;第二预设点与所述基准坐标系的原点连线为交点线,a为所述交点线与Z轴间的夹角,b为所述交点线与Y轴间的夹角,c为所述交点线与X轴间的夹角,T表示矩阵的转置。
4.根据权利要求3所述的工具坐标系的标定方法,其特征在于,所述根据所述N组测量数据,完成所述工具坐标系的标定,包括:
所述旋转矩阵RLT包括以下参数:
其中,在基准坐标系中,XP0为所述机器***置于第一位置时所述第二预设点的位置数据;保持所述第一预设点与所述基准点之间的测距方向,所述机器***从第一位置移动至第二位置,XP1为所述机器***置于第二位置时所述第二预设点的位置数据;所述机器***从第一位置或第二位置移动至第三位置,XPH为所述机器***置于第三位置时所述第二预设点的位置数据。
5.根据权利要求4所述的工具坐标系的标定方法,其特征在于,所述根据所述N组测量数据,完成所述工具坐标系的标定,包括:
所述平移矩阵PLT按照如下公式计算:
其中,PLi为根据所述机器***处于第二位置或第三位置时,第一预设点与所述基准点的距离Li得到的参数矩阵,n=N。
6.根据权利要求5所述的工具坐标系的标定方法,其特征在于,所述根据所述N组测量数据,完成所述工具坐标系的标定,包括:
以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的X轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[Li 0 0]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
7.根据权利要求5所述的工具坐标系的标定方法,其特征在于,所述根据所述N组测量数据,完成所述工具坐标系的标定,包括:
以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Y轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[0 Li 0]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
8.根据权利要求5所述的工具坐标系的标定方法,其特征在于,所述根据所述N组测量数据,完成所述工具坐标系的标定,包括:
以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Z轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[0 0 Li]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
9.根据权利要求6-8任意一项所述的工具坐标系的标定方法,其特征在于,所述根据所述N组测量数据,完成所述工具坐标系的标定,包括:
所述工具坐标系的标定误差按照以下公式计算:
10.一种工具坐标系的标定装置,其特征在于,包括:
基准点确定单元,用于确定机器***在测量范围内的基准点;
测量数据获取单元,用于获取N组测量数据,所述N组测量数据在所述机器***移动过程中得到,且每一组测量数据包括:所述机器***上的第一预设点与所述基准点的距离,所述机器***上第二预设点的位置;在所述N组测量数据中,两个所述第一预设点的位置连成的直线经过所述基准点,至少三个所述第二预设点的位置构成一个确定的平面;N≥3;
工具坐标系标定单元,用于确定工具坐标系的原点,根据所述N组测量数据,完成所述工具坐标系的标定。
11.根据权利要求10所述的工具坐标系的标定装置,其特征在于,
所述工具坐标系标定单元,还用于确定所述工具坐标系的坐标原点为所述第一预设点。
12.根据权利要求11所述的工具坐标系的标定装置,其特征在于,
所述工具坐标系标定单元,还用于基于预设的机器***对应的基准坐标系,确定旋转矩阵RLT和平移矩阵PLT来完成所述工具坐标系的标定;
按照以下公式基于Z Y X欧拉角顺序计算旋转矩阵RLT和平移矩阵PLT:
P(x,y,z)=[x y z]T,
其中,x为第二预设点的位置的X轴坐标,y为第二预设点的Y轴坐标,z为第二预设点的Z轴坐标;第二预设点与所述基准坐标系的原点连线为交点线,a为所述交点线与Z轴间的夹角,b为所述交点线与Y轴间的夹角,c为所述交点线与X轴间的夹角,T表示矩阵的转置。
13.根据权利要求12所述的工具坐标系的标定装置,其特征在于,
所述工具坐标系标定单元在计算所述旋转矩阵RLT时采用以下参数:
其中,在基准坐标系中,XP0为所述机器***置于第一位置时所述第二预设点的位置数据;保持所述第一预设点与所述基准点之间的测距方向,所述机器***从第一位置移动至第二位置,XP1为所述机器***置于第二位置时所述第二预设点的位置数据;所述机器***从第一位置或第二位置移动至第三位置,XPH为所述机器***置于第三位置时所述第二预设点的位置数据。
14.根据权利要求13所述的工具坐标系的标定装置,其特征在于,
所述工具坐标系标定单元在计算所述平移矩阵PLT按照如下公式计算:
其中,PLi为根据所述机器***处于第二位置或第三位置时,第一预设点与所述基准点的距离Li得到的参数矩阵,n=N。
15.根据权利要求14所述的工具坐标系的标定装置,其特征在于,
所述工具坐标系标定单元,还用于以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的X轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[Li 0 0]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
16.根据权利要求14所述的工具坐标系的标定装置,其特征在于,
所述工具坐标系标定单元,还用于以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Y轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[0 Li 0]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
17.根据权利要求14所述的工具坐标系的标定装置,其特征在于,
所述工具坐标系标定单元,还用于以所述第一预设点与所述基准点之间的测距方向作为所述工具坐标系的Z轴,所述旋转矩阵RLT按照以下公式计算:
或
所述参数矩阵PLi=[0 0 Li]T;
通过所述旋转矩阵RLT和平移矩阵PLT,完成基于所述基准坐标系的所述工具坐标系的标定。
18.根据权利要求15-17任意一项所述的工具坐标系的标定装置,其特征在于,所述工具坐标系标定单元,还用于按照以下公式计算所述工具坐标系的标定误差:
19.一种计算机可读存储介质,其上存储有计算机指令,其特征在于,所述计算机指令运行时执行权利要求1~9任一项所述的工具坐标系的标定方法的步骤。
20.一种工具坐标系的标定装置,包括存储器和处理器,所述存储器上存储有计算机指令,其特征在于,所述计算机指令运行时所述处理器执行权利要求1~9任一项所述的工具坐标系的标定方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810644149.1A CN108592838B (zh) | 2018-06-21 | 2018-06-21 | 工具坐标系的标定方法、装置以及计算机存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810644149.1A CN108592838B (zh) | 2018-06-21 | 2018-06-21 | 工具坐标系的标定方法、装置以及计算机存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108592838A true CN108592838A (zh) | 2018-09-28 |
CN108592838B CN108592838B (zh) | 2021-01-22 |
Family
ID=63628547
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810644149.1A Active CN108592838B (zh) | 2018-06-21 | 2018-06-21 | 工具坐标系的标定方法、装置以及计算机存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108592838B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112161598A (zh) * | 2020-09-30 | 2021-01-01 | 深圳中科飞测科技有限公司 | 一种检测设备的检测方法及检测装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102087096A (zh) * | 2010-11-12 | 2011-06-08 | 浙江大学 | 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法 |
CN103175485A (zh) * | 2013-02-20 | 2013-06-26 | 天津工业大学 | 一种飞机涡轮发动机叶片修复机器人的视觉标定方法 |
CN105157567A (zh) * | 2015-05-15 | 2015-12-16 | 天津智通机器人有限公司 | 一种测量机器人的工具坐标系标定方法及*** |
WO2016074646A1 (zh) * | 2014-11-14 | 2016-05-19 | 深圳配天智能技术研究院有限公司 | 一种工具在机器人法兰坐标系上的标定方法及装置 |
CN106426172A (zh) * | 2016-10-27 | 2017-02-22 | 深圳元启智能技术有限公司 | 一种工业机器人工具坐标系的标定方法与*** |
-
2018
- 2018-06-21 CN CN201810644149.1A patent/CN108592838B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102087096A (zh) * | 2010-11-12 | 2011-06-08 | 浙江大学 | 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法 |
CN103175485A (zh) * | 2013-02-20 | 2013-06-26 | 天津工业大学 | 一种飞机涡轮发动机叶片修复机器人的视觉标定方法 |
WO2016074646A1 (zh) * | 2014-11-14 | 2016-05-19 | 深圳配天智能技术研究院有限公司 | 一种工具在机器人法兰坐标系上的标定方法及装置 |
CN105157567A (zh) * | 2015-05-15 | 2015-12-16 | 天津智通机器人有限公司 | 一种测量机器人的工具坐标系标定方法及*** |
CN106426172A (zh) * | 2016-10-27 | 2017-02-22 | 深圳元启智能技术有限公司 | 一种工业机器人工具坐标系的标定方法与*** |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112161598A (zh) * | 2020-09-30 | 2021-01-01 | 深圳中科飞测科技有限公司 | 一种检测设备的检测方法及检测装置 |
CN112161598B (zh) * | 2020-09-30 | 2022-07-05 | 深圳中科飞测科技股份有限公司 | 一种检测设备的检测方法及检测装置 |
Also Published As
Publication number | Publication date |
---|---|
CN108592838B (zh) | 2021-01-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107995885B (zh) | 一种坐标系标定方法 、***及装置 | |
US10422619B2 (en) | Identification of geometric deviations of a motion guide in a coordinate-measuring machine or in a machine tool | |
CN101918792B (zh) | 用于校准坐标测量装置的方法及其坐标测量机 | |
JP5331802B2 (ja) | 測定機及びその動的変形による測定誤差の補正方法 | |
TWI424164B (zh) | 差動校準 | |
JP6030339B2 (ja) | 形状測定装置 | |
CN107152911A (zh) | 基于psd反馈的点激光传感器与机器人相对位置的标定方法 | |
CN107718050A (zh) | Scara机器人臂长与零点标定方法、装置、介质及计算机设备 | |
CN104972361A (zh) | 计测*** | |
CN107901038B (zh) | 一种位置标定方法、装置、双臂机器人及存储介质 | |
CN109719722B (zh) | 一种精确标定机器人末端与视觉***的方法 | |
CN104354166A (zh) | 一种三自由度并联机器人的零点标定方法 | |
CN110560892B (zh) | 一种基于激光切管设备的管材识别方法及装置 | |
CN111531533A (zh) | 一种六维力传感器的零点校正及重力补偿方法 | |
CN110211174A (zh) | 曲面测量装置标定的方法、设备和存储介质 | |
CN107726982A (zh) | 一种激光测距传感器安装位置误差标定方法 | |
CN114012585A (zh) | 一种双摆轴式五轴磁流变机床抛光点位置标定方法 | |
CN106989670A (zh) | 一种机器人协同的非接触式高精度大型工件跟踪测量方法 | |
CN106671081B (zh) | 一种基于单目视觉的少自由度机器人运动学标定方法 | |
CN115319727A (zh) | 一种基于位姿约束和力感知的机器人标定方法 | |
CN113799130B (zh) | 一种人机协作装配中的机器人位姿标定方法 | |
CN115122333A (zh) | 机器人标定方法、装置、电子设备及存储介质 | |
CN108592838A (zh) | 工具坐标系的标定方法、装置以及计算机存储介质 | |
TWI323685B (zh) | ||
CN106123817B (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 |