JP5341861B2 - Magnetic field detector - Google Patents

Magnetic field detector Download PDF

Info

Publication number
JP5341861B2
JP5341861B2 JP2010233979A JP2010233979A JP5341861B2 JP 5341861 B2 JP5341861 B2 JP 5341861B2 JP 2010233979 A JP2010233979 A JP 2010233979A JP 2010233979 A JP2010233979 A JP 2010233979A JP 5341861 B2 JP5341861 B2 JP 5341861B2
Authority
JP
Japan
Prior art keywords
coordinate point
data group
plane
data
point data
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
JP2010233979A
Other languages
Japanese (ja)
Other versions
JP2012088124A (en
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.)
Alps Alpine Co Ltd
Original Assignee
Alps Electric Co 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 Alps Electric Co Ltd filed Critical Alps Electric Co Ltd
Priority to JP2010233979A priority Critical patent/JP5341861B2/en
Publication of JP2012088124A publication Critical patent/JP2012088124A/en
Application granted granted Critical
Publication of JP5341861B2 publication Critical patent/JP5341861B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To provide a magnetic field detection device capable of accurately calculating rotation operations and angular velocity of magnetic vectors by using sensors of three axes for detecting magnetism such as earth magnetism. <P>SOLUTION: Coordinate points of the magnetic vectors are calculated based on detection outputs from three magnetic sensors for detecting the magnetic vectors. A movement plane on which coordinate point data moves is determined by using a first arithmetic data group N1-1 including a prescribed number of the calculated coordinate point data. An error between an average value of a latest data group Na-1 including a plurality of the latest coordinate point data and the movement plane is determined. When the error is small, a first arithmetic data group N1-2 composed of a larger number of data including the latest data group Na-1 is used to determine the movement plane. When the error is large, a second arithmetic data group N2-1 composed of a small number of data including the latest data group Na-1 is used to calculate the movement plane. <P>COPYRIGHT: (C)2012,JPO&amp;INPIT

Description

本発明は、直交する3方向のそれぞれに向けられた磁気センサで地磁気ベクトルなどの磁気ベクトルを検知する磁界検知装置に係り、特に磁気検知部に対して磁気ベクトルが三次元空間内で回動したときに、その回転軌跡を判別して、磁気ベクトルの回転運動を正確に知ることができる磁界検知装置に関する。   The present invention relates to a magnetic field detection device that detects a magnetic vector such as a geomagnetic vector with a magnetic sensor directed in each of three orthogonal directions, and in particular, the magnetic vector rotates in a three-dimensional space with respect to a magnetic detection unit. In some cases, the present invention relates to a magnetic field detection apparatus that can determine the rotational locus of the magnetic vector and accurately know the rotational motion of a magnetic vector.

互いに直交する3方向の磁界強度を検知する3軸の磁気センサを使用する磁界検知装置は、地磁気を検知する地磁気検知装置などとして使用される。   A magnetic field detection device using a triaxial magnetic sensor that detects magnetic field strengths in three directions orthogonal to each other is used as a geomagnetic detection device that detects geomagnetism.

特許文献1に記載された磁気式ジャイロは、3軸直交座標上に配置された地磁気を検知する3軸磁気センサを有している。この磁気式ジャイロは、三次元空間内で回転させたときに、3軸の出力データを用いて異なる2時点間の差分ベクトルを求め、その差分ベクトルが予め決められたしきい値よりも小さくなるか否かを判定して、3軸のうちのどの軸を中心として回転しているのかを特定するというものである。   The magnetic gyro described in Patent Document 1 has a three-axis magnetic sensor that detects geomagnetism arranged on three-axis orthogonal coordinates. When this magnetic gyroscope is rotated in a three-dimensional space, a difference vector between two different time points is obtained using output data of three axes, and the difference vector becomes smaller than a predetermined threshold value. It is determined whether or not one of the three axes is rotating as a center.

特開2008−224642号公報JP 2008-224642 A

特許文献1などに記載されているように、3軸の磁気センサを有する磁気検知部を有する磁界検知装置では、磁気ベクトルを検知した検知データが一定のサンプル時間毎に取得されて、複数の検知データが次々とメモリに保持される。そして、保持された複数の検知データを使用して、磁気検知部と磁気ベクトルとの相対的な回転状態が演算される。   As described in Patent Document 1 and the like, in a magnetic field detection apparatus having a magnetic detection unit having a three-axis magnetic sensor, detection data obtained by detecting a magnetic vector is acquired at a certain sample time, and a plurality of detections are performed. Data is held in memory one after another. And the relative rotation state of a magnetic detection part and a magnetic vector is calculated using the hold | maintained some detection data.

しかし、演算に使用する検知データのサンプル数が少なすぎると、外部ノイズなどによって磁気ベクトルの検知データが一時的に大幅に変化したときに、磁気検知部と磁気ベクトルとの相対的な回転が、一時的に極端に変化しているものとして認識されてしまう。その結果、磁気検知部と磁気ベクトルとの相対動作を安定して把握することが難しくなる。   However, if the number of samples of detection data used in the calculation is too small, the relative rotation between the magnetic detection unit and the magnetic vector when the detection data of the magnetic vector changes temporarily due to external noise or the like, It will be recognized as something that has temporarily changed extremely. As a result, it becomes difficult to stably grasp the relative motion between the magnetic detection unit and the magnetic vector.

演算に使用する検知データのサンプル数を増やすと、外部ノイズなどの一時的な大幅な変化に影響されることなく、磁気検知部と磁気ベクトルとの相対的な回転を安定して求めることができる。しかし、この場合には、磁気検知部と磁気ベクトルとの相対的な回転状態が、実際に大きく変化したときに、この変化を正確に把握することができなくなる。   Increasing the number of samples of detection data used for computation can stably determine the relative rotation between the magnetic detection unit and the magnetic vector without being affected by a large temporary change such as external noise. . However, in this case, when the relative rotation state between the magnetic detection unit and the magnetic vector actually changes greatly, it becomes impossible to accurately grasp the change.

本発明は上記従来の課題を解決するものであり、直交する3軸の方向に向く磁気センサで検知された複数のデータを使用し、ノイズの影響を受けにくくして回転運動を安定して検知でき、しかも、回転運動の変化への追従性を向上することができる磁界検知装置を提供することを目的としている。   The present invention solves the above-described conventional problems, and uses a plurality of data detected by a magnetic sensor directed in three orthogonal directions to detect rotational motion stably without being affected by noise. In addition, an object of the present invention is to provide a magnetic field detection device that can improve follow-up to changes in rotational motion.

本発明は、互いに直交するX方向とY方向およびZ方向が基準方向として決められた磁気検知部と、演算部とを有し、
前記磁気検知部が、X軸の磁気成分を検知するX軸磁気センサと、Y軸の磁気成分を検知するY軸磁気センサと、Z軸の磁気成分を検知するZ軸磁気センサとを有し、
前記演算部で、前記X軸磁気センサと前記Y軸磁気センサおよび前記Z軸磁気センサの検知出力に基づいて、磁気ベクトルの向きが三次元座標上の座標点データとして求められ、複数の座標点データとの誤差が最も小さい平面が座標点データが移動している移動平面として演算され、
少なくとも1つの最新の座標点データを含む最新データ群とそのときの移動平面との誤差が、予め決められた値以下またはその値未満のときは、前記最新データ群とそれ以前に得られた複数の座標点データを含む所定数の第1の演算データ群から次の移動平面が演算され、前記最新データ群とそのときの移動平面との誤差が、予め決められた値以上またはその値を超えたときは、前記最新データ群を含み前記第1の演算データ群よりもデータ数が少ない第2の演算データ群から次の移動平面が求められることを特徴とするものである。
The present invention includes a magnetic detection unit in which the X direction, the Y direction, and the Z direction orthogonal to each other are determined as reference directions, and a calculation unit.
The magnetic detection unit includes an X-axis magnetic sensor that detects an X-axis magnetic component, a Y-axis magnetic sensor that detects a Y-axis magnetic component, and a Z-axis magnetic sensor that detects a Z-axis magnetic component. ,
Based on the detection outputs of the X-axis magnetic sensor, the Y-axis magnetic sensor, and the Z-axis magnetic sensor, the arithmetic unit obtains the direction of the magnetic vector as coordinate point data on three-dimensional coordinates, and a plurality of coordinate points The plane with the smallest error from the data is calculated as the moving plane where the coordinate point data is moving,
When an error between the latest data group including at least one latest coordinate point data and the moving plane at that time is equal to or less than a predetermined value or less than the predetermined value, the latest data group and a plurality of data obtained before that The next movement plane is calculated from a predetermined number of first calculation data groups including the coordinate point data, and an error between the latest data group and the movement plane at that time is greater than or equal to a predetermined value or exceeds that value. In this case, the next movement plane is obtained from the second calculation data group including the latest data group and having a smaller number of data than the first calculation data group.

本発明の磁界検知装置は、複数の座標点データを用いて、座標点データが移動している移動平面が推定されて求められる。最新の座標点データを含む最新データ群に大きな変化がないときは、多くの座標点データを含む第1の演算データ群によって移動平面を演算することで、ノイズなどによる座標点データの一時的な大幅な変化の影響を大きく受けることなく移動平面を求めることができる。最新データ群が大きく変化したときは、座標点データの数が少ない第2の演算データ群を使用して、移動平面が演算される。これにより、実際に磁気検知部と磁気ベクトルとの相対位置が大きく変化したときに、この変化に追従して移動平面を求めることができる。   The magnetic field detection apparatus of the present invention is obtained by estimating a moving plane in which coordinate point data is moving using a plurality of coordinate point data. When there is no significant change in the latest data group including the latest coordinate point data, the movement plane is calculated using the first calculation data group including a large number of coordinate point data, thereby temporarily converting the coordinate point data due to noise or the like. The moving plane can be obtained without being greatly affected by a large change. When the latest data group changes greatly, the moving plane is calculated using the second calculation data group with a small number of coordinate point data. As a result, when the relative position between the magnetic detection unit and the magnetic vector is actually changed, the moving plane can be obtained following this change.

本発明は、三次元座標上で、前記座標点データが現れる球面と、前記移動平面との交線から、座標点データの移動軌跡が求められるものであり、前記移動軌跡から磁気検知部の角加速度が求められるものである。   According to the present invention, the movement locus of the coordinate point data is obtained from the intersection line between the spherical surface where the coordinate point data appears on the three-dimensional coordinates and the movement plane, and the angle of the magnetic detection unit is obtained from the movement locus. Acceleration is required.

本発明では、前記最新データ群は、最新の座標点データを含む複数の座標点データで構成されており、最新データ群に含まれる複数の座標点データの平均値と、そのときの移動平面との誤差が、予め決められた値と比較されることが好ましい。   In the present invention, the latest data group is composed of a plurality of coordinate point data including the latest coordinate point data, an average value of the plurality of coordinate point data included in the latest data group, and a moving plane at that time, Is preferably compared to a predetermined value.

上記のように構成すると、最新データ群に含まれる複数の座標点データの一部がノイズなどにより大きく変動したとしても、座標点データの平均値をとることで、最新データ群とそのときの移動平面との誤差を演算するときに、ノイズなど影響を低減することが可能になる。   When configured as described above, even if some of the multiple coordinate point data included in the latest data group fluctuate greatly due to noise, the latest data group and the movement at that time can be obtained by taking the average value of the coordinate point data. When calculating the error from the plane, it is possible to reduce the influence of noise and the like.

なお、本発明は、最新データ群が1つの最新データのみで構成されており、この1つの最新データとそのときの移動平面との誤差が大きいか否かによって、第1の演算データ群とするか第2の演算データ群とするかを選択してもよい。   According to the present invention, the latest data group includes only one latest data, and the first calculation data group is determined depending on whether or not there is a large error between the one latest data and the moving plane at that time. Or the second calculation data group may be selected.

本発明は、第2の演算データ群は、最新データ群のみから構成されるものであってもよい。ただし、最新データ群に含まれる座標点データが少ないときは、第2の演算データ群が、最新のデータ群と、それ以前に得られた少なくとも1つの座標点データとから構成されてもよい。   In the present invention, the second calculation data group may be composed of only the latest data group. However, when the coordinate data included in the latest data group is small, the second calculation data group may be composed of the latest data group and at least one coordinate point data obtained before that.

本発明は、三次元座標上での平面の一般式と、第1の演算データ群に含まれる複数の座標点データとの誤差が最小二乗法で演算され、その誤差が最も小さい平面が移動平面として求められる。   In the present invention, an error between a general formula of a plane on three-dimensional coordinates and a plurality of coordinate point data included in the first calculation data group is calculated by a least square method, and a plane having the smallest error is a moving plane. As required.

また本発明は、三次元座標上での平面の一般式と、第2の演算データ群に含まれる複数の座標点データとの誤差が最小二乗法で演算され、その誤差が最も小さい平面が移動平面として求められる。   Further, according to the present invention, the error between the general expression of the plane on the three-dimensional coordinates and the plurality of coordinate point data included in the second calculation data group is calculated by the least square method, and the plane with the smallest error is moved. Required as a plane.

本発明は、直交する3軸方向に向けられた磁気センサの検知出力を用いて、磁気ベクトルの絶対的な運動を求めることができる。すなわち、ノイズなどによる検知出力の一時的な変動の影響を受けにくく、且つ運動の変化に追従して運動軌跡を求めることができる。   The present invention can determine the absolute motion of a magnetic vector by using the detection output of a magnetic sensor directed in three orthogonal directions. That is, it is difficult to be affected by temporary fluctuations in the detection output due to noise or the like, and the movement locus can be obtained following the movement change.

本発明の実施の形態の磁界検知装置の回路ブロック図、The circuit block diagram of the magnetic field detection apparatus of embodiment of this invention, 図1に示す磁界検知装置に設けられた演算部の機能を説明するブロック図、The block diagram explaining the function of the calculating part provided in the magnetic field detection apparatus shown in FIG. データバッファの処理動作を示す説明図、Explanatory drawing showing the processing operation of the data buffer, 地磁気検知部に設けられたX軸センサとY軸センサおよびZ軸センサの説明図、Explanatory drawing of the X-axis sensor, the Y-axis sensor and the Z-axis sensor provided in the geomagnetism detection unit, Z軸が重力方向に向けられた状態での地磁気ベクトルの検知状態を示す三次元座標の説明図、Explanatory drawing of three-dimensional coordinates showing the detection state of the geomagnetic vector with the Z-axis oriented in the direction of gravity, 磁気検知部が任意の軸を中心として回転しているときの地磁気ベクトルの検知動作を示す三次元座標の説明図、Explanatory drawing of three-dimensional coordinates showing the detection operation of the geomagnetic vector when the magnetic detection unit is rotating around an arbitrary axis, 座標点データが移動する移動平面を求める演算処理の説明図、Explanatory drawing of the calculation process which calculates | requires the movement plane where coordinate point data move,

図1に示す本発明の実施の形態の磁界検知装置1は、地磁気検知装置として使用されるものであり、磁気検知部2を有している。図4に示すように、磁気検知部2は、互いに直交する基準軸であるX軸とY軸およびZ軸が固定軸として決められている。X軸とY軸およびZ軸の交点が、基準原点Oである。磁界検知装置1は携帯用機器などに搭載されており、磁気検知部2は、X軸とY軸およびZ軸の直交関係を維持したまま、空間内で自由に移動できる。   A magnetic field detection device 1 according to an embodiment of the present invention shown in FIG. 1 is used as a geomagnetism detection device and has a magnetic detection unit 2. As shown in FIG. 4, in the magnetic detection unit 2, the X axis, the Y axis, and the Z axis, which are reference axes orthogonal to each other, are determined as fixed axes. The intersection of the X axis, the Y axis, and the Z axis is the reference origin O. The magnetic field detection device 1 is mounted on a portable device or the like, and the magnetic detection unit 2 can freely move in the space while maintaining the orthogonal relationship between the X axis, the Y axis, and the Z axis.

図4に示すように、磁気検知部2には、X軸センサ3がX軸に沿って固定され、Y軸センサ4がY軸に沿って固定され、Z軸センサがZ軸に沿って固定されている。X軸センサ3とY軸センサ4およびZ軸センサ5は、いずれもGMR素子で構成されている。GMR素子は、Ni−Co合金やNi−Fe合金で形成された軟磁性材料で形成された固定磁性層および自由磁性層と、固定磁性層と自由磁性層との間に挟まれた銅などの非磁性導電層とを有している。固定磁性層の下に反強磁性層が積層され、反強磁性層と固定磁性層との反強結合により、固定磁性層の磁化が固定されている。   As shown in FIG. 4, the X-axis sensor 3 is fixed along the X-axis, the Y-axis sensor 4 is fixed along the Y-axis, and the Z-axis sensor is fixed along the Z-axis. Has been. The X-axis sensor 3, the Y-axis sensor 4, and the Z-axis sensor 5 are all composed of GMR elements. The GMR element includes a pinned magnetic layer and a free magnetic layer formed of a soft magnetic material formed of a Ni—Co alloy or a Ni—Fe alloy, and copper sandwiched between the pinned magnetic layer and the free magnetic layer. And a nonmagnetic conductive layer. An antiferromagnetic layer is laminated under the pinned magnetic layer, and the magnetization of the pinned magnetic layer is pinned by antiferromagnetic coupling between the antiferromagnetic layer and the pinned magnetic layer.

X軸センサ3は、地磁気のX方向に向く成分を検知するものであり、固定磁性層の磁化の向きがX軸に沿うPX方向に固定されている。自由磁性層の磁化の向きは地磁気の向きに反応する。自由磁性層の磁化の向きがPX方向と平行になるとX軸センサ3の抵抗値が極小になり、自由磁性層の磁化の向きがPX方向と逆向きになるとX軸センサ3の抵抗値が極大になる。また、自由磁性層の磁化の向きがPX方向と直交すると、抵抗値が前記極大値と極小値との平均値となる。   The X-axis sensor 3 detects a component of the geomagnetism facing in the X direction, and the magnetization direction of the pinned magnetic layer is fixed in the PX direction along the X axis. The direction of magnetization of the free magnetic layer responds to the direction of geomagnetism. When the magnetization direction of the free magnetic layer is parallel to the PX direction, the resistance value of the X-axis sensor 3 is minimized, and when the magnetization direction of the free magnetic layer is opposite to the PX direction, the resistance value of the X-axis sensor 3 is maximized. become. Further, when the magnetization direction of the free magnetic layer is orthogonal to the PX direction, the resistance value is an average value of the maximum value and the minimum value.

図1に示す磁場データ検知部6では、X軸センサ3と固定抵抗とが直列に接続されている。X軸センサ3と固定抵抗との直列回路に電圧が与えられており、X軸センサ3と固定抵抗との間の中点電圧がX軸の検知出力として取り出される。X軸センサ3にX方向に向く磁界が与えられていないとき、またはPXに対して直交する磁界が与えられているときに、X軸の検知出力が原点となる。   In the magnetic field data detection unit 6 shown in FIG. 1, the X-axis sensor 3 and a fixed resistor are connected in series. A voltage is applied to the series circuit of the X-axis sensor 3 and the fixed resistor, and a midpoint voltage between the X-axis sensor 3 and the fixed resistor is taken out as an X-axis detection output. When a magnetic field directed in the X direction is not applied to the X axis sensor 3, or when a magnetic field orthogonal to PX is applied, the X axis detection output is the origin.

磁気検知部2の全体を傾け、X軸センサ3の固定磁性層の磁化の固定方向PXを地磁気ベクトルVと同じ向きにするとX軸センサ3に与えられる磁界成分が極大値となる。このときのX軸の検知出力は、前記原点に対してプラス側の極大値となる。逆に、X軸センサ3の固定磁性層の磁化の固定方向PXを地磁気ベクトルVと反対に向けると、X軸センサ3に与えられる逆向きの磁界成分が極大値となる。このときのX軸の検知出力は、前記原点に対してマイナス側の極大値となる。   When the entire magnetic detection unit 2 is tilted and the fixed direction PX of the magnetization of the fixed magnetic layer of the X-axis sensor 3 is set in the same direction as the geomagnetic vector V, the magnetic field component applied to the X-axis sensor 3 becomes a maximum value. At this time, the detection output of the X axis becomes a maximum value on the plus side with respect to the origin. Conversely, when the fixed direction PX of the magnetization of the fixed magnetic layer of the X-axis sensor 3 is directed opposite to the geomagnetic vector V, the reverse magnetic field component applied to the X-axis sensor 3 has a maximum value. At this time, the detection output of the X axis is a maximum value on the minus side with respect to the origin.

Y軸センサ4とZ軸センサ5も、それぞれ固定抵抗とが直列に接続され、Y軸センサ4またはZ軸センサ5と固定抵抗との直列回路に電圧が与えられており、各センサと固定抵抗との間の中点電圧がY軸またはZ軸の検知出力として取り出される。   Each of the Y-axis sensor 4 and the Z-axis sensor 5 is also connected to a fixed resistor in series, and a voltage is applied to the Y-axis sensor 4 or a series circuit of the Z-axis sensor 5 and the fixed resistor. Is taken out as a Y-axis or Z-axis detection output.

Y軸センサ4の固定磁性層の磁化の固定方向PYを地磁気ベクトルVと同じ向きにすると、Y軸の検知出力は、原点に対してプラス側の極大値になる。Y軸センサ4の固定磁性層の磁化の固定方向PYを地磁気ベクトルVと反対に向けると、Y軸の検知出力は、原点に対してマイナス側の極大値となる。同様に、Z軸センサ5の固定磁性層の磁化の固定方向PZを地磁気ベクトルVと同じ向きにすると、Z軸の検知出力は、原点に対してプラス側の極大値になる。Z軸センサ5の固定磁性層の磁化の固定方向PZを地磁気ベクトルVと反対に向けると、Z軸の検知出力は、原点に対してマイナス側の極大値となる。   When the fixed direction PY of the magnetization of the fixed magnetic layer of the Y-axis sensor 4 is set to the same direction as the geomagnetic vector V, the detection output of the Y-axis becomes a maximum value on the plus side with respect to the origin. When the fixed direction PY of the magnetization of the fixed magnetic layer of the Y-axis sensor 4 is directed opposite to the geomagnetic vector V, the detection output of the Y-axis becomes a maximum value on the minus side with respect to the origin. Similarly, when the fixed direction PZ of the magnetization of the fixed magnetic layer of the Z-axis sensor 5 is set to the same direction as the geomagnetic vector V, the detection output of the Z-axis becomes a maximum value on the plus side with respect to the origin. When the fixed direction PZ of the magnetization of the fixed magnetic layer of the Z-axis sensor 5 is directed opposite to the geomagnetic vector V, the detection output of the Z-axis becomes a maximum value on the minus side with respect to the origin.

地磁気ベクトルVの大きさが一定であれば、X軸センサ3とY軸センサ4およびZ軸センサ5からの検知出力は、いずれもプラス側の極大値の絶対値と、マイナス側の極大値の絶対値とが同じである。   If the magnitude of the geomagnetic vector V is constant, the detection outputs from the X-axis sensor 3, the Y-axis sensor 4, and the Z-axis sensor 5 are all of the absolute value of the plus side maximum value and the minus side maximum value. The absolute value is the same.

X軸センサ3としては、地磁気ベクトルの向きによってプラス側の検知出力とマイナス側の検知出力が得られ、プラス側の検知出力の極大値とマイナス側の検知出力の極大値とで絶対値が同じになれば、GMR素子以外の磁気センサで構成することもできる。例えば、X軸に沿ってプラス側の磁界強度のみを検知できるホール素子またはMR素子と、マイナス側の磁界強度のみを検知できるホール素子またはMR素子を組み合わせて、X軸センサ3として使用してもよい。これは、Y軸センサ4とZ軸センサ5においても同じである。   As the X-axis sensor 3, a positive detection output and a negative detection output are obtained depending on the direction of the geomagnetic vector, and the absolute value is the same between the maximum value of the positive detection output and the maximum value of the negative detection output. If it becomes, it can also be comprised with magnetic sensors other than a GMR element. For example, a Hall element or MR element that can detect only the positive magnetic field intensity along the X axis and a Hall element or MR element that can detect only the negative magnetic field intensity may be combined and used as the X axis sensor 3. Good. The same applies to the Y-axis sensor 4 and the Z-axis sensor 5.

図1に示すように、磁場データ検知部6で検知されたX軸とY軸およびZ軸の検知出力は、演算部10に与えられる。演算部10は、A/D変換部とCPUおよびクロック回路などから構成されている。演算部10のクロック回路の計測時間に応じて、磁場データ検知部6で検知されたX軸とY軸およびZ軸の検知出力が、短いサイクルで間欠的にサンプリングされて演算部10に読み出される。それぞれの検知出力は、演算部内に設けられた前記A/D変換部によってディジタル値に変換される。   As shown in FIG. 1, the detection outputs of the X axis, the Y axis, and the Z axis detected by the magnetic field data detection unit 6 are given to the calculation unit 10. The arithmetic unit 10 includes an A / D converter, a CPU, a clock circuit, and the like. According to the measurement time of the clock circuit of the calculation unit 10, the detection outputs of the X axis, the Y axis, and the Z axis detected by the magnetic field data detection unit 6 are intermittently sampled in a short cycle and read out to the calculation unit 10. . Each detection output is converted into a digital value by the A / D conversion unit provided in the calculation unit.

演算部10を構成するCPUにはメモリ7が接続されている。メモリ7には、演算処理のためのソフトウエアがプログラミングされて格納されている。演算部10の演算処理は前記ソフトウエアによって実行される。   A memory 7 is connected to the CPU constituting the arithmetic unit 10. In the memory 7, software for arithmetic processing is programmed and stored. The arithmetic processing of the arithmetic unit 10 is executed by the software.

図2に示すように、演算部10は、ソフトウエアに基づいて複数段階の演算処理を行う。ディジタルデータに変換されたX軸の検知出力とY軸の検知出力およびZ軸の検知出力は、主演算部15で演算処理され、図5に示すX−Y−Zの三次元座標上の座標点データDに変換されて、データバッファ(バッファメモリ)11に格納される。クロック回路と同期して短いサイクルでサンプリングされて演算された前記座標点データDは、図3に示すデータバッファ11の格納部11aに与えられる。座標点データDが格納部11aに与えられる毎に、座標点データDが格納部11aから11mまで順に送り出され、最終段の格納部11mの座標点データDが捨てられる。磁界検知装置1が動作している間は、磁場データ検知部6から最新のデータが一定のサンプリング時間毎に読み出され続け、演算後の座標点データDがデータバッファ11に順番に格納されていく。   As shown in FIG. 2, the arithmetic unit 10 performs a plurality of stages of arithmetic processing based on software. The X-axis detection output, the Y-axis detection output, and the Z-axis detection output converted into digital data are arithmetically processed by the main calculation unit 15, and the coordinates on the three-dimensional coordinates of XYZ shown in FIG. It is converted into point data D and stored in a data buffer (buffer memory) 11. The coordinate point data D sampled and calculated in a short cycle in synchronization with the clock circuit is supplied to the storage unit 11a of the data buffer 11 shown in FIG. Each time the coordinate point data D is given to the storage unit 11a, the coordinate point data D is sequentially sent from the storage unit 11a to 11m, and the coordinate point data D in the final stage storage unit 11m is discarded. While the magnetic field detection device 1 is operating, the latest data is continuously read from the magnetic field data detection unit 6 at regular sampling times, and the calculated coordinate point data D is stored in the data buffer 11 in order. Go.

図5に示す三次元座標のX−Y−Zの各軸は、磁界検知装置1に固定されて設定されたものであり、図4に示すように、X軸センサ3はX軸に沿って固定され、Y軸センサ4はY軸に沿って固定され、Z軸センサ5はZ軸に沿って固定されている。   Each of the XYZ axes of the three-dimensional coordinates shown in FIG. 5 is fixed and set to the magnetic field detection device 1, and as shown in FIG. 4, the X-axis sensor 3 is along the X-axis. The Y-axis sensor 4 is fixed along the Y-axis, and the Z-axis sensor 5 is fixed along the Z-axis.

図5に示すように、磁気検知部2が地球上のいずれかの場所に置かれると、磁気検知部2のX軸センサ3から検知出力xbが得られ、Y軸センサ4から検知出力ybが得られ、Z軸センサ5から検知出力zbが得られる。図2に示す演算部10の主演算部15において、三次元の検知出力から座標点データD(xb,yb,zb)が演算される。座標点データD(xb,yb,zb)はサンプリング周期毎に次々と得られ、データバッファ11に順に格納されていく。   As shown in FIG. 5, when the magnetic detection unit 2 is placed anywhere on the earth, the detection output xb is obtained from the X-axis sensor 3 of the magnetic detection unit 2, and the detection output yb is obtained from the Y-axis sensor 4. The detection output zb is obtained from the Z-axis sensor 5. In the main calculation unit 15 of the calculation unit 10 shown in FIG. 2, the coordinate point data D (xb, yb, zb) is calculated from the three-dimensional detection output. The coordinate point data D (xb, yb, zb) are obtained one after another for each sampling period, and are sequentially stored in the data buffer 11.

この磁界検知装置1は、電源が投入された直後にキャリブレーションを行う必要がある。このキャリブレーションは、例えば、磁界検知装置1を搭載した携帯機器などを任意の方向へ数回だけ回転させることで行われる。主演算部15では、キャリブレーションにおいて次々に得られる座標点データDのいくつかをサンプリングする。少なくとも3個の座標点データDを得ることで、その時点での座標点データDの回転軌跡に一致する円を特定できる。この円が複数個求められ、それぞれの円の中心を通る中心線が求められ、さらに中心線の交点が演算される。演算部10では、キャリブレーションの結果として得られた前記交点が、X−Y−Zの三次元座標の基準原点Oとなるように補正される。   The magnetic field detection device 1 needs to be calibrated immediately after the power is turned on. This calibration is performed, for example, by rotating a portable device or the like equipped with the magnetic field detection device 1 several times in an arbitrary direction. The main calculation unit 15 samples some of the coordinate point data D obtained one after another in the calibration. By obtaining at least three coordinate point data D, it is possible to specify a circle that matches the rotation locus of the coordinate point data D at that time. A plurality of circles are obtained, a center line passing through the center of each circle is obtained, and an intersection of the center lines is calculated. In the calculation unit 10, the intersection obtained as a result of the calibration is corrected so as to become the reference origin O of the three-dimensional coordinates of XYZ.

キャリブレーションにより三次元座標の基準原点Oが得られると、その後の検知出力から演算される座標点データD(xb,yb,zb)は、三次元座標上の基準原点Oを中心とする球面G上の点として把握される。この球面Gの半径Rは、X軸センサ3、Y軸センサ4、Z軸センサ5の検知出力の極大値の絶対値に相当する。球面Gの半径Rは、そのときの測定場所によって相違し、検知される地磁気ベクトルVの絶対値の大小に応じて球面Gの半径Rも変化する。   When the reference origin O of the three-dimensional coordinates is obtained by the calibration, the coordinate point data D (xb, yb, zb) calculated from the subsequent detection output is a spherical surface G centered on the reference origin O on the three-dimensional coordinates. It is grasped as the upper point. The radius R of the spherical surface G corresponds to the absolute value of the maximum value of the detection outputs of the X-axis sensor 3, the Y-axis sensor 4, and the Z-axis sensor 5. The radius R of the spherical surface G differs depending on the measurement location at that time, and the radius R of the spherical surface G also changes according to the absolute value of the detected geomagnetic vector V.

図5は、磁界検知装置1に設定されているZ軸が重力方向に向けられている状態を示している。この場合、検知出力から得られる座標点データD(xb,yb,zb)と、三次元座標の基準原点Oを結ぶ線が地磁気ベクトルVである。この状態で、磁界検知装置1をZ軸を中心として(重力方向に向く軸を中心として)回転させると、次々とサンプリングされていく座標点データD(xb,yb,zb)が、Z軸を中心とし且つX−Y軸と平行な水平緯度線Haに沿って移動する。   FIG. 5 shows a state in which the Z axis set in the magnetic field detection device 1 is oriented in the direction of gravity. In this case, a line connecting the coordinate point data D (xb, yb, zb) obtained from the detection output and the reference origin O of the three-dimensional coordinates is the geomagnetic vector V. In this state, when the magnetic field detection device 1 is rotated about the Z axis (about the axis directed in the direction of gravity), the coordinate point data D (xb, yb, zb) sampled one after another becomes the Z axis. It moves along a horizontal latitude line Ha that is centered and parallel to the XY axis.

ここで、演算部10において基準軸Zの方向が重力方向に向けられていることを認識していれば、水平緯度線Haが座標点データの移動軌跡であると認識でき、また水平緯度線HaとZ軸との交点を中心とする複数の座標点データDの開き角度と、サンプリング時間とから角速度を求めることが可能である。しかし、磁界検知装置1およびこの磁界検知装置1を搭載している携帯用機器に、自らの姿勢を検知する検知装置が搭載されていない場合には、磁気検知装置1の装置内の基準座標であるX−Y−Zの三次元座標がどの方向に向けられているのか認識できない。   Here, if the arithmetic unit 10 recognizes that the direction of the reference axis Z is directed in the direction of gravity, the horizontal latitude line Ha can be recognized as the movement locus of the coordinate point data, and the horizontal latitude line Ha. It is possible to obtain the angular velocity from the opening angle of a plurality of coordinate point data D centering on the intersection of the Z axis and the sampling time. However, when the magnetic field detection device 1 and the portable device in which the magnetic field detection device 1 is mounted are not equipped with a detection device that detects their posture, the reference coordinates in the magnetic detection device 1 are used. It cannot be recognized in which direction the three-dimensional coordinates of a certain XYZ are directed.

そこで、図2に示す演算部10では、次のソフトウエアを実行することで、磁気検知装置1を任意の軸を中心として回転させたときに、どの向きでどのような回転が行われているのかを演算できるようにしている。   Therefore, in the calculation unit 10 shown in FIG. 2, by executing the following software, when the magnetic detection device 1 is rotated about an arbitrary axis, what kind of rotation is performed in which direction. It is possible to calculate whether or not.

図6には、磁界検知装置1が、X−Y−Z以外の任意の軸S0を中心として回転しているときに得られた座標点データD1,D2,・・・,Dmが示されている。この座標点データが得られている時点では、軸S0がどの向きであるか特定されておらず、座標点データD1,D2,・・・,Dmが移動する円の軌跡も特定できていない。   FIG. 6 shows coordinate point data D1, D2,..., Dm obtained when the magnetic field detection device 1 is rotated around an arbitrary axis S0 other than XYZ. Yes. At the time when the coordinate point data is obtained, the orientation of the axis S0 is not specified, and the locus of the circle along which the coordinate point data D1, D2,.

そこで、図2に示す演算部10の移動平面計算部12では、複数の座標点データが移動していると推定される移動平面Pxが演算される。演算された移動平面Psと球面Gとの交線が、座標点データの移動軌跡として特定される。   Therefore, the movement plane calculation unit 12 of the calculation unit 10 shown in FIG. 2 calculates the movement plane Px estimated that a plurality of coordinate point data are moving. The calculated intersection line of the movement plane Ps and the spherical surface G is specified as the movement locus of the coordinate point data.

移動平面Pxを演算する方法の一例として、平面の一般式:ax+by+cz+d=0が使用される。前記一般式のa,b,cは、平面の法線ベクトルの成分{n→=(a,b,c)}である。複数の座標点データDi(xi,yi,zi)の成分(xi,yi,zi)を平面の一般式の(x,y,z)に代入して複数の平面の方程式を得て、最小二乗法により、それぞれの方程式との誤差が最も小さい平面を求め、その平面を移動平面Pxと推測する。   As an example of a method for calculating the movement plane Px, a general formula of a plane: ax + by + cz + d = 0 is used. In the general formula, a, b, and c are components of a normal vector of a plane {n → = (a, b, c)}. Substituting the components (xi, yi, zi) of the plurality of coordinate point data Di (xi, yi, zi) into (x, y, z) of the general formula of the plane, the equations of the plurality of planes are obtained. A plane having the smallest error from each equation is obtained by multiplication, and the plane is estimated as a moving plane Px.

図7に、データバッファ11に格納されている複数の座標点データDiが示されている。最も古い座標点データがDmであり、D6,D5,D4,・・・の順に新しい座標点データとしてデータバッファ11に格納されている。   FIG. 7 shows a plurality of coordinate point data Di stored in the data buffer 11. The oldest coordinate point data is Dm, and is stored in the data buffer 11 as new coordinate point data in the order of D6, D5, D4,.

データバッファ11に格納されている座標点データDiのうちの所定数のデータが第1の演算データ群として使用される。図7に示す例では、DmからD7までの複数の座標点データが第1の演算データ群N1−1として使用される。座標点データDmからD7までの(xm,ym,zm)・・・(x7,y7,z7)が、平面の一般式:ax+by+cz+d=0の(x,y,z)に代入されて複数の方程式が得られる。この方程式との誤差が最小となる平面が最小二乗法により求められ、求められた平面がその時点での移動平面P1として求められる。   A predetermined number of data among the coordinate point data Di stored in the data buffer 11 is used as the first calculation data group. In the example shown in FIG. 7, a plurality of coordinate point data from Dm to D7 is used as the first calculation data group N1-1. (Xm, ym, zm)... (X7, y7, z7) from the coordinate point data Dm to D7 is substituted into the general formula of the plane: ax + by + cz + d = 0 (x, y, z), and a plurality of equations Is obtained. The plane that minimizes the error from this equation is obtained by the least square method, and the obtained plane is obtained as the moving plane P1 at that time.

第1の演算データ群N1−1の座標点データDiの数をある程度多くしておくことで、外部ノイズなどによって、一時的に極端に変化した座標点データが含まれていても、その影響を小さくでき、座標点データDiが移動している平面に近い移動平面P1を求めることができる。   By increasing the number of coordinate point data Di of the first calculation data group N1-1 to some extent, even if coordinate point data that has temporarily changed extremely due to external noise or the like is included, the influence thereof is reduced. A moving plane P1 that can be reduced and is close to the plane on which the coordinate point data Di is moving can be obtained.

その後に、得られた複数の最新座標点データD6,D5,D4を最新データ群Na−1とする。図7では、説明を簡単にするために最新データ群Na−1に含まれる座標点データの数が「3」であるが、実際は、最新データ群Na−1に含まれる最新の座標点データDiの数はもっと多い。しかし、最新データ群Na−1に含まれる座標点データDiの数は、第1の演算データ群N1−1に含まれる座標点データDiの数よりも十分に少なく、例えば、最新データ群Na−1に含まれるデータ数は、第1の演算データ群N1−1に含まれるデータ数の1/5以下であり、好ましくは1/10以下である。   Thereafter, the plurality of latest coordinate point data D6, D5, and D4 obtained are set as the latest data group Na-1. In FIG. 7, the number of coordinate point data included in the latest data group Na-1 is “3” for the sake of simplicity, but in fact, the latest coordinate point data Di included in the latest data group Na-1. There are more. However, the number of coordinate point data Di included in the latest data group Na-1 is sufficiently smaller than the number of coordinate point data Di included in the first calculation data group N1-1. For example, the latest data group Na- The number of data included in 1 is 1/5 or less, preferably 1/10 or less, of the number of data included in the first calculation data group N1-1.

第1の演算データ群N1−1で移動平面P1が演算された後に、最新データ群Na−1に含まれる複数の座標点データDiの平均値、すなわちxの平均値とyの平均値およびzの平均値と、移動平面P1の方程式の(x,y,z)との誤差が求められる。または、最新データ群Na−1に含まれる複数の座標点データのそれぞれと移動平面P1との誤差が最小二乗法で求められる。   After the movement plane P1 is calculated in the first calculation data group N1-1, the average value of the plurality of coordinate point data Di included in the latest data group Na-1, that is, the average value of x and the average value of y and z And an error between (x, y, z) of the equation of the moving plane P1. Alternatively, an error between each of the plurality of coordinate point data included in the latest data group Na-1 and the movement plane P1 is obtained by the least square method.

最新データ群Na−1を複数の座標点データで構成し、前記のように平均値の計算や最小二乗法による計算を行うことで、その中にノイズなどの影響で極端に変化しているデータが含まれていても、最新データ群Na−1と移動平面P1とを比較するときに、極端に変化しているデータの影響を小さくすることができる。なお、最新データ群Na−1の中の極端に変化するデータを無視して、移動平面P1との比較を行ってもよい。   The latest data group Na-1 is composed of a plurality of coordinate point data, and the average value calculation or the least square method calculation is performed as described above. Even when the latest data group Na-1 and the movement plane P1 are compared, the influence of extremely changing data can be reduced. Note that data that changes extremely in the latest data group Na-1 may be ignored and the comparison with the movement plane P1 may be performed.

最新データ群Na−1とそのときの移動平面P1との誤差が、予め決められた値以下、あるいはその値未満のときは、移動平面計算部12において、座標点データDiが移動している軌跡が大きく変化していないと判断する。   When the error between the latest data group Na-1 and the moving plane P1 at that time is less than or equal to a predetermined value or less than the predetermined value, the moving plane calculation unit 12 moves the coordinate point data Di. Is determined to have not changed significantly.

このとき、最新データ群Na−1とそれまでに得られた複数の座標点データDiとを第1の演算データ群N1−2とし、平面の一般式と、第1の演算データ群N1−2に含まれた座標点データDiとの誤差を最小二乗法で演算し、その誤差が最も小さい平面を次の移動平面P2とする。第1の演算データ群N1−2に含まれる座標点データDiの数は、前回の演算に使用された第1の演算データ群N1−1に含まれる座標点データDiと同数である。   At this time, the latest data group Na-1 and a plurality of coordinate point data Di obtained so far are defined as a first calculation data group N1-2, a general formula of the plane, and the first calculation data group N1-2. Is calculated by the least square method, and the plane with the smallest error is set as the next moving plane P2. The number of coordinate point data Di included in the first calculation data group N1-2 is the same as the number of coordinate point data Di included in the first calculation data group N1-1 used in the previous calculation.

最新データ群Na−1に含まれる座標点データDiと、そのときの移動平面P1との誤差が小さいとき、最新データ群Na−1を含んだ多くのデータから成る第1の演算データ群N1−2に基づいて移動平面P2が演算されるため、移動平面P1と移動平面P2との変化をきわめて小さくでき、場合によっては、移動平面P1と次の移動平面P2とが同じ方程式となることもある。すなわち、一時的なノイズに影響を受けることなく、移動平面Pxを安定した平面として演算することが可能になる。   When the error between the coordinate point data Di included in the latest data group Na-1 and the moving plane P1 at that time is small, the first calculation data group N1- consisting of many data including the latest data group Na-1. Since the movement plane P2 is calculated based on 2, the change between the movement plane P1 and the movement plane P2 can be made extremely small. In some cases, the movement plane P1 and the next movement plane P2 may have the same equation. . That is, the movement plane Px can be calculated as a stable plane without being affected by temporary noise.

最新データ群Na−1とそのときの移動平面P1との誤差が、予め決められた値以上、あるいはその値を超えたときは、移動平面計算部12において、座標点データDiが移動している軌跡が大きく変化したと判断する。   When the error between the latest data group Na-1 and the moving plane P1 at that time is greater than or equal to a predetermined value or exceeds that value, the coordinate point data Di is moved in the moving plane calculation unit 12. Judge that the trajectory has changed significantly.

このときは、最新データ群Na−1を含む第2の演算データ群N2−1のそれぞれの座標点データDiの(Xi,yi,zi)を平面の一般式に代入した複数の方程式の誤差が最小となる平面を最小二乗法で求め、その平面を次の移動平面P3とする。第2の演算データ群N2−1に含まれる座標点データのデータ数は、第1の演算データ群N1−2に含まれる座標点データのデータ数よりも十分に少ない。例えば、第2の演算データ群N2−1に含まれるデータ数は、第1の演算データ数N1−2に含まれるデータ数の1/5以下であり、好ましくは1/10以下である。   At this time, errors of a plurality of equations obtained by substituting (Xi, yi, zi) of the respective coordinate point data Di of the second calculation data group N2-1 including the latest data group Na-1 into the general formula of the plane are The minimum plane is obtained by the method of least squares, and the plane is set as the next moving plane P3. The number of data of coordinate point data included in the second calculation data group N2-1 is sufficiently smaller than the number of data of coordinate point data included in the first calculation data group N1-2. For example, the number of data included in the second calculation data group N2-1 is 1/5 or less, preferably 1/10 or less, of the number of data included in the first calculation data number N1-2.

なお、第2の演算データ群N2−1は、最新データ群Na−1を構成する複数の座標点データのみで構成されてもよい。   Note that the second calculation data group N2-1 may be composed of only a plurality of coordinate point data constituting the latest data group Na-1.

最新データ群Na−1に含まれる座標点データDiと、そのときの移動平面P1との誤差が大きくなったときは、データ数の少ない第2の演算データ群N2−1に基づいて移動平面P3が演算されるため、実際の磁界検知装置1と地磁気ベクトルVとの相対的な運動軌跡が大きく変化したときに、これに追従して移動平面を更新することが可能になる。   When the error between the coordinate point data Di included in the latest data group Na-1 and the moving plane P1 at that time becomes large, the moving plane P3 is based on the second calculation data group N2-1 having a small number of data. Therefore, when the relative motion trajectory between the actual magnetic field detector 1 and the geomagnetic vector V changes greatly, it is possible to update the moving plane following this.

その後に得られた座標点データD3,D2,D1を含む所定数の最新データ群Na−2に含まれる座標点データの平均値と、そのときの移動平面P2またはP3との誤差が求められ、または最新データ群Na−2に含まれる複数の座標点データとそのときの移動平面P2またはP3との誤差が最小二乗法で求められる。その誤差が、予め決められている値以下またはその値未満なら、最新データ群Na−2を含む第1の演算データ群N1−3から移動平面が求められる。前記誤差が、予め決められている値以上またはその値を超えると、第2の演算データ群N2−2から移動平面が求められる。   Thereafter, an error between the average value of the coordinate point data included in the predetermined number of latest data groups Na-2 including the coordinate point data D3, D2, and D1 and the moving plane P2 or P3 at that time is obtained. Alternatively, an error between a plurality of coordinate point data included in the latest data group Na-2 and the moving plane P2 or P3 at that time is obtained by the least square method. If the error is less than or equal to a predetermined value or less than that value, a moving plane is obtained from the first calculation data group N1-3 including the latest data group Na-2. When the error is greater than or equal to a predetermined value or exceeds the value, a moving plane is obtained from the second calculation data group N2-2.

以上のように、移動平面計算部12において、座標点データDiが大きく変化していないときは、変化の少ない移動平面Pxまたはほとんど変化しない移動平面Pxが安定して求められ、座標点データDiが大きく変化したときは、その変化に追従するように新たな移動平面Pxが求められる。   As described above, when the coordinate plane data Di does not change significantly in the movement plane calculation unit 12, the movement plane Px with little change or the movement plane Px with little change is stably obtained, and the coordinate point data Di is obtained. When there is a large change, a new movement plane Px is obtained so as to follow the change.

図2に示す回転軸計算部13では、移動平面計算部12において演算された移動平面Pxと球面Gとの交線が求められる。この交線が座標点データDiの移動軌跡である。交線である円の中心と三次元座標の原点Oとの結ぶ線が回転軸S0として求められる。さらに、角速度計算部14において、移動平面Pxが求められているときに、複数の座標点データDiの回転軸S0を中心とした開き角度を、そのデータ間のサンプリング時間で微分して、角速度が求められる。   In the rotation axis calculation unit 13 illustrated in FIG. 2, an intersection line between the movement plane Px and the spherical surface G calculated by the movement plane calculation unit 12 is obtained. This intersection line is the movement locus of the coordinate point data Di. A line connecting the center of the circle, which is an intersection line, and the origin O of the three-dimensional coordinates is obtained as the rotation axis S0. Furthermore, when the moving plane Px is obtained in the angular velocity calculation unit 14, the angular velocity is obtained by differentiating the opening angle around the rotation axis S0 of the plurality of coordinate point data Di with the sampling time between the data. Desired.

本発明の磁界検知装置は、重力加速度などの姿勢検知手段を設けなくても、3軸の磁気センサのみで、三次元の回転運動を特定して角速度を算出できる。よって、携帯用のゲーム装置やゲーム装置の入力装置に使用することができる。またロボットの腕や関節などの姿勢の変化を検知する検知部として使用することもできる。   The magnetic field detection apparatus of the present invention can calculate an angular velocity by specifying a three-dimensional rotational motion using only a three-axis magnetic sensor without providing posture detection means such as gravitational acceleration. Therefore, it can be used for a portable game device or an input device of a game device. It can also be used as a detection unit that detects changes in posture of the robot's arms and joints.

さらに、本発明の磁界検知装置は、地磁気以外の外部磁界の磁気ベクトルの向きや動きを検知する装置として使用可能である。例えば磁気検知装置を固定し、外部の磁気ベクトルがどの方向からどのような運動で接近してきているかの検知も可能である。   Furthermore, the magnetic field detection device of the present invention can be used as a device for detecting the direction and movement of a magnetic vector of an external magnetic field other than geomagnetism. For example, it is possible to fix the magnetic detection device and detect the direction in which the external magnetic vector is approaching.

1 磁界検知装置
2 磁気検知部
3 X軸センサ
4 Y軸センサ
5 Z軸センサ
6 磁場データ検知部
7 メモリ
10 演算部
11 データバッファ
12 移動平面計算部
13 回転軸計算部
14 角速度計算部
15 主演算部
D1,・・・Dm 座標点データ
N1−1,N1−2 第1の演算データ群
N2−1,N2−2 第2の演算データ群
Na−1,Na−2 最新データ群
DESCRIPTION OF SYMBOLS 1 Magnetic field detection apparatus 2 Magnetic detection part 3 X-axis sensor 4 Y-axis sensor 5 Z-axis sensor 6 Magnetic field data detection part 7 Memory 10 Calculation part 11 Data buffer 12 Moving plane calculation part 13 Rotation axis calculation part 14 Angular velocity calculation part 15 Main calculation Part D1,... Dm Coordinate point data N1-1, N1-2 First calculation data group N2-1, N2-2 Second calculation data group Na-1, Na-2 Latest data group

Claims (8)

互いに直交するX方向とY方向およびZ方向が基準方向として決められた磁気検知部と、演算部とを有し、
前記磁気検知部が、X軸の磁気成分を検知するX軸磁気センサと、Y軸の磁気成分を検知するY軸磁気センサと、Z軸の磁気成分を検知するZ軸磁気センサとを有し、
前記演算部で、前記X軸磁気センサと前記Y軸磁気センサおよび前記Z軸磁気センサの検知出力に基づいて、磁気ベクトルの向きが三次元座標上の座標点データとして求められ、複数の座標点データとの誤差が最も小さい平面が座標点データが移動している移動平面として演算され、
少なくとも1つの最新の座標点データを含む最新データ群とそのときの移動平面との誤差が、予め決められた値以下またはその値未満のときは、前記最新データ群とそれ以前に得られた複数の座標点データを含む所定数の第1の演算データ群から次の移動平面が演算され、前記最新データ群とそのときの移動平面との誤差が、予め決められた値以上またはその値を超えたときは、前記最新データ群を含み前記第1の演算データ群よりもデータ数が少ない第2の演算データ群から次の移動平面が求められることを特徴とする磁界検知装置。
A magnetic detection unit in which the X direction, the Y direction, and the Z direction orthogonal to each other are determined as reference directions, and a calculation unit;
The magnetic detection unit includes an X-axis magnetic sensor that detects an X-axis magnetic component, a Y-axis magnetic sensor that detects a Y-axis magnetic component, and a Z-axis magnetic sensor that detects a Z-axis magnetic component. ,
Based on the detection outputs of the X-axis magnetic sensor, the Y-axis magnetic sensor, and the Z-axis magnetic sensor, the arithmetic unit obtains the direction of the magnetic vector as coordinate point data on three-dimensional coordinates, and a plurality of coordinate points The plane with the smallest error from the data is calculated as the moving plane where the coordinate point data is moving,
When an error between the latest data group including at least one latest coordinate point data and the moving plane at that time is equal to or less than a predetermined value or less than the predetermined value, the latest data group and a plurality of data obtained before that The next movement plane is calculated from a predetermined number of first calculation data groups including the coordinate point data, and an error between the latest data group and the movement plane at that time is greater than or equal to a predetermined value or exceeds that value. The next moving plane is obtained from a second calculation data group including the latest data group and having a smaller number of data than the first calculation data group.
三次元座標上で、前記座標点データが現れる球面と、前記移動平面との交線から、座標点データの移動軌跡が求められる請求項1記載の磁界検知装置。   The magnetic field detection apparatus according to claim 1, wherein a movement locus of the coordinate point data is obtained from an intersection line between a spherical surface where the coordinate point data appears on the three-dimensional coordinates and the movement plane. 前記移動軌跡から磁気検知部の角加速度が求められる請求項2記載の磁界検知装置。   The magnetic field detection apparatus according to claim 2, wherein an angular acceleration of a magnetic detection unit is obtained from the movement locus. 前記最新データ群は、最新の座標点データを含む複数の座標点データで構成されており、最新データ群に含まれる複数の座標点データの平均値と、そのときの移動平面との誤差が、予め決められた値と比較される請求項1ないし3のいずれかに記載の磁界検知装置。   The latest data group is composed of a plurality of coordinate point data including the latest coordinate point data, and an error between the average value of the plurality of coordinate point data included in the latest data group and the moving plane at that time, 4. The magnetic field detection device according to claim 1, wherein the magnetic field detection device is compared with a predetermined value. 第2の演算データ群は、最新データ群のみから構成される請求項1ないし4のいずれかに記載の磁界検知装置。   The magnetic field detection apparatus according to any one of claims 1 to 4, wherein the second calculation data group includes only the latest data group. 第2の演算データ群は、最新のデータ群と、それ以前に得られた少なくとも1つの座標点データとから構成される請求項1ないし4のいずれかに記載の磁界検知装置。   5. The magnetic field detection device according to claim 1, wherein the second calculation data group includes a latest data group and at least one coordinate point data obtained before that. 三次元座標上での平面の一般式と、第1の演算データ群に含まれる複数の座標点データとの誤差が最小二乗法で演算され、その誤差が最も小さい平面が移動平面として求められる請求項1ないし6のいずれかに記載の磁界検知装置。   An error between a general formula of a plane on three-dimensional coordinates and a plurality of coordinate point data included in the first calculation data group is calculated by a least square method, and a plane having the smallest error is obtained as a moving plane. Item 7. The magnetic field detection device according to any one of Items 1 to 6. 三次元座標上での平面の一般式と、第2の演算データ群に含まれる複数の座標点データとの誤差が最小二乗法で演算され、その誤差が最も小さい平面が移動平面として求められる請求項1ないし7のいずれかに記載の磁界検知装置。   An error between a general expression of a plane on three-dimensional coordinates and a plurality of coordinate point data included in the second calculation data group is calculated by a least square method, and a plane having the smallest error is obtained as a moving plane. Item 8. The magnetic field detection device according to any one of Items 1 to 7.
JP2010233979A 2010-10-18 2010-10-18 Magnetic field detector Active JP5341861B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2010233979A JP5341861B2 (en) 2010-10-18 2010-10-18 Magnetic field detector

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010233979A JP5341861B2 (en) 2010-10-18 2010-10-18 Magnetic field detector

Publications (2)

Publication Number Publication Date
JP2012088124A JP2012088124A (en) 2012-05-10
JP5341861B2 true JP5341861B2 (en) 2013-11-13

Family

ID=46259898

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010233979A Active JP5341861B2 (en) 2010-10-18 2010-10-18 Magnetic field detector

Country Status (1)

Country Link
JP (1) JP5341861B2 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5571027B2 (en) * 2011-03-30 2014-08-13 Kddi株式会社 Portable device, program and method for correcting gravity vector used for autonomous positioning
JP6908067B2 (en) * 2019-03-18 2021-07-21 Tdk株式会社 Signal processing circuits, position detectors and magnetic sensor systems

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE602004032141D1 (en) * 2003-07-03 2011-05-19 Asahi Kasei Emd Corp
JP4638670B2 (en) * 2003-12-26 2011-02-23 旭化成エレクトロニクス株式会社 Azimuth angle measuring method and azimuth angle measuring apparatus
JP4311447B2 (en) * 2004-07-23 2009-08-12 ヤマハ株式会社 Azimuth processing device, azimuth processing method, azimuth processing program, azimuth measurement device, tilt offset correction method, azimuth measurement method, azimuth sensor unit, and portable electronic device
JP4252555B2 (en) * 2005-04-25 2009-04-08 アルプス電気株式会社 Tilt sensor and azimuth measuring device using the same
JPWO2007099599A1 (en) * 2006-02-28 2009-07-16 アイチ・マイクロ・インテリジェント株式会社 Magnetic gyro
JP2008224642A (en) * 2007-03-09 2008-09-25 Aichi Micro Intelligent Corp Magnetic gyro
JP4890660B2 (en) * 2009-03-10 2012-03-07 アルプス電気株式会社 Geomagnetic detector

Also Published As

Publication number Publication date
JP2012088124A (en) 2012-05-10

Similar Documents

Publication Publication Date Title
JP4890660B2 (en) Geomagnetic detector
JP5469670B2 (en) Geomagnetic detector
JP5076027B2 (en) Geomagnetic detector
Hu et al. A robust orientation estimation algorithm using MARG sensors
JP6474128B2 (en) Electronic equipment with geomagnetic and acceleration sensors
Xu et al. A robust incremental-quaternion-based angle and axis estimation algorithm of a single-axis rotation using MARG sensors
JP5425671B2 (en) Magnetic field detector
JP5341861B2 (en) Magnetic field detector
JP5374422B2 (en) Magnetic field detector
JP5144701B2 (en) Magnetic field detector
JP5498209B2 (en) Magnetic field detector
JP5475873B2 (en) Geomagnetic detector
JP5457890B2 (en) Orientation detection device
Kao et al. Design and analysis of an orientation estimation system using coplanar gyro-free inertial measurement unit and magnetic sensors
JP5498208B2 (en) Magnetic field detector
JP5498196B2 (en) Magnetic field detector
JP5490576B2 (en) Magnetic field detector
JP2011169656A (en) Device for detection of magnetic field
JP2011185861A (en) Geomagnetism detector
JP4648423B2 (en) Rotation angle measurement device and rotation angle measurement method
Wang et al. Extrinsic calibration of visual and inertial sensors for the autonomous vehicle
Včelák et al. Influence of sensor imperfections to electronic compass attitude accuracy
Goryanina et al. Stochastic approach to reducing calibration errors of MEMS orientation sensors
JP5643547B2 (en) Magnetic detector
KR20170092356A (en) System for calibrating azimuth of 3-axis magnetic sensor

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20130311

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20130730

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20130731

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130808

R150 Certificate of patent or registration of utility model

Ref document number: 5341861

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350