发明内容
针对上述问题,本发明的目的是提供一种实时、高效、精确地扫描出目标图像的控制成像设备扫描平面的系统及方法。
为实现上述目的,本发明采取以下技术方案:一种控制成像设备扫描平面的系统,其特征在于,它包括:示踪器,其上建立有示踪器坐标系,并固定设置在待扫描目标上;跟踪设备,其上建立有跟踪设备坐标系,用于获取所述示踪器在所述跟踪设备坐标系中的位姿,并将已知的所述待扫描目标的位姿从所述示踪器坐标系中转换到所述跟踪设备坐标系中;成像设备,其上建立有成像设备坐标系,用于将所述成像设备坐标系中的待扫描目标的位姿扫描成图像;所述跟踪设备或成像设备内预置有一转换模块,用于将所述待扫描目标的位姿从所述跟踪设备坐标系转换到所述成像设备坐标系中;当所述转换模块预置在所述跟踪设备中时,所述跟踪设备将所述成像设备坐标系中的待扫描目标的位姿输送给所述成像设备;当所述转换模块预置在所述成像设备中时,所述跟踪设备将所述跟踪设备坐标系中的待扫描目标的位姿输送给所述成像设备。
所述转换模块Ctrack scan的表达式为:
式中,Ctrack scan为4×4矩阵,Rtrack scan为3×3旋转矩阵,Ttrack scan为3维平移向量。
所述示踪器包括一位姿传感器和一固定支架,所述位姿传感器通过所述支架固定设置在所述待扫描目标上,所述位姿传感器的位姿为所述示踪器的位姿。
所述示踪器在所述跟踪设备坐标系中的位姿Ctool track表达式为:
式中,Ctool track为4×4矩阵,Rtool track为3×3旋转矩阵,Ttool track为3维平移向量。
一种控制成像设备扫描平面的方法,其包括以下步骤:1)设置一包括示踪器、跟踪设备和成像设备的系统,将示踪器固定设置在待扫描目标上,将一跟踪设备坐标系与成像设备坐标系的转换模块预置在跟踪设备或成像设备内;2)将成像设备对待扫描目标进行扫描的平面作为扫描平面G,平面G在示踪器坐标系里的表达式为:
其中X
tool为平面G上的任意一点在示踪器坐标系中的坐标,其为一3维向量;
为示踪器坐标系中平面G的法向,其为一归一化3维向量;S
tool为平面G上的一已知点在示踪器坐标系中的坐标,其为一3维向量;3)跟踪设备测量示踪器在跟踪设备坐标系下的位姿C
tool track;4)利用步骤3)中的C
tool track,跟踪设备计算出扫描平面G在跟踪设备坐标系中的平面方程:
其中
为扫描平面G在跟踪设备坐标系中的法向,其为一归一化3维向量;X
track为扫描平面G上的任意一点在跟踪设备坐标系中的坐标,其为一3维向量;S
track为平面G上的一已知点在跟踪设备坐标系中的坐标,其为一3维向量;5)利用跟踪设备坐标系与成像设备坐标系的转换模块C
track scan,计算出扫描平面G在成像设备坐标系中的平面方程:
其中
为扫描平面G在成像设备坐标系中的法向,其为一归一化3维向量;X
scan为扫描平面G上的任意一点在成像设备坐标系中的坐标,其为一3维向量;S
scan为扫描平面G上的一已知点在成像设备坐标系中的坐标,其为一3维向量;6)依据步骤5)得出的扫描平面G在成像设备坐标系中的平面方程,成像设备完成待扫描目标的影像扫描。
所述步骤1)中,跟踪设备坐标系与成像设备坐标系的转换模块Ctrack scan的表达式为:
式中,Ctrack scan为4×4矩阵,Rtrack scan为3×3旋转矩阵,Ttrack scan为3维平移向量。
所述步骤3)中,示踪器在跟踪设备坐标系中的位姿Ctool track表达式为:
式中,Ctool track为4×4矩阵,Rtool track为3×3旋转矩阵,Ttool track为3维平移向量。
所述步骤5)中,若转换模块预置在跟踪设备内,扫描平面G在成像设备坐标系中的平面方程由跟踪设备计算出来,并输送给成像设备。
所述步骤5)中,若转换模块预置在成像设备内,扫描平面G在成像设备坐标系中的平面方程由成像设备计算出来。
本发明由于采取以上技术方案,其具有以下优点:1、本发明系统由于设置了示踪器、跟踪设备和成像设备,定义示踪器坐标系、跟踪设备坐标系和成像设备坐标系分别为固连于示踪器、跟踪设备和成像设备的坐标系,并将示踪器固定设置在待扫描目标(包括器械、病灶等)上,使得示踪器随着待扫描目标的运动而运动,因此可以通过跟踪设备实时而精确地测量示踪器的位姿,结合已知的待扫描目标在示踪器坐标系中的位姿和跟踪设备坐标系与示踪器坐标系的转换关系,可以实时而精确地获得待扫描目标在跟踪设备坐标系中的位姿,再通过事先标定好的精确的跟踪设备坐标系与成像设备坐标系的转换关系,可以实时而精确地获得待扫描目标在成像设备坐标系中的位姿,减少了人工操作(例如手工设置定位图像的位置、角度)带来的误差以及人工操作导致的低效率,实时地获得待扫描目标位姿,快速而精确地得到待扫描目标的图像。此外,器械可当作扫描探头使用,即它指向哪里,就可以扫描哪里,从而提高了操作的灵活性。2、由于本发明系统预先在跟踪设备或成像设备设置有跟踪设备坐标系与成像设备坐标系的转换模块,因此可以将跟踪设备坐标系下的目标位姿实时转换到成像设备坐标系中,因此更进一步节省了操作时间,提高了成像速度。本发明成像速度快、精度高,可以广泛用于各种成像设备中。
具体实施方式
下面结合附图和实施例对本发明进行详细的描述。
如图3所示,本发明系统包括示踪器1、跟踪设备2和成像设备3,在示踪器1、跟踪设备2和成像设备3上分别建立与各自对应的的坐标系,即示踪器坐标系tool、跟踪设备坐标系track、成像设备坐标系scan。
其中,本发明的示踪器1包括一位姿传感器和一固定用的支架,位姿传感器通过支架固定设置在待扫描目标(包括器械、病灶等)上。在示踪器坐标系tool中,位姿传感器的位姿即可作为示踪器1的位姿。本实施例中,位姿传感器可以是3个不共线的外表为荧光粉涂层的塑料球,跟踪设备2可以采用基于双目视觉的光学相机加上计算机及处理软件的组合。跟踪设备2可以测量位姿传感器的位姿,因此跟踪设备2通过跟踪测量示踪器1中位姿传感器的位姿,可以获取示踪器1在跟踪设备坐标系track中的位姿Ctool track,也就是坐标由示踪器坐标系tool转换到跟踪设备坐标系track时所采用的变换矩阵,其表达式为:
式中,Ctool track为4×4矩阵,Rtool track为3×3旋转矩阵,Ttool track为3×1矩阵,即3维平移向量。Ctool track、Rtool track和Ttool track的下标为tool、上标为track,这表示这些变量可将位置或方向从示踪器坐标系tool转换到跟踪设备坐标系track中。例如,采用下面的公式可以将某一点Q在示踪器坐标系tool中的坐标Qtool(即3×1矩阵表示的3维向量,上标tool表示此坐标位于示踪器坐标系tool)转换为在跟踪设备坐标系track中的坐标Qtrack(即3×1矩阵表示的3维向量,上标track表示此坐标位于跟踪设备坐标系track),其表达式为:
某一个方向
在示踪器坐标系tool中可以用单位向量
表示(即3×1矩阵表示的归一化3维向量,上标tool表示此单位向量位于示踪器坐标系tool),在跟踪设备坐标系track中此方向转换为单位向量
(即3×1矩阵表示的归一化3维向量,上标track表示此单位向量位于跟踪设备坐标系track)的公式为:
为了使成像设备3能够使用跟踪设备坐标系track中的位姿数据,需要将跟踪设备坐标系track中的位姿数据转换到成像设备坐标系scan中。负责完成这种转换的矩阵为跟踪设备坐标系与成像设备坐标系的转换模块Ctrack scan,其表达式为:
式中,Ctrack scan为4×4矩阵,Rtrack scan为3×3旋转矩阵,Ttrack scan为3×1矩阵,即3维平移向量。Ctrack scan、Rtrack scan和Ttrack scan的下标为track、上标为scan,这表示这些变量可将位置或方向从跟踪设备坐标系track转换到成像设备坐标系scan。例如,采用下面的公式可将某一点Q在跟踪设备坐标系track中的坐标Qtrack(即3×1矩阵表示的3维向量,上标track表示此坐标位于跟踪设备坐标系track)转换为在成像设备坐标系scan中的坐标Qscan(即3×1矩阵表示3维向量,上标scan表示此坐标位于成像设备坐标系scan),其表达式为:
某一个方向
在跟踪设备坐标系track中可用单位向量
表示(即3×1矩阵表示的归一化3维向量,上标track表示此单位向量位于跟踪设备坐标系track),在成像设备坐标系scan中此方向转换为单位向量
(即3×1矩阵表示的归一化3维向量,上标scan表示此单位向量位于成像设备坐标系scan):
跟踪设备坐标系与成像设备坐标系的转换模块Ctrack scan可以预置在跟踪设备2内,也可以预置在成像设备3内,Ctrack scan将跟踪到的待扫描目标位姿从跟踪设备坐标系track转换到成像设备坐标系scan中。当Ctrack scan预置在跟踪设备2内时,跟踪设备2将待扫描目标位姿从跟踪设备坐标系track中转换到成像设备坐标系scan中,并输送给成像设备3;当Ctrack scan预置在成像设备3内时,跟踪设备2将在跟踪设备坐标系track中的待扫描目标位姿输送给成像设备3,由成像设备3将待扫描目标位姿从跟踪设备坐标系track中转换到成像设备坐标系scan中。成像设备3依据自身坐标系中的待扫描目标位姿完成图像扫描。
跟踪设备坐标系与成像设备坐标系的转换模块Ctrack scan可以通过其它技术标定得到,比如由专利ZL200710064900.2《一种支持多种模式的导航系统及导航方法》可得到跟踪设备坐标系与成像设备坐标系的转换模块Ctrack scan的逆矩阵Cscan track,则通过求逆即可得到Ctrack scan:
如图4所示,对于针状器械4,常用的扫描平面有三种类型:平面7和平面8互相垂直且经过针状器械4,平面9则垂直于平面7和平面8。这三种平面的影像结合起来观察就能快速地提供针状器械的全面影像信息。此外还可以将针状器械4当作扫描探头使用,即它指向哪里,就可以扫描哪里,从而提高了操作的灵活性。
利用本发明系统控制成像设备扫描平面的方法,其包括以下步骤:
1)设置一包括示踪器1、跟踪设备2和成像设备3的系统,将示踪器1固定设置在待扫描目标上,将一跟踪设备坐标系与成像设备坐标系的转换模块Ctrack scan预置在所述跟踪设备2或成像设备3内。
2)成像设备3将采用一个具有一定厚度的平面作为扫描平面G,平面G在示踪器坐标系tool里的表达式为:
其中X
tool为平面G上的任意一点在示踪器坐标系tool中的坐标,其是一未知3×1矩阵,即一未知3维向量;在示踪器坐标系tool中平面G的法向表示为
其是一3×1矩阵,即一归一化3维向量,S
tool为平面G上的一已知点在示踪器坐标系tool中的坐标,其是一3×1矩阵,即一3维向量。X
tool、
和S
tool的上标tool表示这些向量位于示踪器坐标系tool中。
和S
tool为已知量,在设计示踪器1时就已经通过机械设计或者标定等方法得到。
3)跟踪设备2测量示踪器1在跟踪设备坐标系track中的位姿Ctool track,Ctool track是将坐标由示踪器坐标系tool转换到跟踪设备坐标系track时所采用的变换矩阵,即公式(1)
4)跟踪设备2利用公式(1)中的示踪器1在跟踪设备坐标系track中的位姿Ctool track以及公式(2)、(3)和(8),计算出扫描平面G在跟踪设备坐标系track中的平面方程:
其中扫描平面G的法向在跟踪设备坐标系track中表示为
其是一3×1矩阵,即一归一化3维向量,上标track表示此单位向量位于跟踪设备坐标系track;X
track为扫描平面G上的任意一点在跟踪设备坐标系track中的坐标,其是一未知3×1矩阵,即一未知3维向量,上标track表示此向量位于跟踪设备坐标系track;S
track为平面G上的一已知点在跟踪设备坐标系track中的坐标,其是一3×1矩阵,即一3维向量,上标track表示此向量位于跟踪设备坐标系track。
5)跟踪设备2利用公式(4)中的跟踪设备坐标系与成像设备坐标系的转换关系Ctrack scan以及公式(5)、(6)、(9)、(10)和(11),计算出扫描平面G在成像设备坐标系scan中的平面方程:
其中扫描平面G在成像设备坐标系scan中的法向表示为
其是一3×1矩阵,即一归一化3维向量,上标scan表示此单位向量位于成像设备坐标系scan;X
scan为扫描平面G上的任意一点在成像设备坐标系scan中的坐标,其是一未知3×1矩阵,即一未知3维向量,上标scan表示此单位向量位于成像设备坐标系scan;S
scan为扫描平面G上的一已知点在成像设备坐标系scan中的坐标,其是一3×1矩阵,即一3维向量,上标scan表示此单位向量位于成像设备坐标系scan。完成扫描平面G在成像设备坐标系scan中的平面方程(12)、(13)、(14)的计算后,跟踪设备2将此平面方程传输至成像设备3。
6)成像设备3依据扫描平面G在成像设备坐标系scan中的平面方程(12)、(13)、(14)完成待扫描目标的影像扫描。
上述步骤5)中,也可以先由跟踪设备2将扫描平面G在跟踪设备坐标系track中的平面方程(9)、(10)、(11)传输至成像设备3,然后由成像设备3计算出扫描平面G在成像设备坐标系scan中的平面方程(12)、(13)、(14)。