发明内容
本发明所要解决的技术问题是:提供一种多磁性目标的定位方法及定位系统,解决对多目标的定位问题。
本发明另一目的是:解决运动物体内置目标的精确定位跟踪问题。
本发明为解决上述技术问题所采用的技术方案为:
一种多磁性目标的定位方法,包括以下步骤:
A、获取传感器阵列上各传感器所处的空间位置,以及测量各磁性目标作用在所述各传感器处的磁感应强度数据,所述磁性目标内置永磁体;
B、利用测量获得的所述各传感器点的磁感应强度数据以及毕奥-萨伐尔定律,定义多磁性目标的一误差目标函数;
C、利用非线性优化算法寻找所述磁性目标的位置和方向参数,使所述误差目标函数最小,此时所述磁性目标的位置和方向参数即为各磁性目标的定位数据;
D、当所述磁性目标中至少一个被设定为被测目标,其余被设定为参考目标时,计算所述被测目标相对所述参考目标的运动轨迹,对所述被测目标进行相对定位。
所述的定位方法,其中:所述步骤A包括如下:测量各传感器所在位置磁场的三个正交磁感应强度分量;所述步骤B中的所述误差目标函数按照如下步骤获取:
B1、利用测量得到的所述传感器处的三个正交磁感应强度分量定义误差函数三个分量分别为:
其中:Blx,Bly,和Blz为各传感器所在位置磁场的三个正交磁感应强度分量测量值;aq,bq,cq为第q个磁性目标的位置参数;mq,nq,pq为第q个磁性目标的方向参数;xl、yl、zl为第l个传感器的空间位置坐标;N表示传感器阵列中的传感器数量,M表示磁性目标的数量;BTq为第q个磁性目标的磁体常数;并且有:
B2、所述误差目标函数为所述三个误差函数分量之和。
所述的定位方法,其中:当所述磁性目标内置的永磁体被视为磁偶极子时,所述传感器数量至少为所述磁性目标的5倍。
所述的定位方法,其中:当所述磁性目标中至少一个被设定为被测目标,其余被设定为参考目标时,所述步骤C之后还包括执行步骤D:
D、计算所述被测目标相对所述参考目标的运动轨迹,对所述被测目标进行相对定位。
所述的定位方法,其中:所述步骤D包括如下:用所述被测目标的坐标减去所述参考目标的坐标,得到所述被测目标校正后的位置参数。
所述的定位方法,其中:所述被测目标设置在一运动物体内,并相对所述运动物体移动,所述参考目标相对所述运动物体静止。
所述的定位方法,其中:所述步骤D之后还包括执行以下步骤:
E、分析各磁性目标定位数据的合理性,剔除误差大的不合理数据后,用综合优化拟合算法对所述定位数据进行处理,获取各磁性目标的定位定向结果。
F、将所述定位定向结果作为下一次计算的历史数据,依次循环。
所述的定位方法,其中:所述磁性目标之间的距离大致大于所述永磁体自身长度的10倍。
所述的定位方法,其中:在所述步骤A之前还执行以下步骤A0:对所述传感器阵列中的各传感器进行定标,获得各传感器定标参数。
所述的定位方法,其中:所述传感器定标参数包括传感器灵敏度、传感器位置坐标和传感器对准方向;所述步骤A0包括如下步骤:在定 位区域内规定至少一个空间点作为校正点,
A01、将一个标定磁体按确定方向置于一所述校正点上,测试所述传感器阵列中各传感器的磁感应强度数据,以及用毕奥-萨伐尔定律计算所述各传感器处的磁场强度;
A02、比较各传感器计算获取的磁场强度和测量获取的磁感应强度数据,得到一误差分值;
A03、重复步骤A01和A02,得到所述标定磁体在各校正点时的所述误差分值,并获得一误差值,所述误差值为所述各误差分值之和;
A04、调整所述传感器的灵敏度、位置和方向参数定标参数,使所述误差值为最小,此时,所述传感器的灵敏度、位置和方向即为传感器的标定参数。
所述的定位方法,其中:所述步骤F之后还包括执行以下步骤:跟踪记录各磁性目标的定位定向结果数据,并显示各磁性目标运动轨迹的三维图形。
所述的定位方法,其中:当所述磁性目标数量大于2,且把所述磁体常数作为变量时,所述传感器数量至少为所述磁性目标的6倍。
所述的定位方法,其中:所述步骤C中的非线性优化算法采用Levenberg-Marquardt算法。
一种多磁性目标的定位系统,包括至少二个内置永磁体的磁性目标,测量装置、以及多目标定位计算单元,所述测量装置至少包括传感器数量多于所述磁性目标5倍的磁传感器阵列,与磁传感器阵列电连接的数据采集处理单元;所述磁传感器阵列用于测量所述磁性目标在所述磁传感器空间各点上产生的磁场强度信号,所述数据采集处理单元用于对所述磁场强度信号进行数据采集和处理,并输出磁感应强度数据,所述多目标定位单元用于计算得到各磁性目标的位置和参数。
所述的定位系统,其中:当所述磁性目标中至少一个被设定为被测目标,其余被设定为参考目标时,所述多目标定位计算单元还用于根据所述被测目标相对所述参考目标的运动轨迹,对所述被测目标进行相对定位,获取所述被测目标校正位置参数。
所述的定位系统,其中:还包括三维图形引擎,用于描述所述磁性目标的三维运动轨迹。
所述的定位系统,其中:所述永磁体为圆柱体或圆环,所述磁传感器为单轴或双轴或三轴的磁场传感器。
所述的定位系统,其中:所述测量装置采用非磁性材料。
本发明的有益效果为:采用本发明的定位方法和定位系统,可以实现对多目标的定位跟踪,由于被跟踪目标内置的微小永磁体产生的是静态磁场,对人体没有副作用,系统可以长时间运行,满足应用需求;由于永磁铁占用空间小,并且在定位跟踪过程中,被跟踪目标没有能量损耗,不需要配备能源,被跟踪目标结构简单,极易实现微型化,因此特别适宜于人体内目标的定位和跟踪,可以广泛应用于医疗诊断技术领域中。并且,通过多目标磁定位,以及利用被测目标与参考目标进行相对定位,可以实现对运动物体(人体)内置目标的精确定位跟踪,将人体呼吸、运动、扭曲等对被测目标位置的影响得以补偿,还能抵消环境扰动对多目标产生的同步干扰,从而实现对目标的高精度跟踪。
具体实施方式
下面根据附图和实施例对本发明作进一步详细说明:
参见图1和2,一种多磁性目标的定位系统,包括多个内置永磁体的磁性目标11和12,测量装置、以及多目标定位计算单元。测量装置包括磁传感器阵列20,以及与磁传感器阵列电连接的数据采集处理单元21,磁传感器阵列用于测量磁性目标在磁传感器空间各点上产生的磁场强度信号,如图2所示,其包括数量上等于或多于磁性目标5倍的磁场传感器、及放大电路和信号预处理电路,而信号预处理电路可以包括传感器调节电路和复位电路,传感器调节电路用于对传感器零点偏置的调节,以使传感器工作在较佳的线性区域,并排除地磁和环境磁场的影响;复位电路则能使传感器在受到强磁的干扰或长时间工作下,性能发生变化后进行复位,使传感器回到最佳的工作状态。数据采集处理单元用于对磁场强度信号进行数据采集和处理,并输出磁感应强度数据,可以包括多路切换、AD转换、和数据传送部分。多目标定位计算单元用于接收和处理数据采集处理单元输出磁感应强度数据,计算各磁性目标的位置和参数。实际应用中,还包括基于环境虚拟模型下的三维图形引擎,用于显示磁性目标的三维运动轨迹,其中多目标定位计算单元和三维图形引擎可采用工作站或个人计算机40实现,磁性目标中的永磁体为圆柱体或圆环,磁传感器可采用单轴或双轴或三轴的磁场传感器。
利用上述定位系统并采用以下方法就可以实现对多磁性目标的定位和跟踪。
当传感器阵列中的传感器以及测量装置的其它单元机构采用非磁性材料时,可认为永磁体产生的磁场和周围非铁磁材料所构成的环境结构无关,只同磁体目标的位置和方向有关。如图3所示,永磁体周围空间的磁场分布是静态场,是不变的。当选用的永磁体为沿轴均匀磁化的圆柱形或圆环永久磁铁,并且永磁体的尺寸远小于检测点和永磁体间的距离时,永磁体可等效为图4所示的磁偶极子,图中X-Y-Z为全局坐标系,(a,b,c)为磁体目标设备的位置;(xl,yl,zl)为传感器所在空间上位置点;H0为磁体磁场的方向,用矢量H0=(m,n,p)表示。此时,可以套用毕奥-萨伐尔定律(Biot-Savart定律)具体算出空间各点的磁感应强度,其磁感应强度计算可简化如公式(1)。
其中,
是永磁体的磁矩向量,
是永磁体中心(a,b,c)与某一被测点(x,y,z)的距离向量(x-a,y-b,z-c),R是
的标量,即距离值;δ是与磁体材料和体积有关的常量,μ
0是真空磁导率,人体的磁导率可视为与真空一致。
假定有N个磁传感器,且第l个磁场传感器的位置为(xl,yl,zl),1≤l≤N,则空间各点的磁感应强度Bl有
Bl=Blxi+Blyj+Blzk (1=1,2,...,N) (2)
式中i,j,k代表三个坐标轴的单位矢量,Blx,Bly,Blz为磁感应强度的三个分量,即
式中,BT表示一个与磁体体积和磁化强度有关的常量,为磁性目标的磁体常数;
若在磁体周围空间点上放置传感器,则空间上传感器点的坐标(xl,yl,zl)是预先可确定的,所以未知参数为磁体的位置(a,b,c)和方向(m,n,p)。这六个参数就是定位参数。由于采用磁偶极子表示磁体的磁场,它是绕其中心线对称的,所以磁体的方向H0是2维变化的,也即(m,n,p)T可是任意大小的,因此我们对其加上如下的约束:
m2+n2+p2=1 (6)
由此可见,这样的定位问题是发现5维位置方向参数的问题。若能用5个(或更多)磁场传感器测量得到磁体周围的磁场强度Blx,或Bly,或Blz,就可以用以上的公式解出这些参数。因此,本发明采用如下方法获取多磁性目标的定位数据,如图6所示,其中(aq,bq,cq)q=1,2,...M表示各磁体的空间位置;H1,H2,...HM表示各磁体的磁场方向,且HM 用矢量(mM,nM,pM)表示。所述方法包括以下步骤:
A、测量获得所述传感器阵列上各传感器所处的空间位置,以及测量得到各磁性目标作用在所述各传感器处的磁感应强度数据;
B、利用测量获得的所述各传感器点的磁感应强度数据以及毕奥-萨伐尔定律,定义一误差目标函数;
C、利用非线性优化算法寻找所述磁性目标的位置和方向参数,使所述误差目标函数最小,此时所述磁性目标的位置和方向参数即为各磁性目标的定位数据。
以下以多目标中的特例单目标为例,说明本发明方法:首先已知传 感器阵列上各传感器所处的空间位置,通过各磁传感器测量得到其空间点上的磁感应强度Blx,Bly,和Blz,可以计算单目标磁体的位置参数(a,b,c)和方向参数(m,n,p)。确定五个未知定位定向参数至少需要五个传感器,即,可以选择五个传感器来完成定位参数的确定,也可以使用更多的传感器来解决这一问题,即有更多的求解选择。但是,由于测量值中有噪声,对于单目标来讲无论是使用5个或5个以上的传感器,都需要定义一个综合所有传感器信号的目标函数,并使其为最小来获得各参数的解。针对三个正交的磁感应强度分量定义如下的误差函数三个分量分别为:
7-9公式中,Blx,Bly,和Blz为各传感器所在位置磁场的三个正交磁感应强度分量测量值,a,b,c为磁性目标的位置参数;m,n,p为磁性目标的方向参数,N表示传感器阵列中的传感器数量,xl、yl、zl为第l个传感器的空间位置坐标;其中BT、xl、yl、zl、和Rl均为已知值,未知量有a,b,c,m,n,p。定义总目标误差函数为以上三个误差份量之和:
E=Ex+Ey+Ez (10)
这样问题就转变为寻找最合适的参数(a,b,c)和(m,n,p),使误差目标函数E为最小,这样求得的结果即为磁性目标的定位数据。求解误差目标函数E为最小的过程需要应用非线性优化方法,如Levenberg-Marquardt算法来完成。
对于磁性目标等于或多于2个的多目标定位,具体实施方法为:假定有M个磁性目标,如图5所示,M大于等于2,并假定M个磁性目标的位置参数分别为(a1,b1,c1),(a2,b2,c2)...,和(aM,bM,cM);方向参数分别为(m1,n1,p1),(m2,n2,p2),...,和(mM,nM,pM)。当各个磁性目标之间的距离相对磁性目标内置永磁体的尺寸较大,例如大于10倍磁体长度以上,传感器上的磁场可视为各永磁体产生的磁场之线性叠加,即 则在第l个传感器位置(xl,yl,zl)上的磁感应强度的三个分量为:
式中,
并且有m
q 2+n
q 2+p
q 2=1,定义总目标误差函数
为误差函数三个分量之和:
式中:
这里,l=1,2,...,N,表示传感器的序号;q=1,2,...,M,表示磁体的序号,BTq为第q个磁性目标的磁体常数。由此可见,问题转化为通过测量 各个传感器上磁感应强度Blx,Bly,和Blz(l=1,2,...,N),然后用优化算法计算磁体的位置参数(aq,bq,cq)和方向参数(mq,nq,pq),(q=1,2,...,M),使目标误差函数 为最小。此时求解得到的位置参数(aq,bq,cq)和方向参数(mq,nq,pq)即为各磁性目标的定位数据。本发明方法中,由于每一个磁性目标都有5个未知参数(3个位置、2个方向),所以M个磁性目标就有5×M个未知量,这就要求传感器阵列中的传感器数量最少为5×M个,即传感器数量至少为磁性目标的5倍以确定这些未知量。例如对3个磁性目标的定位,传感器数量至少应为15个。对于多目标来讲,无论是使用5×M个或5×M个以上的传感器,同样都需要定义一个综合所有传感器信号的目标函数,并使其为最小来获得各参数的解。由于当被跟踪的磁性目标为多个时(超过2个),在进行实时定位时,预先确定磁体常数BTq是困难且不便的,因此,在实际应用中,在多目标定位时可将BTq作为变量来处理,此时,当有M个磁性目标时要求传感器阵列中的传感器数量最少为6×M个,即传感器数量至少为磁性目标的6倍以确定这些未知量。而对传感器数目上限没有限制,由于传感器信号强度与传感器和磁体之间间距的逆三次方关系,可以布置更多的传感器,使某些传感器到磁体的间距缩小,有利于信噪比提高;同时更多的传感器对信号会起平均的作用;可见所有传感器都在计算中有贡献,布置更多的传感器会改善定位精度。
采用本发明方法,实现了对多目标的定位跟踪,由于被跟踪目标内置的永磁体产生的是静态磁场,对人体没有副作用,系统可以长时间运行,并且由于永磁铁占用空间小,没有能量损耗,不需要配备能源,极易实现微型化,因此本发明多目标定位方法特别适宜于人体内微型装置的定位和跟踪。
本系统的一个很好的应用是对一个运动物体(如人体)内部的目标进行定位跟踪,解决运动物体内置目标的精确定位跟踪问题。例如在医 疗诊断中,通常通过对人体内的微型装置的定位跟踪来获取人体内的病理信息。由于传感器阵列的位置是固定的,含有磁体的微型装置(如内窥镜)设置在人体内,人体在检查过程中会因呼吸、转动、相对伸缩引起人体相对传感器阵列的移动,尤其是运动时的呼吸会使横膈膜被迫下降而压挤腹内各脏器,使大小肠等较柔软的器官产生位置的变化发生相对传感器坐标系的移动,使被跟踪目标的位置或方向会随运动物体的位置方向变化而变化,因此会造成对人体内微型装置定位跟踪的误差。采用本发明同时对多目标跟踪定位的方法,可以消除定位跟踪时人体动作对体内目标的影响,消除这种定位误差,因此可以广泛应用于人体医疗诊断领域中。
如图1和图7所示,将磁性目标中的之一12设定为被测目标,该被测目标置于运动物体内,相对运动物体移动,例如人体吞服一个包含有磁体的微型装置,如胶囊内窥镜;其余磁性目标11被设定为参考目标,例如采用两个或多个参考目标11,并将参考目标11固定在运动物体的某些特殊部位上,参考目标11相对运动物体静止,由于人的躯体和其它动作,会使被测目标和参考目标均随运动物体(人体)相对测量系统中的磁传感器阵列移动。测量装置和多目标定位计算单元对体内的被测目标和体外的参考目标进行同时的跟踪,同时获取体内被测目标和参考目标的定位数据,即在绝对坐标系的位置变化;然后多目标定位计算单元还计算被测目标相对参考目标的轨迹,相比较后计算获得体内被测目标相对参考目标的抵消了人体移动的运动轨迹。对被测目标与参考目标进行相对定位,可补偿由呼吸、心跳、人体运动所产生对被测目标12位置的跟踪影响,提高定位精度。具体方法是:对被测目标及一参考目标的位置跟踪结果用(a目标,b目标,c目标)和(a参考,b参考,c参考)来表示,用被跟踪的体内被测目标坐标(a目标,b目标,c目标)减去体外参考目标的坐标(a 参考,b参考,c参考),得到(a目标-a参考,b目标-b参考,c目标-c参考),这一结果就是相 对于参考目标的体内被测目标的坐标,即被测目标校正后的位置参数。长时间纪录这一坐标数据,就形成相对参考目标点的体内目标的精确轨迹,可以将人体呼吸、运动、扭曲等影响得以补偿,消除定位跟踪时人体动作对体内目标的影响,病人可以实现更自由的活动,而不影响诊断结果,为相关的诊断治疗提供准确的病理信息,为具体病状和病变部位提供精确定位。特别是作为消化道的微型医疗设备时,可提供微型医疗设备在消化道内的运动轨迹、方向、和速度信息,以使医生能准确地确定进一步治疗和手术位置。通过多目标磁定位并利用被观测目标与参考目标进行相对定位,还能抵消环境扰动对多目标产生的同步干扰,从而实现对目标的高精度跟踪。同时,通过掌握目标的位置方向信息,使进一步实现对微型设备的反馈控制成为可能。
在具体应用中,完成了上述定位参数的计算后,系统还对得到的各磁性目标三维定位结果参数(a,b,c)和三个定向参数(m,n,p)进行数据合理性分析和处理,包括以下步骤:
E、跟踪历史数据分析各磁性目标定位数据的合理性,若误差明显偏大,将剔除本次数据;若数据是合理的,进一步用综合优化拟合算法对已得到的定位(位置和方向)数据进行处理,如实施二次抛物线函数进行拟合,获取更为稳定的各个磁性目标的定位定向结果。
F、将所述定位定向结果作为下一次计算的历史数据,依次循环。
采用步骤E和F的优点在于:依靠信号动态拟合技术来滤除各种噪声,滤除外界对跟踪系统的随机干扰,从而大幅度提高定位系统的精度,从而在不同的应用环境下保证测量精度,使跟踪稳定性大大提高,跟踪轨迹更为光滑,结果更为精确,相对的有效定位区域更为扩大。
由于本发明定位系统还采用基于虚拟环境模型下的3维图形引擎,可完成对跟踪环境的3维虚拟图像输出,即,将被跟踪目标的运动轨迹结合在虚拟环境中进行3维图像输出,因此可在跟踪过程中记录环境的 相对运动和跟踪数据,并在计算机显示器上进行数据和3维显示,如图8所示,给人以直观和真实的展示。
在实际应用中,为提高对磁性目标定位跟踪的准确性,传感器阵列和定位系统需要经过定标以后才能进行应用。定标内容包括:传感器阵列中各个传感器的灵敏度测量和校准;多轴(双轴或三轴)传感器位置的精确确定;多轴(双轴或三轴)传感器(最灵敏)的方向确定与校准。其步骤如下:
A01、将一个标定磁体按确定方向放在有效定位区域内若干规定的空间点上,该空间各点为校正点;测试各个传感器的响应数值,即其输出电压信号,通过预定的传感器灵敏度,可以得到传感器所在位置的磁场强度。由于这些校正点的坐标和磁体的位置方向事先已知,传感器位置上的磁场强度可用Biot-Savart定律的公式(3)~(5)计算。
A02、比较标定磁体在某一校正点时通过计算获取的磁场强度和测量获取的磁感应强度数据,得到一误差分值;
A03、将标定磁体在各校正点时得到的误差分值相加,得到一总误差值;
A04、重复地微小调整传感器灵敏度、位置坐标和对准方向数值,使总误差值为最小,此时各传感器的灵敏度、位置和对准方向即为传感器的标定后的参数。在确定了这些参数后,在实时的定位程序中对测量值和算法计算时都进行参数校准,以提高精度和测量的稳定性。定标中,至少规定一个空间点作为校正点,多个校正点可以提高定标准确性。
综上,本发明实施的多磁性目标定位方法包括如下步骤:
1、根据具体的应用环境和追踪对象确定被测目标和参考目标数量,即,磁性目标的总数量;
2、选取适当的传感器阵列类型,如单轴、双轴、或三轴;选取传感器数量规模以及传感器分布方式;
3、系统对传感器阵列和定位系统进行定标;
4、对所有磁场传感器进行复位和灵敏度校正;
5、系统滤除应用环境中的静态磁场(主要为地磁);
6、磁场传感器阵列对所有磁性目标中永磁体产生的磁场强度进行检测;
7、模数转换器对各传感器信号进行转换;
8、计算机对采集的数据进行滤波和灵敏度调整。由于传感器所采集的磁场传感器信号是很低的,采集信号经过放大后噪声较大,应进行相关信号处理。即对各磁场传感器的信号进行快速采集,并用二次抛物线函数进行拟合,以降低传感器信号的随机噪声,滤除时间漂移、白噪声、环境扰动等对微型设备定位结果的影响。
9、计算机利用非线性优化算法(Levenberg-Marquardt算法)计算各个磁体目标的位置和方向,使误差目标函数最小。
10、计算被测目标相对参考目标的运动轨迹,滤除环境相对运动对被测目标设备的影响。
11、分析结果合理性,并用适当的综合优化拟合算法对定位结果进行进一步滤波、优化,获取更精确的定位定向结果;
12、新的结果将被储存作为下一次的计算的历史数据,依次循环。
13、记录环境的相对运动和跟踪数据,并在计算机显示器上进行数据和3维显示。
对于多目标跟踪的一个必须考虑的问题是人体和周围物体对定位的影响。本系统要求在磁体目标和磁场传感器阵列之间,以及它们的周围避免出现任何铁磁材料物体;因此可以用非铁磁材料的部件构成测量装置,如铜、铝等。人体对静态磁场的分布是没有影响的,所以本系统特别适宜于人体体内目标的跟踪。多磁性目标定位系统操作流程为:本发明的定位系统在系统运行前需检测并保存应用环境的静态磁场,在应 用中环境设置参考目标;将带有永磁体的微型设备放入跟踪区域,传感器阵列进行信号采样,然后实施跟踪定位。在跟踪过程中记录环境的相对运动和跟踪数据,并在计算机显示器上进行数据和3维显示。