CN112386209A - 一种基于移动式磁梯度仪的定位精度提升方法 - Google Patents
一种基于移动式磁梯度仪的定位精度提升方法 Download PDFInfo
- Publication number
- CN112386209A CN112386209A CN202011067989.XA CN202011067989A CN112386209A CN 112386209 A CN112386209 A CN 112386209A CN 202011067989 A CN202011067989 A CN 202011067989A CN 112386209 A CN112386209 A CN 112386209A
- Authority
- CN
- China
- Prior art keywords
- magnetic
- positioning
- gradiometer
- vector
- included angle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/00147—Holding or positioning arrangements
- A61B1/00158—Holding or positioning arrangements using magnetic field
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/04—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor combined with photographic or television appliances
- A61B1/041—Capsule endoscopes for imaging
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/04—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor combined with photographic or television appliances
- A61B1/045—Control thereof
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01R—MEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
- G01R33/00—Arrangements or instruments for measuring magnetic variables
- G01R33/02—Measuring direction or magnitude of magnetic fields or magnetic flux
- G01R33/022—Measuring gradient
Landscapes
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Surgery (AREA)
- Physics & Mathematics (AREA)
- Biomedical Technology (AREA)
- Molecular Biology (AREA)
- Pathology (AREA)
- Radiology & Medical Imaging (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Engineering & Computer Science (AREA)
- Biophysics (AREA)
- Heart & Thoracic Surgery (AREA)
- Medical Informatics (AREA)
- Optics & Photonics (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Condensed Matter Physics & Semiconductors (AREA)
- General Physics & Mathematics (AREA)
- Measurement And Recording Of Electrical Phenomena And Electrical Characteristics Of The Living Body (AREA)
- Magnetic Resonance Imaging Apparatus (AREA)
Abstract
Description
技术领域
本发明涉及一种基于移动式磁梯度仪的定位精度提升方法,属于磁定位技术领域。
背景技术
磁定位技术是一项基于磁场的目标定位技术,具有全天候、速度快、精度高等优点,在地球物理、生物医疗等众多领域展示出其特有的优势和应用前景。在定位和导航手术机器人时,相比光学跟踪,磁定位技术不受遮挡物影响且成本更低。在跟踪无线胶囊内窥镜、舌头运动、磁性药物标记时,相比存在辐射的CT和费用昂贵的MRI,磁定位技术更加安全、低成本和高效。
在定位某些磁目标特性(磁目标的磁矩方向和相对于磁定位***的方向)时,定位误差非常大,称为定位盲区,即磁目标的方向和磁矩方向决定了磁目标是否位于定位盲区。张量磁定位方法是磁定位技术的下一次突破点,张量磁定位方法中被广泛关注的是NARA法和STAR法。目前的张量磁定位方法存在以下问题:
1、NARA法因全张量矩阵奇异存在定位盲区,未有较好的盲区误差补偿方法
NARA法无需结构指数的先验估计,可快速、准确地定位磁目标,但当全张量矩阵奇异时,NARA法的定位方程呈现病态性,出现定位盲区。针对定位方程的病态性,有学者利用牛顿插值来对定位盲区的定位结果进行补偿,也有学者利用Moore-Penrose广义逆计算全张量矩阵的逆矩阵。这两种改进思路都需要先选取阈值判断矩阵是否奇异,但不同的工况下阈值是不同的,难以选取准确的阈值。目前,未有较好的方法补偿NARA的定位盲区。
2、STAR法因非球面系数存在定位盲区,盲区的补偿效果需进一步提升
研究者基于张量不变量的磁梯度收缩,提出了标量三角测量与测距(STAR)法。STAR 法可实时定位磁目标且定位精度不受地磁场影响。但由于非球面系数的存在,STAR法存在非球面误差,即定位盲区。有学者提出了不含非球面系数的改进STAR法,称为LSM,相比STAR法,LSM的定位误差减小了10.9%。有学者利用迭代法补偿了STAR法的方向误差,称为WSM,相比STAR法,WSM的定位误差减小了68.5%。但是,LSM和WSM 都没有完全地补偿非球面误差,STAR法定位盲区的补偿还存在进一步提升的空间。
3、未有研究利用定位盲区分布规律提出盲区规避方法
已有研究表明,当位置向量和磁矩向量的夹角接近90°时,NARA法出现定位盲区;当夹角接近60°或120°时,STAR法出现定位盲区。虽然已知定位盲区与物理量之间的映射关系,但未有研究针对此映射关系提出定位盲区的规避方法,定位盲区的分布规律未得到充分的利用。
发明内容
本发明的目的是提出一种基于移动式磁梯度仪的定位精度提升方法,以解决现有技术张量磁定位方法存在定位盲区,针对定位盲区的误差补偿又不充分,定位精度不够的问题。
进一步的,所述定位精度提升方法包括以下步骤:
步骤一:如果初次定位,zmg=0,否则zmg=rz,其中,rz是位置向量的z轴分量;
步骤二:磁梯度仪在z=zmg的柱面移动导轨上旋转一周,采样数量为N;
步骤三:根据式(1)计算磁梯度仪在各个位置处的磁梯度张量Gi(i=1,2,…,N),
本发明的主要优点是:本发明创造的优点在于以下几个方面:
(3)MG-BAA定位结果的均方根误差为1mm,将STAR法的均方根误差减小了90.8%,有效地提升了定位精度。
附图说明
图1是基于移动式磁梯度仪的定位***示意图;
图2是无线胶囊内窥镜的运动轨迹图;
图3是无线胶囊内窥镜的定位误差图。
具体实施方式
下面将结合本发明实施例中的附图对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
因为定位盲区与物理量存在映射关系,所以根据式(3)可知通过改变位置向量可以改变夹角从而实现定位盲区的规避。在磁定位中,磁目标的位置不确定也很难将其移到准确的位置,但可以改变磁梯度仪的位置来改变位置向量。基于移动式磁梯度仪的定位***组成如图1所示。
式中λ1、λ2、λ3、是磁梯度张量G从大到小排序的三个特征值,磁梯度张量是磁场矢量在空间中的变化率,共包含9个元素:
基于移动式磁梯度仪的定位精度提升方法(MG-BAA)的主要思想是磁梯度仪在移动导轨上旋转一周,根据定位误差与物理量之间的映射关系确定磁梯度仪的最优位置,选择最优位置上磁场数据进行磁目标定位。MG-BAA的具体步骤如下:
步骤一:如果初次定位,zmg=0,否则zmg=rz(rz是位置向量的z轴分量);
步骤二:磁梯度仪在z=zmg的柱面移动导轨上旋转一周,采样数量为N;
下面为本发明的一具体实施例:
有学者基于磁梯度张量的不变量,提出了标量三角测量与测距(STAR)法,可实时定位磁目标且定位精度不受地磁场影响,以STAR法为例进行本发明的实施说明。STAR法的定位误差主要是非球面误差δ,非球面误差与物理量的映射关系为:
以无线胶囊内窥镜为例进行磁目标的定位,地磁场的幅值为55000nT,偏角和倾角分别为-10°和为60°。柱面移动导轨半径rmg、采样数量N,磁矩大小M、基线距离D、磁传感器的分辨率S、磁传感器的噪声水平k、高斯白噪声的标准差σ,如表1所示。
表1仿真条件
参照图2所示,将柱面螺旋线作为无线胶囊内窥镜的运动轨迹,其数学表达式为:
式中w是无线胶囊内窥镜的角速度,t是运动时间。取w=0.005πrad/s,t=0s,20s,40 s,…1000s。为了获得完整的病理情况,无线胶囊内窥镜需要在各种姿态下进行拍照和录像。为了模拟实际的定位工况,在每个位置无线胶囊内窥镜的磁矩方向是随机的。为了计算结果具有更好的客观性,取50次的平均值作为计算结果。
从图3可以看出,在定位无线胶囊内窥镜时,STAR法的定位误差较大,而MG-BAA 通过移动磁梯度仪为位置,有效地减小了定位误差。
表2是磁定位方法在运动轨迹上的均方根误差ε,MG-BAA的均方根误差为1mm,将STAR法的均方根误差减小了90.8%,有效地提升了定位精度。
表2磁定位方法在运动轨迹上的均方根误差。
Claims (2)
2.根据权利要求1要求所述的一种基于移动式磁梯度仪的定位精度提升方法,其特征在于,所述定位精度提升方法包括以下步骤:
步骤一:如果初次定位,zmg=0,否则zmg=rz,其中,rz是位置向量的z轴分量;
步骤二:磁梯度仪在z=zmg的柱面移动导轨上旋转一周,采样数量为N;
步骤三:根据式(1)计算磁梯度仪在各个位置处的磁梯度张量Gi(i=1,2,…,N),
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011067989.XA CN112386209B (zh) | 2020-10-08 | 2020-10-08 | 一种基于移动式磁梯度仪的定位精度提升方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011067989.XA CN112386209B (zh) | 2020-10-08 | 2020-10-08 | 一种基于移动式磁梯度仪的定位精度提升方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112386209A true CN112386209A (zh) | 2021-02-23 |
CN112386209B CN112386209B (zh) | 2022-12-06 |
Family
ID=74595821
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011067989.XA Active CN112386209B (zh) | 2020-10-08 | 2020-10-08 | 一种基于移动式磁梯度仪的定位精度提升方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112386209B (zh) |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005098978A (ja) * | 2003-08-20 | 2005-04-14 | Japan Science & Technology Agency | 三次元計測装置、三次元計測方法、三次元計測プログラムおよび記録媒体 |
US20070139175A1 (en) * | 2003-08-18 | 2007-06-21 | Llorenc Servera Serapio | System and method for the magnetic detection of the presence of objects in a blind angle of an automobile vehicle |
JP2011185868A (ja) * | 2010-03-10 | 2011-09-22 | Alps Electric Co Ltd | 方位検知装置 |
CN104698410A (zh) * | 2015-03-02 | 2015-06-10 | 北京大学 | 用于磁力仪的原子磁传感器及消除磁力仪探测盲区的方法 |
CN104854305A (zh) * | 2012-12-07 | 2015-08-19 | 哈利伯顿能源服务公司 | 基于梯度的单井sagd测距*** |
US20150366439A1 (en) * | 2014-06-24 | 2015-12-24 | National Cheng Kung University | Method of operating an endoscope by changing magnetic field and controlling feeding and rotation of the endoscope synchronously |
CN106595670A (zh) * | 2016-12-30 | 2017-04-26 | 北京航空航天大学 | 一种采用广义逆矩阵消除盲区的方法 |
CN108387952A (zh) * | 2018-02-06 | 2018-08-10 | 吉林大学 | 三分量squid传感器正交度校正装置及校正方法 |
CN110007350A (zh) * | 2019-04-15 | 2019-07-12 | 哈尔滨工业大学 | 一种磁探测方法盲区的分析方法 |
CN110017808A (zh) * | 2019-03-26 | 2019-07-16 | 北京理工大学 | 利用地磁信息和加速计解算飞行器姿态的方法 |
CN110146839A (zh) * | 2019-05-30 | 2019-08-20 | 中国海洋大学 | 一种移动平台磁梯度张量***校正方法 |
CN111239838A (zh) * | 2020-01-16 | 2020-06-05 | 哈尔滨工业大学 | 一种磁探测精度的检测方法 |
CN111504256A (zh) * | 2020-04-29 | 2020-08-07 | 中国北方工业有限公司 | 一种基于最小二乘法的滚转角实时估计方法 |
-
2020
- 2020-10-08 CN CN202011067989.XA patent/CN112386209B/zh active Active
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070139175A1 (en) * | 2003-08-18 | 2007-06-21 | Llorenc Servera Serapio | System and method for the magnetic detection of the presence of objects in a blind angle of an automobile vehicle |
JP2005098978A (ja) * | 2003-08-20 | 2005-04-14 | Japan Science & Technology Agency | 三次元計測装置、三次元計測方法、三次元計測プログラムおよび記録媒体 |
JP2011185868A (ja) * | 2010-03-10 | 2011-09-22 | Alps Electric Co Ltd | 方位検知装置 |
CN104854305A (zh) * | 2012-12-07 | 2015-08-19 | 哈利伯顿能源服务公司 | 基于梯度的单井sagd测距*** |
US20150366439A1 (en) * | 2014-06-24 | 2015-12-24 | National Cheng Kung University | Method of operating an endoscope by changing magnetic field and controlling feeding and rotation of the endoscope synchronously |
CN104698410A (zh) * | 2015-03-02 | 2015-06-10 | 北京大学 | 用于磁力仪的原子磁传感器及消除磁力仪探测盲区的方法 |
CN106595670A (zh) * | 2016-12-30 | 2017-04-26 | 北京航空航天大学 | 一种采用广义逆矩阵消除盲区的方法 |
CN108387952A (zh) * | 2018-02-06 | 2018-08-10 | 吉林大学 | 三分量squid传感器正交度校正装置及校正方法 |
CN110017808A (zh) * | 2019-03-26 | 2019-07-16 | 北京理工大学 | 利用地磁信息和加速计解算飞行器姿态的方法 |
CN110007350A (zh) * | 2019-04-15 | 2019-07-12 | 哈尔滨工业大学 | 一种磁探测方法盲区的分析方法 |
CN110146839A (zh) * | 2019-05-30 | 2019-08-20 | 中国海洋大学 | 一种移动平台磁梯度张量***校正方法 |
CN111239838A (zh) * | 2020-01-16 | 2020-06-05 | 哈尔滨工业大学 | 一种磁探测精度的检测方法 |
CN111504256A (zh) * | 2020-04-29 | 2020-08-07 | 中国北方工业有限公司 | 一种基于最小二乘法的滚转角实时估计方法 |
Non-Patent Citations (7)
Title |
---|
PAN DH, LI J, JIN CY, LIN SX,: "A New Calibration Method for Triaxial Fluxgate Magnetometer Based on Magnetic Shielding Room", 《IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS》 * |
YUAN DANDAN, LI XINHUA, GUAN JUN: "Method of roll attitude determination based on GPS and magneto-resistive sensor", 《SYSTEMS ENGINEERING AND ELECTRONICS》 * |
刘家曦等: "考虑磁场交叉耦合的内嵌式永磁同步电机初始位置检测技术", 《电工技术学报》 * |
张宁等: "磁性目标定位误差分析及修正", 《电子测量与仪器学报》 * |
林生鑫: "基于零磁环境张量式磁探测仪的研究", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
牛德森: "基于磁传感的胶囊内镜定位技术", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
邓超凡: "基于运动平台的磁梯度张量目标定位技术研究", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
Also Published As
Publication number | Publication date |
---|---|
CN112386209B (zh) | 2022-12-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107272069B (zh) | 基于磁异常梯度的磁性目标追踪方法 | |
CN111190230B (zh) | 一种基于磁梯度张量的探测方法 | |
CN110007350B (zh) | 一种磁探测方法盲区的分析方法 | |
CN105371870B (zh) | 一种基于星图数据的星敏感器在轨精度测量方法 | |
CN108917759A (zh) | 基于多层次地图匹配的移动机器人位姿纠正算法 | |
CN108413988B (zh) | 机器人末端经纬仪坐标系快速标定方法 | |
CN111190229B (zh) | 一种磁目标探测方法 | |
CN105910535A (zh) | 一种用于舱段自动对接的单双目位姿偏差测量方法 | |
CN101539397B (zh) | 物体三维姿态的精密光学测量方法 | |
CN109737913A (zh) | 一种激光跟踪姿态角测量***及方法 | |
CN108061889A (zh) | Ais与雷达角度***偏差的关联方法 | |
CN103744052B (zh) | 一种应用于空中目标定位的双星测时差测向方法及装置 | |
CN109059964A (zh) | 一种基于重力峰的惯性导航与重力测量双校准方法 | |
CN104898104A (zh) | 基于欧氏距离均值聚类的目标联合定位方法 | |
Gao et al. | Development and calibration of an accurate 6-degree-of-freedom measurement system with total station | |
CN111765879A (zh) | 一种三维电子罗盘装置及实用校准方法 | |
CN111504318A (zh) | 一种基于多磁偶极子反演的海洋导航辅助方法 | |
CN112294437B (zh) | 一种基于磁梯度仪阵列的定位及其设计方法 | |
CN113686299A (zh) | 一种海上动态目标定位与移速预测方法 | |
CN109856616A (zh) | 一种雷达定位相对***误差修正方法 | |
CN102901485A (zh) | 一种光电经纬仪快速自主定向的方法 | |
CN112386209B (zh) | 一种基于移动式磁梯度仪的定位精度提升方法 | |
CN112284372B (zh) | 一种基于线圈磁场调控的定位精度提升方法 | |
Jiang et al. | 3D SLAM based on NDT matching and ground constraints for ground robots in complex environments | |
CN109375160A (zh) | 纯方位无源定位中一种测角误差估计方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |