CN114563034B - 计测装置、计测方法、记录介质 - Google Patents

计测装置、计测方法、记录介质 Download PDF

Info

Publication number
CN114563034B
CN114563034B CN202110895434.2A CN202110895434A CN114563034B CN 114563034 B CN114563034 B CN 114563034B CN 202110895434 A CN202110895434 A CN 202110895434A CN 114563034 B CN114563034 B CN 114563034B
Authority
CN
China
Prior art keywords
magnetic field
field data
tool surface
attitude
phase correction
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
Application number
CN202110895434.2A
Other languages
English (en)
Other versions
CN114563034A (zh
Inventor
滨川圭太
井上雄介
高桥寻之
山田孝纯
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Japan Aviation Electronics Industry Ltd
Original Assignee
Japan Aviation Electronics Industry Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Japan Aviation Electronics Industry Ltd filed Critical Japan Aviation Electronics Industry Ltd
Publication of CN114563034A publication Critical patent/CN114563034A/zh
Application granted granted Critical
Publication of CN114563034B publication Critical patent/CN114563034B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26—Indicating devices
    • E02F9/264—Sensors and their calibration for indicating the position of the work tool
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D21/00—Measuring or testing not otherwise provided for
    • G01D21/02—Measuring two or more variables by means not covered by a single other subclass
    • E—FIXED CONSTRUCTIONS
    • E21—EARTH OR ROCK DRILLING; MINING
    • E21B—EARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
    • E21B47/00—Survey of boreholes or wells
    • E21B47/02—Determining slope or direction
    • E21B47/024—Determining slope or direction of devices in the borehole
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C9/00—Measuring inclination, e.g. by clinometers, by levels
    • G01C9/02—Details
    • G01C9/06—Electric or photoelectric indication or reading means
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P15/00—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
    • G01P15/18—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration in two or more dimensions
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
    • G01V3/00—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation
    • G01V3/08—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation operating with magnetic or electric fields produced or modified by objects or geological structures or by detecting devices
    • G01V3/081—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation operating with magnetic or electric fields produced or modified by objects or geological structures or by detecting devices the magnetic field is produced by the objects or geological structures

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Mining & Mineral Resources (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Geology (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Geophysics (AREA)
  • Environmental & Geological Engineering (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Manufacturing & Machinery (AREA)
  • Electromagnetism (AREA)
  • Fluid Mechanics (AREA)
  • Geochemistry & Mineralogy (AREA)
  • Excavating Of Shafts Or Tunnels (AREA)
  • Geophysics And Detection Of Objects (AREA)
  • Navigation (AREA)

Abstract

本发明提供了计测装置、计测方法以及记录介质，其正确地计测挖掘中的挖掘部的姿态。本发明的计测装置具有姿态估计部和相位校正量计算部。相位校正量计算部求出重力工具面和磁力工具面之间的偏移量，并设为估计偏移量。姿态估计部将基于加速度数据的重力工具面设为计测重力工具面，将基于磁场数据的磁力工具面设为计测磁力工具面，将计测重力工具面和计测磁力工具面之间的偏移量与估计偏移量的差异量设为相位校正量，将以相位校正量校正了磁场数据而得的数据设为校正后磁场数据，并求出基于加速度数据和校正后磁场数据的姿态。

Description

计测装置、计测方法、记录介质
技术领域
本发明涉及使用来自被配置在地下挖掘机的挖掘部上的加速度传感器和磁传感器的输出来求出姿态的计测装置、计测方法、记录介质。
背景技术
作为以往技术，已知专利文献1(US 2019/0353023 A1)所示的技术。在专利文献1中示出了使用两个传感器组，校准或者校正测量数据。图1是表示专利文献1的图4所示的校正动作的处理的例子。另外，在非专利文献1(安藤卓郎(Takuro Ando)，高砂常義(Tsuneyoshi Takasuna)、「母線とその解析(Metal Enclosed Bus and Its Analysis)」，日立評論、第39巻第6号pp11～16，昭和32年(1957年)6月.)中，示出在屏蔽交变磁场的导电体中产生涡流。另外，在专利文献1中也指出，在挖掘中因地磁的影响，在存在于挖掘部内的导电体中产生涡流。
发明内容
在专利文献1中，介绍了在传感器组的数据被改坏的情况下的各种技术。然而，在专利文献1中，未明确表示正确地计测挖掘中的挖掘部的姿态的方法。近年来，为了提高效率，要求即使在挖掘中也计测姿态，但是在挖掘中的测量存在误差大的问题。本发明的目的是提供正确地计测挖掘中的挖掘部的姿态的技术。
本发明的计测装置使用从配置在地下挖掘机的挖掘部的至少3轴的加速度传感器中输出的加速度数据、和从配置在地下挖掘机的挖掘部的至少3轴的磁传感器中输出的磁场数据来求出姿态。本发明的计测装置具有姿态估计部和相位校正量计算部。姿态估计部基于加速度数据和磁场数据求出挖掘部的姿态。相位校正量计算部求出重力工具面和磁力工具面之间的偏移量，并设为估计偏移。更具体地说，姿态估计部将基于加速度数据的重力工具面设为计测重力工具面，将基于磁场数据的磁力工具面设为计测磁力工具面，将计测重力工具面和计测磁力工具面之间的偏移量与估计偏移量的差异量设为相位校正量，将以相位校正量校正了磁场数据而得的数据设为校正后磁场数据，并求出基于加速度数据和校正后磁场数据的姿态。
发明的效果
按照本发明的计测装置，求出与在挖掘时覆盖挖掘部的金属制的外壳中所产生的涡流的影响等所造成的磁场相位的变化对应的相位校正量，使用相位校正量求出姿态，所以即使在挖掘中也可以正确地计测挖掘部的姿态。
附图说明
图1是表示以往技术的校正动作的处理的例子的图。
图2是表示一边控制没有金属制的外壳的挖掘部的转速一边固定姿态下使用从配置在该挖掘部的3轴的加速度传感器中输出的加速度数据、和从配置在该挖掘部的3轴的磁传感器中输出的磁场数据来求出的倾斜角的图。
图3是表示一边控制没有金属制的外壳的挖掘部的转速一边固定姿态下使用从配置在该挖掘部的3轴的加速度传感器中输出的加速度数据、和从配置在该挖掘部的3轴的磁传感器中输出的磁场数据来求出的方位角的图。
图4是表示一边控制具有金属制的外壳的挖掘部的转速一边固定姿态下使用从配置在该挖掘部的外壳内的3轴的加速度传感器中输出的加速度数据、和从配置在该挖掘部的外壳内的3轴的磁传感器中输出的磁场数据来求出的倾斜角的图。
图5是表示一边控制具有金属制的外壳的挖掘部的转速一边固定姿态下使用从配置在该挖掘部的外壳内的3轴的加速度传感器中输出的加速度数据、和从配置在该挖掘部的外壳内的3轴的磁传感器中输出的磁场数据来求出的方位角的图。
图6是表示本发明的计测***的功能结构例的图。
图7是表示本发明的计测方法的处理流程的例子的图。
图8是表示一边控制具有金属制的外壳的挖掘部的转速一边固定姿态下使用从配置在该挖掘部的外壳内的3轴的加速度传感器中输出的加速度数据、和配置在该挖掘部的外壳内的从3轴的磁传感器中输出的磁场数据，以本发明的计测方法求出的倾斜角的图。
图9是表示一边控制具有金属制的外壳的挖掘部的转速一边固定姿态下使用从配置在该挖掘部的外壳内的3轴的加速度传感器中输出的加速度数据、和从配置在该挖掘部的外壳内的3轴的磁传感器中输出的磁场数据，以本发明的计测方法求出的方位角的图。
图10是表示计算机的功能结构例的图。
具体实施方式
以下，详细地说明本发明的实施方式。另外，对具有相同的功能的结构部附加相同的附图标记，省略重复说明。
【实施例1】
＜分析＞
作为本发明的对象的计测装置，使用从地下挖掘机的挖掘部上配置的3轴的加速度传感器中输出的加速度数据(Ax，Ay，Az)和从3轴的磁传感器中输出的磁场数据(Mx，My，Mz)，来求出姿态。Az是挖掘方向的加速度分量。Ax和Ay是与挖掘方向垂直的加速度分量且相互正交。Mz是挖掘方向的磁力分量。Mx和My是与挖掘方向垂直的磁力分量且相互正交。因此，使用从在实际的地下挖掘机的挖掘部上配置的3轴的加速度传感器中输出的加速度数据(Ax，Ay，Az)和从3轴的磁传感器中输出的磁场数据(Mx，My，Mz)，在静止时和旋转时两方求出倾斜角和方位角。虽然没有表示结果的图，但是倾斜角的计测值不因静止时还是旋转时而变化。另一方面，方位角得到了在开始旋转时计测值从静止时的计测值产生变化这样的结果。即，可以预测由于挖掘部的旋转，方位角产生了误差。
接着，示出为了确认预测而进行的实验的结果。一边控制没有金属制的外壳的挖掘部的转速一边固定姿态下，使用从配置在该挖掘部的3轴的加速度传感器中输出的加速度数据(Ax，Ay，Az)、和从配置在该挖掘部的3轴的磁传感器中输出的磁场数据(Mx，My，Mz)来求出倾斜角和方位角，将求出的倾斜角在图2中表示，将求出的方位角在图3中表示。另外，一边控制有金属制的外壳的挖掘部的转速一边固定姿态下，使用从配置在该挖掘部的外壳内的3轴的加速度传感器中输出的加速度数据(Ax，Ay，Az)、和从配置在该挖掘部的外壳内的3轴的磁传感器中输出的磁场数据(Mx，My，Mz)来求出倾斜角和方位角，将求出的倾斜角在图4中表示，将求出的方位角在图5中表示。图2和图4的左侧的纵轴表示倾斜角(deg)，图3和图5的左侧的纵轴表示方位角(deg)。图2～5的右侧的纵轴表示设定的挖掘部的转速(rpm)，横轴表示测量的时刻(时：分：秒)。中空的圆表示使用挖掘部在静止时的加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)来求出的结果(静止时的计测值)。方形表示使用加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)定期地继续求出的结果。另外，在挖掘部在旋转时，在加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)中包含起因于振动等的各种干扰，所以将倾斜角和方位角预先包含在卡尔曼滤波器的状态量中，将加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)作为输入，使用卡尔曼滤波器(Kalman filter)求出倾斜角和方位角。
这里，(ax，ay，az)是起因于重力的加速度数据，az是挖掘方向的重力加速度分量，ax和ay是与挖掘方向垂直的重力加速度分量且相互正交。这时，倾斜角(Inc)如以下那样定义。
即，在求出倾斜角的计算中不使用磁场数据(Mx，My，Mz)。由图2和图4的结果可知，在仅通过加速度数据进行的求出倾斜角的计算中，不受金属制的外壳的影响，以及在挖掘部处于静止时和处于旋转时都估计相同的倾斜角。另一方面，方位角(Azm)如以下那样定义。
在求出方位角的计算中使用加速度数据(ax，ay，az)和磁场数据(Mx，My，Mz)两者。由图3的结果可知，在没有金属制的外壳的挖掘部的情况下，在静止时和旋转时都表示大致相同的方位角。在图5中，在挖掘部以100rpm旋转时，与静止时相比变化0.5度左右方位角，在以200rpm旋转时，与静止时相比变化1.0度左右方位角。从图5的结果可知，在金属制的外壳中配置了加速度传感器和磁传感器的情况下，根据挖掘部的转速，估计值受到影响。从图2～5的结果可知，金属制的外壳的旋转对在内部配置的磁传感器计测的磁场数据产生影响。
如上述那样，在非专利文献1中表示在屏蔽交变磁场的导电体中产生涡流。在本发明的情况下，虽然地磁固定，但是金属制的外壳旋转。认为由于该旋转，与屏蔽交变磁场的情况相同的那样，在外壳中产生了涡流。另外，在非专利文献1中，如下表示将D设为圆筒的直径、将d设为圆筒的厚度、将ρ设为金属的电阻率、将f设为磁场的频率、将μ0设为空气的导磁率、将j设为虚数单位时的、圆筒内部的磁场的强度Hi与没有圆筒时的磁场的强度Ho的关系。
由于在右边的分母中存在虚数部，所以可知磁场的相位变化。实际的地下挖掘机的挖掘部被金属制的外壳覆盖。因此，若使用旋转着的挖掘部内计测的加速度数据和磁场数据，不考虑磁场的相位的变化而求出方位角，则在方位角中包含许多误差。由此，在使用从配置在地下挖掘机的挖掘部的3轴的加速度传感器中输出的加速度数据(Ax，Ay，Az)、和从配置在地下挖掘机的挖掘部的3轴的磁传感器中输出的磁场数据(Mx，My，Mz)来求出姿态(倾斜角、方位角、俯角等)时，需要考虑当挖掘部在旋转时磁场的相位变化的情况。
＜实施例＞
图6表示本发明的计测***的功能结构例。在图7中表示本发明的计测方法的处理流程的例子。本发明的计测***10具有计测装置100、至少3轴的加速度传感器310、至少3轴的磁传感器320。至少3轴的加速度传感器310和至少3轴的磁传感器320被配置在地下挖掘机的挖掘部内。挖掘部被金属制的外壳覆盖，至少3轴的加速度传感器310和至少3轴的磁传感器320被容纳在金属制的外壳内。理论上，若有来自3轴的加速度传感器310和3轴的磁传感器320的数据，则以下说明的计测***起作用。但是，以提高精度等为目的，可以对1轴具备多个加速度传感器或者磁传感器，也可以具备4轴或者5轴等加速度传感器、磁传感器。因此，在上述的说明中表现为“至少3轴”。以下，说明具备3轴的加速度传感器310和3轴的磁传感器320的情况。
计测装置100使用从配置在地下挖掘机的挖掘部的3轴的加速度传感器310输出的加速度数据(Ax，Ay，Az)、和从配置在地下挖掘机的挖掘部的3轴的磁传感器320输出的磁场数据(Mx，My，Mz)来求出姿态。另外，就加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)而言，不是使用从3轴的加速度传感器310和3轴的磁传感器320直接输出的数据，而使用进行了滤波处理、温度校正等处理后的数据。计测装置100由程序控制，并具备处理信息的处理器105。处理器105具有姿态估计部110、相位校正量计算部170以及存储器190。姿态估计部110基于加速度数据和磁场数据来求出挖掘部的姿态。另外，“姿态”包含倾斜角(Inc)和方位角(Azm)、俯角(Dip)。另外，Az是挖掘方向的加速度分量。Ax和Ay是与挖掘方向垂直的加速度分量且相互正交。Mz是挖掘方向的磁力分量。Mx和My是与挖掘方向垂直的磁力分量且相互正交。另外，在挖掘部处于旋转时，在加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)中包含起因于振动等的各种干扰。姿态估计部110利用卡尔曼滤波器等以往技术除去干扰分量，基于起因于重力的加速度数据(ax，ay，az)和磁场数据(Mx，My，Mz)，求出倾斜角(Inc)、方位角(Azm)、俯角(Dip)、重力工具面(gTF)，磁力工具面(mTF)。
姿态估计部110将挖掘部处于静止时的加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)作为输入，并求出姿态等的初始值(S101)。具体地说，如以下那样求出作为初始值的倾斜角(Inc0)、方位角(Azm0)、俯角(Dip0)、重力工具面(gTF0)、磁力工具面(mTF0)即可。
在挖掘部处于旋转期间，相位校正量计算部170基于姿态估计部110求出的姿态，求出重力工具面和磁力工具面之间的偏移量，并作为估计偏移量(TFO)来记录在存储器190中(S170)。例如，在挖掘部处于旋转期间，将从最近求出的倾斜角(Inc)、方位角(Azm)、俯角(Dip)求出的偏移量更新为新的估计偏移量(TFO)即可。具体的计算方法等在后叙述。在图7所示的步骤S101中，姿态估计部110将基于挖掘部处于静止时的加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)求出的重力工具面(gTF)和从磁力工具面(mTF)求出的偏移设为估计偏移量(TFO)，记录在存储器190中。具体地说，如TFO＝mTF－gTF那样求出重力工具面(gTF)、磁力工具面(mTF)、估计偏移量(TFO)即可。
计测装置100取得从配置在地下挖掘机的挖掘部的3轴的加速度传感器310中输出的加速度数据(Ax，Ay，Az)、和从配置在地下挖掘机的挖掘部的3轴的磁传感器320中输出的磁场数据(Mx，My，Mz)(S300)。姿态估计部110将加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)作为输入，并利用卡尔曼滤波器等以往技术除去干扰分量，求出作为姿态的倾斜角(Inc)、方位角(Azm)、俯角(Dip)、重力工具面(gTF)、磁力工具面(mTF)(S110)。只要可以除去干扰分量，也可以是卡尔曼滤波器以外的以往技术。在使用卡尔曼滤波器的情况下，例如，在卡尔曼滤波器的状态量中预先包含倾斜角(Inc)、方位角(Azm)、俯角(Dip)、重力工具面(gTF)，将加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)作为输入，并使用卡尔曼滤波器求出作为状态量的倾斜角(Inc)、方位角(Azm)、俯角(Dip)、重力工具面(gTF)即可。在卡尔曼滤波器的状态量中也可以包含其它状态量。例如，也可以将重力工具面(gTF)的旋转速度设为状态量。这里，将(ax，ay，az)设为在加速度数据(Ax，Ay，Az)中包含的重力分量的加速度数据(ax，ay，az)。计测重力工具面(mgTF)、计测磁力工具面(mmTF)、加速度数据(ax，ay，az)、磁场数据(Mx，My，Mz)的关系如以下那样。
如在分析中说明的那样，由于在旋转时在金属制的外壳中产生的涡流的影响等，磁力工具面的相位发生变化。因此，将计测重力工具面(mgTF)和计测磁力工具面(mmTF)的偏移量与估计偏移量(TFO)的差异量设为相位校正量(pdm)，如以下那样定义。
pdm＝mmTF－mgTF－TFO
另外，估计偏移量(TFO)是在存储器190中记录的数据。即，图7所示的处理的循环的第1次是在步骤S101中求出的估计偏移量(TFO)，在处理的循环的第2次以后中，是在前1次的循环的步骤S170中求出的估计偏移量(TFO)。
用相位校正量校正了磁场数据(Mx，My，Mz)的校正后磁场数据(mx，my，mz)具有下式那样的关系。
mx＝Mxcos(pdm)-Mysin(pdm)
my＝Mxsin(pdm)+Mycos(pdm)
mz＝Mz
磁力工具面(mTF)受到挖掘部的旋转的影响(涡流的影响、磁传感器自身的相位延迟等)，但是难以受到其它原因造成的干扰的影响，所以在步骤S110中姿态估计部110如
那样使用校正后磁场数据(mx，my，mz)求出即可。
基于加速度数据(ax，ay，az)和校正后磁场数据(mx，my，mz)，倾斜角(Inc)、方位角(Azm)、俯角(Dip)具有以下那样的关系。
相位校正量计算部170从姿态估计部110求出的倾斜角(Inc)、方位角(Azm)、俯角(Dip)，如
其中
S＝cos(Dip)·cos(Inc)·cos(Azm)-sin(Dip)·sin(Inc)
那样求出估计偏移量TFO，并更新存储器190中记录的估计偏移量TFO(S170)。然后，返回步骤S300。若通过步骤S170更新估计偏移量(TFO)，则也可以追踪在挖掘部处于旋转期间变化了的重力工具面和磁力工具面之间的偏移量，因此可以正确地求出姿态。
＜实验＞
一边控制有金属制的外壳的挖掘部的转速一边固定挖掘部的姿态下，使用从配置在该挖掘部的外壳内的3轴的加速度传感器中输出的加速度数据(Ax，Ay，Az)、和从配置在该挖掘部的外壳内的3轴的磁传感器中输出的磁场数据(Mx，My，Mz)，通过还包含在实施例中说明的步骤S170的本发明的计测方法求出的倾斜角表示在图8中，将求出的方位角表示在图9中。图8的左侧的纵轴表示倾斜角(deg)，图9的左侧的纵轴表示方位角(deg)。图8和图9的右侧的纵轴表示设定的挖掘部的转速(rpm)，横轴表示测量的时刻(时：分：秒)。中空的圆表示使用挖掘部处于静止时的加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)来求出的结果(静止时的计测值)。方形表示使用加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)定期地继续求出的结果。另外，将倾斜角和方位角包含在卡尔曼滤波器的状态量中，将加速度数据(Ax，Ay，Az)和磁场数据(Mx，My，Mz)作为输入，并使用卡尔曼滤波器求出倾斜角和方位角。从图8和图9可知，可以估计即使在挖掘部处于旋转时也不受金属制的外壳的影响的倾斜角和方位角。因此，可知可以充分降低旋转时在金属制的外壳中产生的涡流的影响。
按照本发明的计测装置，由于求与在挖掘时覆盖挖掘部的金属制的外壳中产生的涡流的影响所造成的磁场的相位的变化、因旋转引起的磁传感器自身的相位延迟等对应的相位校正量，并使用相位校正量来求出姿态，因此可以减轻由于挖掘部的旋转所产生的影响。由此，即使在挖掘中也可以正确地计测挖掘部的姿态。
[程序，记录介质]
上述的各种处理可以通过在图10所示的计算机2000的记录部2020中读入由于使上述方法的各步骤执行的程序，使控制部2010、输入部2030、输出部2040、显示部2050等动作来实施。
记述了该处理内容的程序可以记录在计算机可读取的记录介质中。作为计算机可读取的记录介质，例如可以是磁记录装置、光盘、光磁记录介质、半导体存储器等任意介质。
而且，该程序的流通例如通过销售、转让、租借等记录了该程序的DVD、CD-ROM等可拆装型记录介质来进行。进而，也可以设为将该程序存储在服务器计算机的存储装置中，经由网络，通过将该程序从服务器计算机转发到其它计算机，使该程序流通的结构
执行这样的程序的计算机例如首先将可拆装型记录介质中记录的程序或者从服务器计算机转发的程序暂时存储在自己的存储装置中。然后，在执行处理时，该计算机读取自己的记录装置中存储的程序，执行按照读取的程序的处理。而且，作为该程序其它执行方式，计算机也可以从可拆装型记录介质直接读取程序，执行按照该程序的处理，进而，也可以在每次从服务器计算机对该计算机转发程序时，逐次执行按照接受的程序的处理。而且，也可以设为通过不进行从服务器计算机向该计算机的程序的转发，仅通过该执行指令和结果取得来实现处理功能的、所谓ASP(Application Service Provider，应用服务提供商)型的服务，执行上述的处理的结构。而且，本方式中的程序中，包含供电子计算机的处理用的信息即基于程序的信息(虽然不是对于计算机的直接的指令，但是具有规定计算机的处理的性质的数据等)。
另外，在本方式中，设为通过在计算机上执行规定的程序来构成本装置，但是也可以硬件性地实现这些处理内容的至少一部分。

Claims (17)

1.一种计测装置，用于使用从配置在地下挖掘机的挖掘部的至少3轴的加速度传感器中输出的加速度数据、和从配置在地下挖掘机的挖掘部的至少3轴的磁传感器中输出的磁场数据来求出姿态，包括：
姿态估计部，基于所述加速度数据和所述磁场数据来求出所述挖掘部的姿态；以及
相位校正量计算部，求出重力工具面和磁力工具面之间的偏移量并设为估计偏移量，
所述姿态估计部
将基于所述加速度数据的重力工具面设为计测重力工具面，将基于所述磁场数据的磁力工具面设为计测磁力工具面，将所述计测重力工具面和所述计测磁力工具面之间的偏移量与所述估计偏移量的差异量设为相位校正量，将用所述相位校正量校正了所述磁场数据而得的数据设为校正后磁场数据，
求出基于所述加速度数据和所述校正后磁场数据的所述姿态。
2.如权利要求1所述的计测装置，其中，
所述姿态估计部所求出的所述姿态为倾斜角、方位角、俯角，
所述相位校正量计算部在所述挖掘部处于旋转时，用根据所述姿态估计部所求出的倾斜角、方位角、俯角所求出的重力工具面和磁力工具面之间的偏移量，来更新估计偏移量。
3.如权利要求2所述的计测装置，其中，
将(ax，ay，az)设为在所述加速度数据中包含的起因于重力的加速度数据，将(mx，my，mz)设为所述校正后磁场数据，
倾斜角Inc、方位角Azm、俯角Dip具有如下的关系：
4.如权利要求2所述的计测装置，其中，
将Inc设为所述姿态估计部所求出的倾斜角，将Azm设为所述姿态估计部所求出的方位角，将Dip设为所述姿态估计部所求出的俯角，
所述相位校正量计算部如下求出估计偏移量TFO：
其中、
S＝cos(Dip)·cos(Inc)·cos(Azm)-sin(Dip)·sin(Inc)。
5.如权利要求3所述的计测装置，其中，
将Inc设为所述姿态估计部所求出的倾斜角，将Azm设为所述姿态估计部所求出的方位角，将Dip设为所述姿态估计部所求出的俯角，
所述相位校正量计算部如下求出估计偏移量TFO：
其中、
S＝cos(Dip)·cos(Inc)·cos(Azm)-sin(Dip)·sin(Inc)。
6.如权利要求1至5的任意一项所述的计测装置，其中，
将pdm设为所述相位校正量，将(Mx，My，Mz)设为所述磁场数据，将(mx，my，mz)设为所述校正后磁场数据，
所述磁场数据和所述校正后磁场数据具有如下的关系：
mx＝Mxcos(pdm)-Mysin(pdm)
my＝Mxsin(pdm)+Mycos(pdm)
mz＝Mz。
7.如权利要求1至5的任意一项所述的计测装置，其中，
所述姿态估计部将所述挖掘部处于静止时所求出的姿态设为姿态的初始值。
8.如权利要求6所述的计测装置，其中，
所述姿态估计部将所述挖掘部处于静止时所求出的姿态设为姿态的初始值。
9.一种计测方法，使用了从配置在地下挖掘机的挖掘部的至少3轴的加速度传感器中输出的加速度数据、和从配置在地下挖掘机的挖掘部的至少3轴的磁传感器中输出的磁场数据，
所述计测方法执行：
姿态估计过程，基于所述加速度数据和所述磁场数据来求出所述挖掘部的姿态；以及
相位校正量计算过程，求出重力工具面和磁力工具面之间的偏移量，设为估计偏移量，
在所述姿态估计过程中，
将基于所述加速度数据的重力工具面设为计测重力工具面，将基于所述磁场数据的磁力工具面设为计测磁力工具面，将所述计测重力工具面和所述计测磁力工具面之间的偏移量与所述估计偏移量的差异量设为相位校正量，
将用所述相位校正量校正了所述磁场数据而得的数据设为校正后磁场数据，
求出基于所述加速度数据和所述校正后磁场数据的所述姿态。
10.如权利要求9所述的计测方法，其中，
在所述姿态估计过程中求出的所述姿态是倾斜角、方位角、俯角，
在所述相位校正量计算过程中，在所述挖掘部处于旋转时，用根据在所述姿态估计过程中求出的倾斜角、方位角、俯角所求出的重力工具面和磁力工具面之间的偏移量，来更新估计偏移量。
11.如权利要求10所述的计测方法，其中，
将(ax，ay，az)设为所述加速度数据中包含的起因于重力的加速度数据，将(mx，my，mz)设为所述校正后磁场数据，
倾斜角Inc、方位角Azm、俯角Dip具有如下的关系：
12.如权利要求10所述的计测方法，其中，
将Inc设为在所述姿态估计过程中求出的倾斜角，将Azm设为在所述姿态估计过程中求出的方位角，将Dip设为在所述姿态估计过程中求出的俯角，
所述相位校正量计算过程如下求出估计偏移量TFO：
其中、
13.如权利要求11所述的计测方法，其中，
将Inc设为在所述姿态估计过程中求出的倾斜角，将Azm设为在所述姿态估计过程中求出的方位角，将Dip设为在所述姿态估计过程中求出的俯角，
所述相位校正量计算过程如下求出估计偏移量TFO：
其中、
14.如权利要求9至13的任意一项所述的计测方法，其中，
将pdm设为所述相位校正量，将(Mx，My，Mz)设为所述磁场数据，将(mx，my，mz)设为所述校正后磁场数据，
所述磁场数据和所述校正后磁场数据具有如下的关系：
mx＝Mxcos(pdm)-Mysin(pdm)
my＝Mxsin(pdm)+Mycos(pdm)
mz＝Mz。
15.如权利要求9至13的任意一项所述的计测方法，其中，
所述姿态估计过程将所述挖掘部处于静止时所求出的姿态设为姿态的初始值。
16.如权利要求14所述的计测方法，其中，
所述姿态估计过程将所述挖掘部处于静止时所求出的姿态设为姿态的初始值。
17.一种计算机可读取的记录介质，记录了用于使计算机执行权利要求9至16的任意一项所述的计测方法的计测程序。
CN202110895434.2A 2020-11-27 2021-08-05 计测装置、计测方法、记录介质 Active CN114563034B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020196616A JP2022085112A (ja) 2020-11-27 2020-11-27 計測装置、計測方法、計測プログラム、記録媒体
JP2020-196616 2020-11-27

Publications (2)

Publication Number Publication Date
CN114563034A CN114563034A (zh) 2022-05-31
CN114563034B true CN114563034B (zh) 2023-11-03

Family

ID=77249683

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110895434.2A Active CN114563034B (zh) 2020-11-27 2021-08-05 计测装置、计测方法、记录介质

Country Status (4)

Country Link
US (1) US20220170245A1 (zh)
EP (1) EP4006297B1 (zh)
JP (1) JP2022085112A (zh)
CN (1) CN114563034B (zh)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001141408A (ja) * 1999-11-15 2001-05-25 Ddi Corp 位置測定方法、位置指示方法および位置測定装置
CN105102762A (zh) * 2013-03-29 2015-11-25 普拉德研究及开发股份有限公司 钻井工具面的闭环控制
US9464482B1 (en) * 2016-01-06 2016-10-11 Isodrill, Llc Rotary steerable drilling tool
CN106170596A (zh) * 2015-03-27 2016-11-30 株式会社小松制作所 作业机械的校正装置及作业机械的作业装置参数的校正方法
CN109696178A (zh) * 2017-10-20 2019-04-30 夏普株式会社 偏移校正装置、偏移校正程序、步行者航位推算装置及记录介质
JP2020029668A (ja) * 2018-08-21 2020-02-27 ヤンマー株式会社 建設機械

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6529834B1 (en) * 1997-12-04 2003-03-04 Baker Hughes Incorporated Measurement-while-drilling assembly using gyroscopic devices and methods of bias removal
US6315062B1 (en) * 1999-09-24 2001-11-13 Vermeer Manufacturing Company Horizontal directional drilling machine employing inertial navigation control system and method
US9273547B2 (en) * 2011-12-12 2016-03-01 Schlumberger Technology Corporation Dynamic borehole azimuth measurements
CA3099823A1 (en) 2018-05-18 2019-11-21 Scientific Drilling International, Inc. In-situ downhole measurement correction and control

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001141408A (ja) * 1999-11-15 2001-05-25 Ddi Corp 位置測定方法、位置指示方法および位置測定装置
CN105102762A (zh) * 2013-03-29 2015-11-25 普拉德研究及开发股份有限公司 钻井工具面的闭环控制
CN106170596A (zh) * 2015-03-27 2016-11-30 株式会社小松制作所 作业机械的校正装置及作业机械的作业装置参数的校正方法
US9464482B1 (en) * 2016-01-06 2016-10-11 Isodrill, Llc Rotary steerable drilling tool
CN109696178A (zh) * 2017-10-20 2019-04-30 夏普株式会社 偏移校正装置、偏移校正程序、步行者航位推算装置及记录介质
JP2020029668A (ja) * 2018-08-21 2020-02-27 ヤンマー株式会社 建設機械

Also Published As

Publication number Publication date
EP4006297B1 (en) 2023-01-04
EP4006297A1 (en) 2022-06-01
CN114563034A (zh) 2022-05-31
US20220170245A1 (en) 2022-06-02
JP2022085112A (ja) 2022-06-08

Similar Documents

Publication Publication Date Title
CN102822626B (zh) 校准在移动装置上的传感器测量
US11473894B2 (en) Computing system implementing an algorithm for fusing data from inertial sensors, and method
US7650252B2 (en) Inclinometer measurement system and method providing correction for movement induced acceleration errors
US10788324B2 (en) Method and apparatus for calculation of angular velocity using acceleration sensor and geomagnetic sensor
CN103791905A (zh) 姿态估计方法和装置
TWI555994B (zh) 磁性感測器的動態校準技術
CN112567097A (zh) 用于确定机器的作业设备的角度的方法
CN114563034B (zh) 计测装置、计测方法、记录介质
EP2615416B1 (en) Electronic bias compensation for a gyroscope
CN113483765B (zh) 一种卫星自主姿态确定方法
CN114964214B (zh) 一种航姿参考***的扩展卡尔曼滤波姿态解算方法
Štebe et al. Trajectory tracking of an oscillating movement with a low-cost IMU in geodetic surveying applications
CN110864684A (zh) 用户姿态测算方法
JP7190063B2 (ja) 水晶発振器の加速度感度を測定する方法およびシステム
JP2001083224A (ja) 磁界測定方法および装置
US11415590B2 (en) Method and apparatus with posture estimation
Xuan Application of real-time Kalman filter with magnetic calibration for MEMS sensor in attitude estimation
CN113608576B (zh) 电子装置控制方法、其电子装置和软件产品
JP2012132713A (ja) 状態推定装置、状態推定方法および状態推定プログラム
KR20230134189A (ko) 가상 imu를 이용한 적응적 방향추정용 측위 시스템 및 방법
Lin et al. System-Level Calibration Method Considering Nonorthogonal Angles in Dual-Axis Rotational Inertial Navigation System
Zhou et al. Accelerometer Mounting Error Calibration
CN113984090A (zh) 一种轮式机器人imu误差在线标定与补偿方法及装置
Cao et al. Error compensation method for pedestrian navigation system based on low-cost inertial sensor array
CN115061195A (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