一种空间万向均匀旋转磁场轴线方位的精确测量方法技术

本发明专利技术属于自动化工程技术领域，公开了一种空间万向均匀旋转磁场轴线方位的精确测量方法。首先，使用3个霍尔传感器和1个3轴加速度传感器测量任意两时刻旋转磁场的三维磁矢量坐标，并建立旋转磁矢量坐标在探头坐标系和固定坐标系中的旋转变换关系。其次，借助空间矢量的运算法则求解上述两时刻旋转磁矢量的法向量。再次，根据空间矢量的正交变换原理，求得以俯仰角和侧摆角描述的空间万向旋转磁场轴线方位。最后，根据任意两时刻旋转磁矢量的法向量与空间旋转磁场轴线方位的对应关系，可求得以三维磁矢量坐标表示的旋转磁场轴线方位。本发明专利技术的测量方法具有测量精度高，实时性好，环境适应能力强、工作环境要求低等优点。工作环境要求低等优点。工作环境要求低等优点。

【技术实现步骤摘要】
一种空间万向均匀旋转磁场轴线方位的精确测量方法


[0001]本专利技术属于自动化工程
，涉及一种空间万向均匀旋转磁场轴线方位的精确测量方法，具体涉及使用3个霍尔传感器测定的三维磁场矢量对三维旋转磁场的轴线方位进行精确测量的方法和步骤。

技术介绍

[0002]胶囊内窥镜是替代传统胃镜、结肠镜进行胃肠道检查的有效手段，它旨在以微创方式对胃肠道进行检查。该种方法无需镇静，也不会引起患者的不适或疼痛，是小肠疾病监测的有效手段和工具。目前，磁驱型胶囊机器人代表了其最新研究进展。按照工作原理的不同，磁驱动胶囊大致可分为梯度磁场驱动型和均匀旋转磁场驱动型两种。
[0003]梯度磁场驱动型胶囊通过外部电磁场与胶囊内嵌永磁体间的梯度磁拉力拖动胶囊前进，并通过控制外部磁场的方位改变胶囊的姿态。以该种方式为工作原理，研究者提出了多种结构形式的胶囊，甚至推出了商业化的产品：如文献《Feasibility of stomach exploration with a guided capsule endoscope》介绍了一种由西门子医疗中心与奥林巴斯医疗公司联合开发的多线圈驱动磁导航胶囊内窥镜系统；武汉安翰科技有限公司也在专利US 2015/0018615 A1中提出一款通过外部球形永磁体实现胶囊主动运动的胶囊内窥镜系统。然而，由于外部磁场方位以及胶囊在胃肠道中的精确位置和方向难以实时监测，因而无法精确控制作用于胶囊的磁力和磁矩的大小。同时，该类胶囊存在磁力磁矩耦合问题，即通过磁力控制胶囊位置或通过磁矩控制胶囊方位时，两种操作会不可避免的产生相互影响。因此，梯度磁场驱动型胶囊在临床应用中多表现出稳定性差、操纵控制困难、以及容易冲击胃肠道等问题。
[0004]纯磁矩驱动胶囊通过外部均匀旋转磁场与胶囊内嵌永磁体间的磁矩实现胶囊的主动运动和位姿控制。纯磁矩驱动胶囊的外部驱动源通常为三轴亥姆霍兹线圈产生的均匀旋转磁场，通过外部旋转磁场和胶囊内嵌径向磁化永磁体间的耦合磁力矩，可将胶囊的螺旋运动转化为直线运动或实现胶囊的滚动运动，具体描述见专利200710159159.8；通过控制旋转磁场的轴线方位(磁矢量旋转平面的法向方向)可实现胶囊位姿的调整，相关胶囊见专利201510262778.4。该类胶囊不仅能有效避免梯度磁场力的产生，而且能够解决梯度磁场驱动型胶囊存在的磁力磁矩耦合问题，因而代表了磁驱型胶囊的最新研究动向。纯磁矩驱动胶囊位姿控制的核心问题是对旋转磁场轴线方位的精确控制，磁场轴线方位的精确与否将直接影响胶囊位姿的控制精度，而对磁场轴线方位的精确检测是实现胶囊位姿精确控制的基本前提。
[0005]综上，对于磁驱胶囊机器人来说，外部磁场方位检测是非常必要的：首先，磁驱胶囊机器人需要通过外部驱动磁场来控制胶囊在胃肠道内的位置和方向。如果外部磁场方位发生变化，就会影响胶囊的运动轨迹和位置，可能导致胶囊无法到达目标位置或出现偏移，影响诊断和治疗的准确性。其次，外部磁场方位的变化也可能会引起磁场的干扰，使得胶囊无法保持稳定的运动和位置，从而影响胶囊的位姿稳定性和诊疗效果。再次，外部磁场方位
的检测可以实时监测磁场方位的变化，及时对胶囊进行校准和调整，从而使其保持准确的位姿，并提高医疗治疗的效果和安全性。因此，对磁驱胶囊机器人的外部磁场方位，特别是空间均匀旋转磁场的轴线方位的检测是非常必要的，它可以保障机器人的运动和位置控制精度，从而提高诊疗的效果和安全性。尽管研究者对胶囊机器人的磁驱动方式已达成共识，并已充分认识到磁场方位检测的重要性，然而市面上尚无检测磁场方位，特别是空间均匀旋转磁场轴线方位的有效仪器。
[0006]针对上述问题，本专利技术在已有国家专利技术专利“一种空间万向旋转磁场人机交互控制方法”(专利号：ZL201610009285.4)的基础上，通过霍尔传感器和加速度传感器获得的三维磁矢量信息，并依据空间矢量的正交变换原理，提出一种空间均匀旋转磁场轴线方位的精确测量方法。具体以霍尔传感器在任意两时刻测定的三维磁矢量坐标为依据，建立旋转磁矢量在探头坐标系和固定坐标系中的旋转变换关系。之后，结合固定坐标系中旋转磁场轴线方位的表示方法，以及任意两时刻磁矢量的法向量与旋转磁场轴线方位的对应关系，给出空间旋转磁场轴线方位的函数表达式。
[0007]目前，尚未有人提出空间均匀旋转磁场轴线方位的精确测量方法，该定位方法的突出特点是可利用霍尔传感器和加速度传感器获得的三维磁矢量坐标信息，实现三维动态均匀旋转磁场轴线方位的精确测量，该方法具有测量精度高，测量实时强，有望为磁驱胶囊机器人姿态控制精度的提高提供强有力的技术支撑。

技术实现思路

[0008]本专利技术要解决的技术方案是提供一种使用3个霍尔传感器和3轴加速度传感器对空间万向均匀旋转磁场的轴线方位进行精确测量的方法。首先，使用3个霍尔传感器和1个3轴加速度传感器测量任意两时刻t1、t2，旋转磁矢量在探头坐标系中三维磁矢量坐标，并建立旋转磁矢量在探头坐标系和固定坐标系中的旋转变换关系。其次，借助空间矢量的运算法则求解上述两时刻磁矢量的法向量。再次，根据空间矢量的正交变换原理，求得以俯仰角和侧摆角描述的空间万向旋转磁场轴线方位。最后，根据t1和t2时刻旋转磁矢量的法向量与旋转磁场轴线方位的对应关系，可求得以三维磁矢量坐标描述的旋转磁场轴线方位。
[0009]本专利技术的技术方案：
[0010]一种空间万向均匀旋转磁场轴线方位的精确测量方法，步骤如下：
[0011]如附图1a和图1b所示，分别引入探头坐标系Ox
′
y
′
z
′
和固定坐标系OXYZ，探头坐标系Ox
′
y
′
z
′
的原点位于探头的左下角，Ox
′
,Oy
′
,Oz
′
轴分别与长方体探头的三条边平行。固定坐标系OXYZ的原点位于三轴亥姆霍兹线圈的中心，坐标轴OX、OY、OZ分别与三轴亥姆霍兹线圈的外、中、内三组线圈主平面垂直，如附图1b所示。附图1a中，长方体探头中的3个霍尔传感器呈正交布置，其主平面分别与探头坐标系Ox
′
y
′
z
′
的Ox
′
,Oy
′
,Oz
′
轴垂直。由于探头可以自由转动，同一测量点由于探头姿态的不同会得到不同的测量值，因此引入3轴加速度传感器对探头的姿态进行测定，3轴加速度传感器的主平面与探头坐标系Ox
′
y
′
z
′
的Oz
′
轴垂直。
[0012]如图2a所示，测量探头相对固定坐标系OXYZ的方位可以用卡尔丹角描述：假定初始时刻固定坐标系OXYZ与探头坐标系Ox
′
y
′
z
′
重合，先将固定坐标系OXYZ绕OY轴逆时针转动α后得到坐标系Ox1Yz1，之后将Ox1Yz1绕Ox1轴逆时针转动β后本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种空间万向均匀旋转磁场轴线方位的精确测量方法，其特征在于，步骤如下：首先，分别引入探头坐标系Ox
′
y
′
z
′
和固定坐标系OXYZ，探头坐标系Ox
′
y
′
z
′
的原点位于探头的左下角，Ox
′
,Oy
′
,Oz
′
轴分别与长方体探头的三条边平行；固定坐标系OXYZ的原点位于三轴亥姆霍兹线圈的中心，坐标轴OX、OY、OZ分别与三轴亥姆霍兹线圈的外、中、内三组线圈主平面垂直；测量探头中的3个霍尔传感器呈正交布置，其主平面分别与Ox
′
,Oy
′
,Oz
′
轴垂直，3轴加速度传感器的主平面与Oz
′
轴垂直；第一步，根据探头坐标系Ox
′
y
′
z
′
相对固定坐标系OXYZ的旋转变换关系：探头坐标系Ox
′
y
′
z
′
通过固定坐标系OXYZ先绕OY轴逆时针转动α，再绕Ox
′
轴逆时针转动β得到，求得探头坐标系Ox
′
y
′
z
′
到固定坐标系OXYZ的旋转变换矩阵为第二步，探头坐标系Ox
′
y
′
z
′
与固定坐标系OXYZ重合时，3轴加速度传感器测得的重力加速度坐标为(0,0,z)；探头坐标系Ox
′
y
′
z
′
相对固定坐标系OXYZ转动(α，β)后，3轴加速度传感器测得的重力加速度坐标为(x'，y'，z')，3轴加速度传感器两次测得的数据满足以下关系根据(2)式，求得测量探头相对固定坐标系OXYZ的姿态角α，β表示为第三步，根据...

【专利技术属性】
技术研发人员：杨慧远，张光华，党玉功，李京杭，马新备，党浩然，
申请(专利权)人：河南科技大学，
类型：发明
国别省市：