CN103376076A - 三次元测针补偿及空间误差测定系统及方法 - Google Patents

Abstract

一种三次元测针补偿及空间误差测定系统及方法，包括：提供一带有支撑杆的标准球；按比例将标准球分成多层，根据标准球的半径、标准球顶点的坐标及在标准球上取点的个数，计算各表面点的坐标及向量，得到坐标集；将测杆的法向、标准球的法向进行差乘得到旋转法向N3，将标准球绕该旋转法向N3旋转后得到旋转矩阵；将该旋转矩阵与所述各表面点的坐标相乘，计算得到所述各表面点的新坐标，并利用各表面点的新坐标更新所述坐标集；根据上述坐标集生成量测程序以控制测针实际量测工件两次，得到两个点集；及根据该两个点集计算测针的补偿值以补偿该测针，并计算该测针的空间误差。利用本发明可提高测针的补偿精度和效率。

Description

三次元测针补偿及空间误差测定系统及方法

技术领域

本发明涉及一种三次元量测系统及方法，尤其涉及一种三次元测针补偿及空间误差测定系统及方法。

背景技术

三次元机台的硬件精度主要包含：测针系统的精度、光学尺的精度、机器本体架构（Frame）的精度。其中，测针系统（包含旋转部件、感应部件、测杆、测头等）的精度最为重要，其直接关系到量测点的精度。然而，在制造与日益使用过程中，测针系统会因为磨损造成精度的丢失，因此，需要对测针系统的精度进行补偿。

发明内容

鉴于以上内容，有必要提供一种三次元测针补偿及空间误差测定系统，其通过对一个标准球的分层取点与计算，来避开量测时容易撞针的部位，并通过两次量测来提高测针的补偿精度和效率。

还有必要提供一种三次元测针补偿及空间误差测定方法，其通过对一个标准球的分层取点与计算，来避开量测时容易撞针的部位，并通过两次量测来提高测针的补偿精度和效率。

一种三次元测针补偿及空间误差测定系统，运行于电子装置中，所述测针包括测头及与三次元机台连接的测杆。该系统包括：导入模块用于提供一个带有支撑杆的标准球，导入该标准球的半径R1、该支撑杆的半径R2、该标准球顶部任意点的坐标PT及测杆的法向N1；表面点计算模块用于按照比例将该标准球分成多层，并根据该标准球的半径R1、所述顶部任意点的坐标PT及在所述标准球上点取的表面点的个数Num，计算出所述点取的各表面点的坐标及向量，得到坐标集PTS；旋转模块用于将所述测杆的法向N1、标准球的法向N2进行差乘得到旋转法向N3，将所述标准球绕该旋转法向N3旋转一个预设角度得到旋转矩阵mat；表面点更新模块用于将该旋转矩阵mat与所述各表面点的坐标相乘，计算得到所述各表面点的新坐标，并利用各表面点的新坐标更新所述坐标集PTS；实际量测模块用于根据上述坐标集PTS生成量测程序，将该量测程序传送给三次元机台以控制所述测针实际量测工件两次，分别得到实际量测的点集Refs和Meas；及补偿与误差测定模块用于根据实际量测的点集Refs和Meas、标准球的半径R1及测头的半径R3计算该测针的补偿值，利用该补偿值补偿该测针，并根据实际量测的点集Refs和Meas计算该测针的空间误差。

一种三次元测针补偿及空间误差测定方法，应用于电子装置中，其中，所述测针包括测头及与三次元量测机台连接的测杆，该方法包括：提供一个带有支撑杆的标准球，导入该标准球的半径R1、该支撑杆的半径R2、该标准球顶部任意点的坐标PT及测杆的法向N1；按照比例将该标准球分成多层，并根据该标准球的半径R1、所述顶部任意点的坐标PT及在所述标准球上点取的表面点的个数Num，计算出所述点取的各表面点的坐标及向量，得到坐标集PTS；将所述测杆的法向N1、标准球的法向N2进行差乘得到旋转法向N3，将所述标准球绕该旋转法向N3旋转一个预设角度得到旋转矩阵mat；将该旋转矩阵mat与所述各表面点的坐标相乘，计算得到所述各表面点的新坐标，并利用各表面点的新坐标更新所述坐标集PTS；根据上述坐标集PTS生成量测程序，将该量测程序传送给三次元机台以控制所述测针实际量测工件两次，分别得到实际量测的点集Refs和Meas；及根据实际量测的点集Refs和Meas、标准球的半径R1及测头的半径R3计算该测针的补偿值，利用该补偿值补偿该测针，并根据实际量测的点集Refs和Meas计算该测针的空间误差。

相较于现有技术，所述的三次元测针补偿及空间误差测定系统及方法，通过对高精度陶瓷标准球的分层取点及按照算法的自定比例取点，使测头各部位区域基本能接触到，能反应测头真实使用情况。

附图说明

图1是本发明较佳实施例中的三次元测针补偿及空间误差测定系统的运行环境示意图。

图2是图1中电子装置的结构示意图。

图3是本发明较佳实施例中的三次元测针补偿及空间误差测定方法的作业流程图。

图4是图3步骤S202中按照比例将标准球划分为五层的示意图。

图5是图3步骤S202中计算每个表面点的坐标的示意图。

图6是图3步骤S204中计算旋转法向N3的示意图。

图7和图8是图3步骤S208中重新计算标准球的表面点的坐标的示意图。

主要元件符号说明

电子装置	1
		测针	2
测头	20
		测杆	22
标准球	30
		支撑杆	32
三次元测针补偿及空间误差测定系统	10
		存储设备	12
处理器	14
		导入模块	100
表面点计算模块	102
		旋转模块	104
表面点更新模块	106
		实际量测模块	108
补偿与误差测定模块	110

如下具体实施方式将结合上述附图进一步说明本发明。

具体实施方式

如图1所示，是本发明较佳实施例中的三次元测针补偿及空间误差测定系统的运行环境示意图。该三次元测针补偿及空间误差测定系统10（以下简称为“系统10”）运行于一台电子装置1中，该电子装置1用于控制一个三次元机台（图中未示出）的测针2量测工件。其中，测针2包括测头20、测杆22、转部件（图中未示出）和感应部件（图中未示出）。

为了减少测针2量测工件时的撞针，本实施例通过对一个带有支撑杆32的标准球30进行分层取点与计算，来生成量测程序。系统10利用该量测程序控制测针2两次实际量测工件，并根据量测的数据对所述测针2进行补偿及测定该测针2所在的空间误差。如图8所示，所述标准球30与支撑杆32相连。另外，通过对所述标准球30的分层取点与计算，还可以避开量测时容易撞针的部位，及通过所述两次量测可以提高测针2的补偿精度和效率。

在本实施例中，所述标准球30是一个由高精度陶瓷支撑的球体，该标准球30的半径比测头20的半径大，且比支撑杆32的半径大。

如图2所示，是图1中电子装置1的结构示意图。在该示意图中，电子装置1除了包括所述系统10外，还包括存储设备12和至少一个处理器14。在本实施例中，所述系统10以软件程序或指令的形式安装在该存储设备12中，并由处理器14执行。该系统10包括导入模块100、表面点计算模块102、旋转模块104、表面点更新模块106、实际量测模块108及补偿与误差测定模块110。本发明所称的模块是完成一特定功能的计算机程序段，比程序更适合于描述软件在计算机中的执行过程，因此在本发明以下对软件描述都以模块描述。

所述导入模块100用于从存储设备12中导入所述标准球的半径R1、支撑杆的半径R2、该标准球30顶部任意点的坐标PT及所述测杆22的法向N1。

所述表面点计算模块102用于按照比例将该标准球30分成多层，并根据该标准球30的半径R1、所述顶部任意点的坐标PT及在所述标准球30上点取的表面点（即在标准球30上取点）的个数Num，计算出所述点取的各表面点的坐标及向量，得到坐标集PTS。本实施例中，在所述标准球30上取点的个数Num可预先设定，标准取点个数为二十五个或二十五个以上。

例如，表面点计算模块102根据标准球30的半径R1、所述顶部任意点的坐标PT及在所述标准球30上取点的个数为Num，按照比例把该标准球30分成多层。由于量测时，标准球30的下半部分不会与工件接触，因此，本实施例将该标准球30的上半部分进行等比例划分，如图4所示，以22.5度的夹角将该标准球30的上半部分进行等比例划分后共得到五层，每层上的表面点的个数可以由公式大致计算得出。如第一层的表面点个数=(Num-1)*33.3%，第二层的表面点个数=(Num-1)*16.7%，第三层的表面点个数=(Num-1)*33.3%，第四层的表面点个数=(Num-1)*16.7%，第五层的表面点个数=1。其中，第一层即所述标准球30的球心所在的层，第五层即所述标准球30顶点所在的层。

其中，该标准球30的球心坐标ptCenter=PT-R1。具体地，该球心坐标中的x值ptCenter.x等于所述顶部任意点的坐标PT在x轴上的值，该球心坐标中的y值ptCenter.y等于所述坐标PT在y轴上的值，及该球心坐标中的z值ptCenter.z等于所述坐标PT在z轴上的值与标准球30的半径R1间的差值。

而每层的圆心坐标pt=ptStepCenter+sin(22.5)*R1。具体地，圆心坐标中的x值ptStepCenter.x=ptCenter.x，圆心坐标中的y值ptStepCenter.y=ptCenter.y，圆心坐标中的z值ptStepCenter.z=ptCenter.z+sin(22.5°)*R1。

如图5所示，假设每层上每两个表面点间的夹角为a，则a=360/每层表面点的个数，其中，第一个表面点（简称“第一点”）的坐标=ptStepCenter.x+R1，第n点的坐标=第一点绕轴(0,0,1)旋转角度(a*n)后的坐标，所述表面点计算模块102由每个表面点的坐标指向标准球30的球心得到每个表面点的向量。所述表面点计算模块102由上述计算出的各表面点的坐标及向量得到所述坐标集PTS。

所述旋转模块104用于将如图6所示的测杆22的法向N1、标准球30的法向N2进行差乘得到旋转法向N3，将所述标准球30绕该旋转法向N3旋转一个预设角度得到旋转矩阵mat。其中，该预设角度等于所述测杆22的法向N1与标准球30的法向N2间的夹角。

所述表面点更新模块106用于将该旋转矩阵mat与所述各表面点的坐标相乘，计算得到所述各表面点的新坐标，并利用各表面点的新坐标更新所述坐标集PTS。

为了提高补偿精度，本实施例需要避开量测时容易撞针的部位，因此，需要对所述各表面点的新坐标进行再次更新。具体而言，所述表面点更新模块106将所述支撑杆32和标准球30的交点的坐标与上述每层中各表面点的新坐标进行比较。当某个新坐标的Z值小于所述交点的Z值时，重新计算该新坐标所在层上各表面点的坐标值，并利用该重新计算出的坐标值更新所述坐标集PTS。经过旋转后的表面点的坐标可能会比支撑杆32和标准球30的球面的交点的位置还小，因此要避开如图7所示的该支撑杆32和标准球30的所有交点，通过下述公式重新计算所述各表面点的坐标：第n点坐标=第一点绕轴(0,0,1)旋转角度((360-a1)*n)后的坐标。所述表面点更新模块106利用该重新计算出的坐标更新所述坐标集PTS。

所述实际量测模块108用于根据上述更新后的坐标集PTS生成量测程序，并将该量测程序传送给三次元机台，以控制所述测针2实际量测工件。本实施例中，为了提高补偿精度，会控制测针2实际量测工件两次，并由此得到实际量测点集Refs和Meas。

本实施例中，所述量测程序为I++量测程序。I++是三次元业界中的通用格式，适合大部分量测机台。例如，所述量测程序中各表面点的坐标与向量格式为：

C0001 PtMeas(IJK(-0.00000, -0.00000, 1.00000), X(0.00000), Y(0.00000), Z(0.00000))

C0002

PtMeas(X(9.23879533),Y(-3.82683432),Z(-12.00000000),IJK(0.92387953, -0.38268343, 0.00000000))

C0003

PtMeas(X(3.82683432),Y(-9.23879533),Z(-12.00000000),IJK(0.38268343, -0.92387953, 0.00000000))。

所述补偿与误差测定模块110用于根据实际量测的点集Refs和Meas、标准球的半径R1及测头20的半径R3计算出该测针2的补偿值，利用该补偿值补偿该测针2，并根据实际量测点集Refs和Meas计算测针2的空间误差。本实施例中，所述补偿值包括测头20的半径补偿值和球心补偿值。

具体地，所述补偿与误差测定模块110根据上述实际量测的点集Refs拟合第一参考球，得到球心ptRef及该第一参考球的半径rRef；根据所述实际量测点集Meas拟合第二参考球，得到球心ptMeas及该第二参考球的半径rMeas；根据所述测杆22的出厂标准长度得到所述标准球的球心坐标ptMorminal，该标准球的球心坐标ptMorminal等于（0，0，–标准长度）；利用公式计算出所述测头20的半径补偿值，该半径补偿值rOffset=rMeas–R1+stdProbeR，其中，stdProbeR为所述测头20的出厂标准半径；及利用公式计算出所述测头20的球心补偿值，该球心补偿值ptOffset=ptMeas+ptNorminal–ptRef。

另外，所述补偿与误差测定模块110利用公式计算出所述测针2的空间误差，该测针2的空间误差等于maxR–minR，其中，maxR为所述实际量测点集Meas中的表面点与所述第二参考球的球心间的最大距离，minR为所述实际量测点集Meas中的表面点与所述第二参考球的球心间的最小距离。

如图3所示，是本发明较佳实施例中的三次元测针补偿及空间误差测定方法的作业流程图。

步骤S300，提供一个带有支撑杆32的标准球30，导入模块100从存储设备12中导入所述标准球的半径R1、支撑杆的半径R2、该标准球30顶部任意点的坐标PT及所述测杆22的法向N1。

步骤S302，表面点计算模块102按照比例将该标准球30分成多层，并根据该标准球30的半径R1、所述顶部任意点的坐标PT及在所述标准球30上点取的表面点（即在标准球30上取点）的个数Num，计算出所述点取的各表面点的坐标及向量，得到坐标集PTS。

本实施例中，在所述标准球30上点取的表面点的个数Num一般为二十五个以上，所述标准球30可以被划分成五层。第一层为所述标准球30的球心所在的层，第五层为所述标准球30顶点所在的层。每层上的表面点的个数可以由公式大致计算得出。如第一层的表面点个数=(Num-1)*33.3%，第二层的表面点个数=(Num-1)*16.7%，第三层的表面点个数=(Num-1)*33.3%，第四层的表面点个数=(Num-1)*16.7%，第五层的表面点个数=1。所述各表面点的坐标与向量计算方法可如图2、图4至图5中的描述。

步骤S304，旋转模块104将测杆22的法向N1、标准球30的法向N2进行差乘得到旋转法向N3（如图6所示），将所述标准球30绕该旋转法向N3旋转一个预设角度得到旋转矩阵mat。其中，该预设角度等于所述测杆22的法向N1与标准球30的法向N2间的夹角。

步骤S306，所述表面点更新模块106将该旋转矩阵mat与所述各表面点的坐标相乘，计算得到所述各表面点的新坐标，并利用各表面点的新坐标更新所述坐标集PTS。

步骤S308，所述表面点更新模块106将所述支撑杆32和标准球30的交点的坐标与上述每层中各表面点的新坐标进行比较，当某个新坐标的Z值小于所述交点的Z值时，利用公式重新计算该新坐标所在层上各表面点的坐标值，并利用该重新计算出的坐标值更新所述坐标集PTS。在本实施例中，所述公式为：第n点坐标=第一点绕轴(0,0,1)旋转角度((360-a1)*n)后的坐标。

步骤S310，实际量测模块108根据上述更新后的坐标集PTS生成量测程序，并将该量测程序传送给三次元机台，以控制所述测针2实际量测工件。本实施例中，为了提高补偿精度，会控制测针2实际量测工件两次，并由此得到实际量测点集Refs和Meas。

步骤S312，补偿与误差测定模块110根据实际量测的点集Refs和Meas、标准球的半径R1及测头20的半径R3计算出该测针2的补偿值，利用该补偿值补偿该测针2，并根据实际量测点集Refs和Meas计算测针2的空间误差。本实施例中，所述补偿值包括测头20的半径补偿值和球心补偿值。

具体地，所述补偿与误差测定模块110根据上述实际量测的点集Refs拟合第一参考球，得到球心ptRef及该第一参考球的半径rRef；根据所述实际量测点集Meas拟合第二参考球，得到球心ptMeas及该第二参考球的半径rMeas；根据所述测杆22的出厂标准长度得到所述标准球的球心坐标ptMorminal，该标准球的球心坐标ptMorminal等于（0，0，–标准长度）；利用公式计算出所述测头20的半径补偿值，该半径补偿值rOffset=rMeas–R1+stdProbeR，其中，stdProbeR为所述测头20的出厂标准半径；及利用公式计算出所述测头20的球心补偿值，该球心补偿值ptOffset=ptMeas+ptNorminal–ptRef。所述补偿与误差测定模块110利用公式计算出所述测针2的空间误差，该测针2的空间误差等于maxR–minR，其中，maxR为所述实际量测点集Meas中的表面点与所述第二参考球的球心间的最大距离，minR为所述实际量测点集Meas中的表面点与所述第二参考球的球心间的最小距离。

最后应说明的是，以上实施例仅用以说明本发明的技术方案而非限制，尽管参照较佳实施例对本发明进行了详细说明，本领域的普通技术人员应当理解，可以对本发明的技术方案进行修改或等同替换，而不脱离本发明技术方案的精神和范围。例如，将此方法应用于在清晰的边界线上寻找边界点。

Claims (10)

1.一种三次元测针补偿及空间误差测定方法，应用于电子装置中，其中，所述测针包括测头及与三次元量测机台连接的测杆，其特征在于，该方法包括：

导入步骤，提供一个带有支撑杆的标准球，导入该标准球的半径R1、该支撑杆的半径R2、该标准球顶部任意点的坐标PT及测杆的法向N1；

表面点计算步骤，按照比例将该标准球分成多层，并根据该标准球的半径R1、所述顶部任意点的坐标PT及在所述标准球上点取的表面点的个数Num，计算出所述点取的各表面点的坐标及向量，得到坐标集PTS；

旋转步骤，将所述测杆的法向N1、标准球的法向N2进行差乘得到旋转法向N3，将所述标准球绕该旋转法向N3旋转一个预设角度得到旋转矩阵mat；

表面点更新步骤，将该旋转矩阵mat与所述各表面点的坐标相乘，计算得到所述各表面点的新坐标，并利用各表面点的新坐标更新所述坐标集PTS；

实际量测步骤，根据上述坐标集PTS生成量测程序，将该量测程序传送给三次元机台以控制所述测针实际量测工件两次，分别得到实际量测的点集Refs和Meas；及

补偿与误差测定步骤，根据实际量测的点集Refs和Meas、标准球的半径R1及测头的半径R3计算该测针的补偿值，利用该补偿值补偿该测针，并根据实际量测的点集Refs和Meas计算该测针的空间误差。

2.如权利要求1所述的三次元测针补偿及空间误差测定方法，其特征在于，所述预设角度等于所述测杆的法向N1与标准球的法向N2间的夹角。

3.如权利要求1所述的三次元测针补偿及空间误差测定方法，其特征在于，所述表面点更新步骤还包括：

将所述支撑杆和标准球的交点的坐标与上述每层中各表面点的新坐标进行比较；及

当某个新坐标的Z值小于所述交点的Z值时，重新计算该新坐标所在层上各表面点的坐标值，并利用该重新计算出的坐标值更新所述坐标集PTS。

4.如权利要求1所述的三次元测针补偿及空间误差测定方法，其特征在于，所述补偿与误差测定步骤中计算测针的补偿值的步骤包括：

根据所述实际量测点集Refs拟合第一参考球，得到球心ptRef及该第一参考球的半径rRef；

根据所述实际量测点集Meas拟合第二参考球，得到球心ptMeas及该第二参考球的半径rMeas；

根据所述测杆的出厂标准长度得到所述标准球的球心坐标ptMorminal，该标准球的球心坐标ptMorminal等于（0，0，–标准长度）；

利用公式计算出所述测头的半径补偿值，该半径补偿值rOffset=rMeas–R1+stdProbeR，其中，stdProbeR为所述测头的出厂标准半径；及

利用公式计算出所述测头的球心补偿值，该球心补偿值ptOffset=ptMeas+ptNorminal–ptRef。

5.如权利要求4所述的三次元测针补偿及空间误差测定方法，其特征在于，所述补偿与误差测定步骤中计算测针的空间误差的步骤包括：

利用公式计算出所述测针的空间误差，该测针的空间误差等于maxR–minR，其中，maxR为所述实际量测点集Meas中的表面点与所述第二参考球的球心间的最大距离，minR为所述实际量测点集Meas中的表面点与所述第二参考球的球心间的最小距离。

6.一种三次元测针补偿及空间误差测定系统，运行于电子装置中，所述测针包括测头及与三次元机台连接的测杆，其特征在于，该系统包括：

导入模块，用于提供一个带有支撑杆的标准球，导入该标准球的半径R1、该支撑杆的半径R2、该标准球顶部任意点的坐标PT及测杆的法向N1；

表面点计算模块，用于按照比例将该标准球分成多层，并根据该标准球的半径R1、所述顶部任意点的坐标PT及在所述标准球上点取的表面点的个数Num，计算出所述点取的各表面点的坐标及向量，得到坐标集PTS；

旋转模块，用于将所述测杆的法向N1、标准球的法向N2进行差乘得到旋转法向N3，将所述标准球绕该旋转法向N3旋转一个预设角度得到旋转矩阵mat；

表面点更新模块，用于将该旋转矩阵mat与所述各表面点的坐标相乘，计算得到所述各表面点的新坐标，并利用各表面点的新坐标更新所述坐标集PTS；

实际量测模块，用于根据上述坐标集PTS生成量测程序，将该量测程序传送给三次元机台以控制所述测针实际量测工件两次，分别得到实际量测的点集Refs和Meas；及

补偿与误差测定模块，用于根据实际量测的点集Refs和Meas、标准球的半径R1及测头的半径R3计算该测针的补偿值，利用该补偿值补偿该测针，并根据实际量测的点集Refs和Meas计算该测针的空间误差。

7.如权利要求6所述的三次元测针补偿及空间误差测定系统，其特征在于，所述预设角度等于所述测杆的法向N1与标准球的法向N2间的夹角。

8.如权利要求6所述的三次元测针补偿及空间误差测定系统，其特征在于，所述表面点更新模块还用于：

将所述支撑杆和标准球的交点的坐标与上述每层中各表面点的新坐标进行比较；及

当某个新坐标的Z值小于所述交点的Z值时，重新计算该新坐标所在层上各表面点的坐标值，并利用该重新计算出的坐标值更新所述坐标集PTS。

9.如权利要求6所述的三次元测针补偿及空间误差测定系统，其特征在于，所述补偿与误差测定模块通过以下步骤计算测针的补偿值：

根据所述实际量测点集Refs拟合第一参考球，得到球心ptRef及该第一参考球的半径rRef；

根据所述实际量测点集Meas拟合第二参考球，得到球心ptMeas及该第二参考球的半径rMeas；

根据所述测杆的出厂标准长度得到所述标准球的球心坐标ptMorminal，该标准球的球心坐标ptMorminal等于（0，0，–标准长度）；

利用公式计算出所述测头的半径补偿值，该半径补偿值rOffset=rMeas–R1+stdProbeR，其中，stdProbeR为所述测头的出厂标准半径；及

利用公式计算出所述测头的球心补偿值，该球心补偿值ptOffset=ptMeas+ptNorminal–ptRef。

10.如权利要求9所述的三次元测针补偿及空间误差测定系统，其特征在于，所述补偿与误差测定模块通过以下步骤计算测针的空间误差：

利用公式计算出所述测针的空间误差，该测针的空间误差等于maxR–minR，其中，maxR为所述实际量测点集Meas中的表面点与所述第二参考球的球心间的最大距离，minR为所述实际量测点集Meas中的表面点与所述第二参考球的球心间的最小距离。

Images