CN105403140B - 一种基于磁场的六自由度位移测量方法 - Google Patents
一种基于磁场的六自由度位移测量方法 Download PDFInfo
- Publication number
- CN105403140B CN105403140B CN201510959014.0A CN201510959014A CN105403140B CN 105403140 B CN105403140 B CN 105403140B CN 201510959014 A CN201510959014 A CN 201510959014A CN 105403140 B CN105403140 B CN 105403140B
- Authority
- CN
- China
- Prior art keywords
- axis
- degree
- magnetic sensor
- magnetic
- freedom
- 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.)
- Active
Links
- 238000006073 displacement reaction Methods 0.000 title claims abstract description 53
- 238000000691 measurement method Methods 0.000 title claims abstract description 21
- 238000005259 measurement Methods 0.000 claims abstract description 16
- 238000000034 method Methods 0.000 claims abstract description 13
- 230000006698 induction Effects 0.000 claims abstract description 8
- 238000009434 installation Methods 0.000 claims abstract description 8
- 238000001514 detection method Methods 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 10
- 238000012804 iterative process Methods 0.000 claims description 2
- 238000013178 mathematical model Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B7/00—Measuring arrangements characterised by the use of electric or magnetic techniques
- G01B7/02—Measuring arrangements characterised by the use of electric or magnetic techniques for measuring length, width or thickness
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
Abstract
本发明是一种基于磁场的六自由度位移测量方法，该方法是利用合理分布的永磁体在空间内构建出特殊分布的磁场，在其产生的磁场空间范围内布置磁传感器，用于接收磁感应强度信号，并将磁传感器固结于运动物体上使之跟随运动，进而利用磁感应强度和空间位置坐标间的关系建立对应的数学模型求解位置方程，从而实现高精度的位移测量。本发明可解决由于安装位置或测量手段有限带来的在工业领域无法进行三自由度以及更高自由度的测量的问题。
Description
技术领域
本发明涉及一种六自由度的位移测量方法，尤其适用于基于磁场信息的六自由度的位移检测。
背景技术
测量系统是精密机电系统的关键环节。而多自由度精密位移测量系统更是被广泛应用于机床、航空航天、汽车等领域中。现阶段高精密的多自由度位移测量以电容传感器、电涡流传感器、激光干涉仪为代表，这些方法测量精度高，但是量程一般较小，安装要求比较苛刻。
在精密测量领域特别是多自由度的位移测量，空间坐标和传感器输出之间一般都呈现复杂的非线性关系，因而为了实现三自由度乃至六自由度的位移测量需要布置多种不同类型传感器实现各个自由度的线性化以达到求解位移的目的，这样对工业领域测量系统的实时性和可靠性非常不利。因此一种安装简便，精度高又能实现多自由度位移测量的方法亟待提出。
发明内容
本发明的目的在于提供一种六自由度的位移测量方法，利用永磁体产生的磁场信息，实现六自由度的位移测量。
为了达到上述目的，本发明所采用的技术方案如下：
1)在相互运动的两个物体上分别固定永磁体和n个磁传感器，其中n大于等于所测自由度的个数；
2)在永磁体上建立定坐标系OXYZ，在定坐标系OXYZ下建立永磁体的磁感应强度与空间位置坐标的数学关系：B(x,y,z)＝Bx(x,y,z)i+By(x,y,z)j+Bz(x,y,z)k，其中Bx,By,Bz分别为B在X轴、Y轴和Z轴方向上的分量，i,j,k分别为X轴、Y轴和Z轴的单位矢量；
3)在磁传感器所在的运动物体上建立动坐标系O'X'Y'Z'，n个磁传感器的安装位置，即在动坐标系O'X'Y'Z'下的坐标为(xi0,yi0,zi0)，其中i＝1,2,...,n；
4)设初始时刻动坐标系O'X'Y'Z'与定坐标系OXYZ相重合，若某时刻运动物体在定坐标系OXYZ下产生六自由度位移X＝(x,y,z,θx,θy,θz)T，其中x,y,z为O'在定坐标系OXYZ下分别沿X轴、Y轴和Z轴的平动位移，θx,θy,θz为O'分别绕X轴、Y轴和Z轴的旋转角，则该时刻这n个磁传感器在定坐标系OXYZ的坐标(xi,yi,zi)为(xi,yi,zi)T＝R(xi0,yi0,zi0)T+(x,y,z)T，
式中R为旋转矩阵，此时磁传感器中的检测量为Bi＝Bx(xi,yi,zi)i·a'+By(xi,yi,zi)j·a'+Bz(xi,yi,zi)k·a'，其中a'为所选磁传感器敏感方向的单位矢量；
5)运动物体以一定速度在磁场空间中连续运动，磁传感器中的检测信号为Bn，利用步骤4)中得到的磁传感器的检测量与空间位置坐标的关系，n个磁传感器就有n个位置方程，通过求解n个位置方程得到六自由度位移X＝(x,y,z,θx,θy,θz)T，实现位移测量。
如上所述的一种基于磁场的六自由度位移测量方法所选用的永磁体的形状为规则的几何图形。
如上所述的一种基于磁场的六自由度位移测量方法，固定磁传感器的运动物体的旋转顺序为先绕X轴转θx，再绕Y轴转θy，最后绕Z轴转θz，则旋转矩阵：
如上所述的一种基于磁场的六自由度位移测量方法，磁传感器敏感方向的单位矢量a'是固结于该磁传感器上的动坐标系沿X'轴、Y'轴和Z'轴的单位矢量i',j',k'，若敏感方向与X'轴平行，则a'＝i'＝R·i；敏感方向与Y'轴平行，则a'＝j'＝R·j；敏感方向与Z'轴平行，则a'＝k'＝R·k。
如上所述的一种基于磁场的六自由度位移测量方法，在求解n个位置方程时可采用迭代法、牛顿法或同伦法。
本发明的一种基于磁场的六自由度位移测量方法主要优点在于：将一般的单自由度、双自由度或平面三自由度的位移测量方法扩展成空间六自由度测量，应用更加广泛。提供了一种非接触式的测量手段，对安装环境没有苛刻要求，并且该方法的测量范围大、精度高、实时性好，易于在工业系统中实现。
附图说明
图1为本发明所述的位移测量装置示意图。
图2为本发明所用的磁传感器排布。
图3a～3f为本发明测量得到的位移曲线。
图中：1-永磁体；2-磁传感器。
具体实施方式
下面结合附图和实施例对本发明做进一步的说明，以进一步了解本发明。
本发明提供的一种基于磁场的六自由度位移测量方法，其具体包括如下步骤：
1)在相互运动的两个物体上分别固定永磁体和n个磁传感器，其中n大于等于所测自由度的个数；
2)如图1，在永磁体上建立定坐标系OXYZ，在定坐标系OXYZ下建立永磁体的磁感应强度与空间位置坐标的数学关系：B(x,y,z)＝Bx(x,y,z)i+By(x,y,z)j+Bz(x,y,z)k，其中Bx,By,Bz分别为B在X轴、Y轴和Z轴方向上的分量，i,j,k分别为X轴、Y轴和Z轴的单位矢量；
3)如图2，在磁传感器所在的运动物体上建立动坐标系O'X'Y'Z'，n个磁传感器的安装位置，即在动坐标系O'X'Y'Z'下的坐标为(xi0,yi0,zi0)，其中i＝1,2,...,n；
4)设初始时刻动坐标系O'X'Y'Z'与定坐标系OXYZ相重合，若某时刻运动物体在定坐标系OXYZ下产生六自由度位移X＝(x,y,z,θx,θy,θz)T，其中x,y,z为O'在定坐标系OXYZ下分别沿X轴、Y轴和Z轴的平动位移，θx,θy,θz为O'分别绕X轴、Y轴和Z轴的旋转角，则该时刻这n个磁传感器在定坐标系OXYZ的坐标(xi,yi,zi)为(xi,yi,zi)T＝R(xi0,yi0,zi0)T+(x,y,z)T，
式中R为旋转矩阵，此时磁传感器中的检测量为Bi＝Bx(xi,yi,zi)i·a'+By(xi,yi,zi)j·a'+Bz(xi,yi,zi)k·a'，其中a'为所选磁传感器敏感方向的单位矢量；
5)运动物体以一定速度在磁场空间中连续运动，磁传感器中的检测信号为Bn，利用步骤4)中得到的磁传感器的检测量与空间位置坐标的关系，n个磁传感器就有n个位置方程，通过求解n个位置方程得到六自由度位移X＝(x,y,z,θx,θy,θz)T，实现位移测量。
上述技术方案中该基于磁场的六自由度位移测量方法所选用的永磁体的形状为规则的几何图形。
如上所述的一种基于磁场的六自由度位移测量方法，固定磁传感器的运动物体的旋转顺序为先绕X轴转θx，再绕Y轴转θy，最后绕Z轴转θz，则旋转矩阵：
如上所述的一种基于磁场的六自由度位移测量方法，磁传感器敏感方向的单位矢量a'是固结于该磁传感器上的动坐标系沿X'轴、Y'轴和Z'轴的单位矢量i',j',k'，若敏感方向与X'轴平行，则a'＝i'＝R·i；敏感方向与Y'轴平行，则a'＝j'＝R·j；敏感方向与Z'轴平行，则a'＝k'＝R·k。
如上所述的一种基于磁场的六自由度位移测量方法，在求解n个位置方程时可采用迭代法、牛顿法或同伦法。
实施例：
下面以矩形永磁体构建的空间磁场为例，结合附图和实施例对本发明所述基于磁场信息的六自由度位移测量方法进行说明。
1)在相互运动的两个物体上分别固定矩形永磁体和8个敏感磁场信息的磁传感器，形成传感器阵列，传感器排布方式如图2；
2)如图1，在长宽高分别为50mm,50mm,5mm的矩形永磁体上建立定坐标系OXYZ，其XY平面与永磁体上表面重合，在定坐标系OXYZ下建立永磁体的磁感应强度与空间位置坐标的数学关系：B(x,y,z)＝Bx(x,y,z)i+By(x,y,z)j+Bz(x,y,z)k，其中Bx,By,Bz分别为B在X轴、Y轴和Z轴方向上的分量，i,j,k分别为X轴、Y轴和Z轴的单位矢量；
3)如图2，在磁传感器所在的运动物体上建立动坐标系O'X'Y'Z'，8个磁传感器P1～P8的安装位置即在动坐标系O'X'Y'Z'下的坐标为(xi0,yi0,zi0)，相邻两个传感器之间间距8mm，其中i＝1,2,...,8；
4)假设初始时刻动坐标系O'X'Y'Z'与定坐标系OXYZ相重合，若某时刻运动物体在定坐标系OXYZ下产生六自由度位移X＝(x,y,z,θx,θy,θz)T，其中x,y,z为O'在定坐标系OXYZ下沿X轴、Y轴和Z轴的平动位移，θx,θy,θz为绕X轴、Y轴和Z轴的旋转角，则该时刻这8个磁传感器在定坐标系OXYZ的坐标(xi,yi,zi)为(xi,yi,zi)T＝R(xi0,yi0,zi0)T+(x,y,z)T，其中R为旋转矩阵，运动物体的旋转顺序为先绕X轴转θx，再绕Y轴转θy，最后绕Z轴转θz，则旋转矩阵
此时磁传感器中的检测量为Bi＝Bx(xi,yi,zi)i·a'+By(xi,yi,zi)j·a'+Bz(xi,yi,zi)k·a'其中a'为所选磁传感器敏感方向的单位矢量。本实施例中选用单轴的霍尔传感器则a'＝k'＝R·k。
5)运动物体以一定速度在磁场空间中连续运动，利用牛顿迭代法进行位置方程的解算，假设在初始时刻t＝t0时，动坐标系O'X'Y'Z'与定坐标系OXYZ相重合，此时的位置坐标X0＝(x0,y0,z0,θx0,θy0,θz0)；通过8个传感器测得的磁感应强度信号为Bk，而通过计算得到的磁传感器检测量为Bi，算出测量偏差△B＝Bk-Bi，设置判定收敛的条件ε和迭代次数k，计算判定不等式△B<ε
a.若不等式成立，则该时刻的位移即为X0＝(x0,y0,z0,θx0,θy0,θz0)；
b.若不等式不成立，则计算该时刻的雅克比矩阵和位移偏差：△x＝[JT(X0)J(X0)]-1JT(X0)△B，更新该时刻的位移X0＝X0+△x，将更新过后的位移带入判定不等式计算直至不等式成立或达到迭代次数为止，否则重复这一迭代过程；
6)在下一时刻t＝t1时，将位置坐标初始值X1更新为上一时刻t＝t0的最终位移迭代值X0，计算判定不等式直到不等式成立或达到迭代次数为止；
通过上述步骤，实现了一种基于磁场的六自由度位移测量方法，如图3a～3f是六个自由度方向测量所得到的位移曲线。
Claims (3)
1.一种基于磁场的六自由度位移测量方法，其特征在于所述方法包括如下步骤：
1)在相互运动的两个物体上分别固定永磁体和n个磁传感器，其中n大于等于所测自由度的个数；
2)在永磁体上建立定坐标系OXYZ，在定坐标系OXYZ下建立永磁体的磁感应强度与空间位置坐标的数学关系：B(x,y,z)＝Bx(x,y,z)i+By(x,y,z)j+Bz(x,y,z)k，其中Bx,By,Bz分别为B在X轴、Y轴和Z轴方向上的分量，i,j,k分别为X轴、Y轴和Z轴的单位矢量；所述永磁体的形状为规则的几何图形；
3)在磁传感器所在的运动物体上建立动坐标系O'X'Y'Z'，n个磁传感器的安装位置，即在动坐标系O'X'Y'Z'下的坐标为(xi0,yi0,zi0)，其中i＝1,2,...,n；
4)设初始时刻动坐标系O'X'Y'Z'与定坐标系OXYZ相重合，若某时刻运动物体在定坐标系OXYZ下产生六自由度位移X＝(x,y,z,θx,θy,θz)T，其中x,y,z为O'在定坐标系OXYZ下分别沿X轴、Y轴和Z轴的平动位移，θx,θy,θz为O'分别绕X轴、Y轴和Z轴的旋转角，则该时刻这n个磁传感器在定坐标系OXYZ的坐标(xi,yi,zi)为(xi,yi,zi)T＝R(xi0,yi0,zi0)T+(x,y,z)T，
式中R为旋转矩阵，此时磁传感器中的检测量为Bi＝Bx(xi,yi,zi)i·a'+By(xi,yi,zi)j·a'+Bz(xi,yi,zi)k·a'，其中a'为所选磁传感器敏感方向的单位矢量；
5)运动物体以一定速度在磁场空间中连续运动，磁传感器中的检测信号为Bn，利用步骤4)中得到的磁传感器的检测量与空间位置坐标的关系，n个磁传感器就有n个位置方程，利用牛顿迭代法进行位置方程的解算：
假设在初始时刻t＝t0时，位置坐标X0＝(x0,y0,z0,θx0,θy0,θz0)；通过n个传感器测得的磁感应强度信号为Bk，而通过计算得到的磁传感器检测量为Bi，算出测量偏差△B＝Bk-Bi，设置判定收敛的条件ε和迭代次数k，计算判定不等式△B<ε；
a.若不等式成立，则该时刻的位移即为X0＝(x0,y0,z0,θx0,θy0,θz0)；
b.若不等式不成立，则计算该时刻的雅克比矩阵和位移偏差：△x＝[JT(X0)J(X0)]-1JT(X0)△B，更新该时刻的位移X0＝X0+△x，将更新过后的位移带入判定不等式计算直至不等式成立或达到迭代次数为止，否则重复这一迭代过程；
6)在下一时刻t＝t1时，将位置坐标初始值X1更新为上一时刻t＝t0的最终位移迭代值X0，计算判定不等式直到不等式成立或达到迭代次数为止；得到六自由度位移X＝(x,y,z,θx,θy,θz)T，实现位移测量。
2.根据权利要求1所述的一种基于磁场的六自由度位移测量方法，其特征在于：固定磁传感器的运动物体的旋转顺序为先绕X轴转θx，再绕Y轴转θy，最后绕Z轴转θz，则旋转矩阵：
3.根据权利要求1所述的一种基于磁场的六自由度位移测量方法，其特征在于：磁传感器敏感方向的单位矢量a'是固结于该磁传感器上的动坐标系沿X'轴、Y'轴和Z'轴的单位矢量i',j',k'，若敏感方向与X'轴平行，则a'＝i'＝R·i；敏感方向与Y'轴平行，则a'＝j'＝R·j；敏感方向与Z'轴平行，则a'＝k'＝R·k。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510959014.0A CN105403140B (zh) | 2015-12-18 | 2015-12-18 | 一种基于磁场的六自由度位移测量方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510959014.0A CN105403140B (zh) | 2015-12-18 | 2015-12-18 | 一种基于磁场的六自由度位移测量方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN105403140A CN105403140A (zh) | 2016-03-16 |
| CN105403140B true CN105403140B (zh) | 2018-10-30 |
Family
ID=55468779
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201510959014.0A Active CN105403140B (zh) | 2015-12-18 | 2015-12-18 | 一种基于磁场的六自由度位移测量方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN105403140B (zh) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108871301B (zh) * | 2018-07-18 | 2021-03-23 | 哈尔滨工业大学 | 磁场方位测量方法 |
| EP3742130A1 (en) * | 2019-05-21 | 2020-11-25 | Melexis Technologies SA | Magnetic position sensor arrangement |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101361660A (zh) * | 2008-05-16 | 2009-02-11 | 深圳先进技术研究院 | 一种多磁性目标的定位方法及定位系统 |
| CN101750187A (zh) * | 2010-01-19 | 2010-06-23 | 清华大学 | 一种基于磁钢阵列的运动平台二维定位方法 |
| CN102607391A (zh) * | 2012-03-01 | 2012-07-25 | 清华大学 | 一种平面电机动子位移的测量方法 |
| CN103637803A (zh) * | 2013-11-14 | 2014-03-19 | 上海交通大学 | 基于永磁和感应线圈的胶囊内镜空间定位系统及定位方法 |
| CN103926582A (zh) * | 2013-01-15 | 2014-07-16 | 财团法人工业技术研究院 | 基于磁场特征的方位测定方法与系统 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2006023318A (ja) * | 2000-10-16 | 2006-01-26 | Dentsu Kiko Kk | ３軸磁気センサ、全方位磁気センサおよびそれらを用いた方位測定方法 |
-
2015
- 2015-12-18 CN CN201510959014.0A patent/CN105403140B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101361660A (zh) * | 2008-05-16 | 2009-02-11 | 深圳先进技术研究院 | 一种多磁性目标的定位方法及定位系统 |
| CN101750187A (zh) * | 2010-01-19 | 2010-06-23 | 清华大学 | 一种基于磁钢阵列的运动平台二维定位方法 |
| CN102607391A (zh) * | 2012-03-01 | 2012-07-25 | 清华大学 | 一种平面电机动子位移的测量方法 |
| CN103926582A (zh) * | 2013-01-15 | 2014-07-16 | 财团法人工业技术研究院 | 基于磁场特征的方位测定方法与系统 |
| CN103637803A (zh) * | 2013-11-14 | 2014-03-19 | 上海交通大学 | 基于永磁和感应线圈的胶囊内镜空间定位系统及定位方法 |
Non-Patent Citations (2)
| Title |
|---|
| A New Tracking System for Three Magnetic Objectives;Wan’an Yang等;《IEEE TRANSACTIONS ON MAGNETICS》;20101231;第46卷(第12期);第4023-4029页 * |
| 面向机器人运动跟踪的电磁定位系统;宋霜等;《集成技术》;20130331;第2卷(第2期);正文第4节，图4 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN105403140A (zh) | 2016-03-16 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US10697800B2 (en) | Multi-dimensional measurement using magnetic sensors and related systems, methods, and integrated circuits | |
| US20210333129A1 (en) | Position sensor system and method, robust against disturbance field | |
| Chen et al. | A time-grating sensor for displacement measurement with long range and nanometer accuracy | |
| CN103234496B (zh) | 一种三坐标测量机二维平台误差的高精度校正方法 | |
| CN106597566A (zh) | 一种非开挖地下管线探测系统及其实现方法 | |
| EP3617657B1 (en) | Magnetic position sensor system and method | |
| CN103645369A (zh) | 一种电流传感装置 | |
| US11255702B2 (en) | Angle sensor and angle sensor system | |
| CN109238175A (zh) | 一种基于激光跟踪仪的空间平面夹角测量方法 | |
| CN104553872B (zh) | 一种能够同时检测磁浮列车悬浮间距和运行速度的传感器 | |
| CN105403140B (zh) | 一种基于磁场的六自由度位移测量方法 | |
| CN103955002B (zh) | 基于磁异常一阶导数的磁偶极子目标位置测量方法 | |
| CN102435156B (zh) | 一种大型筒柱状工件尺寸和几何误差测量方法 | |
| CN105444722A (zh) | 检测平台姿态变化的方法 | |
| CN104330631B (zh) | 一种磁浮平面电机动子初始相位定位方法 | |
| CN103591874A (zh) | 用标准块实现极坐标齿轮测量中心零点标定的方法 | |
| CN103322919B (zh) | 光栅尺及其快速找零位的方法 | |
| RU2510500C1 (ru) | Способ и устройство диагностики технического состояния подземного трубопровода | |
| CN102564383B (zh) | 基于轴面角确定三轴磁传感器轴间角的方法 | |
| Sun et al. | High-accuracy and efficient method for calibrating spatial laser beam based on optimized PSD | |
| CN204367911U (zh) | 一种能够同时检测磁浮列车悬浮间距和运行速度的传感器 | |
| Wang et al. | Angular displacement sensor for gear position detection based on the tunneling magnetoresistance effect | |
| Zhang et al. | Study on the multiperiod bipolar inductive absolute angle sensor | |
| CN107939813A (zh) | 转轴和对转轴进行轴向位移检测的方法 | |
| CN110073230B (zh) | 磁传感器 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |