JP2016211906A - 傾斜度測定方法及び装置並びに電子機器及びプログラム - Google Patents
傾斜度測定方法及び装置並びに電子機器及びプログラム Download PDFInfo
- Publication number
- JP2016211906A JP2016211906A JP2015093909A JP2015093909A JP2016211906A JP 2016211906 A JP2016211906 A JP 2016211906A JP 2015093909 A JP2015093909 A JP 2015093909A JP 2015093909 A JP2015093909 A JP 2015093909A JP 2016211906 A JP2016211906 A JP 2016211906A
- Authority
- JP
- Japan
- Prior art keywords
- measurement
- azimuth
- inclination
- axis
- error
- 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.)
- Granted
Links
Landscapes
- Navigation (AREA)
Abstract
【解決手段】 重力方向と交差する仮想平面に直交二軸の検出軸を有する加速度センサー10x(10y)の検出軸の一方を、基準方位である第1測定方位(0度)と、仮想平面に対する法線の周りの回転位置にて第1測定方位から180度離れた第2測定方位と、基準方位に戻した第3測定方位と、の各々に設定する。第1〜第3測定方位に設定された加速度センサーの静止状態での出力を用いて、測定方位で異なる動的誤差を、第1及び第3測定方位に設定された加速度センサーの出力の差分に基づいて測定する。加速度センサーの出力から、動的誤差と静的誤差とが除去された、仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、傾斜角及び前記傾斜方位角の少なくとも一方を測定する。
【選択図】 図6
Description
前記第1測定方位及び前記第2測定方位に設定された前記加速度センサーの出力から、前記動的誤差と、前記第1〜第3測定方位の各々で実質的に一定の静的誤差とが除去された、前記仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、前記傾斜角及び前記傾斜方位角の少なくとも一方を測定する傾斜度測定工程と、
を有し、
前記誤差測定工程は、前記第1測定方位及び前記第3測定方位に設定された前記加速度センサーの出力の差分に基づいて、前記動的誤差を測定する工程を含む傾斜度測定方法に関する。
前記第1〜第4測定方位に設定された前記加速度センサーの出力から、前記動的誤差と、前記第1〜第5測定方位の各々で実質的に一定の静的誤差とが除去された、前記仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、前記傾斜角及び前記傾斜方位角の少なくとも一方を測定する傾斜度測定工程と、
を有し、
前記誤差測定工程は、前記第1測定方位及び前記第5測定方位に設定された前記加速度センサーの出力の差分に基づいて、前記動的誤差を測定する工程を含む傾斜度測定方法に関する。
重力方向と交差する仮想平面に直交二軸の検出軸を有する加速度センサーの前記直交二軸の検出軸の一方を、基準方位に設定した第1測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から180度離れた第2測定方位と、前記基準方位に戻した第3測定方位と、の各々に設定する指令を出力する手段と、
前記第1〜第3測定方位にそれぞれ設定された前記加速度センサーの出力を受信する手段と、
前記加速度センサーの出力を用いて、前記第1〜第3測定方位の各々で異なる動的誤差を測定する誤差測定手段と、
前記前記第1測定方位及び前記第2測定方位の各々の測定方位に設定された前記加速度センサーの出力から、前記動的誤差と、前記第1〜第3測定方位の各々で実質的に一定の静的誤差とが除去された、前記仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、前記傾斜角及び前記傾斜方位角の少なくとも一方を測定する手段と、
を有し、
前記誤差測定手段は、前記第1測定方位及び前記第3測定方位に設定された前記加速度センサーの出力の差分に基づいて、前記動的誤差を測定する傾斜度測定装置に関する。
に関する。
重力方向と交差する仮想平面に直交二軸の検出軸を有する加速度センサーの前記直交二軸の検出軸の一方を、基準方位に設定した第1測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から90度離れた第2測定方位と、前記法線の周りの回転位置にて前記第1測定方位から180度離れた第3測定方位と、前記法線の周りの回転位置にて前記第1測定方位から270度離れた第4測定方位と、前記基準方位に戻した第5測定方位と、の各々に設定する指令を出力する手段と、
前記第1〜第3測定方位にそれぞれ設定された前記加速度センサーの出力を受信する手段と、
前記加速度センサーの出力を用いて、前記第1〜第5測定方位の各々で異なる動的誤差を測定する誤差測定手段と、
前記前記第1〜第4測定方位の各々の測定方位に設定された前記加速度センサーの出力から、前記動的誤差と、前記第1〜第5測定方位の各々で実質的に一定の静的誤差とが除去された、前記仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、前記傾斜角及び前記傾斜方位角の少なくとも一方を測定する手段と、
を有し、
前記誤差測定手段は、前記第1測定方位及び前記第5測定方位に設定された前記加速度センサーの出力の差分に基づいて、前記動的誤差を測定する傾斜度測定装置に関する。
重力方向と交差する仮想平面に直交二軸の検出軸を有する加速度センサーの前記直交二軸の検出軸の一方を、基準方位に設定した第1測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から180度離れた第2測定方位と、前記基準方位に戻した第3測定方位と、の各々に設定する指令を出力する手順と、
前記第1〜第3測定方位に設定された前記加速度センサーからの出力を受信する手順と、
前記第1〜第3測定方位の各々にて、静止状態で測定される前記加速度センサーの出力を用いて、前記第1〜第3測定方位の各々で異なる動的誤差を測定する手順と、
前記第1測定方位及び前記第2測定方位の各々の測定方位に設定された前記加速度センサーの出力から、前記動的誤差と、前記第1〜第3測定方位の各々で実質的に一定の静的誤差とが除去された、前記仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、前記傾斜角及び前記傾斜方位角の少なくとも一方を測定する手順と、
をコンピューターに実施させ、
前記動的誤差を測定する手順は、前記第1測定方位及び前記第3測定方位での前記加速度センサーの出力の差分に基づいて、前記動的誤差を測定する手順を含むことを特徴とするプログラムに関する。
重力方向と交差する仮想平面に直交二軸の検出軸を有する加速度センサーの前記直交二軸の検出軸の一方を、基準方位に設定した第1測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から90度離れた第2測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から180度離れた第3測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から270度離れた第4測定方位と、前記基準方位に戻した第5測定方位と、の各々に設定する指令を出力する手順と、
前記第1〜第5測定方位に設定された前記加速度センサーからの出力を受信する手順と、
前記第1〜第5測定方位の各々にて、静止状態で測定される前記加速度センサーの出力を用いて、前記第1〜第5測定方位の各々で異なる動的誤差を測定する手順と、
前記第1〜第4測定方位の各々の測定方位に設定された前記加速度センサーの出力から、前記動的誤差と、前記第1〜第5測定方位の各々で実質的に一定の静的誤差とが除去された、前記仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、前記傾斜角及び前記傾斜方位角の少なくとも一方を測定する手順と、
をコンピューターに実施させ、
前記動的誤差を測定する手順は、前記第1測定方位及び前記第5測定方位での前記加速度センサーの出力の差分に基づいて、前記動的誤差を測定する手順を含むプログラムに関する。
図1に示す測定システムは、測定データを集中管理するホスト装置1と、ホスト装置1と例えばインターネットや無線、携帯電話で接続された複数の端末装置2と、各端末装置2と例えばWiFi(登録商標)やBluetooth(登録商標)等の無線通信、移動体通信システム、ローカルエリアネットワーク(LAN)で接続された一又は複数の測定端末装置3と、を有する。端末装置2は携帯電話やスマートフォン、タブレット、又は端末PC等の汎用機であっても専用機であっても良い。測定端末装置3は、加速度センサーに接続或いは内蔵している機器、携帯電話やスマートフォン、タブレット、又は端末PC等の汎用機であっても専用機、加速度計測器であってもよい。
図4には、水平座標系(Xr,Yr,Zr)と、センサー座標系(X,Y,Z)が示されている。水平座標系(Xr,Yr,Zr)の直交二軸Xr,Yrを含む(Xr−Yr)平面は水平面であり、Zr軸は水平面(Xr−Yr)に直交する鉛直軸である。
図6に、端末装置2及び測定端末装置3を示す。測定端末装置3は、三軸加速度センサー10x,10y,10z、回転操作部5、インジケーター6、通信装置7を有する。端末装置2は上述した回転駆動部8を有していても良い。また、測定端末装置3は、回転操作部5と回転駆動部8を外部に有してもよい。
4. 誤差測定方法
以下に、較正プログラムに従って回転操作部5を操作して設定される回転位置(静止位置)での動的誤差DxΔTΔT,DyΔTΔT、静的誤差DFx,DFy及び傾斜誤差Iφ・cosθ,Iφ・sinθの測定方法について説明する。
(i) 測定時に設定される加速度センサーの検出軸の方位を測定方位と称する。少なくとも一つの測定方位(基準方位)を重複させて測定し、基準方位とは異なる方位でも測定する。好ましくは最初と最後の測定方位を基準方位とする。
測定間の回転角度を90度または180度刻みとする場合には、2軸2方位回転測定(測定方位は0度、180度、360度)と、2軸4方位回転測定(測定方位は0度、90度、180度、270度、360度)とを挙げることができる。
図7は、2軸4方位で測定した時の測定方位(0度、90度、180度、270度、360度)毎の加速度センサー10xの測定値を示す。図7に示すように、0度と360度で測定値が同じである場合、この測定の間に加速度センサー10xの出力中のドリフトが安定していると仮定する。測定中のドリフトが安定していると仮定した場合、0度方位から+270度方位の間で直交する4方位の測定値は、測定時点の測定系の傾斜量と、加速度センサー10x(または10y)のドリフト(静的誤差)とによるオフセットの和であるとする。0度と360度で値に変動があるようなら、その差分を動的誤差として各測定に等分に割り当てて引き算する必要がある(動的誤差の除去)。任意の検出軸の直交する4方位での測定値の平均値は、バイアスのドリフトによるオフセット量を示す。任意の検出軸の直交する4方位の出力の回転方位に対する軌跡は、図7の通りサインカーブ上の4点となり、その振幅は水平面に対する傾きとなる。また、図7に示す最大値と最小値を取る方位は、その傾きの方位となる。
先ず、図2に示す回転操作部5を操作して直交二軸加速度センサー10x,10yを回転させ、例えば0度→90度→180度→270度→0度(360度)の順に各測定方位で停止させる。各測定方位にて、静止状態で2軸4方位データを加速度センサー10x,10yにて収集する。2軸4方位データを図10の通り定義する。
次に、動的誤差である、測定中のドリフトDxΔTΔT,DyΔTΔTを測定する。図7について上述した通り、もし最初(0度)と最後(360度=0度)の測定値が等しい場合には測定中のドリフトは無視できるが、変動があるようなら、最初(0度)と最後(360度)の測定値の差分からドリフトDxΔTΔT,DyΔTΔTを求めることができる。なぜなら、式(7)(8)から分かる通り、測定方位が0度で共に等しい測定値X0,X4は、ドリフトDxΔTΔTのみが異なり、他の値であるIφ・cosθ及びDFxについては測定値X0,X4間で共に等しいからである。本実施形態にて、最初と最後の測定方位を等しくした理由は、全ての測定方位でのドリフト(動的誤差)の測定を可能とするためである。
式(9)(10)に示す表記を用いると、測定値X0〜X3は、次のように示すことができる。
次に、動的誤差が除去されたデータX’からさらに静的誤差DFxを除去するために次式を計算し、図12に示す二次加工データを求める。
求められた二次加工データX”nを測定順序nを用いて示すと次式の通りである。
先ず、手順5で求めた傾斜量Iφで、手順4で求められた各二次加工データX”nを次式の通り除算して、図13に示す三次加工データを求める。
式(12)を式(11)を用いて変形するとともに、図14に示すX,Yの実数毎及びX,Yの虚数毎に平均する。それにより、X軸及びY軸の複素数表現は次式の通りとなる。
第1象限 θs>0,θc>0 結果θ=θc,θs=θc
第2象限 θs>0,θc>0 結果θ=θc,θs≠θc
第3象限 θs<0,θc>0 結果θ=2π−≠θc,θs=θc
第4象限 θs<0,θc>0 結果θ=2π−θc,θs≠θc
その結果、θs>0,θc>0の場合には、次式が成立する(単位はradian)。
以上の通り、測定手順1〜6により、式(7)(8)中の未知数4つの全てについて解を求めることができる。
4.2.1. 測定手順1(2軸2方位データ収集)
先ず、図2に示す回転操作部5を操作して直交二軸加速度センサー10x,10yを回転させ、0度→180度→0度(360度)の順に各測定方位で停止させる。各測定方位にて、静止状態で2軸2方位での測定値を加速度センサー10x,10yにて収集する。図17は、2軸2方位で測定した時の測定方位(0度、180度、360度)毎の加速度センサー10xの測定値を示す(Y軸は省略)。図7に示す2軸4方位回転測定と同様に、0度と360度で値が同じである場合、この測定の間に加速度センサー10xの出力中のドリフトが安定していると仮定する。もし変動があるようなら、その差分を動的誤差として各測定に等分に割り当てて引き算する。なお、図17の縦軸も図7と同様に測定値そのものではなく、予想される最大振幅と測定結果の比(振幅±1)に正規化されている。2軸2方位データを図18の通り定義する。
次に、式(7)(8)中の動的誤差である、測定中のドリフトDxΔTΔTn,DyΔTΔTnを測定する。図17について上述した通り、もし最初(0度)と最後(360度=0度)の測定値が等しい場合には測定中のドリフトは無視できるが、変動があるようなら、2軸4方位回転測定の測定手順2(4.1.1)と同様にして、最初(0度)と最後(360度)の測定値の差分からドリフトDxΔTΔTn,DyΔTΔTnを求めることができる。
2軸4方位回転測定の処理手順3(4.1.3)と同様にして、式(13)で定義されるX’0とX’1との平均から静的誤差DFxを求め、Y’0とY’1との平均から静的誤差DFyを求める。
次に、動的誤差が除去された一次加工データX’からさらに静的誤差DFxを除去するために次式を計算し、図20に示す二次加工データを求める。
以上により、2軸2方位回転測定から、動的誤差、静的誤差及び傾斜誤差の全てを求めることができる。
処理手順4で求められた二次加工データX”n,Y”nを次式の通り変形して、X”0,X”1,Y”0,Y”1をそれぞれ求める。
以上の通り、2軸2方位データから傾斜角φを求めることができる。
先ず、手順5で求めた傾斜量Iφで、手順4で求められた各二次加工データX”nを式(14)の通り除算して規格化して、図22に示す三次加工データX'''nを求める。
次に、0度及び180度の三次加工データについて、X軸を実数としY軸を虚数として複素数Vを表すと次の通りとなる。
以上の通り、測定手順1〜6により、2軸2方位回転測定でも式(7)(8)中の未知数4つの全てについて解を求めることができる。なお、2軸4方位回転測定と比べると、2軸2方位回転測定ではデータ数が小さくなるので精度は劣化するが、測定量が約1/2となるので計測上の負荷は減少する。
4.3. 回転角が90度の整数倍以外を含む回転測定の一般的手法
上述した各実施形態では加速度センサーの回転角度を90度の整数倍としたが、以下、90度の整数倍の以外の回転角を含む方位回転測定の一般的手法について説明する。
加速度センサーの検出軸を回転させ方向を変えて静止状態で測定する計測を連続して行う。図27に示すように、加速度センサーの検出軸を回転させて所望の方向に向ける区間tSと、静止状態の間に加速度を測定する区間tRとの一対で、一方向の測定を構成する。この一方向の測定が繰り返され、検出軸を回転させて方向を変えながら連続して計測する。測定方位を変えながら測定された連続した測定データから、誤差を測定するデータ処理の区間を切り出し、これを1サイクルとする。計測方向は、円周(2π)を3以上の自然数で割った角度ステップで計測する。円の中心から円に内接する正多角形の頂点への方向を測定方位とする。1サイクルの区間をm=0,1,2,…,mmとする。1サイクル区間は、区間の最初の測定方向(基準方位)m=0とし、この方向から回転したその他の方向の測定と、最初の測定方向(基準方位)と同じ方向の測定m=mmまでの区間とする。この1サイクルの区間内に設定される方位は、最初の方位(基準方位)と、基準方位と同じ方向である最後の方位と、その他の方位とは、誤差を測定するために必要なすべての方位を含む。測定に必要な全ての方位が1サイクル中に1回以上含まれる。従って、1サイクルの区間の長さは異なる場合がある。方位を変更する回転の方向は交互に反転してもよい。また、隣り合うサイクル区間の回転は、サイクル区間内の方向順番が対称であってもよいし、あるいは同順であってもよい。
測定結果を次のモデル式でそれぞれのパラメータが表される関係とする。測定データからそれぞれの項が44見積もられる。
測定方位毎のデータは、測定方位番号nで区分された測定値Dnと測定方位角θnの組合せとし、それらを図33に示す1次加工データDn’とする。
次に、1次加工データの平均値を計算して、静的誤差DFを算出する。ただし、測定方位番号n=0,1,2,…,nnであり、測定方位数はnnである。
1次加工データDn’から静的誤差DFを減算して二次加工データDn”を生成する。この二次加工データを図34に示す。
測定方位角θnと二次加工データDn”の関係は次式で表される。
それぞれの測定サイクルをk=1,2,…,kk回繰り返して計測したとき、測定サイクルkで得られた計測値を次の通り定義する。
それぞれの測定サイクルをk=1,2,…として、サイクルの測定区間の温度センサー出力Tmの平均を計算し、Tmをサイクル区間の測定温度とする。kサイクルの測定温度平均値Tkは次の通りとなる。
加速度センサーの入出力を次の通り定義して、補正を行うことができる。
次に、図37を参照して、上述した処理手順1〜7に従った更正値の更新動作につて説明する。先ず、加速度センサーに関して、図4に示す水平座標系への関連付け、測定条件等が初期設定される(ステップ1)。個別の測定条件として、例えば図26に示すようにランダムドリフトレートDRが最小となる測定条件を設定し(ステップ2)、図26に示す区間A−Bを初期設定する(ステップ3)。その後、図27〜図30に示すようにして加速度センサーを順次回転静止させて測定を行う(ステップ4)。各回転静止毎に、図27〜図30に示す1サイクル区間の定義の判定を実施する(ステップ5)。図27〜図30に示す1サイクル区間が成立していなければ(ステップ6がNO)、ステップ4に戻る。1サイクル区間が成立していれば(ステップ6がYES)、ステップ7に移行する。ステップ7では、加速度センサーの出力Dmから動的誤差を引き算して一次加工データを生成し、さらに1サイクル区間で一次加工データの平均値を生成する。さらに、一次加工データから静的誤差を引き算して二次加工データを求め、二次加工データに基づいて各種の補正値を計算する(ステップ8)。全サイクルについて回転静止位置での測定が終了したか否かが判断され(ステップ9)、ステップ9での判断がNOであればステップ4に戻り、ステップ9での判断がYESであればステップ10に移行する。ステップ10では、統計計算として例えば全サイクルk=1〜kkでの計測値の平均が求められ、その統計値が更正値として更新される(ステップ11)。
図38は、上述した処理手順1〜8に従った傾斜角、傾斜方位角、傾斜量等の傾斜計測定動作について説明する。図38において、ステップ1〜ステップ11は図37と同じであり、ステップ12が追加されている。図38において、ステップ11にて更正値が更新された後に、傾斜角、傾斜方位角、傾斜量等の傾斜計測定動作が終了したか否かが判断される(ステップ12)。ステップ12での判断がNOであれば、ステップ4に戻って、ステップ4〜ステップ11による傾斜角、傾斜方位角、傾斜量等の傾斜計測定動作が行われる。ここで、図38のステップ10での統計計算では、測定データ及び更正値を用いて傾斜方位角の平均値θφR、傾斜量の平均値IφR、傾斜角の平均値φRが求められる。
Claims (14)
- 重力方向と交差する仮想平面に直交二軸の検出軸を有する加速度センサーの前記直交二軸の一方の検出軸を、基準方位に設定した第1測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から180度離れた第2測定方位と、前記基準方位に戻した第3測定方位と、の各々に設定した静止状態にて測定される前記直交二軸の検出軸を有する加速度センサーの出力を用いて、前記第1〜第3測定方位の各々で異なる動的誤差を測定する誤差測定工程と、
前記第1測定方位及び前記第2測定方位に設定された前記加速度センサーの出力から、前記動的誤差と、前記第1〜第3測定方位の各々で実質的に一定の静的誤差とが除去された、前記仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、前記傾斜角及び前記傾斜方位角の少なくとも一方を測定する傾斜度測定工程と、
を有し、
前記誤差測定工程は、前記第1測定方位及び前記第3測定方位に設定された前記加速度センサーの出力の差分に基づいて、前記動的誤差を測定する工程を含むことを特徴とする傾斜度測定方法。 - 請求項1に記載の傾斜度測定方法において、
前記傾斜度測定工程は、前記直交二軸の検出軸をX軸及びY軸とし、前記傾斜角をφとし、前記傾斜方位角をθとし、前記仮想平面に投影される重力成分をIφとしたとき、前記第1測定方位での重力のX軸成分X”0=Iφ(cosθ)及びY軸成分Y”0=Iφ(sinθ)と、前記第2測定方位での重力のX軸成分X”1=−X”0及びY成分Y”1=−Y”0とを求め、前記第1測定方位と前記第2測定方位での重力の前記X軸成分の平均値X”01=(X”0−X”1)/2と、前記第1測定方位と前記第2測定方位での重力の前記Y軸成分の平均値Y”01=(Y”0−Y”1)/2とを用いて、Iφ=(X”01 2+Y”01 2)1/2を求め、傾斜角φ=180×Iφ/πを算出することを特徴とする傾斜度測定方法。 - 請求項1に記載の傾斜度測定方法において、
前記傾斜度測定工程は、前記直交二軸の検出軸をX軸及びY軸とし、前記傾斜角をφとし、前記傾斜方位角をθとし、前記仮想平面に投影される重力成分をIφとしたとき、前記第1測定方位での重力のX軸成分X”0=Iφ(cosθ)及びY軸成分Y”0=Iφ(sinθ)と、前記第2測定方位での重力のX軸成分X”1=−X”0及びY成分Y”1=−Y”0、前記第2測定方位での重力のX軸成分X”1=−X”0及びY成分Y”1=−Y”0と、を求め、前記第1測定方位と前記第2測定方位での重力の前記X軸成分の平均値X”01=(X”0−X”1)/2と、前記第1測定方位と前記第2測定方位での重力の前記Y軸成分の平均値Y”01=(Y”0−Y”1)/2とを用いてIφ=(X”01 2+Y”01 2)1/2を求め、前記X及びY軸成分X”0、X”1、Y”0、Y”1をIφで除して正規化して、前記傾斜方位角θを測定することを特徴とする傾斜度測定方法。 - 重力方向と交差する仮想平面に直交二軸の検出軸を有する加速度センサーの前記直交二軸の検出軸の一方を、基準方位に設定した第1測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から90度離れた第2測定方位と、前記法線の周りの回転位置にて前記第1測定方位から180度離れた第3測定方位と、前記法線の周りの回転位置にて前記第1測定方位から270度離れた第4測定方位と、前記基準方位に戻した第5測定方位と、の各々で静止状態にて測定される前記加速度センサーの前記直交二軸の検出軸の出力を用いて、前記第1〜第5測定方位の各々で異なる動的誤差を測定する誤差測定工程と、
前記第1〜第4測定方位に設定された前記加速度センサーの出力から、前記動的誤差と、前記第1〜第5測定方位の各々で実質的に一定の静的誤差とが除去された、前記仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、前記傾斜角及び前記傾斜方位角の少なくとも一方を測定する傾斜度測定工程と、
を有し、
前記誤差測定工程は、前記第1測定方位及び前記第5測定方位に設定された前記加速度センサーの出力の差分に基づいて、前記動的誤差を測定する工程を含むことを特徴とする傾斜度測定方法。 - 請求項4に記載の傾斜度測定方法において、
前記傾斜度測定工程は、前記直交二軸の検出軸をX軸及びY軸とし、前記傾斜角をφとし、前記傾斜方位角をθとし、前記仮想平面に投影される重力成分をIφとしたとき、前記第1測定方位での重力のX軸成分X”0=Iφ(cosθ)及びY軸成分Y”0=Iφ(sinθ)と、前記第2測定方位での重力のX軸成分X1=Iφ(sinθ)及びY成分Y1=Iφ(cosθ)と、前記第3測定方位での重力のX成分X”2=−X”0及びY成分Y”2=−Y”0と、前記第4測定方位での重力のX軸成分X”3=−X”1及びY成分Y”3=−Y”1とを求め、前記第1測定方位と前記第3測定方位での重力の前記X軸成分の平均値X”03=(X”0−X”3)/2または前記Y軸成分の平均値Y”03=(Y”0−Y”3)/2と、前記第2測定方位と前記第4測定方位での重力の前記X軸成分の平均値X”24=(X”2−X”4)/2または前記Y軸成分の平均値Y”24=(Y”2−Y”4)/2とを用いて、Iφ=(X”03 2+X”24 2)1/2またはIφ=(Y”03 2+Y”24 2)1/2を求め、傾斜角φ=180×Iφ/πを算出することを特徴とする傾斜度測定方法。 - 請求項4に記載の傾斜度測定方法において、
前記傾斜度測定工程は、前記直交二軸の検出軸をX軸及びY軸とし、前記傾斜角をφとし、前記傾斜方位角をθとし、前記仮想平面に投影される重力成分をIφとしたとき、前記第1測定方位での重力のX軸成分X”0=Iφ(cosθ)及びY軸成分Y”0=Iφ(sinθ)と、前記第2測定方位での重力のX軸成分X1=Iφ(sinθ)及びY成分Y1=Iφ(cosθ)と、前記第3測定方位での重力のX成分X”2=−X”0及びY成分Y”2=−Y”0と、前記第4測定方位での重力のX軸成分X”3=−X”1及びY成分Y”3=−Y”1とを求め、前記第1測定方位と前記第3測定方位での重力の前記X軸成分の平均値X”03=(X”0−X”3)/2または前記Y軸成分の平均値Y”03=(Y”0−Y”3)/2と、前記第2測定方位と前記第4測定方位での重力の前記X軸成分の平均値X”24=(X”2−X”4)/2または前記Y軸成分の平均値Y”24=(Y”2−Y”4)/2とを用いて、Iφ=(X”03 2+X”24 2)1/2またはIφ=(Y”03 2+Y”24 2)1/2を求め、前記X及びY軸成分X”0、X”1、Y”0、Y”1をIφで除して正規化して、前記傾斜方位角θを測定することを特徴とする傾斜度測定方法。 - 請求項3または6において、
前記傾斜度測定工程は、前記X及びY軸成分X”0、X”1、Y”0、Y”1をIφで除して正規化した、振幅が±1のX及びY軸成分X’‘‘0、X’‘‘1、Y’‘‘0、Y’‘‘1をガウス平面の直交座標に変換し、前記傾斜方位角θが前記ガウス平面の第1〜第4象限の何れに存在するかを判定する工程を含むことを特徴とする傾斜度測定方法。 - 請求項1〜7のいずれか一項に記載の傾斜度測定方法において、
前記検出軸を前記基準方位から回転させて前記基準方位に戻すまでの間の測定を1サイクルとしたとき、サイクル数nを2以上とする場合、nサイクルに亘って測定し、nサイクル目の前記第1測定方位を(n−1)サイクル目の測定方位として兼用することを特徴とする傾斜度測定方法。 - 請求項1〜8のいずれか一項に記載の傾斜度測定方法において、
前記加速度センサーの前記検出軸は、前記基準方位から第1方向に回転された後に、前記基準方位に向けて、前記第1方向とは逆方向の第2方向に回転されることを特徴とする傾斜度測定方法。 - 重力方向と交差する仮想平面に直交二軸の検出軸を有する加速度センサーの前記直交二軸の検出軸の一方を、基準方位に設定した第1測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から180度離れた第2測定方位と、前記基準方位に戻した第3測定方位と、の各々に設定する指令を出力する手段と、
前記第1〜第3測定方位にそれぞれ設定された前記加速度センサーの出力を受信する手段と、
前記加速度センサーの出力を用いて、前記第1〜第3測定方位の各々で異なる動的誤差を測定する誤差測定手段と、
前記前記第1測定方位及び前記第2測定方位の各々の測定方位に設定された前記加速度センサーの出力から、前記動的誤差と、前記第1〜第3測定方位の各々で実質的に一定の静的誤差とが除去された、前記仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、前記傾斜角及び前記傾斜方位角の少なくとも一方を測定する手段と、
を有し、
前記誤差測定手段は、前記第1測定方位及び前記第3測定方位に設定された前記加速度センサーの出力の差分に基づいて、前記動的誤差を測定することを特徴とする傾斜度測定装置。 - 重力方向と交差する仮想平面に直交二軸の検出軸を有する加速度センサーの前記直交二軸の検出軸の一方を、基準方位に設定した第1測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から90度離れた第2測定方位と、前記法線の周りの回転位置にて前記第1測定方位から180度離れた第3測定方位と、前記法線の周りの回転位置にて前記第1測定方位から270度離れた第4測定方位と、前記基準方位に戻した第5測定方位と、の各々に設定する指令を出力する手段と、
前記第1〜第5測定方位にそれぞれ設定された前記加速度センサーの出力を受信する手段と、
前記加速度センサーの出力を用いて、前記第1〜第5測定方位の各々で異なる動的誤差を測定する誤差測定手段と、
前記前記第1〜第4測定方位の各々の測定方位に設定された前記加速度センサーの出力から、前記動的誤差と、前記第1〜第5測定方位の各々で実質的に一定の静的誤差とが除去された、前記仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、前記傾斜角及び前記傾斜方位角の少なくとも一方を測定する手段と、
を有し、
前記誤差測定手段は、前記第1測定方位及び前記第5測定方位に設定された前記加速度センサーの出力の差分に基づいて、前記動的誤差を測定することを特徴とする傾斜度測定装置。 - 請求項10または11に記載の傾斜度測定装置を有することを特徴とする電子機器。
- 重力方向と交差する仮想平面に直交二軸の検出軸を有する加速度センサーの前記直交二軸の検出軸の一方を、基準方位に設定した第1測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から180度離れた第2測定方位と、前記基準方位に戻した第3測定方位と、の各々に設定する指令を出力する手順と、
前記第1〜第3測定方位に設定された前記加速度センサーからの出力を受信する手順と、
前記第1〜第3測定方位の各々にて、静止状態で測定される前記加速度センサーの出力を用いて、前記第1〜第3測定方位の各々で異なる動的誤差を測定する手順と、
前記第1測定方位及び前記第2測定方位の各々の測定方位に設定された前記加速度センサーの出力から、前記動的誤差と、前記第1〜第3測定方位の各々で実質的に一定の静的誤差とが除去された、前記仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、前記傾斜角及び前記傾斜方位角の少なくとも一方を測定する手順と、
をコンピューターに実施させ、
前記動的誤差を測定する手順は、前記第1測定方位及び前記第3測定方位での前記加速度センサーの出力の差分に基づいて、前記動的誤差を測定する手順を含むことを特徴とするプログラム。 - 重力方向と交差する仮想平面に直交二軸の検出軸を有する加速度センサーの前記直交二軸の検出軸の一方を、基準方位に設定した第1測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から90度離れた第2測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から180度離れた第3測定方位と、前記仮想平面に対する法線の周りの回転位置にて前記第1測定方位から270度離れた第4測定方位と、前記基準方位に戻した第5測定方位と、の各々に設定する指令を出力する手順と、
前記第1〜第5測定方位に設定された前記加速度センサーからの出力を受信する手順と、
前記第1〜第5測定方位の各々にて、静止状態で測定される前記加速度センサーの出力を用いて、前記第1〜第5測定方位の各々で異なる動的誤差を測定する手順と、
前記第1〜第4測定方位の各々の測定方位に設定された前記加速度センサーの出力から、前記動的誤差と、前記第1〜第5測定方位の各々で実質的に一定の静的誤差とが除去された、前記仮想平面が水平面に対して傾斜する傾斜角及び傾斜方位角に依存するデータに基づいて、前記傾斜角及び前記傾斜方位角の少なくとも一方を測定する手順と、
をコンピューターに実施させ、
前記動的誤差を測定する手順は、前記第1測定方位及び前記第5測定方位での前記加速度センサーの出力の差分に基づいて、前記動的誤差を測定する手順を含むことを特徴とするプログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015093909A JP6485195B2 (ja) | 2015-05-01 | 2015-05-01 | 傾斜度測定方法及び装置並びに電子機器及びプログラム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015093909A JP6485195B2 (ja) | 2015-05-01 | 2015-05-01 | 傾斜度測定方法及び装置並びに電子機器及びプログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2016211906A true JP2016211906A (ja) | 2016-12-15 |
JP6485195B2 JP6485195B2 (ja) | 2019-03-20 |
Family
ID=57549548
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015093909A Expired - Fee Related JP6485195B2 (ja) | 2015-05-01 | 2015-05-01 | 傾斜度測定方法及び装置並びに電子機器及びプログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6485195B2 (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109211265A (zh) * | 2017-07-07 | 2019-01-15 | 北京凌云智能科技有限公司 | 两轮车及两轮车车体倾角测量校准方法 |
EP3578995A1 (de) * | 2018-06-08 | 2019-12-11 | Robert Bosch GmbH | Verfahren zur online-kalibrierung eines sensors eines fahrzeugs |
CN111676656A (zh) * | 2020-05-30 | 2020-09-18 | 广东蓝水花智能电子有限公司 | 洗衣机水平调整提醒方法、装置及系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008241490A (ja) * | 2007-03-28 | 2008-10-09 | Seiko Epson Corp | センサ用補正装置、プロジェクタ、測定値の補正方法、および補正プログラム |
JP2012154769A (ja) * | 2011-01-26 | 2012-08-16 | Seiko Epson Corp | 加速度検出方法、位置算出方法及び加速度検出装置 |
JP5381347B2 (ja) * | 2009-06-02 | 2014-01-08 | 富士通株式会社 | センサ較正装置 |
JP6167747B2 (ja) * | 2013-08-14 | 2017-07-26 | セイコーエプソン株式会社 | バイアス算出方法及びバイアス算出装置 |
-
2015
- 2015-05-01 JP JP2015093909A patent/JP6485195B2/ja not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008241490A (ja) * | 2007-03-28 | 2008-10-09 | Seiko Epson Corp | センサ用補正装置、プロジェクタ、測定値の補正方法、および補正プログラム |
JP5381347B2 (ja) * | 2009-06-02 | 2014-01-08 | 富士通株式会社 | センサ較正装置 |
JP2012154769A (ja) * | 2011-01-26 | 2012-08-16 | Seiko Epson Corp | 加速度検出方法、位置算出方法及び加速度検出装置 |
JP6167747B2 (ja) * | 2013-08-14 | 2017-07-26 | セイコーエプソン株式会社 | バイアス算出方法及びバイアス算出装置 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109211265A (zh) * | 2017-07-07 | 2019-01-15 | 北京凌云智能科技有限公司 | 两轮车及两轮车车体倾角测量校准方法 |
EP3578995A1 (de) * | 2018-06-08 | 2019-12-11 | Robert Bosch GmbH | Verfahren zur online-kalibrierung eines sensors eines fahrzeugs |
CN111676656A (zh) * | 2020-05-30 | 2020-09-18 | 广东蓝水花智能电子有限公司 | 洗衣机水平调整提醒方法、装置及系统 |
CN111676656B (zh) * | 2020-05-30 | 2023-08-08 | 广东蓝水花智能电子有限公司 | 洗衣机水平调整提醒方法、装置及系统 |
Also Published As
Publication number | Publication date |
---|---|
JP6485195B2 (ja) | 2019-03-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8010308B1 (en) | Inertial measurement system with self correction | |
JP2004286732A5 (ja) | ||
JP5017539B1 (ja) | 地磁気を測定し、利用する応用機器 | |
JP5706576B2 (ja) | オフセット推定装置、オフセット推定方法、オフセット推定プログラムおよび情報処理装置 | |
CN102269592A (zh) | 基于传感器的定向系统 | |
CN109459585B (zh) | 一种加速度计零位偏置修正方法 | |
JP5086225B2 (ja) | 磁気方位センサのキャリブレーション装置、方法およびプログラム | |
KR20120107439A (ko) | 자체 보정 멀티-자기력계 플랫폼을 위한 시스템 및 방법 | |
JP6485195B2 (ja) | 傾斜度測定方法及び装置並びに電子機器及びプログラム | |
TW201428297A (zh) | 使用磁力儀及加速度儀之角速度估計 | |
KR101503046B1 (ko) | 다축 감지 장치 및 이의 교정 방법 | |
JP2015225083A (ja) | レーザおよびレーザ光センサを使用して閉軌道を判定する方法ならびに閉軌道を判定する装置 | |
CN105444722B (zh) | 检测平台姿态变化的方法 | |
US9279682B2 (en) | Inertial unit having vibrating gyros mounted on a carousel, and an angle-measurement method | |
JP6550906B2 (ja) | 傾斜度測定方法及び装置並びに電子機器及びプログラム | |
JP2009186244A (ja) | 傾斜角度推定システム、相対角度推定システム及び角速度推定システム | |
JP6477214B2 (ja) | 傾斜度測定方法及び装置並びに電子機器及びプログラム | |
JP6485194B2 (ja) | 誤差測定方法及び装置、バイアス補正方法及び装置、電子機器及びプログラム | |
US8528220B2 (en) | Six-direction indicator | |
Łuczak | Specific measurements of tilt with MEMS accelerometers | |
JP2006337333A (ja) | 3軸型電子コンパス及びこれを用いた方位検出方法 | |
JP5424224B2 (ja) | 相対角度推定システム | |
CN109974575A (zh) | 用于使用自动增益调整算法检测旋转角度的方法及其设备 | |
Chu et al. | Error-separation method for the calibration of magnetic compass | |
JP2017193012A (ja) | 回転2軸運動の同期精度の診断方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20180405 |
|
RD05 | Notification of revocation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7425 Effective date: 20180904 |
|
RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20181107 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20190118 |
|
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: 20190122 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20190204 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6485195 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
LAPS | Cancellation because of no payment of annual fees |