CN105030331A - 位置传感器与三维腹腔镜摄像机标定装置及方法 - Google Patents

Abstract

本发明涉及一种位置传感器与三维腹腔镜摄像机标定装置及方法，首先利用高精度光学定位系统补偿电磁位置传感器输出误差，然后利用标定参考立方体计算三维腹腔镜摄像机位置和姿态，最后使用对偶四元数分析电磁位置传感器与三维腹腔镜摄像机的坐标关系；其克服了现有电磁位置传感器由于磁场形变产生的输出偏差缺陷，标定精确、实时性高；本发明操作简便，仅利用内窥镜摄像机前端固定的电磁位置传感器和标定网格，即可推定电磁位置传感器和内窥镜摄像机的位置关系。

Description

位置传感器与三维腹腔镜摄像机标定装置及方法

技术领域

本发明涉及一种位置传感器与三维腹腔镜摄像机标定装置及方法，特别是用于手术导航的位置传感器与内窥镜摄像机标定的装置与方法，属于计算机手术导航技术领域。

背景技术

位置传感器与三维腹腔镜摄像机的标定是三维腹腔镜手术导航的首要问题，标定的精度是影响导航系统精度的关键因素。

光学传感器的跟踪精度非常高，但由于存在光学标记遮挡的问题，不能保证跟踪定位的连续性；另外，由于用来计算跟踪物体位置和姿态的光学标记必须和跟踪物体刚性接触，所以使光学跟踪系统的应用范围受到了一定的限制。

电磁位置传感器利用电磁波的穿透性，可以深入人体内，不用考虑标记遮挡的问题。但对于电磁位置传感器来说，同样存在一个自身无法克服的问题，就是磁场的形变问题。众所周知，如果在磁场周围存在铁磁物体或电磁物体，磁场就极易受到干扰而产生形变。这对于依靠磁场感应来获得位置信息的电磁位置传感器来说，直接导致的后果就是输出精度产生偏差。

文献“NakadaK,NakamotoM,SatoY,etal.ARapidMethodforMagneticTrackerCalibrationUsingaMagneto-opticHybridTrackers[C].NewYork:Springer(MICCAI2003),2003:285-293.”采用一个光学位置跟踪系统(OT:Opticaltrackingsystem)作为参照标准，并借助一个固定了电磁位置传感器和光学位置跟踪系统的磁-光数据采集工具。操作者在测量空间中移动这个数据采集工具并同时记录两种跟踪系统的输出，然后通过比较这两种输出的误差来构建一个电磁位置跟踪系统输出误差的多项式模型，从而推测出电磁位置跟踪系统的输出误差。但是，由于电磁位置跟踪系统和光学位置跟踪系统有着各自的测量频率和系统时钟，所以如何获得与电磁位置跟踪系统输出准确对应的光学位置跟踪系统输出是一个难题。文献“GregorySFischerandRussellHTaylor.ElectromagneticTrackerMeasurementErrorSimulationandToolDesign[C].NewYork:Springer(MICCAI2005),2005:73-80.”通过利用采集数据时固定采集工具的方法来获得准确的电磁位置跟踪系统和光学位置跟踪系统的对应输出，但是由于需要大量的时间来采集补偿模型所需要的样本数据，使之很难应用于实践。

发明内容

本发明的目的在于提供一种位置传感器与三维腹腔镜摄像机标定装置及方法，其克服了现有电磁位置传感器由于磁场形变产生的输出偏差缺陷，标定精确、实时性高；本发明操作简便，仅利用内窥镜摄像机前端固定的电磁位置传感器和标定网格，即可推定电磁位置传感器和内窥镜摄像机的位置关系。

本发明技术方案是这样实现的：位置传感器与三维腹腔镜摄像机标定装置及方法，首先利用高精度光学定位系统补偿电磁位置传感器输出误差，然后利用标定参考立方体计算三维腹腔镜摄像机位置和姿态，最后使用对偶四元数分析电磁位置传感器与三维腹腔镜摄像机的坐标关系；其特征在于具体步骤如下：

1.电磁位置传感器误差补偿

(1)建立光学位置跟踪系统坐标系、光学位置传感器坐标系、电磁位置跟踪系统坐标系、电磁位置传感器坐标系；

(2)计算电磁位置传感器在中的位置和姿态矩阵，记为：；

(3)根据从的位置关系转换，将电磁传感器的位置和姿态在光学位置跟踪系统坐标系中的坐标转换到电磁位置跟踪系统坐标系下，其位置和姿态矩阵记为：；

（4）比较和获得电磁位置传感器输出误差，建立误差补偿模型；

2.摄像机位置和姿态计算

(1)制作标定参考立方体

(2)获取欧氏坐标系下的坐标X

(3)获取图像坐标系下坐标

(4)建立X、之间坐标的对应关系

(5)根据建立摄像机矩阵约束方程组

(6)求解(5)中约束方程组最小二乘解得摄像机矩阵

3.位置传感器与内窥镜坐标关系分析

(1)对N个空间中的位置取电磁位置传感器和摄像机的位置和姿态

(2)计算表达传感器与摄像机之间变换关系的对偶四元数

(3)利用由奇异值分解(SVD)法求的对偶四元数所包含的变换，即位置传感器与内窥镜摄像机位置转换矩阵；

在三维腹腔镜导航系统中，将内窥镜摄像机、EMT传感器、磁场发生器以及MR图像的坐标系分别定义为C,S,M和I。摄像机坐标系C下点和图像上点的对应关系可以表示为：

（1）

其中，，分别表示从C到S、S到M、M到I、C到I的转换矩阵，表示电磁位置传感器的输出；

本发明旨在标定电磁位置传感器和内窥镜摄像机的位置关系，即C到S的转换矩阵。

本发明的积极效果是针对电磁位置传感器受环境干扰产生磁场形变而引起的输出偏差缺陷，提出一种固定有光学位置传感器和电磁位置传感器的磁-光数据采集装置，通过建立电磁位置传感器输出误差的补偿模型，利用光学传感器高精度特性，补偿电磁传感器输出误差，提高了电磁定位精度；利用标定立方体计算摄像机的位置和姿态，并用最小二乘解作为最终计算结果；用对偶四元数计算传感器和摄像机的位置和姿态矩阵，节省了计算时间。

附图说明

图1三维腹腔镜导航系统中各个坐标空间的对应关系。

图2磁-光数据采集工具。

图3光学位置传感器和电磁位置传感器的位置关系。

图4用于求解摄像机矩阵的立方体。

图5传感器和摄像机的坐标关系。

图6棋盘格标定模型。

图7获取不同姿态下标定模型的图像，并抽取特征点。

图8通过标定模型的图像来估计摄像机的位置和姿态。

图9传感器对于摄像机坐标系的位移及旋转角的计算结果1。

图10传感器对于摄像机坐标系的位移及旋转角的计算结果2。

具体实施方式

下面结合附图和实施例对本发明做进一步的描述：如图1所示，位置传感器与三维腹腔镜摄像机标定装置，其特征在于：在三维腹腔镜导航系统中，将内窥镜摄像机、EMT传感器、磁场发生器以及MR图像的坐标系分别定义为C,S,M和I。摄像机坐标系C下点和图像上点的对应关系可以表示为：

（1）

其中，，分别表示从C到S、S到M、M到I、C到I的转换矩阵。表示电磁位置传感器的输出。

本发明旨在标定电磁位置传感器和内窥镜摄像机的位置关系，即C到S的转换矩阵。

位置传感器与三维腹腔镜摄像机标定方法，首先利用高精度光学定位系统补偿电磁位置传感器输出误差，然后利用标定参考立方体计算三维腹腔镜摄像机位置和姿态，最后使用对偶四元数分析电磁位置传感器与三维腹腔镜摄像机的坐标关系；其特征在于具体步骤如下：

1.电磁位置传感器误差补偿

如图2所示，本发明设计一个固定有光学位置传感器和电磁位置传感器的磁-光数据采集装置来采集两种传感器的输出。目标是通过光学位置传感器的输出来校正电磁位置传感器的输出误差。因此首先需要保证两个传感器的测量点以及测量空间的坐标是一致的。从图1中给定的测量工具和图2所描述的坐标关系来看，光学位置传感器和电磁位置传感器有着各自不同的测量点和坐标系。所以在考察电磁位置传感器的误差之前，首先需要去统一这两个位置传感器的测量点和坐标系。

在图3中，为电磁位置传感器的坐标系，为磁场发生器坐标系M下电磁位置传感器的位置和姿态，为光学位置传感器坐标系O下光学标记的位置和姿态。令为光学位置传感器坐标系So下电磁位置传感器的位置和姿态，则有：

（2）

也就是说，如果是已知的，就可以获得了电磁传感器位置在光学位置跟踪系统坐标系中的坐标。这样就可以统一两个传感器的测量点。光学位置传感器坐标系So下电磁位置传感器的位置和姿态采用的是Hand-Eye标定方法获得。

如图2所示，如果得出光学位置跟踪系统坐标在电磁位置跟踪系统坐标系中的位置和姿态信息，就可以将电磁传感器位置在光学位置跟踪系统坐标系中的坐标进一步转换到电磁位置跟踪系统坐标系下：

（3）

这样，就可以通过比较来获得电磁位置传感器输出误差，建立电磁位置传感器输出误差的补偿模型，补偿电磁位置传感器输出误差。

2.摄像机位置和姿态估计

为了得到一些空间点的欧氏坐标，本发明制作一个标定参考物，在标定参考物上经过精确测定的特征点作为估计摄像机矩阵时所需要的空间点，如图4所示。

记摄像机矩阵为，其中为矩阵的第行向量。令是特征点在世界坐标系下的坐标，对应的图像点坐标为，于是根椐摄像机的投影关系，得到

（4）

因此，消去上式中的常数因子后，可得到下述方程：

（5）

在这个方程组中，第三个方程可由前两个方程线性表示，因此给定个以上的特征点与其图像点的对应，就可以线性求解摄像机矩阵。

当图像数据存在测量误差时，方程组（5）一般不存在非零解。此时，通常以它的最小二乘解作为摄像机矩阵的估计。对每一个点对应，记作

（6）

它是一个3×12的矩阵。给定个点对应，得到个形如这样的矩阵，再将这个矩阵组合起来得到一个的矩阵，对作奇异值分解(SVD)，，则的最后一个列向量是方程的最小二乘解，再将写成矩阵的形式就得到摄像机矩阵。

由于摄像机矩阵是齐次的，所以只能在相差一个非零常数因子的意义下求解，即所得到的摄像机矩阵与它的标准形式相差一个非零常数因子。

2.位置传感器与内窥镜坐标关系分析

如图5所示，利用空间中两个位置i和j来讨论电磁位置传感器和摄像机坐标系之间的关系。位置i和j在M坐标系下的电磁位置传感器输出分别记为和，标记网格坐标系下摄像机的位置和姿态分别记为。因此就可以得到式（7）和式（8）：

这里，表示位置j的位置传感器在位置i的位置传感器坐标系下的的位置和姿态；表示位置j的摄像机在位置i的摄像机坐标下的位置和姿态。在这四个坐标系下，很容易看出：

（9）

对N个空间中的位置取电磁位置传感器和摄像机的位置和姿态，将得到N(N-1)/2个(A，B)对。

（10）

用对偶四元数来表示位置传感器的螺旋推进，来表示摄像机的螺旋推进。用来表示位置传感器和摄像机之间的坐标变换。根据对偶四元数表达旋进运动公式可得：

用表示对偶四元数的标量部分，则有

因为传感器和摄像机在移动过程中的螺旋角以及推进距离是相同的，对于式（11）来说，其标量部分是相同的，所以对于的计算可以化简到用向量的部分来计算：

如果，不为0度或360度，即传感器和摄像机的移动不仅仅是平移，其中包含有旋转，则上式即可被写为：

令，，并应用单位对偶四元数的性质，式(14)可得：

同时，可以用矩阵形式表达为：

将式（9）中的传感器和摄像机的姿态矩阵A，B分别转换成对偶四元数后代入式（16）中，即可获得关于的连立方程组。这样，表达传感器与摄像机之间变换关系的对偶四元数即可被求解。利用由奇异值分解(SVD)求解这个方程组的方法，求解得到的所包含的变换，即为所需要的变换矩阵。

在标定实践中，为了估算从摄像机坐标系到电磁位置传感器坐标系的变换矩阵，本发明采用了一个预先设计制作好的棋盘格标定模型(如图6所示)。首先，在空间中以多种位置和姿态测量N个电磁位置传感器和摄像机的位置和姿态(图7)。使用空间中的两点，利用式（7）和式（8）来计算。N个点中任意两点组成一个(A，B)对，这样可以得到(N(N-1)/2)个(A，B)对。使用摄像机位置姿态获取方法计算(图8)。

为验证的稳定性，使用了3到39个测量点(N=3，4,…39)。对每个N，进行了10次验证（结果如图9-10所示）。图中的竖线表示10次实验的最小、平均和最大值。根据结果，当测量点数超过20时趋于稳定，使用27个测量点时平均误差最小。

Claims (1)

1.位置传感器与三维腹腔镜摄像机标定装置及方法，首先利用高精度光学定位系统补偿电磁位置传感器输出误差，然后利用标定参考立方体计算三维腹腔镜摄像机位置和姿态，最后使用对偶四元数分析电磁位置传感器与三维腹腔镜摄像机的坐标关系；其特征在于具体步骤如下：

1）电磁位置传感器误差补偿

(1)建立光学位置跟踪系统坐标系、光学位置传感器坐标系、电磁位置跟踪系统坐标系、电磁位置传感器坐标系；

(2)计算电磁位置传感器在中的位置和姿态矩阵，记为：；

(3)根据从的位置关系转换，将电磁传感器的位置和姿态在光学位置跟踪系统坐标系中的坐标转换到电磁位置跟踪系统坐标系下，其位置和姿态矩阵记为：；

（4）比较和获得电磁位置传感器输出误差，建立误差补偿模型；

2）摄像机位置和姿态计算

(1)制作标定参考立方体

(2)获取欧氏坐标系下的坐标X

(3)获取图像坐标系下坐标

(4)建立X、之间坐标的对应关系

(5)根据建立摄像机矩阵约束方程组

(6)求解(5)中约束方程组最小二乘解得摄像机矩阵

3）位置传感器与内窥镜坐标关系分析

(1)对N个空间中的位置取电磁位置传感器和摄像机的位置和姿态

(2)计算表达传感器与摄像机之间变换关系的对偶四元数

(3)利用由奇异值分解(SVD)法求的对偶四元数所包含的变换，即位置传感器与内窥镜摄像机位置转换矩阵；

在三维腹腔镜导航系统中，将内窥镜摄像机、EMT传感器、磁场发生器以及MR图像的坐标系分别定义为C,S,M和I；

摄像机坐标系C下点和图像上点的对应关系可以表示为：

（1）

其中，，分别表示从C到S、S到M、M到I、C到I的转换矩阵，表示电磁位置传感器的输出；旨在标定电磁位置传感器和内窥镜摄像机的位置关系，即C到S的转换矩阵。