一种超声探头校准方法与流程

本发明涉及超声技术领域，尤其是涉及一种超声探头校准方法。

背景技术：

目前，超声诊断是利用超声波探测人体组织的图像诊断技术，具有分辨率高，实时性好，安全无创等优点，在临床图像诊断中得到广泛应用，超声图像诊断技术不断发展创新，近年来，三维超声成像逐渐成为一种重要的医疗诊断技术，通过探头获取人体组织器官的超声数据，对这些数据进行处理，得到更具真实感的组织器官的三维超声图像，三维超声具有直观显示、多角度观察等新功能，优于传统的二维超声，有着重要的应用价值。

三维超声成像是由多组二维平面信息经过三维重建得来，通过空间扫描获取序列二维图像数据，测量并记录它们之间的空间位置关系，利用这些已知的空间位置关系，运用一定的插值算法恢复三维的空间数据，其中，探头扫査位置的定位是成功实现三维重建的关键因素。

现有技术中，结合当前的医疗科技出现了电磁跟踪定位技术，其主要采用一种称作自由手的探头(freehand)，将传感器固定在普通超声探头上，并配套精确的接收定位机构，辅助计算探头的坐标，但是这种定位技术需要操作人员在每次使用超声探头时都需要进行人工探头校准，不仅繁琐、耗费时间，而且计算得到的特征点坐标值与其真实坐标值的误差较大，难以满足测量需求。

技术实现要素：

本发明实施例提供了一种超声探头校准方法，以解决现有的超声探头校准误差较大的技术问题，该方法能有效地降低测量误差，从而有利于提高三维定位精度。

为了解决上述技术问题，本发明实施例提供了一种超声探头校准方法，包括以下步骤：

s11、通过仿组织超声体模分析得到所述超声探头在预设的探测深度下的盲区；

s12、将所述超声探头置于三维磁场下，并获得所述超声探头在扫描空气时得到的第一成像图、所述超声探头的声透镜在与涂有耦合剂的自由传感器顶端触碰时得到的第二成像图；其中，所述第一成像图和所述第二成像图的色值相同；

s13、选取所述第二成像图中的任意两个圆弧分别作为起始圆弧、同心圆弧，并各自计算所述起始圆弧和所述同心圆弧的圆心坐标、半径和圆弧上的像素点坐标；

s14、获得所述起始圆弧与所述第一成像图中的一对应圆弧的像素点色值的第一色差比值，及所述同心圆弧与所述第一成像图中的一对应圆弧的像素点色值的第二色差比值；

s15、根据所述第一色差比值对应所述起始圆弧上像素点坐标绘制第一曲线，预设用于判断色差的调节阈值，获得所述第一曲线上存在色差的区域，并从中选取连续色差最长的第一区域，计算所述第一区域的中间值坐标，及根据所述第二色差比值对应所述同心圆弧上像素点坐标绘制第二曲线，按照所述调节阈值，获取所述第二曲线上存在色差的区域，并从中选取连续色差最长的第二区域，计算所述第二区域的中间值坐标；

s16、根据所述第一区域的中间值坐标、所述第二区域的中间值坐标以及所述盲区，计算所述自由传感器的顶端在所述第二成像图中的二维坐标；

s17、将所述自由传感器的顶端在所述第二成像图中的二维坐标转换为所述三维磁场下的待测三维坐标，并获得所述自由传感器在所述三维磁场下的实际三维坐标；

s18、根据所述待测三维坐标和所述实际三维坐标建立三元方程组，计算得到所述超声探头在所述三维磁场下的修正值。

作为优选方案，所述步骤s17中的将所述自由传感器的顶端在所述第二成像图中的二维坐标转换为所述三维磁场下的待测三维坐标，具体为：

设定所述第二成像图的起始圆弧的中心点在所述三维磁场下的修正量为(xyz)，所述自由传感器的顶端在所述第二成像图中的二维坐标为(mn)，所述起始圆弧中的最大纵向值的点在所述第二成像图中的二维坐标为(pq)，所述第二成像图的大小为(lw)，所述预设的探测深度为h，并在所述三维磁场中设定一个具有六自由度的定位传感器；

计算所述自由传感器的顶端在所述定位传感器的坐标系中的定位三维坐标(x+(m-p)*h/(w-q)y+(n-q)*h/(w-q)z)；

根据所述定位传感器相对所述三维磁场的六个自由度x1、y1、z1、a1、e1、r1，将所述定位三维坐标(x+(m-p)*h/(w-q)y+(n-q)*h/(w-q)z)通过三维坐标变换公式计算得到所述自由传感器的顶端在所述三维磁场下的待测三维坐标(x0y0z0)；

其中，所述待测三维坐标(x0y0z0)的x0、y0、z0分别为：

x0＝(x+(m-p)*h/(w-q))*(cos(e1)*cos(a1))+(y+(n-q)*h/(w-q))*(-cos(r1)*sin(a1)

+sin(r1)*sin(e1)*cos(a1))+z*(sin(r1)*sin(a1)+cos(r1)*sin(e1)*cos(a1))+x1

y0＝(x+(m-p)*h/(w-q))*(cos(e1)*sin(a1))+(y+(n-q)*h/(w-q))*(cos(r1)*cos(a1)

+sin(r1)*sin(e1)*sin(a1))+z*(-sin(r1)*cos(a1)+cos(r1)*sin(e1)*sin(a1))+y1

z0＝(x+(m-p)*h/(w-q))*(-sin(e1))+(y+(n-q)*h/(w-q))*(sin(r1)*cos(e1))

+z*(cos(r1)*cos(e1))+z1。

作为优选方案，所述步骤s17中的获得所述自由传感器在所述三维磁场下的实际三维坐标，具体为：

根据所述定位传感器相对所述三维磁场的六个自由度x2、y2、z2、a2、e2、r2，计算所述自由传感器的顶端在所述三维磁场下的实际三维坐标(x'y'z')，所述实际三维坐标(x'y'z')的坐标x'、y'、z'分别为：

x′＝x2+l*cos(e2*pi/180)*cos(a2*pi/180)

y′＝y2+l*cos(e2*pi/180)*sin(a2*pi/180)

z′＝z2-l*sin(e2*pi/180)

其中，l为所述自由传感器的中心与顶端之间的距离。

作为优选方案，所述根据所述待测三维坐标和所述实际三维坐标建立三元方程组，计算得到所述超声探头在所述三维磁场下的修正值，具体为：

根据所述自由传感器的顶端在所述三维磁场下的待测三维坐标(x0y0z0)与所述自由传感器在所述三维磁场的实际三维坐标(x'y'z')对应相等的关系，建立关于(xyz)的方程组；

计算所述方程组，得到所述超声探头在所述三维磁场下的修正值。

作为优选方案，所述步骤s12中的自由传感器为外表均匀的涂有耦合剂的传感器。

作为优选方案，所述步骤s13中的选取所述第二成像图中的任意两个圆弧分别作为起始圆弧、同心圆弧，并各自计算所述起始圆弧和所述同心圆弧的圆心坐标、半径和圆弧上的像素点坐标，具体为：

选取所述第二成像图中的任意两个圆弧分别作为起始圆弧、同心圆弧；

在所述起始圆弧上选取任意三个点，建立圆弧方程组并计算所述起始圆弧的圆心坐标、半径和圆弧上的像素点坐标；

在所述同心圆弧上选取任意三个点，建立圆弧方程组并计算所述起始圆弧的圆心坐标、半径和圆弧上的像素点坐标；

其中，所述起始圆弧的半径小于所述同心圆弧的半径。

作为优选方案，所述方法还包括：

根据所述第一色差比值、所述第二色差比值和所述调节阈值，判断所述第一成像图和所述第二成像图是否存在色差；

当所述第一成像图和所述第二成像图存在色差时，执行步骤：根据所述第一色差比值对应所述起始圆弧上像素点坐标绘制第一曲线，预设用于判断色差的调节阈值，获得所述第一曲线上存在色差的区域，并从中选取连续色差最长的第一区域，计算所述第一区域的中间值坐标，及根据所述第二色差比值对应所述同心圆弧上像素点坐标绘制第二曲线，按照所述调节阈值，获取所述第二曲线上存在色差的区域，并从中选取连续色差最长的第二区域，计算所述第二区域的中间值坐标。

作为优选方案，所述根据所述第一色差比值、所述第二色差比值和所述调节阈值，判断所述第一成像图和所述第二成像图是否存在色差，具体为：

将所述调节阈值设为c；其中，0＜c＜1；

判断所述第一色差比值、所述第二色差比值是否满足大于c且小于2-c；

若是，则判定所述第一成像图和所述第二成像图不存在色差；

若否，则判定所述第一成像图和所述第二成像图存在色差。

作为优选方案，在获得所述超声探头的声透镜在与涂有耦合剂的自由传感器顶端触碰时得到的第二成像图之前，将所述自由传感器的顶端垂直所述超声探头的声透镜表层。

作为优选方案，所述方法还包括：

多次改变所述自由传感器与所述超声探头的声透镜的触碰位置，并得到多个修正值；

计算得到所述多个修正值的平均值。

相比于现有技术，本发明的有益效果在于，本发明通过所述超声探头在扫描空气和将涂有耦合剂的所述自由传感器触碰所述超声探头，分别得到所述第一成像图和所述第二成像图，并计算所述第二成像图上所述起始圆弧、所述同心圆弧对应像素点的色差比值，选取这两个圆弧上存在连续色差的最长区域，从而获得两个区域的中间值坐标，再结合超声盲区反推得到所述自由传感器顶端在所述第二成像图中的坐标，进而进一步计算得到所述待测三维坐标，根据所述待测三维坐标和所述实际三维坐标的对应相等关系建立有关三元方程组，最终计算得到修正值。这样，不仅简化了校准过程，而且能够有效地降低测量误差，有利于提高三维定位精度；且所述超声探头在测试得到的修正值偏差较小，稳定性较好，操作人员在每次成像图的定位计算中，加入所述修正值计算得到的结果更为准确。

附图说明

图1是本发明实施例一的超声探头校准方法的步骤流程图；

图2是本发明实施例一的超声探头扫描空气的示意图；

图3是本发明实施例一的超声探头与涂有耦合剂的自由传感器的顶端触碰的示意图；

图4展现的是图2得到的第一成像图；

图5展现的是图3得到的第二成像图；

图6是本发明实施例一的超声探头校准方法的原理图；

图7展现的是仿组织体模的成像图；

图8是本发明实施例二的超声探头与自由传感器触碰的成像图；

图9是本发明实施例二的超声探头校准方法的原理图；

图10是本发明实施例二的同心圆弧、第三圆弧对应色差比较值的曲线图。

具体实施方式

下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。

请参见图1至图6，本发明优选实施例提供了一种超声探头校准方法，包括以下步骤：

s11、通过仿组织超声体模分析得到所述超声探头在预设的探测深度下的盲区；

s12、将所述超声探头置于三维磁场下，并获得所述超声探头在扫描空气时得到的第一成像图、所述超声探头的声透镜在与涂有耦合剂的自由传感器顶端触碰时得到的第二成像图；其中，所述第一成像图和所述第二成像图的色值相同；

s13、选取所述第二成像图中的任意两个圆弧分别作为起始圆弧、同心圆弧，并各自计算所述起始圆弧和所述同心圆弧的圆心坐标、半径和圆弧上的像素点坐标；

s14、获得所述起始圆弧与所述第一成像图中的一对应圆弧的像素点色值的第一色差比值，及所述同心圆弧与所述第一成像图中的一对应圆弧的像素点色值的第二色差比值；

s15、根据所述第一色差比值对应所述起始圆弧上像素点坐标绘制第一曲线，预设用于判断色差的调节阈值，获得所述第一曲线上存在色差的区域，并从中选取连续色差最长的第一区域，计算所述第一区域的中间值坐标，及根据所述第二色差比值对应所述同心圆弧上像素点坐标绘制第二曲线，按照所述调节阈值，获取所述第二曲线上存在色差的区域，并从中选取连续色差最长的第二区域，计算所述第二区域的中间值坐标；

s16、根据所述第一区域的中间值坐标、所述第二区域的中间值坐标以及所述盲区，计算所述自由传感器的顶端在所述第二成像图中的二维坐标；

s17、将所述自由传感器的顶端在所述第二成像图中的二维坐标转换为所述三维磁场下的待测三维坐标，并获得所述自由传感器在所述三维磁场下的实际三维坐标；

s18、根据所述待测三维坐标和所述实际三维坐标建立三元方程组，计算得到所述超声探头在所述三维磁场下的修正值。

在本发明实施例中，所述方法还包括：多次改变所述自由传感器与所述超声探头的声透镜的触碰位置，并得到多个修正值；计算得到所述多个修正值的平均值。

在本发明实施例中，应当说明的是，在获得所述超声探头的声透镜在与涂有耦合剂的自由传感器顶端触碰时得到的第二成像图之前，将所述自由传感器的顶端垂直所述超声探头的声透镜表层。

在本实施例中，通过所述超声探头在扫描空气和将涂有耦合剂的所述自由传感器触碰所述超声探头，分别得到所述第一成像图和所述第二成像图，并计算所述第二成像图上所述起始圆弧、所述同心圆弧对应像素点的色差比值，选取这两个圆弧上存在连续色差的最长区域，从而获得两个区域的中间值坐标，再结合超声盲区反推得到所述自由传感器顶端在所述第二成像图中的坐标，进而进一步计算得到所述待测三维坐标，根据所述待测三维坐标和所述实际三维坐标的对应相等关系建立有关三元方程组，最终计算得到修正值。这样，不仅简化了校准过程，而且能够有效地降低测量误差，有利于提高三维定位精度；且所述超声探头在测试得到的修正值偏差较小，稳定性较好，操作人员在每次成像图的定位计算中，加入所述修正值计算得到的结果更为准确。

具体的，本发明实施例的实施步骤如下：

(1)固定所述超声探头的探测深度，作为所述预设的探测深度，通过仿组织超声体模分析得到所述超声探头在预设的探测深度下的盲区。

(2)将所述超声探头置于三维磁场下，同时把一个具有六自由度的传感器固定在所述超声探头的夹具上，将所述超声探头上的传感器作为所述定位传感器。

(3)如图2和图4所示，获得所述超声探头在扫描空气时得到的第一成像图，以及如图3和图5所示，获得所述超声探头的声透镜在与涂有耦合剂的自由传感器顶端触碰时得到的第二成像图；其中，通过特定的图像软件读取所述第一成像图和所述第二成像图的rgb值，抽取两张成像图三色值中任意一项同种色值，使所述第一成像图和所述第二成像图的色值相同；

(4)如图6所示，随机选取所述第二成像图中的任意两个圆弧分别作为起始圆弧、同心圆弧，并各自计算所述起始圆弧和所述同心圆弧的圆心坐标、半径和圆弧上的像素点坐标，具体如下：

选取所述第二成像图中的任意两个圆弧分别作为起始圆弧、同心圆弧；

在所述起始圆弧上选取任意三个点，建立圆弧方程组并计算所述起始圆弧的圆心坐标、半径和圆弧上的像素点坐标；

同理，在所述同心圆弧上选取任意三个点，建立圆弧方程组并计算所述起始圆弧的圆心坐标、半径和圆弧上的像素点坐标；

其中，所述起始圆弧的半径小于所述同心圆弧的半径，所述起始圆弧为所述第二成像图上方与背景色正好不同的圆弧，可以是上方的第一道圆弧，也可以是中间的圆弧。

(5)选定一个可调节的阈值作为所述调节阈值c(0＜c＜1)，在所述第一成像图、所述第二成像图的相同位置处，判断所述第一色差比值、所述第二色差比值是否满足大于c且小于2-c；

若是，则判定所述第一成像图和所述第二成像图不存在色差；

若否，则判定所述第一成像图和所述第二成像图存在色差。

根据所述第一色差比值、所述第二色差比值和所述调节阈值，判断所述第一成像图和所述第二成像图是否存在色差；

当所述第一成像图和所述第二成像图存在色差时，执行步骤s15：根据所述第一色差比值对应所述起始圆弧上像素点坐标绘制第一曲线，预设用于判断色差的调节阈值，获得所述第一曲线上存在色差的区域，并从中选取连续色差最长的第一区域，计算所述第一区域的中间值坐标，及根据所述第二色差比值对应所述同心圆弧上像素点坐标绘制第二曲线，按照所述调节阈值，获取所述第二曲线上存在色差的区域，并从中选取连续色差最长的第二区域，计算所述第二区域的中间值坐标，所述第一区域的中间值坐标、所述第二区域的中间值坐标如图6所示。

(6)由于所述第一区域的中间值坐标、所述第二区域的中间值坐标事故所述自由传感器与所述起始圆弧、所述同心圆弧交点的坐标，所述盲区是所述自由传感器与所述起始圆弧的交点到所述自由传感器顶端之间的距离，因此结合所述第一区域的中间值坐标、所述第二区域的中间值坐标以及所述盲区，能计算所述自由传感器的顶端在所述第二成像图中的二维坐标。

(7)如图6所示，通过所述定位传感器接收所述三维磁场的六个自由度，因此根据所述定位传感器相对所述三维磁场的六个自由度x2、y2、z2、a2、e2、r2，计算所述自由传感器的顶端在所述三维磁场下的实际三维坐标(x'y'z')，所述实际三维坐标(x'y'z')的坐标x'、y'、z'分别为：

x′＝x2+l*cos(e2*pi/180)*cos(a2*pi/180)

y′＝y2+l*cos(e2*pi/180)*sin(a2*pi/180)

z′＝z2-l*sin(e2*pi/180)

其中，l为所述自由传感器的中心与顶端之间的距离。

(8)设定所述第二成像图的起始圆弧的中心点在所述三维磁场下的修正量为(xyz)，所述自由传感器的顶端在所述第二成像图中的二维坐标为(mn)，所述起始圆弧中的最大纵向值的点在所述第二成像图中的二维坐标为(pq)，所述第二成像图的大小为(lw)，所述预设的探测深度为h，并在所述三维磁场中设定一个具有六自由度的定位传感器；

计算所述自由传感器的顶端在所述定位传感器的坐标系中的定位三维坐标(x+(m-p)*h/(w-q)y+(n-q)*h/(w-q)z)；

根据所述定位传感器相对所述三维磁场的六个自由度x1、y1、z1、a1、e1、r1，将所述定位三维坐标(x+(m-p)*h/(w-q)y+(n-q)*h/(w-q)z)通过三维坐标变换公式计算得到所述自由传感器的顶端在所述三维磁场下的待测三维坐标(x0y0z0)；

其中，所述待测三维坐标(x0y0z0)的x0、y0、z0分别为：

x0＝(x+(m-p)*h/(w-q))*(cos(e1)*cos(a1))+(y+(n-q)*h/(w-q))*(-cos(r1)*sin(a1)

+sin(r1)*sin(e1)*cos(a1))+z*(sin(r1)*sin(a1)+cos(r1)*sin(e1)*cos(a1))+x1

y0＝(x+(m-p)*h/(w-q))*(cos(e1)*sin(a1))+(y+(n-q)*h/(w-q))*(cos(r1)*cos(a1)

+sin(r1)*sin(e1)*sin(a1))+z*(-sin(r1)*cos(a1)+cos(r1)*sin(e1)*sin(a1))+y1

z0＝(x+(m-p)*h/(w-q))*(-sin(e1))+(y+(n-q)*h/(w-q))*(sin(r1)*cos(e1))

+z*(cos(r1)*cos(e1))+z1。

(9)根据所述自由传感器的顶端在所述三维磁场下的待测三维坐标(x0y0z0)与所述自由传感器在所述三维磁场的实际三维坐标(x'y'z')对应相等的关系，建立关于(xyz)的方程组；

计算所述方程组，得到所述超声探头在所述三维磁场下的修正值。

(10)在多次重复操作后，所述修正量的偏差较小，稳定性较好，从而在每次成像图的定位计算中，加入所述修正值，计算到的成像图中标识点在磁场下的三维坐标与真实值的偏差小于3mm。

在本发明实施例中，作为示例性的，在通过仿组织超声体模分析得到所述超声探头在预设的探测深度下的盲区时，可采用ks107bd型超声体模进行分析，超声的主频为3mhz，探测深度为150mm；通过用所述超声探头扫描盲区靶群，并使所需靶点位于仿组织体模的成像图的横向中心，如图7所示。

在仿组织体模的成像图中，标记为上缘的点a是距离声窗为10mm的盲区靶点，标记为下缘的点b是距离上缘点为10mm的横向靶点(参考ks107bd型仿组织超声体模的产品说明书可得)。

因将探测深度为150mm，可计算dab＝150/(754-43)*(122-72)＝10.5485mm，仿组织体模的成像图中ab的距离比实际距离大0.5485mm，相对误差较小。仿组织体模的成像图中点a到声窗的距离为da＝150/(754-43)*(72-43)＝6.1181mm；

因点a到声窗的实际距离为10mm，再加上ab测量距离与实际距离的0.5485mm偏差，所以成像图的盲区为10-6.1181+0.5485＝4.4304mm。

在本实施例中，可以理解的是，为了提高所述超声探头校准的准确性，除了所述同心圆弧还可以有第三圆弧，由于所述起始圆弧、所述同心圆弧、所述第三圆弧对应的圆为同心圆，在所述起始圆弧上随机选取3个点(建议3个的间距大些)，建立方程组，计算所述起始圆弧圆心的坐标、半径和所述起始圆弧在成像图中点的坐标，随机选取同心圆弧上一个点，此点到所述起始圆弧的距离为所述同心圆弧的半径，由此半径，可获得所述同心圆弧在成像图中点的坐标。同理，计算所述第三圆弧的半径和所述第三圆弧的在呈现图中点的坐标。所述同心圆弧和所述第三圆弧成像图轨迹上点的色差比值曲线，如图10所示，为了便于观察，所述同心圆弧在成像图上点的b值比值加上了0.1，所以最大值为1.1，最小值为0.1。

根据图10，可得到所述同心圆弧中连续0值最大的区域为[75102]，所以自由传感器经过所述同心圆弧时的中心位置对应图5中的横坐标为75-1+(102-75+1)/2＝88；所述第三圆弧中连续0值最大的区域为[74112]，所以自由传感器经过所述第三圆弧时的中心位置对应图5中的横坐标为74-1+(112-74+1)/2＝92.5，取整为92。

在图3中，所述同心圆弧与自由传感器中心交点的横坐标为563+88＝651，所述同心圆弧与所述自由传感器中心交点的坐标为(65126)；所述第三圆弧与所述自由传感器中心交点的横坐标为563+92＝655，则所述同心圆弧与所述自由传感器中心交点的坐标为(65570)。引用上述的示例结果，所述超声探头的盲区为4.4304mm，即所述自由传感器顶点距所述起始圆弧处自由传感器中心4.4304mm(自由传感器与探头声透镜垂直)，结合所述同心圆弧与所述起始圆弧的半径差，根据成像图像素点对应的距离，能计算所述自由传感器顶点在所述第二成像图的坐标(588.095220.2814)。

所述起始圆的中间值坐标的准确将直接影响所述三维磁场坐标的换算。通过传感器接收磁场的六个自由度(x2y2z2a2e2r2)，计算传感器顶点在磁场坐标系下的坐标(x′y′z′)，并将这一实际三维坐标为真实值。

假设成像图起始圆弧中心点该体系下的修正量为(xyz)，计算所述自由传感器在所述第二成像图中的坐标(mn)，所述起始圆弧在所述第二成像图的坐标为(pq)，超声成像图的大小为(lw)，超声探测深度为h；

则所述第二成像图中所述自由传感器的顶端在所述定位传感器坐标系下的坐标为(x+(m-p)*h/(w-q)y+(n-q)*h/(w-q)z)。

所述定位传感器接收所述三维磁场的六个自由度为(x2y2z2a2e2r2)，将所述自由传感器的顶端在所述定位传感器坐标系下的坐标经坐标变换后，得到所述自由传感器的顶端在所述三维磁场下的待测坐标(x0y0z0)。

由于(x′y′z′)与(x0y0z0)应对应相等，则可建立关于xyz的方程组，求解方程组，得到xyz值，其中：

x0＝(x+(m-p)*h/(w-q))*(cos(e1)*cos(a1))+(y+(n-q)*h/(w-q))*(-cos(r1)*sin(a1)

+sin(r1)*sin(e1)*cos(a1))+z*(sin(r1)*sin(a1)+cos(r1)*sin(e1)*cos(a1))+x1

y0＝(x+(m-p)*h/(w-q))*(cos(e1)*sin(a1))+(y+(n-q)*h/(w-q))*(cos(r1)*cos(a1)

+sin(r1)*sin(e1)*sin(a1))+z*(-sin(r1)*cos(a1)+cos(r1)*sin(e1)*sin(a1))+y1

z0＝(x+(m-p)*h/(w-q))*(-sin(e1))+(y+(n-q)*h/(w-q))*(sin(r1)*cos(e1))

+z*(cos(r1)*cos(e1))+z1。

计算到起始圆弧中心的修正值为(89.91855.332419.3941)。

此外，为了使得所述修正量的偏差较小，稳定性较好，还需在多次重复操作后，发明人进行10次校正，校正得到的数据如表1所示。

表1多次校正数据

从表1可计算得到所述修正值的平均值为：

(89.974955.3130219.55709)，其中，表中的修正值与平均值在xyz三个方向上的偏差小于±3mm。

依据本发明实施例的实施步骤(8)，结合上述修正值的平均值，可求得待测三维坐标，比较待测三维坐标和真实坐标的差值，结果如下表2所示：

表2多次距离误差分析

表2中，dif_x:表示x轴方向上的距离差；

dif_y:表示y轴方向上的距离差；

dif_z:表示z轴方向上的距离差；

distance表示待测三维坐标和真实坐标的差值；

从表2可计算得到待测三维坐标和真实坐标在xyz轴方向上的平均偏差为：(0.937790.704640.38675)，这表明测算到的坐标值与其真实坐标值的误差小于2mm，因此结果的稳定性较高。

以上所述是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也视为本发明的保护范围。