JP5033526B2 - Physical quantity measuring apparatus and physical quantity measuring method - Google Patents
Physical quantity measuring apparatus and physical quantity measuring method Download PDFInfo
- Publication number
- JP5033526B2 JP5033526B2 JP2007189999A JP2007189999A JP5033526B2 JP 5033526 B2 JP5033526 B2 JP 5033526B2 JP 2007189999 A JP2007189999 A JP 2007189999A JP 2007189999 A JP2007189999 A JP 2007189999A JP 5033526 B2 JP5033526 B2 JP 5033526B2
- Authority
- JP
- Japan
- Prior art keywords
- data
- physical quantity
- offset
- detection sensitivity
- axis
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Indication And Recording Devices For Special Purposes And Tariff Metering Devices (AREA)
Description
本発明は、物理量計測装置及び物理量計測方法に関し、より詳細には、2種類以上の3次元ベクトル物理量を計測する計測手段による計測結果に基づいてオフセットと検出感度の算出を行うようにした物理量計測装置及び物理量計測方法に関するものである。 The present invention relates to a physical quantity measuring apparatus and a physical quantity measuring method, and more specifically, physical quantity measurement in which offset and detection sensitivity are calculated based on measurement results obtained by a measuring unit that measures two or more types of three-dimensional vector physical quantities. The present invention relates to an apparatus and a physical quantity measurement method.
従来から磁気センサの感度を補正するには、例えば、特許文献1のものが提案されている。この特許文献1のものは、3軸磁気センサの向きが3次元空間において変化した時の3軸出力を所定回数以上繰り返して取得し、直交座標系(x,y,z)上に、各主軸が直交座標系の各座標軸に平行な楕円面を定め、繰り返し取得した測定データを直交座標系上に配置し、配置した各測定点と楕円面との距離が最小となるように、感度補正係数αx,αy,αz及び楕円面の中心座標であるオフセットCrx,Cry,Crzを統計的手法によって算出するようにしたものである。
In order to correct the sensitivity of a magnetic sensor, for example, the one disclosed in
このように、従来から、3軸ベクトルの計測装置については、上述した特許文献1に見られるように、最適化手法又は統計的手法によるオフセットと検出感度の算出方法することが知られている。この算出方法は、算出に係る測定が簡単なこと、また任意の時点で利用できること、の2点が大きな特徴である。これらの特徴によって、計測装置の製造時ではなく実動作時に算出が可能になり、その結果、製造時の検査コストの低減や不揮発性メモリの不要化といった効果が期待できる。
As described above, conventionally, with respect to a three-axis vector measuring apparatus, it is known to calculate an offset and a detection sensitivity by an optimization method or a statistical method, as can be seen in
しかしながら、上述した特許文献1に示される従来の方法は、3軸ベクトルを計測する計測装置が1種類しかない機器においては非常に有用な方法である。また、仮に2種類以上の3軸ベクトル計測装置があった機器であっても、それらの計測装置がお互いにまったく独立であるとみなせば、上述した特許文献1に示される従来の方法をそれに応じた3軸ベクトル計測装置の種類の数だけ繰り返して行えばよい。
However, the conventional method disclosed in
ところで、上述した特許文献1に示される従来の方法は、オフセット及び検出感度の算出を行う時点において、大きさが0でなく、なおかつその算出過程中には変化しない3軸ベクトル物理量の存在することが不可欠である。また、上述した特許文献1にならって磁場を計測する装置について具体的に言えば、例えば、地磁気のように大きさが0ではなく、なおかつ外乱等による磁場の時間的変化のないような磁場ベクトルの存在が不可欠である。
By the way, in the conventional method shown in
したがって、上述したように、2種類以上の3次元ベクトルを計測する計測装置がある機器においては、2種類以上の大きさが0でなく、時間的変化もない3次元ベクトル物理量が存在する場合がある。そして、それらの3次元ベクトル物理量のなす角度は、計測装置の状態(姿勢、方向、向き等)にかかわらず一定である。 Therefore, as described above, in a device having a measuring device that measures two or more types of three-dimensional vectors, there are cases where two or more types of magnitudes are not zero and there are three-dimensional vector physical quantities that have no temporal change. is there. The angle formed by these three-dimensional vector physical quantities is constant regardless of the state of the measuring device (posture, direction, orientation, etc.).
そこで、2種類以上の3次元ベクトル物理量計測装置に対して、2種類以上の3次元ベクトル物理量のうち、任意の異なる2種類の3次元ベクトル物理量が一定であれば必然的にそれらのベクトルのなす角度も一定になるという特徴を利用して、任意の異なる2種類の3次元ベクトル物理量に対してこれらのベクトルのなす角度を表す所定の関数値のばらつきが最小となるように、3次元ベクトル物理量の計測データに基づいて3軸センサのオフセット及び検出感度を、最適化手法又は統計的手法によって求める手段を提供することが望まれている。 Therefore, for two or more types of three-dimensional vector physical quantity measuring devices, if two different types of three-dimensional vector physical quantities out of two or more types of three-dimensional vector physical quantities are constant, they are inevitably formed. Using the feature that the angle is also constant, the three-dimensional vector physical quantity is such that the variation of a predetermined function value representing the angle formed by these vectors with respect to any two different kinds of three-dimensional vector physical quantities is minimized. It is desired to provide means for obtaining the offset and detection sensitivity of the three-axis sensor based on the measurement data by an optimization method or a statistical method.
さて、3次元ベクトル物理量の計測装置として加速度を計測する装置について検討すると、地球上では重力が存在しているので大きさが0になることはない。だが、重力加速度のような静的な加速度とともに、例えば、振動運動のような動的な加速度も一緒に検出してしまう。したがって、変化のない3次元ベクトルという条件は容易には満足されない。逆に、地磁気に関してみるとこの条件は比較的容易に満足するため、磁場計測に関しては、上述した特許文献1のように単独での算出方法が非常に有意義である。
Considering an apparatus for measuring acceleration as a three-dimensional vector physical quantity measuring apparatus, the magnitude does not become zero because gravity exists on the earth. However, a static acceleration such as gravitational acceleration is detected together with a dynamic acceleration such as a vibration motion. Therefore, the condition of a three-dimensional vector without change is not easily satisfied. On the contrary, since this condition is relatively easily satisfied in terms of geomagnetism, a single calculation method as described in
つまり、3次元ベクトル物理量の計測装置が2種類以上ある機器においては、上述した特許文献1を適用して算出を行う場合には、各々の装置に対して算出の難易度に差のあることが一般的であると言える。
That is, in a device having two or more types of three-dimensional vector physical quantity measurement devices, when calculation is performed by applying
そこで、比較的算出の容易な3次元ベクトル物理量の算出結果を適用することによって、別の比較的算出の困難な3次元ベクトル物理量の計測データに基づいて3軸センサのオフセットと検出感度を算出する手段を提供することが望まれている。 Therefore, by applying the calculation result of the three-dimensional vector physical quantity that is relatively easy to calculate, the offset and detection sensitivity of the three-axis sensor are calculated based on the measurement data of another relatively difficult three-dimensional vector physical quantity. It would be desirable to provide a means.
さらに、3次元ベクトル物理量において、絶対値(大きさ)には時間的変化があるが、向きに時間的変化がない場合であってもまったく同様の論旨が適用できることは明らかである。すなわち、上述したような場合でも、2種類の3次元ベクトル物理量のなす角度はやはり一定である。この場合でも3次元ベクトル物理量の計測データに基づいて3軸センサのオフセットと検出感度を、任意の異なる2種類の3次元ベクトル物理量に対してこれらのベクトルのなす角度を表す所定の関数値のばらつきが最小となるように、最適化手法又は統計的手法によって求める手段が望まれている。 Further, in the three-dimensional vector physical quantity, the absolute value (magnitude) has a temporal change, but it is clear that the same argument can be applied even when the direction has no temporal change. That is, even in the case described above, the angle formed by the two types of three-dimensional vector physical quantities is still constant. Even in this case, the offset and detection sensitivity of the three-axis sensor are based on the measurement data of the three-dimensional vector physical quantity, and the variation of a predetermined function value representing the angle formed by these vectors with respect to any two different three-dimensional vector physical quantities Therefore, a means for obtaining by the optimization method or the statistical method is desired.
本発明は、このような問題に鑑みてなされたもので、その目的とするところは、2種類以上の3次元ベクトル物理量を計測する計測手段の計測結果に基づいてオフセットと検出感度の算出を行うようにした物理量計測装置及び物理量計測方法を提供することにある。 The present invention has been made in view of such problems, and an object of the present invention is to calculate an offset and a detection sensitivity based on a measurement result of a measurement unit that measures two or more types of three-dimensional vector physical quantities. An object of the present invention is to provide a physical quantity measuring device and a physical quantity measuring method.
本発明は、このような目的を達成するためになされたもので、請求項1に記載の発明は、第1の3次元ベクトル物理量を計測して第1のデータを出力する第1の3軸計測手段(1)と、前記第1の3次元ベクトル物理量とは異なる第2の3次元ベクトル物理量を計測して第2のデータを出力する第2の3軸計測手段(2)とを備えた物理量計測装置において、前記第1及び第2の3軸計測手段から出力される第1及び第2のデータを所定回数以上繰り返し取得するデータ取得手段(3)と、該データ取得手段によって取得されたデータが適当であるか否かを判断して該データを選択するデータ選択手段(4)と、該データ選択手段によって選択されたデータを蓄積するデータ蓄積手段(5)と、該データ蓄積手段で蓄積されたデータに対して、前記第1及び第2の3次元ベクトル物理量のなす角度を表す所定の関数値のばらつきが最小になるように、前記第1及び第2の3軸計測手段の少なくともいずれかのオフセットと検出感度を算出するオフセット・検出感度算出手段(6)とを備えたことを特徴とする。(図1に対応)
The present invention has been made to achieve such an object. The invention according to
また、請求項2に記載の発明は、請求項1に記載の発明において、前記第1及び第2の3軸計測手段の一方が、重力加速度ベクトル物理量を計測する3軸加速度センサ(1)であり、他方の3軸計測手段が、地磁気ベクトル物理量を計測する3軸磁気センサ(2)であって、前記オフセット・検出感度算出手段(6)が、前記データ蓄積手段(5)で蓄積されたデータに対して、前記重力加速度ベクトルと前記地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、前記3軸加速度センサ(1)のオフセットと検出感度、及び前記3軸磁気センサ(2)のオフセットと検出感度の少なくともいずれかを算出することを特徴とする。(図1に対応)
The invention according to
また、請求項3に記載の発明は、請求項1に記載の発明において、前記オフセット・検出感度算出手段(6)が、前記第1又は第2の3次元ベクトル物理量の大きさ又は絶対値が変化した場合でも、前記第1及び第2の3次元ベクトル物理量のなす角度を表す所定の関数値のばらつきが最小になるように、前記第1及び第2の3軸計測手段(1,2)の少なくともいずれかのオフセットと検出感度を算出することを特徴とする。(図1に対応)
また、請求項4に記載の発明は、請求項2に記載の発明において、前記オフセット・検出感度算出手段(6)が、前記重力加速度ベクトルが同一方向に対して振動している場合でも、前記重力加速度ベクトル及び地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、前記3軸加速度センサ(1)のオフセットと検出感度、及び前記3軸磁気センサ(2)のオフセットと検出感度の少なくともいずれかを算出することを特徴とする。(図1に対応)
The invention according to claim 3 is the invention according to
According to a fourth aspect of the present invention, in the invention of the second aspect, the offset / detection sensitivity calculating means (6) is configured such that the gravitational acceleration vector vibrates in the same direction. The offset and detection sensitivity of the three-axis acceleration sensor (1) and the offset of the three-axis magnetic sensor (2) are set so that the variation of a predetermined function value representing the angle formed by the gravitational acceleration vector and the geomagnetic vector is minimized. It is characterized in that at least one of the detection sensitivities is calculated. (Corresponding to Fig. 1)
また、請求項5に記載の発明は、第1の3次元ベクトル物理量を計測して第1のデータを出力する第1の3軸計測手段(1)と、前記第1の3次元ベクトル物理量とは異なる第2の3次元ベクトル物理量を計測して第2のデータを出力する第2の3軸計測手段(2)とを備えた物理量計測装置において、前記第1の3軸計測手段から出力されるデータを所定回数以上繰り返し取得するデータ取得手段(3)と、該データ取得手段によって取得されたデータが適当であるか否かを判断して該データを選択するデータ選択手段(4)と、該データ選択手段によって選択されたデータを蓄積するデータ蓄積手段(5)と、前記第2の3軸計測手段(2)から出力されるデータのオフセットと検出感度を算出する第1のオフセット・検出感度算出手段(8)と、前記第1のオフセット・検出感度算出手段で算出された前記第2の3軸計測手段のオフセットと検出感度に基づいて、前記第2の3軸計測手段から出力されたデータを前記第2の3次元ベクトル物理量に変換するデータ/物理量変換手段(9)と、該データ蓄積手段(5)で蓄積されたデータに対して、前記第1の3次元ベクトル物理量と前記データ/物理量変換手段で変換された前記第2の3次元ベクトル物理量とのなす角度を表す所定の関数値のばらつきが最小になるように、前記第1の3軸計測手段のオフセットと検出感度を算出する第2のオフセット・検出感度算出手段(6a)とを備えたことを特徴とする。(図5に対応)
The invention according to
また、請求項6に記載の発明は、請求項5に記載の発明において、前記第1及び第2の3軸計測手段の一方が、重力加速度ベクトル物理量を計測する3軸加速度センサ(1)であり、他方の3軸計測手段が、地磁気ベクトル物理量を計測する3軸磁気センサ(2)であって、前記第1の3軸計測手段の前記第2のオフセット・検出感度算出手段(6a)が、前記データ蓄積手段(5)で蓄積されたデータに対して、前記重力加速度ベクトルと前記地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、前記第1の3軸計測手段のオフセットと検出感度を算出することを特徴とする。(図5に対応)
The invention according to
また、請求項7に記載の発明は、請求項5に記載の発明において、前記第2の3軸計測手段から出力されたデータを所定回数以上繰り返して取得する第2のデータ取得手段(10)と、該第2のデータ取得手段によって繰り返し取得されたデータが適当であるか否かを判断して選択する第2のデータ選択手段(11)と、該第2のデータ選択手段によって選択されたデータを蓄積する第2のデータ蓄積手段(12)とを設け、前記第2の3軸計測手段のデータのオフセットと検出感度を算出する前記第1のオフセット・検出感度算出手段(8)が、前記第2のデータ蓄積手段(12)で蓄積されたデータに対して、前記第2の3軸ベクトル物理量が一定であることを適用した最適化手法又は統計的手法によって、前記第2の3軸ベクトル物理量のデータに基づいて前記第2の3軸計測手段のオフセットと検出感度を算出することを特徴とする。(図6に対応)
The invention according to claim 7 is the second data acquisition means (10) according to the invention of
また、請求項8に記載の発明は、請求項5又は7に記載の発明において、前記第2のオフセット・検出感度算出手段(6a)が、前記第1の3次元ベクトル物理量の大きさ又は絶対値が変化した場合でも、前記第1及び第2の3次元ベクトル物理量のなす角度を表す所定の関数値のばらつきが最小になるように、前記第1の3軸計測手段(1)のオフセットと検出感度を算出することを特徴とする。(図5,図6に対応)
The invention according to
また、請求項9に記載の発明は、請求項6に記載の発明において、前記地磁気ベクトルのオフセット・検出感度算出手段(6a)が、前記重力加速度ベクトルが同一方向に対して振動している場合でも、前記重力加速度ベクトル及び地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、前記3軸加速度センサのオフセットと検出感度の少なくともいずれかを算出することを特徴とする。(図5に対応)
The invention according to claim 9 is the invention according to
また、請求項10に記載の発明は、第1の3軸ベクトル物理量を計測する第1の3軸計測手段(1)と、前記第1の3軸ベクトル物理量とは異なる第2の3軸ベクトル物理量を計測する第2の3軸計測手段(2)とにより計測する計測ステップを有する物理量計測方法において、前記計測ステップによって計測された前記第1及び第2の3軸ベクトル物理量のデータを所定回数以上繰り返し取得するデータ取得ステップと、該データ取得ステップによって取得された前記3軸ベクトル物理量のデータが適当であるか否かを判断して該データを選択するデータ選択ステップと、該データ選択ステップによって選択されたデータを蓄積するデータ蓄積ステップと、該データ蓄積ステップで蓄積されたデータに対して、前記第1及び第2の3軸ベクトル物理量のなす角度を表す所定の関数値のばらつきが最小になるように、前記第1及び第2の3軸計測手段の少なくともいずれかのオフセットと検出感度を算出するオフセット・検出感度算出ステップとを有することを特徴とする。(図4に対応)
The invention described in
また、請求項11に記載の発明は、請求項10に記載の発明において、前記第1及び第2の3軸計測手段の一方が、重力加速度ベクトル物理量を計測する3軸加速度センサであり、他方の3軸計測手段が、地磁気ベクトル物理量を計測する3軸磁気センサであって、前記オフセット・検出感度算出ステップが、前記データ蓄積ステップで蓄積されたデータに対して、前記重力加速度ベクトルと前記地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、前記3軸加速度センサのオフセットと検出感度、及び前記3軸磁気センサのオフセットと検出感度の少なくともいずれかを算出することを特徴とする。(図4に対応)
The invention according to claim 11 is the invention according to
また、請求項12に記載の発明は、請求項10に記載の発明において、前記オフセット・検出感度算出ステップが、前記3次元ベクトル物理量の大きさ又は絶対値が変化した場合でも、前記3次元ベクトル物理量のなす角度を表す所定の関数値のばらつきが最小になるように、前記第1及び第2の3軸計測手段の少なくともいずれかのオフセットと検出感度を算出することを特徴とする。
The invention according to
また、請求項13に記載の発明は、請求項11に記載の発明において、前記オフセット・検出感度算出ステップが、前記重力加速度ベクトルが同一方向に対して振動している場合でも、前記重力加速度ベクトル及び地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、前記3軸加速度センサのオフセットと検出感度、及び前記3軸磁気センサのオフセットと検出感度の少なくともいずれかを算出することを特徴とする。 The invention according to claim 13 is the gravitational acceleration vector according to claim 11, wherein the offset / detection sensitivity calculating step is performed even when the gravity acceleration vector vibrates in the same direction. And at least one of the offset and detection sensitivity of the three-axis acceleration sensor and the offset and detection sensitivity of the three-axis magnetic sensor so that the variation of a predetermined function value representing the angle formed by the geomagnetic vector is minimized. It is characterized by that.
また、請求項14に記載の発明は、第1の3次元ベクトル物理量を計測して第1のデータを出力する第1の3軸計測手段(1)と、前記第1の3次元ベクトル物理量とは異なる第2の3次元ベクトル物理量を計測して第2のデータを出力する第2の3軸計測手段(2)とにより計測する計測ステップを有する物理量計測方法において、前記計測ステップによって計測された前記第1及び第2のデータを所定回数以上繰り返し取得するデータ取得ステップと、該データ取得ステップによって取得された前記データが適当であるか否かを判断して該データを選択するデータ選択ステップと、該データ選択ステップによって選択されたデータを蓄積するデータ蓄積ステップと、前記第2の3軸計測手段(2)から出力されるデータのオフセットと検出感度を求める第1のオフセット・検出感度算出ステップと、該第1のオフセット・検出感度算出ステップで算出されたオフセット及び検出感度に基づいて、前記第2の3軸計測手段から出力されたデータを前記第1の3次元物理量に変換するデータ/物理量変換ステップと、前記データ蓄積ステップで蓄積されたデータに対して、前記第1の3次元ベクトル物理量と前記データ/物理量変換ステップで変換された前記第2の3次元ベクトル物理量とのなす角度を表す所定の関数値のばらつきが最小になるように、前記第1の3軸計測手段のオフセットと検出感度を算出する第2のオフセット・検出感度算出ステップとを有することを特徴とする。 The invention described in claim 14 is a first three-axis measuring means (1) for measuring a first three-dimensional vector physical quantity and outputting first data; and the first three-dimensional vector physical quantity; In the physical quantity measuring method having a measuring step of measuring different second three-dimensional vector physical quantity and measuring by a second three-axis measuring means (2) for outputting second data, the physical quantity is measured by the measuring step. A data acquisition step of repeatedly acquiring the first and second data a predetermined number of times or more, and a data selection step of selecting whether the data acquired by the data acquisition step is appropriate or not A data accumulation step for accumulating the data selected in the data selection step, and an offset and detection of the data output from the second three-axis measuring means (2). Based on the first offset / detection sensitivity calculation step for obtaining the sensitivity and the offset and detection sensitivity calculated in the first offset / detection sensitivity calculation step, the data output from the second three-axis measuring means is obtained. The data / physical quantity conversion step for converting to the first three-dimensional physical quantity, and the data stored in the data storage step are converted in the first three-dimensional vector physical quantity and the data / physical quantity conversion step. Second offset / detection sensitivity calculation for calculating the offset and detection sensitivity of the first three-axis measuring means so that the variation of a predetermined function value representing the angle formed with the second three-dimensional vector physical quantity is minimized. And a step.
また、請求項15に記載の発明は、請求項14に記載の発明において、前記第1及び第2の3軸計測手段の一方が、重力加速度ベクトル物理量を計測する3軸加速度センサであり、他方の3軸計測手段が、地磁気ベクトル物理量を計測する3軸磁気センサであって、前記第1の3軸計測手段の前記第2のオフセット・検出感度算出ステップが、前記データ蓄積ステップで蓄積されたデータに対して、前記重力加速度ベクトルと前記地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、前記第1の3軸計測手段のオフセットと検出感度を算出することを特徴とする。 The invention according to claim 15 is the invention according to claim 14, wherein one of the first and second triaxial measuring means is a triaxial acceleration sensor for measuring a gravitational acceleration vector physical quantity, The three-axis measuring means is a three-axis magnetic sensor for measuring a geomagnetic vector physical quantity, and the second offset / detection sensitivity calculating step of the first three-axis measuring means is accumulated in the data accumulating step. The offset and detection sensitivity of the first three-axis measuring means are calculated so that variation of a predetermined function value representing an angle formed by the gravitational acceleration vector and the geomagnetic vector is minimized with respect to data. And
また、請求項16に記載の発明は、請求項14に記載の発明において、前記第2の3軸ベクトル物理量の計測データを所定回数以上繰り返して取得する第2のデータ取得ステップと、該第2のデータ取得ステップによって繰り返し取得された前記第2の3軸ベクトル物理量のデータが適当であるか否かを判断して選択する第2のデータ選択ステップと、該第2のデータ選択ステップによって選択されたデータを蓄積する第2のデータ蓄積ステップとをさらに有し、前記第2の3軸計測手段のデータのオフセットと検出感度を算出する前記第1のオフセット・検出感度算出ステップが、前記第2のデータ蓄積ステップで蓄積されたデータに対して、前記第2の3軸ベクトル物理量が一定であることを適用した最適化手法又は統計的手法によって、前記第2の3軸ベクトル物理量のデータに基づいて前記第2の3軸計測手段のオフセットと検出感度を算出することを特徴とする。 The invention according to claim 16 is the invention according to claim 14, wherein the second data acquisition step of repeatedly acquiring the measurement data of the second three-axis vector physical quantity a predetermined number of times or more, A second data selection step for determining whether or not the data of the second three-axis vector physical quantity repeatedly acquired by the data acquisition step is appropriate, and the second data selection step. A second data accumulation step for accumulating the data, and the first offset / detection sensitivity calculation step for calculating the data offset and detection sensitivity of the second three-axis measuring means includes the second data storage step. For the data accumulated in the data accumulation step, the optimization method or statistical method applying that the second three-axis vector physical quantity is constant And calculating the offset and sensitivity of the second three-axis measurement means based on the data of the second three-axis vector physical quantity.
また、請求項17に記載の発明は、請求項14又は16に記載の発明において、前記第2のオフセット・検出感度算出ステップが、前記第1の3次元ベクトル物理量の大きさ又は絶対値が変化した場合でも、前記第1及び第2の3次元ベクトル物理量のなす角度を表す所定の関数値のばらつきが最小になるように、前記第1の3軸計測手段のオフセットと検出感度を算出することを特徴とする。 Further, in the invention described in claim 17, in the invention described in claim 14 or 16, the second offset / detection sensitivity calculation step changes the magnitude or absolute value of the first three-dimensional vector physical quantity. Even in this case, the offset and detection sensitivity of the first three-axis measuring means are calculated so that the variation of the predetermined function value representing the angle formed by the first and second three-dimensional vector physical quantities is minimized. It is characterized by.
また、請求項18に記載の発明は、請求項15に記載の発明において、前記地磁気ベクトルのオフセット・検出感度算出ステップが、前記重力加速度ベクトルが同一方向に対して振動している場合でも、前記重力加速度ベクトル及び地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、前記3軸加速度センサのオフセットと検出感度の少なくともいずれかを算出することを特徴とする。 The invention according to claim 18 is the invention according to claim 15, wherein the step of calculating offset / detection sensitivity of the geomagnetic vector is performed even when the gravity acceleration vector vibrates in the same direction. It is characterized in that at least one of the offset and the detection sensitivity of the three-axis acceleration sensor is calculated so that a variation in a predetermined function value representing an angle formed by the gravitational acceleration vector and the geomagnetic vector is minimized.
本発明によれば、第1の3次元ベクトル物理量を計測して第1のデータを出力する第1の3軸計測手段と、第1の3次元ベクトル物理量とは異なる第2の3次元ベクトル物理量を計測して第2のデータを出力する第2の3軸計測手段とを備えた物理量計測装置において、第1及び第2の3軸計測手段から出力される第1及び第2のデータを所定回数以上繰り返し取得するデータ取得手段と、このデータ取得手段によって取得されたデータが適当であるか否かを判断して該データを選択するデータ選択手段と、このデータ選択手段によって選択されたデータを蓄積するデータ蓄積手段と、このデータ蓄積手段で蓄積されたデータに対して、第1及び第2の3次元ベクトル物理量のなす角度を表す所定の関数値のばらつきが最小になるように、第1及び第2の3軸計測手段の少なくともいずれかのオフセットと検出感度を算出するオフセット・検出感度算出手段とを備えたので、これまでの1種類の3次元ベクトル物理量の計測データに基づいて3軸センサのオフセットと検出感度を求める手段とは独立した手段であり、したがって、本発明のみによって3軸ベクトル物理量の計測データのオフセットと検出感度の算出が可能となる。 According to the present invention, the first three-axis measuring means for measuring the first three-dimensional vector physical quantity and outputting the first data, and the second three-dimensional vector physical quantity different from the first three-dimensional vector physical quantity. And a second triaxial measuring unit for measuring the first and second data output from the first and second triaxial measuring units. The data acquisition means for repeatedly acquiring the number of times, the data selection means for selecting whether the data acquired by the data acquisition means is appropriate, and the data selected by the data selection means The data accumulating means for accumulating and the data accumulated by the data accumulating means so that the variation of a predetermined function value representing the angle formed by the first and second three-dimensional vector physical quantities is minimized. And an offset / detection sensitivity calculation means for calculating the detection sensitivity at least one of the second three-axis measurement means, and the three axes based on the measurement data of one kind of three-dimensional vector physical quantity so far The means for obtaining the sensor offset and the detection sensitivity are independent means. Therefore, the offset of the measurement data of the three-axis vector physical quantity and the detection sensitivity can be calculated only by the present invention.
また、比較的算出の容易な3次元ベクトル物理量の計測データを適用することによって、別の比較的算出の困難な3次元ベクトル物理量の計測データに基づいて3軸センサのオフセットと検出感度の算出手段を提供したので、比較的算出の困難な3次元ベクトル物理量の計測データに基づいて3軸センサのオフセットと検出感度を、例えば、上述した特許文献1と本発明の手法とを併用することによって、精度を向上させること及び算出の時間を節約することの両者が可能となる。
Further, by applying measurement data of a three-dimensional vector physical quantity that is relatively easy to calculate, the offset and detection sensitivity calculation means of the three-axis sensor based on another relatively difficult calculation of three-dimensional vector physical quantity measurement data Since the offset and detection sensitivity of the three-axis sensor are based on the measurement data of the three-dimensional vector physical quantity that is relatively difficult to calculate, for example, by using the above-described
さらに、3次元ベクトル物理量において、絶対値(大きさ)に時間的変化があっても向きに時間的変化がない場合でも、2種類の3次元ベクトル物理量のなす角度は一定であることを利用し、この場合でも3次元ベクトル物理量の計測データ基づいて3軸センサのオフセットと検出感度を、任意の異なる2種類の3次元ベクトル物理量に対してこれらのベクトルのなす角度を表す所定の関数値のばらつきが最小となるように、最適化手法又は統計的手法によって求める手段を提供した。このように、大きさに時間的変化がある3次元ベクトル物理量の場合には、上述した特許文献1の手法ではオフセットと検出感度を算出することは本質的に不可能であったが、本発明の手段によってこれらの算出が可能となる。
Furthermore, in the three-dimensional vector physical quantity, even if there is a temporal change in the absolute value (size), even if there is no temporal change in the direction, the angle formed by the two types of three-dimensional vector physical quantities is constant. Even in this case, the offset of the three-axis sensor and the detection sensitivity based on the measurement data of the three-dimensional vector physical quantity, and the variation of a predetermined function value representing the angle formed by these vectors with respect to any two different three-dimensional vector physical quantities In order to minimize the error, a means for obtaining by an optimization method or a statistical method is provided. As described above, in the case of a three-dimensional vector physical quantity having a temporal change in size, it is essentially impossible to calculate the offset and the detection sensitivity by the method of
以下、図面を参照して本発明の実施の形態について説明する。
図1は、本発明の物理量計測装置の一実施形態を説明するためのブロック構成図で、図中符号1は第1の3次元ベクトル物理量計測部、2は第2の3次元ベクトル物理量計測部、3はデータ取得部、4はデータ選択部、5はデータ蓄積部、6は第1の3次元ベクトル物理量計測部1及び第2の3次元ベクトル物理量計測部2のオフセット・検出感度算出部、7は第1の3次元ベクトル物理量計測部1及び第2の3次元ベクトル物理量計測部2のデータ/物理量変換部を示している。
Embodiments of the present invention will be described below with reference to the drawings.
FIG. 1 is a block diagram for explaining an embodiment of a physical quantity measuring apparatus according to the present invention. In FIG. 1,
本発明の物理量計測装置は、2種類以上の3次元ベクトル物理量を計測する第1の3次元ベクトル物理量計測部1と第2の3次元ベクトル物理量計測部2を備えたもので、この第1の3次元ベクトル物理量計測部1と第2の3次元ベクトル物理量計測部2は、ともに3次元ベクトル物理量の計測が可能な3軸加速度センサと3軸磁気センサを含んでいる。なお、本発明の構成においては、図1において図示した第1の3次元ベクトル物理量計測部1及び第2の3次元ベクトル物理量計測部2以外に第3の3次元ベクトル物理量計測部などが存在してもかまわない。
The physical quantity measuring device of the present invention includes a first three-dimensional vector physical
データ取得部3は、第1の3次元ベクトル物理量計測部1及び第2の3次元ベクトル物理量計測部2によって計測された2種類以上の3次元ベクトル物理量のデータを所定回数以上繰り返して取得するものである。データ選択部4は、データ取得部3によって繰り返し取得された3次元ベクトル物理量のデータが適当であるか否かを判断してそのデータを選択するものである。このデータ選択部4においてデータ取得部3のデータから必要なデータを選択し、その選択されたデータがデータ蓄積部5に蓄積される。ここまでは、次のオフセット・検出感度算出部6での最適化手法又は統計的手法によるオフセット及び検出感度の算出の準備である。
The data acquisition unit 3 repeatedly acquires data of two or more types of three-dimensional vector physical quantities measured by the first three-dimensional vector physical
データ蓄積部5で蓄積されたデータは、オフセット・検出感度算出部6において、最適化手法又は統計的手法に基づいてオフセット及び検出感度の算出に利用される。これらの算出結果がデータ/物理量変換部7によって3次元ベクトル物理量に変換される。
The data accumulated in the
また、3軸センサ1,2が、重力加速度ベクトル物理量を計測する3軸加速度センサ1と、地磁気ベクトル物理量を計測する3軸磁気センサ2であって、オフセット・検出感度算出部6が、データ蓄積部5で蓄積されたデータに対して、重力加速度ベクトルと地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、3軸加速度センサ1のオフセットと検出感度、及び3軸磁気センサ2のオフセットと検出感度を算出する。
The
以下において、本発明の新たな構成要素である最適化手法又は統計的手法によるオフセット・検出感度算出部6の実際の算出手法を中心に説明する。
In the following, an actual calculation method of the offset / detection
図2は、本発明における物理量計測装置の実際の測定系を示す概念図である。
電子機器100の中に、第1の3次元ベクトル物理量計測部1の3軸センサの一例としての加速度センサ101、及び第2の3次元ベクトル物理量計測部2の3軸センサの一例としての磁気センサ102が組み込まれている。加速度センサ101は、X方向、Y方向、Z方向のお互いに垂直な方向の加速度成分を測定するセンサであり、磁気センサ102は、加速度センサ100と同じ3方向の磁場成分を測定するセンサである。
FIG. 2 is a conceptual diagram showing an actual measurement system of the physical quantity measuring device according to the present invention.
The
なお、以下の実施形態の説明は、本発明に対して以下に示す4点について具体的に実例を挙げながら説明するものである。
まず第1に、上述したように加速度センサ100及び磁気センサ101を例に説明するが、特にこれらのセンサ、あるいは計測装置に限るものではない。一般的には、3次元ベクトルで表現される物理量において、これらすべての成分を計測できる装置であれば本発明が適用できる。
In the following description of the embodiment, the following four points will be described with reference to specific examples.
First, as described above, the
第2に、以下の説明では、前記各センサが電圧値として出力される場合について説明するが、これは電圧値に限らず電流値、物体の変位等、どのような出力であってもかまわない。 Secondly, in the following description, the case where each sensor is output as a voltage value will be described. However, this is not limited to the voltage value, and any output such as a current value or an object displacement may be used. .
第3に、各センサの実際の出力値(電圧値、電流値、物体の変位等)とセンサ出力から求められる実際の物理量とが線型関係(比例関係)にある場合について説明するが、この関係は特に線型に限られるものではなく、非線型関係にあるとしても適用可能である。 Third, the actual output value (voltage value, current value, object displacement, etc.) of each sensor and the actual physical quantity obtained from the sensor output will be described in a linear relationship (proportional relationship). Is not limited to a linear type, and can be applied even if it has a non-linear relationship.
第4に、各センサの3軸の各軸が一致している場合について説明するが、一般的にセンサの配置自体は必ずしも上述したように各軸の方向が一致している必要はない。もし一致していないときは、適宜いずれかのセンサの出力に対して座標変換を行うことにより、すべての場合について以下の内容が適用できる。 Fourthly, a case will be described in which the three axes of each sensor coincide with each other. However, in general, the arrangement of the sensors does not necessarily need to coincide with each other as described above. If they do not match, the following contents can be applied to all cases by appropriately performing coordinate transformation on the output of any one of the sensors.
加速度センサ101の出力電圧をVGx、VGy、VGz、オフセット電圧(0m/s/sのときの出力電圧)をOGx、OGy、OGz、検出感度(例えば、1m/s/sあたりの出力電圧変化)をSGx、SGy、SGzとすると、加速度センサ101によって得られた加速度の3方向各成分値Gx、Gy、Gzは以下のように与えられる。
Gx=(VGx−OGx)/SGx・・・(1)
Gy=(VGy−OGy)/SGy・・・(2)
Gz=(VGy−OGz)/SGz・・・(3)
The output voltage of the
Gx = (VGx−OGx) / SGx (1)
Gy = (VGy−OGy) / SGy (2)
Gz = (VGy−OGz) / SGz (3)
一方、磁気センサ102の出力電圧をVMx、VMy、VMz、オフセット電圧(0テスラのときの出力電圧)をOMx、OMy、OMz、検出感度(例えば、1マイクロテスラあたりの出力電圧変化)をSMx、SMy、SMzとすると、磁気センサ102によって得られた磁場の各成分値Mx、My、Mzは以下のように与えられる。
Mx=(VMx−OMx)/SMx・・・(4)
My=(VMy−OMy)/SMy・・・(5)
Mz=(VMz−OMz)/SMz・・・(6)
On the other hand, the output voltage of the
Mx = (VMx−OMx) / SMx (4)
My = (VMy−OMy) / SMy (5)
Mz = (VMz−OMz) / SMz (6)
もし、上述した(1)〜(6)式において、オフセット電圧OGx、OGy、OGz、OMx、OMy、OMz、及び検出感度SGx、SGy、SGz、SMx、SMy、SMzがすべて既知であれば、実際のセンサにかかった測定の出力電圧VGx、VGy、VGz、VMx、VMy、VMzによって、加速度の3軸各成分Gx、Gy、Gz、及び磁場の3軸各成分Mx、My、Mzを求めることができる。 If the offset voltages OGx, OGy, OGz, OMx, OMy, OMz and the detection sensitivities SGx, SGy, SGz, SMx, SMy, SMz are all known in the equations (1) to (6) described above, The three-axis components Gx, Gy, and Gz of acceleration and the three-axis components Mx, My, and Mz of the magnetic field can be obtained from the output voltages VGx, VGy, VGz, VMx, VMy, and VMz measured on the sensor. it can.
さらに、地上の任意の地点においてこれらのセンサがある時間内において静止していれば、この加速度センサの出力は、重力加速度のみが測定の対象となる。また、磁石等による外乱の磁場の影響がなければ、この磁気センサの出力は、地磁気(地磁気)のみが測定の対象となる。これらの測定値によって、すなわち重力加速度と地磁気を測定することによって、電子機器にいわゆる電子コンパス機能を持たせることが可能となる。 Furthermore, if these sensors are stationary within a certain time at an arbitrary point on the ground, only the acceleration of gravity is measured as the output of the acceleration sensor. If there is no influence of the magnetic field of disturbance due to a magnet or the like, only the geomagnetism (geomagnetism) is measured as the output of this magnetic sensor. By measuring these measured values, that is, by measuring gravitational acceleration and geomagnetism, the electronic device can be provided with a so-called electronic compass function.
ところが、図3に示すように、重力加速度G(3次元ベクトル物理量)及び地磁気M(3次元ベクトル物理量)は、上述した条件を満たす場所であればほぼ(3次元ベクトル物理量として)一定とみなすことができる。したがって、両者ベクトルのなす角度θも一定とみなせる。一方で、電子機器100は一般に3次元空間内でどのような姿勢でも取り得るため、重力加速度による加速度センサ出力、及び地磁気による磁気センサ出力の各量は、時々刻々と変化するが、GとMのなす角度θは電子機器100の姿勢には依存しない。θは線型代数学における内積の公式から、
cosθ=(G・M)/(|G|*|M|)=(Gx*Mx+Gy*My+Gz*Mz)/(√(Gx^2+Gy^2+Gz^2)*√(Mx^2+My^2+Mz^2)) ・・・(7)
で与えられる。すなわち、この左辺のcosθが一定であるという条件から、右辺の量も一定ではなければならないという結論が必然的に導かれる。一方で、実際の加速度センサ及び磁気センサの各出力は実際には電圧値出力によって与えられ、その変換公式は上述したような(1)〜(6)式で与えられる。
However, as shown in FIG. 3, the gravitational acceleration G (three-dimensional vector physical quantity) and the geomagnetism M (three-dimensional vector physical quantity) are considered to be almost constant (as a three-dimensional vector physical quantity) if the place satisfies the above-described conditions. Can do. Therefore, the angle θ formed by both vectors can be regarded as constant. On the other hand, since the
cos θ = (G · M) / (| G | * | M |) = (Gx * Mx + Gy * My + Gz * Mz) / (√ (Gx ^ 2 + Gy ^ 2 + Gz ^ 2) * √ (Mx ^ 2 + My ^ 2 + Mz ^ 2) (7)
Given in. That is, from the condition that cos θ on the left side is constant, a conclusion that the amount on the right side must be constant is inevitably derived. On the other hand, each output of the actual acceleration sensor and magnetic sensor is actually given by a voltage value output, and its conversion formula is given by the equations (1) to (6) as described above.
なお、一般に、(7)式で示すθに対して(90°−θ)で与えられる角度、すなわち図3で示した水平方向と地磁気ベクトルMとのなす角度を俗に「伏角」と呼ぶ。東京における伏角はおよそ48°であることが知られている。 In general, the angle given by (90 ° −θ) with respect to θ shown in equation (7), that is, the angle formed between the horizontal direction and the geomagnetic vector M shown in FIG. It is known that the dip in Tokyo is about 48 °.
上述のことから、加速度センサのオフセット電圧OGx、OGy、OGz、磁気センサのオフセット電圧OMx、OMy、OMz、加速度センサの検出感度SGx、SGy、SGz、及び磁気センサの検出感度SMx、SMy、SMzのいずれか、あるいはすべてが仮に未知であったとしても、加速度センサの測定値VGx、VGy、VGz、及び磁気センサの測定値VMx、VMy、VMzを(1)〜(6)式に基づいて(7)式の右辺に代入すると、この右辺の量は一定ではなければならない、という条件から、最適化手法又は統計的手法を用いることによって、未知であった加速度センサのオフセット電圧と検出感度及び磁気センサのオフセット電圧と検出感度を求めることができる。 From the above, the acceleration sensor offset voltages OGx, OGy, OGz, the magnetic sensor offset voltages OMx, OMy, OMz, the acceleration sensor detection sensitivities SGx, SGy, SGz, and the magnetic sensor detection sensitivities SMx, SMy, SMz Even if any or all of them are unknown, the measured values VGx, VGy, and VGz of the acceleration sensor and the measured values VMx, VMy, and VMz of the magnetic sensor are calculated based on the equations (1) to (6) (7 If the right side of the equation is substituted into the right side of the equation, the amount of the right side must be constant. By using an optimization method or a statistical method, the offset voltage and detection sensitivity of the acceleration sensor and the magnetic sensor, which were unknown, are used. The offset voltage and the detection sensitivity can be obtained.
したがって、改めて求めた加速度センサのオフセット電圧をOGx、OGy、OGz、検出感度をSGx、SGy、SGz、磁気センサのオフセット電圧をOMx、OMy、OMz、検出感度をSMx、SMy、SMzとすれば、各センサの成分値Gx、Gy、Gz、Mx、My、Mzは、上述した(1)〜(6)式によって与えられる。 Therefore, if the offset voltage of the acceleration sensor newly obtained is OGx, OGy, OGz, the detection sensitivity is SGx, SGy, SGz, the offset voltage of the magnetic sensor is OMx, OMy, OMz, and the detection sensitivity is SMx, SMy, SMz, The component values Gx, Gy, Gz, Mx, My, and Mz of each sensor are given by the above-described equations (1) to (6).
図4は、本発明の物理量計測方法の一実施形態を説明するためのフローチャートを示す図である。まず、2種類以上の3次元ベクトル物理量を3軸センサ(第1の3次元ベクトル物理量計測部1と第2の3次元ベクトル物理量計測部2に含まれる3軸センサ)により計測する(ステップS1)。この3軸センサが3軸加速度センサであって、重力加速度ベクトル物理量をこの3軸加速度センサで計測するステップと、3軸センサが3軸磁気センサであって、地磁気ベクトル物理量をこの3軸磁気センサで計測するステップを含んでいる。
FIG. 4 is a flowchart for explaining an embodiment of the physical quantity measuring method of the present invention. First, two or more types of three-dimensional vector physical quantities are measured by a three-axis sensor (a three-axis sensor included in the first three-dimensional vector physical
次に、ステップS2によって2種類以上の3次元ベクトル物理量の計測データを所定回数以上繰り返してデータ取得部3で取得する(ステップS2)。次に、ステップS2によって繰り返し取得された3次元ベクトル物理量のデータが適当であるか否かを判断してそのデータをデータ選択部4で選択する(ステップS3)。次に、このステップS3よって選択されたデータをデータ蓄積部5で蓄積する(ステップS4)。 Next, in step S2, two or more types of three-dimensional vector physical quantity measurement data are repeated a predetermined number of times or more and acquired by the data acquisition unit 3 (step S2). Next, it is determined whether or not the data of the three-dimensional vector physical quantity repeatedly acquired in step S2 is appropriate, and the data is selected by the data selection unit 4 (step S3). Next, the data selected in step S3 is stored in the data storage unit 5 (step S4).
次に、このステップS4で蓄積されたデータに対して、2種類以上の中の異なる2種類の3次元ベクトル物理量のなす角度を表す所定の関数値のばらつきが最小になるように、3軸センサのオフセット及び検出感度をオフセット・検出感度算出部6で算出する(ステップS5)。このステップS5では、3軸加速度センサのオフセットと検出感度を算出するステップと、3軸磁気センサのオフセットと検出感度を算出するステップとを含んでいる。 Next, the three-axis sensor is set so that the variation of a predetermined function value representing the angle formed by two different types of three-dimensional vector physical quantities among two or more types is minimized with respect to the data accumulated in step S4. Are calculated by the offset / detection sensitivity calculation unit 6 (step S5). This step S5 includes a step of calculating the offset and detection sensitivity of the triaxial acceleration sensor and a step of calculating the offset and detection sensitivity of the triaxial magnetic sensor.
図5は、本発明に係る他の実施態様を説明するためのブロック構成図で、図中符号6aは第1の3次元ベクトル物理量計測部1のオフセット・検出感度算出部、7aは第1の3次元ベクトル物理量計測部1のデータ/物理量変換部、8は第2の3次元ベクトル物理量計測部2のオフセット・検出感度算出部、9は第2の3次元ベクトル物理量計測部2のデータ/物理量変換部を示している。その他、図1と同じ機能を有する構成要素には同一の符号を付してある。
FIG. 5 is a block diagram for explaining another embodiment according to the present invention. In FIG. 5,
第2の3次元ベクトル物理量計測部2とデータ取得部3との間には、第2の3次元ベクトル物理量計測部2のオフセット・検出感度算出部8と第2の3次元ベクトル物理量計測部2のデータ/物理量変換部9が設けられている。オフセット・検出感度算出部8は、第2の3次元ベクトル物理量計測部2のオフセットと感度の一方または両方を算出する。データ/物理量変換部9は、オフセット・検出感度算出部8で算出されたオフセットまたは検出感度に基づいて、3次元ベクトル物理量計測部2で計測されるべき3次元物理量に変換して出力する。
Between the second three-dimensional vector physical
データ取得部3は、第1の3次元ベクトル物理量計測部1で計測されたデータと、データ/物理量変換部9で変換された3次元物理量を取得する。データ選択部4は、データ取得部3で取得されたデータと3次元物理量を取捨選択し、データ蓄積部5に蓄積する。
The data acquisition unit 3 acquires the data measured by the first three-dimensional vector physical
オフセット・検出感度算出部6aでは、データ蓄積部5で蓄積されたデータと物理量に基づいて、第1の3次元ベクトル物理量計測部1から出力されたデータのオフセットおよび検出感度を算出する。
The offset / detection
データ/物理量変換部7aは、オフセット・検出感度算出部6aで算出されたオフセットと検出感度に基づいて、第1の3次元ベクトル物理量計測部1から出力されたデータを計測した3次元ベクトル物理量に変換する。
The data / physical
<第1実施例>
以下、第1の3次元ベクトル物理量計測部1を3軸加速度センサとし、第2の3次元ベクトル物理量計測部2を3軸磁気センサとして説明するが、その逆となってもよいことはいうまでもない。
<First embodiment>
Hereinafter, the first three-dimensional vector physical
この実施例の場合、磁気センサのオフセット電圧及び検出感度が既知であるため、(7)式の右辺の各項のうち、まずは磁気センサの測定に関して以下の簡略化が可能となる。
|M|=√(Mx^2+My^2+Mz^2)=1・・・(8)
ただし、磁場Mx、My、Mzは、地磁気の大きさ(一般には50マイクロテスラ程度)を1と規格化したときの量であるとする。すなわち、この場合の検出感度は各々の規格化された量に対する比として定義される。
In the case of this embodiment, since the offset voltage and detection sensitivity of the magnetic sensor are known, the following simplification of the measurement of the magnetic sensor among the terms on the right side of the equation (7) is possible.
| M | = √ (Mx ^ 2 + My ^ 2 + Mz ^ 2) = 1 (8)
However, the magnetic fields Mx, My, and Mz are amounts when the magnitude of the geomagnetism (generally, about 50 microtesla) is normalized to 1. That is, the detection sensitivity in this case is defined as a ratio to each normalized quantity.
(8)式を(7)式に代入すると、
cosθ=(G・M)/(|G|*|M|)=(Gx*Mx+Gy*My+Gz*Mz)/√(Gx^2+Gy^2+Gz^2)・・・(9)
となる。すなわち、この(9)式の右辺が一定値であることが要求される。
Substituting equation (8) into equation (7),
cos θ = (G · M) / (| G | * | M |) = (Gx * Mx + Gy * My + Gz * Mz) / √ (Gx ^ 2 + Gy ^ 2 + Gz ^ 2) (9)
It becomes. That is, the right side of the equation (9) is required to be a constant value.
ここで、加速度センサの測定値を静止した状態のみで取得した場合について検討する。この場合、加速度センサにかかる加速度は重力加速度のみであるため、(9)式右辺の分母の量は一定である。この分母の一定量を1と規格化する。すなわち、
|G|=√(Gx^2+Gy^2+Gz^2)=1・・・(10)
とする。この要請により、加速度Gx、Gy、Gzは、重力加速度の大きさ(1G、一般には9.8m/s/s程度)を1と規格化したときの量として定義される。
Here, the case where the measured value of the acceleration sensor is acquired only in a stationary state will be considered. In this case, since the acceleration applied to the acceleration sensor is only gravitational acceleration, the amount of the denominator on the right side of equation (9) is constant. A certain amount of this denominator is normalized to 1. That is,
| G | = √ (Gx ^ 2 + Gy ^ 2 + Gz ^ 2) = 1 (10)
And According to this request, accelerations Gx, Gy, and Gz are defined as quantities when the magnitude of gravitational acceleration (1 G, generally about 9.8 m / s / s) is normalized to 1.
(10)式及び(1)〜(3)式を(9)式の右辺に代入すると、
Mx*(VGx−OGx)/SG+My*(VGy−OGy)/SG+Mz*(VGz−OGz)/SG・・・(11)
となる。(11)式の諸量のうち、Mx、My、Mzは磁気センサによって測定可能、また、VGx、VGy、VGzは加速度センサによって測定可能、SGは加速度センサの各軸の検出感度(SG=SGx=SGy=SGz)であるからすでに既知である。一方、未知数はOGx、OGy、OGzであり、(11)式の量が一定であるという条件の下に、3個の未知数を、最適化手法を用いて解くことにより加速度センサのオフセット電圧を求めることができる。この方法の一例を以下で説明する。
Substituting the expression (10) and the expressions (1) to (3) into the right side of the expression (9),
Mx * (VGx−OGx) / SG + My * (VGy−OGy) / SG + Mz * (VGz−OGz) / SG (11)
It becomes. Of the various quantities in the equation (11), Mx, My, and Mz can be measured by a magnetic sensor, VGx, VGy, and VGz can be measured by an acceleration sensor. SG is a detection sensitivity of each axis of the acceleration sensor (SG = SGx = SGy = SGz), which is already known. On the other hand, the unknowns are OGx, OGy, and OGz, and the offset voltage of the acceleration sensor is obtained by solving the three unknowns using an optimization method under the condition that the amount of equation (11) is constant. be able to. An example of this method will be described below.
加速度センサと磁気センサの測定をそれぞれN回行ったと仮定する。そのi番目の加速度センサの測定値をVGxi、VGyi、VGzi、同様にi番目の磁気センサの測定値をMxi、Myi、Mziとすると、(11)式の量が一定値であるという仮定の下で、以下のような方程式が導かれる。
Mxi*(VGxi−OGx)+Myi*(VGyi−OGy)+Mzi*(VGzi−OGz)=SG*C’=C(ただし、C及びC’は一定値。)・・・(12)
このとき、もっとも確からしいOGx、OGy、OGzの値は、最小二乗法の原理により、Mxi、Myi、Mzi、VGxi、VGyi、VGziの6*N個の測定値があったとき
SUM=Σ[Mxi*(VGxi−OGx)+Myi*(VGyi−OGy)+Mzi*(VGzi−OGz)−C]^2・・・(13)
が最小値を取るようなOGx、OGy、OGzの値である。以下、式を簡略化するため、SUM=S、OGx=x、OGy=y、OGz=zと表記すると、Sを最小にするx、y、zは
ρS/ρx=ρS/ρy=ρS/ρz=0・・・(14)
を満足する。ここで、ρ(本当はラウンド)は偏微分を表す記号である。
Assume that the acceleration sensor and the magnetic sensor are each measured N times. Assuming that the measured value of the i-th acceleration sensor is VGxi, VGyi, VGzi, and similarly the measured value of the i-th magnetic sensor is Mxi, Myi, Mzi, the amount of equation (11) is a constant value. The following equation is derived.
Mxi * (VGxi−OGx) + Myi * (VGyi−OGy) + Mzi * (VGzi−OGz) = SG * C ′ = C (where C and C ′ are constant values) (12)
At this time, the most probable values of OGx, OGy, and OGz are obtained when there are 6 * N measurement values of Mxi, Myi, Mzi, VGxi, VGyi, and VGzi according to the principle of least squares. SUM = Σ [Mxi * (VGxi-OGx) + Myi * (VGyi-OGy) + Mzi * (VGzi-OGz) -C] ^ 2 (13)
Are values of OGx, OGy, and OGz that take a minimum value. Hereinafter, in order to simplify the expression, when SUM = S, OGx = x, OGy = y, and OGz = z, x, y, and z that minimize S are ρS / ρx = ρS / ρy = ρS / ρz. = 0 (14)
Satisfied. Here, ρ (actually round) is a symbol representing partial differentiation.
(13)式を計算して(14)の方程式に代入すると、以下の(15)〜(17)の連立方程式が導かれる。
ρS/ρx=Σ(−4Mxi*P)=0・・・(15)
ρS/ρy=Σ(−4Myi*P)=0・・・(16)
ρS/ρz=Σ(−4Mzi*P)=0・・・(17)
ただし、
P=Mxi*(VGxi−x)+Myi*(VGyi−y)+Mzi*(VGzi−z)・・・(18)
である。この連立方程式は、一般に最小二乗法における正規方程式と呼ばれるものであり、行列表示すれば、
When the equation (13) is calculated and substituted into the equation (14), the following simultaneous equations (15) to (17) are derived.
ρS / ρx = Σ (−4Mxi * P) = 0 (15)
ρS / ρy = Σ (−4Myi * P) = 0 (16)
ρS / ρz = Σ (−4Mzi * P) = 0 (17)
However,
P = Mxi * (VGxi-x) + Myi * (VGyi-y) + Mzi * (VGzi-z) (18)
It is. This simultaneous equation is generally called a normal equation in the least squares method.
と表すことができる。ただし、Aは以下の(20)式に示される行列、Bは(21)式に示されるベクトルである。 It can be expressed as. However, A is the matrix shown by the following (20) Formula, B is the vector shown by (21) Formula.
(19)〜(21)式は、未知数3個(x、y、z)の連立1次方程式であるが、Aの行列の各成分及びBのベクトルの各成分は、測定値から簡単に計算できる量であるので、線型代数学におけるガウスージョルダンの方法(掃き出し法)、クラメールの公式、あるいは逆行列を求める方法等によって容易に解くことができる。この方程式の解(x、y、z)は、とりもなおさず加速度センサのオフセット電圧OGx、OGy、OGzの最適値である。 Equations (19) to (21) are three unknowns (x, y, z) simultaneous linear equations, but each component of the A matrix and each component of the B vector are simply calculated from the measured values. Since it is a possible quantity, it can be easily solved by the Gauss-Jordan method (sweeping method) in the linear algebra, the Kramer formula, or the inverse matrix calculation method. The solution (x, y, z) of this equation is the optimum value of the offset voltage OGx, OGy, OGz of the acceleration sensor.
したがって、実際の加速度の3軸各成分値は、前記で求めたオフセット電圧OGx、OGy、OGzと、既知の検出感度SGによって、上述した(1)〜(3)で与えられる。 Therefore, the three-axis component values of the actual acceleration are given by the above-described (1) to (3) by the offset voltages OGx, OGy, and OGz obtained above and the known detection sensitivity SG.
なお、この実施例においては、加速度センサの検出感度が3軸ともすべてSGという既知の量であることを前提条件としたが、前記の計算を見て容易にわかるように、すべて同じであることさえわかっていれば、特に検出感度の量自体が未知であってもOGx、OGy、OGzを求めることが可能である。 In this embodiment, it is assumed that the detection sensitivities of the acceleration sensors are all known amounts of SG for all three axes. However, as is easy to see from the above calculation, they are all the same. As long as it is known, it is possible to obtain OGx, OGy, and OGz even if the amount of detection sensitivity itself is unknown.
<第2実施例>
次に、上述した第1実施例と比較して、加速度センサの検出感度が既知ではあるけれどもすべて異なる場合について説明する。この場合のブロック構成図は、図5に示した第1実施例と同様である。
<Second embodiment>
Next, a case will be described in which the detection sensitivity of the acceleration sensor is already known but completely different from that of the first embodiment described above. The block configuration diagram in this case is the same as that of the first embodiment shown in FIG.
この場合は、加速度センサの検出感度SGx、SGy、SGzが既知であるので、加速度センサの測定値VGx、VGy、VGzにより、
VGx’=VGx/SGx・・・(22)
VGy’=VGy/SGy・・・(23)
VGz’=VGz/SGz・・・(24)
で定義されるVGx’、VGy’、VGz’が測定の回数分だけ計算できる。これらの量は、検出感度によって規格化されているので、オフセットレベル、すなわち、基準レベルは不明であるけれども、第1実施例で仮定されていた「検出感度がすべて等しい場合」と同等な量であることは容易に導かれる。
In this case, since the detection sensitivities SGx, SGy, and SGz of the acceleration sensor are known, the measured values VGx, VGy, and VGz of the acceleration sensor
VGx ′ = VGx / SGx (22)
VGy ′ = VGy / SGy (23)
VGz ′ = VGz / SGz (24)
VGx ′, VGy ′, and VGz ′ defined in (1) can be calculated for the number of times of measurement. Since these amounts are standardized by the detection sensitivity, the offset level, that is, the reference level is unknown, but it is an amount equivalent to “when all the detection sensitivities are assumed” assumed in the first embodiment. Being easy is guided.
したがって、この第2実施例の場合、第1実施例における加速度センサ測定値VGx、VGy、VGzを、上述した(22)〜(24)式で計算されたVGx’、VGy’、VGz’に置き換えて第1実施例と同様の計算を行えばよい。その計算によって求められたオフセットレベルを仮にOGx’、OGy’、OGz’とすると、実際のオフセット電圧OGx、OGy、OGzは
OGx=OGx’*SGx・・・(25)
OGy=OGy’*SGy・・・(26)
OGz=OGz’*SGz・・・(27)
として求めることができる。
Therefore, in the case of the second embodiment, the acceleration sensor measured values VGx, VGy, VGz in the first embodiment are replaced with VGx ′, VGy ′, VGz ′ calculated by the above-described equations (22) to (24). The same calculation as in the first embodiment may be performed. Assuming that the offset level obtained by the calculation is OGx ′, OGy ′, OGz ′, the actual offset voltages OGx, OGy, OGz are OGx = OGx ′ * SGx (25)
OGy = OGy '* SGy (26)
OGz = OGz ′ * SGz (27)
Can be obtained as
なお、上述した各実施例では、加速度センサの検出感度が3軸とも既知の量であることを前提条件としたが、検出感度の比の値だけが既知である場合、例えば、X軸の検出感度を1としたときのY軸及びZ軸の検出感度のみが既知であれば、第2実施例と同じ計算がそのまま適用可能である。この理由は、第1実施例にて記載した末尾の理由と同様である。 In each of the above-described embodiments, it is assumed that the detection sensitivity of the acceleration sensor is a known amount for all three axes. However, when only the value of the detection sensitivity ratio is known, for example, detection of the X axis is performed. If only the Y-axis and Z-axis detection sensitivities when the sensitivity is 1 are known, the same calculation as in the second embodiment can be applied as it is. This reason is the same as the reason at the end described in the first embodiment.
<第3実施例>
次に、上述した実施例1及び2に対し、加速度センサの検出感度も未知である場合、すなわち、加速度センサのオフセット電圧と検出感度がすべて未知であり、磁気センサのオフセット電圧と検出感度がすべて既知である場合について説明する。この場合のブロック構成図は図5と同様である。
<Third embodiment>
Next, with respect to the first and second embodiments described above, when the acceleration sensor detection sensitivity is unknown, that is, the acceleration sensor offset voltage and detection sensitivity are all unknown, and the magnetic sensor offset voltage and detection sensitivity are all unknown. The case where it is known will be described. The block diagram in this case is the same as FIG.
この場合は、(7)式の右辺のうち、
|M|=√(Mx^2+My^2+Mz^2)=1・・・(28)
が第1実施例と同様に成り立つ。したがって(7)式は以下のようになる。
cosθ=(G・M)/(|G|*|M|)=(Gx*Mx+Gy*My+Gz*Mz)/√(Gx^2+Gy^2+Gz^2)・・・(29)
すなわち、この(29)式の右辺の量に対して最適化計算を行う必要がある。
In this case, of the right side of equation (7),
| M | = √ (Mx ^ 2 + My ^ 2 + Mz ^ 2) = 1 (28)
The same holds true for the first embodiment. Therefore, Equation (7) is as follows.
cos θ = (G · M) / (| G | * | M |) = (Gx * Mx + Gy * My + Gz * Mz) / √ (Gx ^ 2 + Gy ^ 2 + Gz ^ 2) (29)
In other words, it is necessary to perform optimization calculation for the amount on the right side of the equation (29).
ここで、第1実施例と同様に、加速度センサの測定値を静止した状態のみで取得した場合を検討する。すなわち、加速度センサにかかる加速度は重力加速度のみであるとすれば、(29)式の右辺の分母の量は一定である。この一定値を1とおけば、第1実施例と同様、加速度センサの検出感度は重力加速度の大きさで規格化された値として定義される。ただし、第1実施例と異なるのは、検出感度が不明であるためにSG=SGx=SGy=SGzとは限らないことである。この条件を(29)式に代入すると、
Mx*(VGx−OGx)/SGx+My*(VGy−OGy)/SGy+Mz*(VGz−OGz)/SGz・・・(30)
が一定値でなければならないことが示される。この(30)式は(11)式と酷似しているが、未知数がOGx、OGy、OGzに加え、SGx、SGy、SGzと6個になっている点が大きく異なる。以下で詳しく説明する。
Here, as in the first embodiment, the case where the measured value of the acceleration sensor is acquired only in a stationary state will be considered. That is, if the acceleration applied to the acceleration sensor is only gravitational acceleration, the amount of the denominator on the right side of the equation (29) is constant. If this constant value is 1, the detection sensitivity of the acceleration sensor is defined as a value normalized by the magnitude of gravitational acceleration, as in the first embodiment. However, the difference from the first embodiment is that SG = SGx = SGy = SGz is not necessarily because the detection sensitivity is unknown. Substituting this condition into equation (29)
Mx * (VGx−OGx) / SGx + My * (VGy−OGy) / SGy + Mz * (VGz−OGz) / SGz (30)
Is a constant value. This equation (30) is very similar to equation (11), but differs greatly in that there are six unknowns in addition to OGx, OGy, and OGz, SGx, SGy, and SGz. This will be described in detail below.
上述した場合と同様に、加速度センサと磁気センサの測定をN回行ったと仮定する。そのi番目の加速度センサの測定値をVGxi、VGyi、VGzi、同様にi番目の磁気センサの測定値をMxi、Myi、Mziとすると、(30)式の量が一定値であるという仮定の下で、以下のような方程式が導かれる。
Mxi*(VGxi−OGx)/SGx+Myi*(VGyi−OGy)/SGy+Mzi*(VGzi−OGz)/SGz=C(ただし、Cは一定値)・・・(31)
したがって、同様に最小二乗法を適用すれば
SUM=Σ[Mxi*(VGxi−OGx)/SGx+Myi*(Gyi−OGy)/SGy+Mzi*(VGzi−OGz)/SGz−C]^2・・・(32)
が最小値を取るようなOGx、OGy、OGz、SGx、SGy、SGzの値を求めればよい。しかしながら、(32)式に対して、前記と同様に未知数の微分を0とおく方程式を計算すると、SGx、SGy、SGzが未知数であるがゆえに、6変数の非線型連立方程式となることが容易に示される。一般に、非線型連立方程式を解析的に解くのは不可能であるため、第1実施例の解法をそのまま適用することはできない。したがって、(32)式の最適値問題を解くには、例えば、共役勾配法が用いられる。この方法については非特許文献1に詳しく記載されているため、本明細書においては詳細の説明は省略する。
As in the case described above, it is assumed that the acceleration sensor and the magnetic sensor are measured N times. Assuming that the measured value of the i-th acceleration sensor is VGxi, VGyi, VGzi, and similarly the measured value of the i-th magnetic sensor is Mxi, Myi, Mzi, the amount of equation (30) is a constant value. The following equation is derived.
Mxi * (VGxi−OGx) / SGx + Myi * (VGyi−OGy) / SGy + Mzi * (VGzi−OGz) / SGz = C (where C is a constant value) (31)
Therefore, if the least squares method is similarly applied, SUM = Σ [Mxi * (VGxi−OGx) / SGx + Myi * (Gyi−OGy) / SGy + Mzi * (VGzi−OGz) / SGz−C] ^ 2 (32 )
The values of OGx, OGy, OGz, SGx, SGy, and SGz may be obtained such that takes a minimum value. However, if an equation that sets the derivative of the unknown to 0 is calculated with respect to the equation (32) as described above, since SGx, SGy, and SGz are unknowns, it is easy to become a 6-variable nonlinear simultaneous equation. Shown in In general, since it is impossible to analytically solve the nonlinear simultaneous equations, the solution of the first embodiment cannot be applied as it is. Therefore, for example, the conjugate gradient method is used to solve the optimum value problem of the equation (32). Since this method is described in detail in
<第4実施例>
次に、加速度センサ及び磁気センサ両方のオフセット電圧も検出感度もすべて未知である場合について説明する。この場合がもっとも一般的なものであり、上述した第1から第3実施例は、上述した未知数のいずれかが既知であるという特別な場合である。
<Fourth embodiment>
Next, a case where both the offset voltage and the detection sensitivity of both the acceleration sensor and the magnetic sensor are unknown will be described. This is the most general case, and the first to third embodiments described above are special cases in which any of the unknowns described above is known.
この場合のブロック構成図は上述した図1と同様である。つまり、異なる2種類以上の3次元ベクトル物理量を計測する3軸センサ1,2を備えた物理量計測装置であって、この3軸センサ1,2によって計測された3次元ベクトル物理量のデータを所定回数以上繰り返し取得するデータ取得部3と、このデータ取得部3によって取得された3次元ベクトル物理量のデータが適当であるか否かを判断してこのデータを選択するデータ選択部4と、このデータ選択部4によって選択されたデータを蓄積するデータ蓄積部5と、このデータ蓄積部5で蓄積されたデータに対して、2種類以上の中の異なる2種類の3次元ベクトル物理量のなす角度を表す所定の関数値のばらつきが最小になるように、3軸センサ1,2のオフセットと検出感度を算出するオフセット・検出感度算出部6とを備えている。
The block diagram in this case is the same as FIG. 1 described above. In other words, the physical quantity measuring apparatus includes three-
また、3軸センサ1,2は、重力加速度ベクトル物理量を計測する3軸加速度センサ1と、地磁気ベクトル物理量を計測する3軸磁気センサ2であって、オフセット・検出感度算出部6が、データ蓄積部5で蓄積されたデータに対して、重力加速度ベクトルと地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、3軸加速度センサのオフセットと検出感度、及び3軸磁気センサのオフセットと検出感度を算出する。
The
この実施例の場合の(7)式の分母は、第3実施例で示したのと同様の理由によって、
|G|・|M|=√[(Gx^2+Gy^2+Gz^2)*(Mx^2+My^2+Mz^2)]=1・・・(33)
のように、一定値1を取る。
In this embodiment, the denominator of the equation (7) is the same as that shown in the third embodiment.
| G |. | M | = √ [(Gx ^ 2 + Gy ^ 2 + Gz ^ 2) * (Mx ^ 2 + My ^ 2 + Mz ^ 2)] = 1 (33)
As shown in FIG.
したがって、(7)式の分子が一定であるという条件が課される。具体的に書けば、
(VMx−OMx)/SMx*(VGx−OGx)/SGx+(VMy−OMy)/SMy*(VGy−OGy)/SGy+(VMz−OMz)/SMz*(VGz−OGz)/SGz・・・(34)
となる。すなわち、(34)式が一定値(例えば、C)であるという条件のもとに、未知数12個(OMx、OMy、OMz、SMx、SMy、SMz、OGx、OGy、OGz、SGx,SGy、SGz)の最適値問題を解くことに帰着される。この具体的な方法については、上述した非特許文献1に記載されているので省略する。
Therefore, the condition that the numerator of formula (7) is constant is imposed. Specifically,
(VMx−OMx) / SMx * (VGx−OGx) / SGx + (VMy−OMy) / SMy * (VGy−OGy) / SGy + (VMz−OMz) / SMz * (VGz−OGz) / SGz (34) )
It becomes. That is, 12 unknowns (OMx, OMy, OMz, SMx, SMy, SMz, OGx, OGy, OGz, SGx, SGy, SGz under the condition that the equation (34) is a constant value (for example, C). ) To solve the optimal value problem. Since this specific method is described in
<第5実施例>
上述した第1実施例と同様に、加速度センサのオフセット電圧OGx、OGy、OGzが未知の場合について、第1実施例と異なる解法について説明する。
<Fifth embodiment>
Similar to the first embodiment described above, a solution different from the first embodiment will be described in the case where the offset voltages OGx, OGy, and OGz of the acceleration sensor are unknown.
図6は、本発明の第5実施例を説明するためのブロック構成図で、図中符号10は第2の3次元ベクトル物理量計測部2のデータ取得部、11は第2の3次元ベクトル物理量計測部2のデータ選択部、12は第2の3次元ベクトル物理量計測部2のデータ蓄積部を示している。その他、図1及び図5と同じ機能を有する構成要素には同一の符号を付してある。
FIG. 6 is a block diagram for explaining a fifth embodiment of the present invention, in which
第2の3次元ベクトル物理量計測部2とオフセット・検出感度算出部8との間には、第2の3次元ベクトル物理量計測部2のデータ取得部10と第2の3次元ベクトル物理量計測部2のデータ選択部11と第2の3次元ベクトル物理量計測部2のデータ蓄積部12が設けられている。
Between the second three-dimensional vector physical
以下、第2の3次元ベクトル物理量計測部2を3軸磁気センサとし、第1の3次元ベクトル物理量計測部1を3軸加速度センサとして説明する。その逆でもよいことはいうまでもない。
Hereinafter, the second three-dimensional vector physical
データ取得部10は、3軸磁気センサのデータを所定回数以上繰り返して取得し、データ選択部11はこのデータ取得部10によって繰り返し取得された3軸磁気センサのデータが適当であるか否かを判断して選択する。データ選択部11によって選択されたデータは、データ蓄積部12で蓄積され、オフセット・検出感度算出部6aが、データ蓄積部5で蓄積されたデータに対して、地磁気ベクトルが一定であることを適用した最適化手法又は統計的手法によって、3軸磁気センサのオフセットと検出感度を算出する。
The
以下、実施例1,2,3(図5)と同様にして加速度センサのオフセットと検出感度をオフセット・検出感度算出部6aで算出することができる。
Thereafter, the offset and detection sensitivity of the acceleration sensor can be calculated by the offset / detection
また、同様にして、図示しないが(第1の3次元ベクトル物理量計測部1に図6の構成と同様に、第1の3次元ベクトル物理量計測部1のオフセット・検出感度算出部と第1の3次元ベクトル物理量計測部1のデータ/物理量変換部からなる物理量変換部(重力加速度ベクトル物理量変換手段)と、第1の3次元ベクトル物理量計測部1のデータ取得部と、第1の3次元ベクトル物理量計測部1のデータ選択部と、第1の3次元ベクトル物理量計測部1のデータ蓄積部を設けることにより、重力加速度ベクトルが一定であることを適用した最適化手法又は統計的手法によって、3軸磁気センサ2のオフセットと検出感度を算出することができる。
Similarly, although not shown (the first three-dimensional vector physical
この実施例の場合、上述した(7)式において、
|G|=√(Gx^2+Gy^2+Gz^2)=1・・・(35)
|M|=√(Mx^2+My^2+Mz^2)=1・・・(36)
が成立することを第1実施例で説明した。このうち(35)式の左辺を具体的に書くと
VGx−OGx/SG^2+(VGy−OGy)/SG^2+(VGz−OGz)/SG^2
であるから、
(VGx−OGx)^2+(VGy−OGy)^2+(VGz−OGz)^2=SG^2・・・(37)
という最適値問題が導かれる。この(37)式は、加速度センサの測定値VGx、VGy、VGzのみに対する最適値問題であり、したがって、この(37)式に対しても最適化方法が適用できる。なお、この(37)式に対する最適化の詳しい計算手法については先に示した特許文献1に示されている。
In the case of this embodiment, in the above equation (7),
| G | = √ (Gx ^ 2 + Gy ^ 2 + Gz ^ 2) = 1 (35)
| M | = √ (Mx ^ 2 + My ^ 2 + Mz ^ 2) = 1 (36)
It has been described in the first embodiment that the above holds. Of these, the left side of equation (35) is specifically written: VGx−OGx / SG ^ 2 + (VGy−OGy) / SG ^ 2 + (VGz−OGz) / SG ^ 2
Because
(VGx−OGx) ^ 2 + (VGy−OGy) ^ 2 + (VGz−OGz) ^ 2 = SG ^ 2 (37)
The optimal value problem is derived. This equation (37) is an optimum value problem only for the measured values VGx, VGy, and VGz of the acceleration sensor. Therefore, the optimization method can be applied to this equation (37). A detailed calculation method for optimization with respect to the equation (37) is disclosed in
つまり、第1実施例における方程式(15)〜(18)式と(37)式から導かれる正規方程式とを連立させて解くことができる。この解法を適用すると、第1実施例と同じ測定回数でありながら連立方程式の本数が倍になる。同じことを別の表現で言えば、半分の測定回数でありながら連立方程式の本数が同じになる。したがって、第1実施例及び特許文献1の手法と比べて、測定ポイントが半分であっても同じように未知数を求めることができる。このことは、前記の手法と比べて早く未知数を決定することができるという利点を有している。
That is, the equations (15) to (18) in the first embodiment and the normal equation derived from the equation (37) can be solved simultaneously. When this solution is applied, the number of simultaneous equations is doubled with the same number of measurements as in the first embodiment. In other words, the number of simultaneous equations is the same, although the number of measurements is half. Therefore, compared with the method of the first embodiment and
<第6実施例>
上述した第4実施例のように、加速度センサのオフセット電圧と検出感度及び磁気センサのオフセット電圧と検出感度がすべて未知の場合にも、第5実施例で示したように、本発明と特許文献1とを併用して連立方程式として解く手法もある。
<Sixth embodiment>
Even when the offset voltage and detection sensitivity of the acceleration sensor and the offset voltage and detection sensitivity of the magnetic sensor are all unknown as in the fourth embodiment, as described in the fifth embodiment, the present invention and the patent document There is also a method of solving as a simultaneous equation using 1 together.
この場合のブロック構成図は図5と同様である。つまり、任意の1種類以上の3次元ベクトル物理量のデータに基づいて3軸磁気センサ2のオフセットと検出感度を求める物理量変換部20を備え、第1の3次元ベクトル物理量計測部1のオフセット・検出感度算出部6aが、物理量変換部20によって求められたオフセットと検出感度に基づいて、1種類以上の3次元ベクトル物理量のデータとは異なる3次元ベクトル物理量のデータに基づいて3軸加速度センサ1のオフセットと検出感度を算出する。
The block diagram in this case is the same as FIG. That is, a physical
具体的には、本発明から導かれる方程式
Gx*Mx+Gy*My+Gz*Mz=(VMx−OMx)/SMx*(VGx−OGx)/SGx+(VMy−OMy)/SMy*(VGy−OGy)/SGy+(VMz−OMz)/SMz*(VGz−OGz)/SGz=C1=cosθ ・・・(38)
(ただし、θは重力加速度ベクトルと地磁気ベクトルのなす角度。)
加速度センサに対して特許文献1を適用した場合の方程式
(VGx−OGx)^2/SGx^2+(VGy−OGy)^2/SGy^2+(VGz−OGz)^2/SGz^2=1・・・(39)
及び磁気センサに対して特許文献1を適用した場合の方程式
(VMx−OMx)^2/SMx^2+(VMy−OMy)^2/SMy^2+(VMz−OMz)^2/SMz^2=1・・・(40)
の3種類の方程式を連立させて解くことができる。
Specifically, the equation Gx * Mx + Gy * My + Gz * Mz = (VMx−OMx) / SMx * (VGx−OGx) / SGx + (VMy−OMy) / SMy * (VGy−OGy) / SGy + ( VMz−OMz) / SMz * (VGz−OGz) / SGz = C1 = cos θ (38)
(However, θ is the angle between the gravitational acceleration vector and the geomagnetic vector.)
Equation (VGx-OGx) ^ 2 / SGx ^ 2 + (VGy-OGy) ^ 2 / SGy ^ 2 + (VGz-OGz) ^ 2 / SGz ^ 2 = 1. (39)
(VMx−OMx) ^ 2 / SMx ^ 2 + (VMy−OMy) ^ 2 / SMy ^ 2 + (VMz−OMz) ^ 2 / SMz ^ 2 = 1 ... (40)
These three types of equations can be solved simultaneously.
<第7実施例>
上述した第1から第6実施例における手法は、すべて加速度センサに重力加速度のみが加わった状態、すなわち、一般的には静止した状態において適用可能なものであった。ここで示す第7実施例は、加速度センサに重力加速度と同じ方向(逆方向も含む)にのみ加速度の時間的変化が加わった場合のものである。この実施例は、例えば、歩行体が歩行している場合に適用することができる。この場合のブロック構成図は図1と同様である。
<Seventh embodiment>
The methods in the first to sixth embodiments described above can be applied in a state where only gravitational acceleration is applied to the acceleration sensor, that is, generally in a stationary state. The seventh embodiment shown here is a case where the acceleration sensor is subjected to a temporal change only in the same direction (including the reverse direction) as the gravitational acceleration. This embodiment can be applied, for example, when a walking body is walking. The block diagram in this case is the same as FIG.
つまり、オフセット・検出感度算出部6は、2種類の3次元ベクトル物理量の大きさもしくは絶対値が変化した場合でも、2種類の3次元ベクトル物理量のなす角度を表す所定の関数値のばらつきが最小になるように、3軸センサ1,2のオフセットと検出感度を算出する。
That is, the offset / detection
また、オフセット・検出感度算出部6は、加速度ベクトルが同一方向に対して振動している場合でも、加速度ベクトル及び地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、3軸加速度センサ1のオフセットと検出感度及び3軸磁気センサ2のオフセットと検出感度を算出する。
Further, the offset / detection
上述した(7)式のうち、磁気センサはオフセット電圧と検出感度がすべて既知であるとする。
|M|=√(Mx^2+My^2+Mz^2)=1・・・(41)
したがって、(7)式は
cosθ=(G・M)/(|G|*|M|)=(Gx*Mx+Gy*My+Gz*Mz)/√(Gx^2+Gy^2+Gz^2)=・・・(42)
となる。一般にこの分母の量も分子の量も加速度に時間的変化があれば変化するが、先に示したような重力加速度方向にのみ変化があるような場合、この場合には重力加速度の大きさが変化するものの方向は一定だから、なす角度θは一定、すなわちcosθも一定値をとる。したがって、(42)式の右辺も一定値を取るはずである。これが第3実施例と異なるのは、第3実施例では、分母の量及び分子の量もそれぞれ一定だったが、今回はこれら各々の量は変化することである。
Of the above-described equation (7), it is assumed that the magnetic sensor has all known offset voltage and detection sensitivity.
| M | = √ (Mx ^ 2 + My ^ 2 + Mz ^ 2) = 1 (41)
Therefore, the equation (7) is expressed as follows: cos θ = (G · M) / (| G | * | M |) = (Gx * Mx + Gy * My + Gz * Mz) / √ (Gx ^ 2 + Gy ^ 2 + Gz ^ 2) =. 42)
It becomes. In general, both the amount of denominator and the amount of numerator change if there is a temporal change in acceleration, but if there is a change only in the direction of gravitational acceleration as shown above, in this case the magnitude of gravitational acceleration is Since the direction of the change is constant, the angle θ formed is constant, that is, cos θ has a constant value. Therefore, the right side of the equation (42) should also take a constant value. This is different from the third embodiment. In the third embodiment, the amount of the denominator and the amount of the numerator are also constant, but this time, these amounts change.
これも上述した各実施例と同様に最適化手法を適用すると非線型方程式となるので、共役勾配法等が用いられるが、計算の詳細について非特許文献1に記載されている。
Since this also becomes a nonlinear equation when the optimization method is applied as in the above-described embodiments, the conjugate gradient method or the like is used, but details of calculation are described in
1 第1の3次元ベクトル物理量計測部
2 第2の3次元ベクトル物理量計測部
3,10 データ取得部
4,11 データ選択部
5,12 データ蓄積部
6,6a,8 オフセット・検出感度算出部
7,7a,9 データ/物理量変換部
20 物理量変換部
100 電子機器
101 加速度センサ
102 磁気センサ
DESCRIPTION OF
Claims (18)
前記第1及び第2の3軸計測手段から出力される第1及び第2のデータを所定回数以上繰り返し取得するデータ取得手段と、
該データ取得手段によって取得されたデータが適当であるか否かを判断して該データを選択するデータ選択手段と、
該データ選択手段によって選択されたデータを蓄積するデータ蓄積手段と、
該データ蓄積手段で蓄積されたデータに対して、前記第1及び第2の3次元ベクトル物理量のなす角度を表す所定の関数値のばらつきが最小になるように、前記第1及び第2の3軸計測手段の少なくともいずれかのオフセットと検出感度を算出するオフセット・検出感度算出手段と
を備えたことを特徴とする物理量計測装置。 First three-axis measuring means for measuring the first three-dimensional vector physical quantity and outputting first data; and measuring a second three-dimensional vector physical quantity different from the first three-dimensional vector physical quantity A physical quantity measuring device including a second three-axis measuring unit that outputs data of 2;
Data acquisition means for repeatedly acquiring the first and second data output from the first and second three-axis measurement means a predetermined number of times;
A data selection means for determining whether the data acquired by the data acquisition means is appropriate and selecting the data;
Data storage means for storing data selected by the data selection means;
With respect to the data stored in the data storage means, the first and second 3 so that the variation of a predetermined function value representing the angle formed by the first and second three-dimensional vector physical quantities is minimized. A physical quantity measuring apparatus comprising: an offset / detection sensitivity calculating means for calculating at least one offset of the axis measuring means and detection sensitivity.
前記オフセット・検出感度算出手段が、前記データ蓄積手段で蓄積されたデータに対して、前記重力加速度ベクトルと前記地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、前記3軸加速度センサのオフセットと検出感度、及び前記3軸磁気センサのオフセットと検出感度の少なくともいずれかを算出することを特徴とする請求項1に記載の物理量計測装置。 One of the first and second triaxial measuring means is a triaxial acceleration sensor that measures a gravitational acceleration vector physical quantity, and the other triaxial measuring means is a triaxial magnetic sensor that measures a geomagnetic vector physical quantity. ,
The offset / detection sensitivity calculation means is configured so that a variation in a predetermined function value representing an angle formed by the gravitational acceleration vector and the geomagnetic vector is minimized with respect to the data stored in the data storage means. The physical quantity measuring apparatus according to claim 1, wherein at least one of an offset and detection sensitivity of an axial acceleration sensor and an offset and detection sensitivity of the triaxial magnetic sensor are calculated.
前記第1の3軸計測手段から出力されるデータを所定回数以上繰り返し取得するデータ取得手段と、
該データ取得手段によって取得されたデータが適当であるか否かを判断して該データを選択するデータ選択手段と、
該データ選択手段によって選択されたデータを蓄積するデータ蓄積手段と、
前記第2の3軸計測手段から出力されるデータのオフセットと検出感度を算出する第1のオフセット・検出感度算出手段と、
前記第1のオフセット・検出感度算出手段で算出された前記第2の3軸計測手段のオフセットと検出感度に基づいて、前記第2の3軸計測手段から出力されたデータを前記第2の3次元ベクトル物理量に変換するデータ/物理量変換手段と、
該データ蓄積手段で蓄積されたデータに対して、前記第1の3次元ベクトル物理量と前記データ/物理量変換手段で変換された前記第2の3次元ベクトル物理量とのなす角度を表す所定の関数値のばらつきが最小になるように、前記第1の3軸計測手段のオフセットと検出感度を算出する第2のオフセット・検出感度算出手段と
を備えたことを特徴とする物理量計測装置。 First three-axis measuring means for measuring the first three-dimensional vector physical quantity and outputting first data; and measuring a second three-dimensional vector physical quantity different from the first three-dimensional vector physical quantity A physical quantity measuring device including a second three-axis measuring unit that outputs data of 2;
Data acquisition means for repeatedly acquiring data output from the first three-axis measurement means a predetermined number of times;
A data selection means for determining whether the data acquired by the data acquisition means is appropriate and selecting the data;
Data storage means for storing data selected by the data selection means;
First offset / detection sensitivity calculation means for calculating an offset and detection sensitivity of data output from the second three-axis measurement means;
Based on the offset and detection sensitivity of the second three-axis measuring means calculated by the first offset / detection sensitivity calculating means, the data output from the second three-axis measuring means is used as the second three-axis measuring means. Data / physical quantity conversion means for converting to a dimensional vector physical quantity;
A predetermined function value representing an angle formed by the first three-dimensional vector physical quantity and the second three-dimensional vector physical quantity converted by the data / physical quantity conversion means with respect to the data stored by the data storage means A physical quantity measuring apparatus comprising: a second offset / detection sensitivity calculating means for calculating an offset and a detection sensitivity of the first three-axis measuring means so as to minimize variation in
前記第1の3軸計測手段の前記第2のオフセット・検出感度算出手段が、前記データ蓄積手段で蓄積されたデータに対して、前記重力加速度ベクトルと前記地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、前記第1の3軸計測手段のオフセットと検出感度を算出することを特徴とする請求項5に記載の物理量計測装置。 One of the first and second triaxial measuring means is a triaxial acceleration sensor that measures a gravitational acceleration vector physical quantity, and the other triaxial measuring means is a triaxial magnetic sensor that measures a geomagnetic vector physical quantity. ,
The second offset / detection sensitivity calculating means of the first three-axis measuring means is a predetermined function representing an angle formed by the gravitational acceleration vector and the geomagnetic vector with respect to the data stored in the data storing means. The physical quantity measuring apparatus according to claim 5, wherein the offset and detection sensitivity of the first three-axis measuring unit are calculated so that a variation in values is minimized.
前記第2の3軸計測手段のデータのオフセットと検出感度を算出する前記第1のオフセット・検出感度算出手段が、前記第2のデータ蓄積手段で蓄積されたデータに対して、前記第2の3軸ベクトル物理量が一定であることを適用した最適化手法又は統計的手法によって、前記第2の3軸ベクトル物理量のデータに基づいて前記第2の3軸計測手段のオフセットと検出感度を算出することを特徴とする請求項5に記載の物理量計測装置。 A second data acquisition unit that repeatedly acquires data output from the second three-axis measurement unit a predetermined number of times, and whether or not the data repeatedly acquired by the second data acquisition unit is appropriate A second data selection means for selecting and selecting, and a second data storage means for storing the data selected by the second data selection means;
The first offset / detection sensitivity calculation means for calculating the data offset and detection sensitivity of the second three-axis measurement means is configured to calculate the second offset with respect to the data stored in the second data storage means. The offset and detection sensitivity of the second three-axis measuring means are calculated based on the data of the second three-axis vector physical quantity by an optimization method or a statistical technique applying that the three-axis vector physical quantity is constant. The physical quantity measuring device according to claim 5, wherein:
前記計測ステップによって計測された前記第1及び第2の3軸ベクトル物理量のデータを所定回数以上繰り返し取得するデータ取得ステップと、
該データ取得ステップによって取得された前記3軸ベクトル物理量のデータが適当であるか否かを判断して該データを選択するデータ選択ステップと、
該データ選択ステップによって選択されたデータを蓄積するデータ蓄積ステップと、
該データ蓄積ステップで蓄積されたデータに対して、前記第1及び第2の3軸ベクトル物理量のなす角度を表す所定の関数値のばらつきが最小になるように、前記第1及び第2の3軸計測手段の少なくともいずれかのオフセットと検出感度を算出するオフセット・検出感度算出ステップと
を有することを特徴とする物理量計測方法。 Measurement is performed by a first three-axis measuring unit that measures the first three-axis vector physical quantity and a second three-axis measuring unit that measures a second three-axis vector physical quantity different from the first three-axis vector physical quantity. In the physical quantity measuring method having a measuring step to
A data acquisition step of repeatedly acquiring data of the first and second three-axis vector physical quantities measured by the measurement step a predetermined number of times;
A data selection step of determining whether or not the data of the three-axis vector physical quantity acquired by the data acquisition step is appropriate, and selecting the data;
A data accumulation step for accumulating data selected by the data selection step;
With respect to the data accumulated in the data accumulation step, the first and second 3 so that the variation of a predetermined function value representing the angle formed by the first and second three-axis vector physical quantities is minimized. A physical quantity measurement method comprising: an offset / detection sensitivity calculation step for calculating at least one offset of the axis measurement means and detection sensitivity.
前記オフセット・検出感度算出ステップが、前記データ蓄積ステップで蓄積されたデータに対して、前記重力加速度ベクトルと前記地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、前記3軸加速度センサのオフセットと検出感度、及び前記3軸磁気センサのオフセットと検出感度の少なくともいずれかを算出することを特徴とする請求項10に記載の物理量計測方法。 One of the first and second triaxial measuring means is a triaxial acceleration sensor that measures a gravitational acceleration vector physical quantity, and the other triaxial measuring means is a triaxial magnetic sensor that measures a geomagnetic vector physical quantity. ,
In the offset / detection sensitivity calculation step, the variation of a predetermined function value representing an angle formed by the gravitational acceleration vector and the geomagnetic vector is minimized with respect to the data accumulated in the data accumulation step. The physical quantity measurement method according to claim 10, wherein at least one of an offset and detection sensitivity of an axial acceleration sensor and an offset and detection sensitivity of the triaxial magnetic sensor is calculated.
前記計測ステップによって計測された前記第1及び第2のデータを所定回数以上繰り返し取得するデータ取得ステップと、
該データ取得ステップによって取得された前記データが適当であるか否かを判断して該データを選択するデータ選択ステップと、
該データ選択ステップによって選択されたデータを蓄積するデータ蓄積ステップと、
前記第2の3軸計測手段から出力されるデータのオフセットと検出感度を求める第1のオフセット・検出感度算出ステップと、
該第1のオフセット・検出感度算出ステップで算出されたオフセット及び検出感度に基づいて、前記第2の3軸計測手段から出力されたデータを前記第1の3次元物理量に変換するデータ/物理量変換ステップと、
前記データ蓄積ステップで蓄積されたデータに対して、前記第1の3次元ベクトル物理量と前記データ/物理量変換ステップで変換された前記第2の3次元ベクトル物理量とのなす角度を表す所定の関数値のばらつきが最小になるように、前記第1の3軸計測手段のオフセットと検出感度を算出する第2のオフセット・検出感度算出ステップと
を有することを特徴とする物理量計測方法。 First three-axis measuring means for measuring the first three-dimensional vector physical quantity and outputting first data; and measuring a second three-dimensional vector physical quantity different from the first three-dimensional vector physical quantity A physical quantity measuring method including a measuring step of measuring by a second three-axis measuring unit that outputs data of 2;
A data acquisition step of repeatedly acquiring the first and second data measured by the measurement step a predetermined number of times;
A data selection step of determining whether the data acquired by the data acquisition step is appropriate and selecting the data;
A data accumulation step for accumulating data selected by the data selection step;
A first offset / detection sensitivity calculating step for obtaining an offset and detection sensitivity of data output from the second three-axis measuring means;
Data / physical quantity conversion for converting data output from the second three-axis measuring means into the first three-dimensional physical quantity based on the offset and detection sensitivity calculated in the first offset / detection sensitivity calculating step Steps,
A predetermined function value representing an angle formed by the first three-dimensional vector physical quantity and the second three-dimensional vector physical quantity converted in the data / physical quantity conversion step with respect to the data accumulated in the data accumulation step. A physical quantity measuring method comprising: a second offset / detection sensitivity calculating step for calculating an offset and a detection sensitivity of the first three-axis measuring means so as to minimize the variation of.
前記第1の3軸計測手段の前記第2のオフセット・検出感度算出ステップが、前記データ蓄積ステップで蓄積されたデータに対して、前記重力加速度ベクトルと前記地磁気ベクトルのなす角度を表す所定の関数値のばらつきが最小になるように、前記第1の3軸計測手段のオフセットと検出感度を算出することを特徴とする請求項14に記載の物理量計測方法。 One of the first and second triaxial measuring means is a triaxial acceleration sensor that measures a gravitational acceleration vector physical quantity, and the other triaxial measuring means is a triaxial magnetic sensor that measures a geomagnetic vector physical quantity. ,
The second offset / detection sensitivity calculating step of the first three-axis measuring means is a predetermined function representing an angle formed by the gravitational acceleration vector and the geomagnetic vector with respect to the data stored in the data storing step. The physical quantity measuring method according to claim 14, wherein the offset and detection sensitivity of the first three-axis measuring unit are calculated so that a variation in values is minimized.
前記第2の3軸計測手段のデータのオフセットと検出感度を算出する前記第1のオフセット・検出感度算出ステップが、前記第2のデータ蓄積ステップで蓄積されたデータに対して、前記第2の3軸ベクトル物理量が一定であることを適用した最適化手法又は統計的手法によって、前記第2の3軸ベクトル物理量のデータに基づいて前記第2の3軸計測手段のオフセットと検出感度を算出することを特徴とする請求項14に記載の物理量計測方法。 A second data acquisition step of repeatedly acquiring measurement data of the second three-axis vector physical quantity a predetermined number of times or more, and data of the second three-axis vector physical quantity repeatedly acquired by the second data acquisition step A second data selection step for determining and selecting whether or not the data is appropriate; and a second data accumulation step for accumulating the data selected by the second data selection step,
The first offset / detection sensitivity calculation step for calculating the offset and detection sensitivity of the data of the second three-axis measuring means is performed on the data stored in the second data storage step with respect to the second The offset and detection sensitivity of the second three-axis measuring means are calculated based on the data of the second three-axis vector physical quantity by an optimization method or a statistical technique applying that the three-axis vector physical quantity is constant. The physical quantity measuring method according to claim 14, wherein:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007189999A JP5033526B2 (en) | 2007-07-20 | 2007-07-20 | Physical quantity measuring apparatus and physical quantity measuring method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007189999A JP5033526B2 (en) | 2007-07-20 | 2007-07-20 | Physical quantity measuring apparatus and physical quantity measuring method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2009025208A JP2009025208A (en) | 2009-02-05 |
JP5033526B2 true JP5033526B2 (en) | 2012-09-26 |
Family
ID=40397141
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007189999A Expired - Fee Related JP5033526B2 (en) | 2007-07-20 | 2007-07-20 | Physical quantity measuring apparatus and physical quantity measuring method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5033526B2 (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9148158B2 (en) | 2012-02-03 | 2015-09-29 | Asahi Kasei Kabushiki Kaisha | Signal processing device |
-
2007
- 2007-07-20 JP JP2007189999A patent/JP5033526B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2009025208A (en) | 2009-02-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Camps et al. | Numerical calibration for 3-axis accelerometers and magnetometers | |
Pylvänäinen | Automatic and adaptive calibration of 3D field sensors | |
JP4093861B2 (en) | Compensation of large magnetic errors for electronic compass and all orientation operations | |
US9417091B2 (en) | System and method for determining and correcting field sensors errors | |
CN103941309B (en) | Geomagnetic sensor calibrator (-ter) unit and its method | |
RU2566427C1 (en) | Method of determination of temperature dependences of scaling factors, zero shifts and array of orientation of axes of sensitivity of laser gyroscopes and pendulum accelerometers as part of inertial measuring unit at bench tests | |
CN109791048A (en) | Usage scenario captures the method and system of the component of data calibration Inertial Measurement Unit (IMU) | |
JPWO2006035505A1 (en) | Magnetic sensor control method, control device, and portable terminal device | |
US20190298202A1 (en) | Magnetocardiographic measurement apparatus, calibration method, and recording medium having recorded thereon calibration program | |
JP2012503194A (en) | How to process measurements from accelerometers | |
Yang et al. | A robust inclinometer system with accurate calibration of tilt and azimuth angles | |
Noureldin et al. | Inertial navigation system | |
Markovič et al. | Calibration of a solid-state magnetic compass using angular-rate information from low-cost sensors | |
JP5070428B2 (en) | Electronic compass and direction measurement method | |
Salehi et al. | A practical in-field magnetometer calibration method for IMUs | |
JP5033526B2 (en) | Physical quantity measuring apparatus and physical quantity measuring method | |
Dubé et al. | The calibration of an array of accelerometers | |
Chesneau | Magneto-Inertial Dead-Reckoning in inhomogeneous field and indoor applications | |
Zhang et al. | A component compensation method for magnetic interferential field | |
WO2011129288A1 (en) | Terrestrial magnetism detection device | |
Klingbeil et al. | Magnetic field sensor calibration for attitude determination | |
Reis et al. | Calibration of high-grade inertial measurement units using a rate table | |
Frosio et al. | Autocalibration of MEMS accelerometers | |
Tomaszewski et al. | Analysis of the noise parameters and attitude alignment accuracy of INS conducted with the use of MEMS-based integrated navigation system | |
Liu et al. | An effective unscented Kalman filter for state estimation of a gyro-free inertial measurement unit |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100701 |
|
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: 20120615 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120702 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5033526 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150706 Year of fee payment: 3 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
LAPS | Cancellation because of no payment of annual fees |