JP2011069633A - Portable device - Google Patents
Portable device Download PDFInfo
- Publication number
- JP2011069633A JP2011069633A JP2009218759A JP2009218759A JP2011069633A JP 2011069633 A JP2011069633 A JP 2011069633A JP 2009218759 A JP2009218759 A JP 2009218759A JP 2009218759 A JP2009218759 A JP 2009218759A JP 2011069633 A JP2011069633 A JP 2011069633A
- Authority
- JP
- Japan
- Prior art keywords
- axis
- acceleration
- rotation angle
- portable device
- rotation
- 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.)
- Pending
Links
Images
Landscapes
- Navigation (AREA)
Abstract
Description
本発明は、持ち歩き可能な携帯機器に関するものであり、特に、携帯することで歩行者ナビゲーションとして使用したり、車両などに設置してカーナビゲーションとして使用したりする携帯機器に関するものである。 The present invention relates to a portable device that can be carried around, and more particularly to a portable device that is used as pedestrian navigation by being carried or used as car navigation by being installed in a vehicle or the like.
近年、据付型のナビゲーション装置よりも機能を簡略化し、本体を小型軽量化することで携帯可能なPND(Portable Navigation Device)と呼ばれる簡易型のナビゲーション装置が普及している。 In recent years, a simple navigation device called PND (Portable Navigation Device) that is portable by simplifying functions and reducing the size and weight of the main body of the navigation device has become widespread.
PNDは、GPS信号を受信して自らの現在位置を検出するほか、GPS信号が取得できない場合のための補助的手段として、加速度センサやジャイロセンサを内蔵することでGPSよりも正確な現在位置を検出することが可能である。 In addition to detecting the current position of the PND by receiving the GPS signal, the PND provides a more accurate current position than the GPS by incorporating an acceleration sensor and a gyro sensor as an auxiliary means when the GPS signal cannot be acquired. It is possible to detect.
また、PNDは、車内のダッシュボードへの取り付け、取り外しが容易に行えるため、その取り付け作業はユーザ自らによって行われている。しかしながら、自立航法式に用いられる加速度センサやジャイロセンサ等は、所定の方向を向くように正しい姿勢で取り付けなければ、それぞれの取り付け角度に起因する誤差によって現在位置が正確に検出することができない。 Further, since the PND can be easily attached to and detached from the dashboard inside the vehicle, the attachment work is performed by the user himself. However, if an acceleration sensor, a gyro sensor, or the like used in the self-contained navigation system is not attached in a correct posture so as to face a predetermined direction, the current position cannot be accurately detected due to an error caused by each attachment angle.
そこで、この種のセンサを用いて携帯端末機器の姿勢角度を検出する従来技術としては、例えば、下記の特許文献1(特開2002−164987号公報)に開示されている。この特許文献1には、1軸もしくは2軸しかない姿勢角度センサ(ジャイロセンサ、加速度センサ、地磁気センサ等)を含む姿勢角度検出装置の取り付け角度を、角度検出基準面に対して45度±20度で実装することにより、携帯端末機器を使用する際の傾きの制限を緩和することができる。
Therefore, as a conventional technique for detecting the attitude angle of a mobile terminal device using this type of sensor, for example, it is disclosed in the following Patent Document 1 (Japanese Patent Laid-Open No. 2002-164987). In this
ところで、PNDは、車両に一度正しく取り付けた場合であってもPNDに対する入力操作や車両の振動などによって使用中に取り付け角度が変動したり、PNDを持ち歩いて使用する際にその姿勢角度が様々に振動したりするので、現在位置や移動距離を正確に検出するには、PNDの姿勢角度の変動を正確に検出して姿勢角度の変動によるセンサの出力誤差を補正する必要があった。 By the way, even if the PND is correctly attached to the vehicle once, the mounting angle varies during use due to an input operation to the PND or the vibration of the vehicle, or the posture angle varies when carrying the PND while being used. In order to accurately detect the current position and moving distance, it is necessary to accurately detect the change in the attitude angle of the PND and correct the output error of the sensor due to the change in the attitude angle.
そこで、上記特許文献1に示すような姿勢角度検出装置を用いて姿勢角を検出することも考えられるが、携帯電話を使用する際に好適となるように検出装置を携帯電話などの端末機器に所定の角度で取付けなければならないという制限があるため、使用時にどのような姿勢角に変動するかが不明なPNDのような車両に設置可能な機器には適用が難しいという問題点があった。また、上記特許文献1においては、この姿勢角の変動を正確に検出する点については考慮されていなかった。
Therefore, it is conceivable to detect the attitude angle by using the attitude angle detection device as shown in
したがって、本発明は、上記の問題点を解消することを課題とし、各種センサを備えた携帯機器の使用時の姿勢角度の変動を精度良く検出でき、正確にセンサからの出力を補正することが可能な携帯機器を提供することを目的とするものである。 Accordingly, an object of the present invention is to eliminate the above-described problems, and to accurately detect a change in posture angle when using a portable device having various sensors, and to accurately correct the output from the sensor. The object is to provide a portable device that can be used.
前記課題を解決するため、本願の請求項1に係る発明は、
携帯機器に加わる加速度に基づき当該携帯機器の姿勢角を補正する携帯機器であって、
前記携帯機器の3軸方向への加速度を検出する加速度検出手段(例えば下記実施例では、加速度センサ131)と、
前記加速度検出手段により検出された3軸方向の加速度成分に基づいて、前記携帯機器が回転した回転軸を検出する回転軸検出手段(例えば下記実施例では、回転軸検出部182)と、
前記回転軸検出手段により検出された回転軸周りの前記携帯機器の回転角を算出する回転角算出手段(例えば下記実施例では、回転角算出部183)と、
前記回転角算出手段により算出された前記回転角の大きさに応じて、前記3軸方向の加速度成分の論理値を交換する軸交換手段(例えば下記実施例では、軸交換手段133)と、
を備えたことを特徴とする。
In order to solve the above-mentioned problem, the invention according to
A mobile device that corrects the attitude angle of the mobile device based on acceleration applied to the mobile device,
Acceleration detecting means for detecting acceleration in the three-axis direction of the portable device (for example,
Based on the acceleration components in the three-axis directions detected by the acceleration detection means, a rotation axis detection means (for example, a rotation
A rotation angle calculation means for calculating the rotation angle of the portable device around the rotation axis detected by the rotation axis detection means (for example, in the following embodiment, a rotation angle calculation unit 183);
Axis exchanging means (for example, axis exchanging means 133 in the following embodiment) for exchanging logical values of acceleration components in the three-axis directions according to the magnitude of the rotation angle calculated by the rotation angle calculating means;
It is provided with.
また、本願の請求項2に係る発明は、請求項1に係る携帯機器において、
前記携帯機器の3軸周りの角速度を検出する角速度検出手段(例えば下記実施例では、ジャイロセンサ132)を備え、
前記軸交換手段は、前記回転角の大きさに応じて、前記3軸周りの角速度の論理値を交換することを特徴とする。
The invention according to claim 2 of the present application is the portable device according to
An angular velocity detection means (for example,
The axis exchanging means exchanges logical values of angular velocities around the three axes in accordance with the magnitude of the rotation angle.
また、本願の請求項3に係る発明は、請求項1または請求項2に係る携帯機器において、
前記回転角算出手段は、算出する回転角の大きさを、前記加速度検出手段により検出された3軸方向の加速度成分のうち所定の軸に関する加速度成分から算出することを特徴とする。
Further, the invention according to claim 3 of the present application is the portable device according to
The rotation angle calculation means calculates the magnitude of the rotation angle to be calculated from acceleration components related to a predetermined axis among the acceleration components in the three-axis directions detected by the acceleration detection means.
また、本願の請求項4に係る発明は、請求項3に係る携帯機器において、
前記回転角算出手段により算出された回転角に基づいて、前記姿勢角を補正する姿勢角補正手段(例えば下記実施例では、姿勢角補正部184)を備えたことを特徴とする。
The invention according to claim 4 of the present application is the portable device according to claim 3,
An attitude angle correction unit (for example, an attitude
上記の構成により、本発明は下記に示すような優れた効果を奏する。すなわち、請求項1に係る発明においては、携帯機器は、加速度検出手段により検出された3軸方向の加速度成分に基づいて、前記携帯機器が回転した回転軸を検出し、検出された回転軸周りの携帯機器の回転角を算出し、算出された回転角の大きさに応じて、前記3軸方向の加速度成分の論理値を交換するようにしている。
With the above configuration, the present invention has the following excellent effects. That is, in the invention according to
このような構成によれば、携帯機器の回転角度に関係なく、加速度検出手段により検出された3軸方向の加速度成分に関する出力値を容易に把握することができる携帯機器を提供できる。 According to such a configuration, it is possible to provide a portable device that can easily grasp the output value related to the acceleration component in the three-axis directions detected by the acceleration detecting means regardless of the rotation angle of the portable device.
また、請求項2に係る発明においては、請求項1に係る携帯機器において、携帯機器の3軸周りの角速度を検出する角速度検出手段からの出力についても前記回転角の大きさに応じて、前記3軸周りの角速度の論理値を交換するようにしている。このような構成によれば、携帯機器の回転角度に関係なく、角速度検出手段により検出された3軸周りの角速度成分に関する出力値を容易に把握することができる携帯機器を提供できる。
Further, in the invention according to claim 2, in the portable device according to
また、請求項3に係る発明においては、請求項1または請求項2に係る携帯機器において、算出する回転角の大きさを、前記加速度検出手段により検出された3軸方向の加速度成分のうち所定の軸に関する加速度成分から算出するようにしている。このような構成によれば、携帯機器が回転した回転軸周りの回転角の大きさを、加速度検出手段により検出された3軸方向の加速度成分のうち最も回転角の変化率を正確に検出することが可能な所定の軸に関する加速度成分を用いて回転角を算出することが可能となり、携帯機器の姿勢角などを正確に補正することができる携帯機器を提供できる。
In the invention according to claim 3, in the portable device according to
また、請求項4に係る発明においては、請求項3に係る携帯機器において、算出された回転角に基づいて、前記携帯機器の姿勢角を補正する。このような構成によれば、携帯機器が回転した回転軸周りの回転角の大きさに応じて、加速度検出手段により検出された3軸方向の加速度成分のうちから最も回転角の変化率を正確に検出することが可能な所定の軸に関する加速度成分を用いて回転角を算出することが可能となり、さらに携帯機器の姿勢角などを正確に補正することができる携帯機器を提供できる。 In the invention according to claim 4, in the portable device according to claim 3, the attitude angle of the portable device is corrected based on the calculated rotation angle. According to such a configuration, the change rate of the rotation angle is most accurately determined from the acceleration components in the three-axis directions detected by the acceleration detecting unit according to the magnitude of the rotation angle around the rotation axis around which the portable device is rotated. Thus, it is possible to calculate the rotation angle using the acceleration component related to the predetermined axis that can be detected, and it is possible to provide a portable device that can accurately correct the attitude angle of the portable device.
以下、本発明の具体例を実施例及び図面を用いて詳細に説明する。但し、以下に示す実施例は、本発明の技術思想を具体化するための携帯機器として車体に搭載可能なナビゲーション装置を例示するものであって、本発明をこのナビゲーション装置に特定することを意図するものではなく、特許請求の範囲に示した技術思想に含まれるその他の実施形態の携帯機器にも等しく適用し得るものである。 Hereinafter, specific examples of the present invention will be described in detail with reference to examples and drawings. However, the embodiment described below exemplifies a navigation device that can be mounted on a vehicle body as a portable device for embodying the technical idea of the present invention, and is intended to specify the present invention as this navigation device. However, the present invention is equally applicable to portable devices of other embodiments included in the technical idea shown in the claims.
まず、図1を参照して、本発明の実施例に係るナビゲーション装置の構成について説明する。図1は、本発明の実施例に係るナビゲーション装置の構成を示すブロック図である。ナビゲーション装置10は、制御手段100、通信手段110、GPS測位手段120、自立航法測位手段130、経路探索手段140、経路案内手段150、表示手段160、入力手段170、姿勢角補正手段180、記憶手段190を備えて構成される。
First, with reference to FIG. 1, the structure of the navigation apparatus based on the Example of this invention is demonstrated. FIG. 1 is a block diagram showing a configuration of a navigation device according to an embodiment of the present invention. The
制御手段100は、CPU100a、RAM100b、ROM100cからなるプロセッサで構成され、RAM100b又はROM100cに記憶されているプログラムをCPU100aにおいて実行することによってナビゲーション装置10の各部の動作を制御統括する。
The
通信手段110は、制御手段100の制御により、このナビゲーション装置10と通信可能な情報提供サーバ(図示せず)との間で地図データといった各種情報の送受信を行う。
The
GPS測位手段120は、地球上空を周回している複数のGPS衛星からの時刻情報を含む電波を受信し、それをもとにナビゲーション装置10を搭載した車体の現在位置情報を算出するものである。
The GPS positioning means 120 receives radio waves including time information from a plurality of GPS satellites orbiting the earth, and calculates current position information of the vehicle body on which the
自立航法測位手段130は、加速度センサ131とジャイロセンサ132を備えて構成される。加速度センサ131は、予め定められた3軸方向へのナビゲーション装置10の加速度を検出し、ジャイロセンサ132は、ナビゲーション装置10のX軸回り、Y軸回り及びZ軸回りの角速度を検出する。加速度センサ131とジャイロセンサ132は、それぞれ検出した加速度や角速度を制御手段100に出力する。
The self-contained
加速度センサ131が車体に対して正しい姿勢で設置された場合、図2(a)で示すように、加速度センサ131によって、車体の進行方向(本実施例ではX軸方向とする)への加速度Xと、車体の進行方向に水平面内で直交する方向(本実施例ではY軸方向とする)への加速度Yと、車体の進行方向(X軸方向)及びこの進行方向に水平面内で直交する方向(Y軸方向)に直交する方向(本実施例ではZ軸方向とする)への加速度Zとが検出される。
When the
ジャイロセンサ132が車体に対して正しい姿勢で設置されている場合、図2(b)で示すように、ジャイロセンサ132rによってX軸回りに車体が回転する際の角速度X(Roll角θr)が検出され、ジャイロセンサ132pによってY軸回りに車体が回転する際の角速度Y(Pitch角θp)が検出され、およびジャイロセンサ132yによってZ軸回りに車体が回転する際の角速度Z(Yaw角θy)が検出される。
When the
また、自立航法測位手段130は、車体に対して正しい姿勢で設置されていたナビゲーション装置10が所定の軸周りに回転した場合に回転した角度に応じて、加速度センサ131の各軸における出力の論理値あるいはジャイロセンサ132の各軸周りの出力の論理値を交換するための軸交換手段133を備えている。軸交換手段133による軸交換方法については後で詳細に説明する。
In addition, the self-contained navigation positioning means 130 outputs logic on each axis of the
経路探索手段140は、入力手段170の操作により出発地点や目的地点が指定されると、記憶手段190の地図記憶部192に記憶されている道路データを参照し、出発地点から目的地点に至るまでの最適経路を探索し、案内経路データを作成するものである。経路探索手段140によって探索された案内経路は、制御手段100によって、表示手段160に現在位置周辺の地図画像と共に表示され、目的地点までの案内に用いられる。
When the departure point and the destination point are designated by the operation of the
経路案内手段150は、経路探索手段140によって探索された案内経路データと、GPS測位手段120によって検出された現在位置とを比較し、現在位置において必要とされるガイダンスを図示しないスピーカなどから音声出力する。 The route guidance means 150 compares the guidance route data searched by the route search means 140 with the current position detected by the GPS positioning means 120, and outputs the guidance required at the current position from a speaker or the like not shown. To do.
表示手段160は、LCDなどのディスプレイパネルから構成される表示画面を備えた表示ユニットであり、地図画像や案内経路、現在位置などを表示する。
The
入力手段170は、操作ボタンやタッチパネルなどにより構成され、ナビゲーション装置10の各種機能を操作したり、所要の数値や文字を入力したりするものである。
The
姿勢角補正手段180は、姿勢角算出部181、回転軸検出部182、回転角算出部183、姿勢角補正部184を備えて構成される。
The posture
姿勢角算出部181は、加速度センサ131やジャイロセンサ132からの出力に基づいて、ナビゲーション装置10の車体に対する姿勢角度(取り付け角度)、或いはナビゲーション装置10を携帯して使用する際の姿勢角度を算出し、姿勢角度記憶部191に記憶させる。
The posture
回転軸検出部182は、加速度センサ131によって検出される重力加速度成分に基づいて、車体に対して設置されたナビゲーション装置10が所定位置からナビゲーション装置10の互いに直交する3軸(X軸、Y軸、Z軸)のうちのいずれの軸周りに対して回転して姿勢角度(取り付け角度)を変動させたか検出する。
Based on the gravitational acceleration component detected by the
回転角算出部183は、加速度センサ131から出力される3軸方向の加速度成分に基づいて、回転軸検出部182によって検出された回転軸周りのナビゲーション装置10の回転角を算出する。このとき、加速度センサ131から出力される3軸方向の加速度成分のうちで最も回転角の変化率が大きく、わずかな回転角であっても正確に検出できる軸方向の加速度成分を用いてナビゲーション装置10の回転角を算出する。
The rotation
すなわち、図2で示すように、ナビゲーション装置10の互いに直交する3軸をX軸、Y軸、Z軸(ここで、X軸は車体の進行方向と同じ軸、Y軸は車体の横軸、Z軸は車体の垂直軸)とし、加速度センサ131が、ナビゲーション装置10の互いに直交する3軸と同軸に配置されているとすると、回転角算出部183は、例えば、Y軸周りに回転した回転軸を算出する。
That is, as shown in FIG. 2, the three orthogonal axes of the
図2〜図4は、ナビゲーション装置がY軸周りに回転した場合のセンサの出力を説明するための図である。図2(a)〜図4(a)は、加速度センサの場合であり、図2(b)〜図4(b)は、ジャイロセンサの場合である。 2-4 is a figure for demonstrating the output of a sensor when a navigation apparatus rotates around the Y-axis. 2A to 4A show the case of the acceleration sensor, and FIGS. 2B to 4B show the case of the gyro sensor.
例えば、静止状態にあるナビゲーション装置10が、図3(a)で示すように、図2(a)で示す正しい姿勢からY軸周りに回転した場合、回転角度をθとすると、加速度センサ131のX軸成分(加速度X)とZ軸成分(加速度Z)の出力は、それぞれ
X=sinθ
Z=cosθ
と表わされる。ただし、ナビゲーション装置10に加わる重力加速度を1とする。
For example, when the
Z = cos θ
It is expressed as However, the gravitational acceleration applied to the
図5は、Y軸周りの回転を検出する場合の角度θに対する加速度センサのX軸成分およびZ軸成分をそれぞれ表示した図である。 FIG. 5 is a diagram displaying the X-axis component and the Z-axis component of the acceleration sensor with respect to the angle θ when rotation about the Y-axis is detected.
回転角度が、0°≦θ≦45°と小さい(傾きが小さい)場合には、cosθは1に近く、逆にsinθが大きく変化する。このため、加速度センサ131のX軸成分であるX=sinθの値から、回転角θは、
θ=sin-1X
となり、X軸成分の変動に応じてθを正確に求めることできる。したがって、姿勢角の補正を精度良く行うことができる。
When the rotation angle is as small as 0 ° ≦ θ ≦ 45 ° (the inclination is small), cos θ is close to 1, and conversely sin θ changes greatly. Therefore, from the value of X = sin θ, which is the X-axis component of the
θ = sin −1 X
Thus, θ can be accurately obtained according to the variation of the X-axis component. Therefore, the posture angle can be corrected with high accuracy.
また、ナビゲーション装置10が、図4(a)で示すように、図3(a)で示す姿勢からさらにY軸周りに回転した場合、回転角度が45°≦θ≦90°では、sinθは1に近く、逆にcosθが大きく変化する。したがって、加速度センサ131のZ軸成分であるZ=cosθの値から、回転角θは、
θ=cos-1Z
と求めることによって、姿勢角の補正を精度良く行うことができる。
Further, as shown in FIG. 4A, when the
θ = cos -1 Z
Thus, the posture angle can be corrected with high accuracy.
さらに、ナビゲーション装置10がY軸周りに回転すると、回転角度が90°≦θ≦135°では、sinθは1に近く、cosθは大きく変化するので、同様に、加速度センサ131のZ軸成分であるZ=cosθの値からθを求めることによって、精度良く姿勢角の補正を行うことができる。
Further, when the
以下同様に、図5で示すように、
回転角度が135°≦θ≦225°では、θ=sin-1X
回転角度が225°≦θ≦315°では、θ=cos-1Z
回転角度が315°≦θ≦360°では、θ=sin-1X
としてθを求めることができる。
Similarly, as shown in FIG.
When the rotation angle is 135 ° ≦ θ ≦ 225 °, θ = sin −1 X
When the rotation angle is 225 ° ≦ θ ≦ 315 °, θ = cos −1 Z
When the rotation angle is 315 ° ≦ θ ≦ 360 °, θ = sin −1 X
Can be obtained as follows.
姿勢角補正部184は、回転角算出部183によって算出された回転角に基づいて、姿勢角算出部181において算出された姿勢角度(取り付け角度)、或いは、すでに算出されて姿勢角度記憶部191に記憶されている姿勢角度(取り付け角度)の補正を行う。補正された姿勢角度は、改めて姿勢角度記憶部191に記憶される。
The posture
記憶手段190は、姿勢角度記憶部191、地図記憶部192を備えて構成される。姿勢角度記憶部191は、FRAM(登録商標)などの不揮発性メモリによって構成されており、姿勢角算出部181によって算出された車体に対するナビゲーション装置10の姿勢角度(取り付け角度)を記憶する。また、姿勢角補正部184によって補正された姿勢角度(取り付け角度)を記憶する。記憶された姿勢角度は、車体の走行距離や現在位置を算出する際に用いられる。
The
地図記憶部192には、各道路の交差点や分岐点などの結節点をノードとし、それぞれのノード間を結ぶ経路をリンクとした道路ノードデータと道路リンクデータを含む道路データが記憶されている。道路ノードデータには、道路ノードの番号、位置座標、接続リンク本数、交差点名称などが含まれる。また、道路リンクデータには起点および終点となる道路ノードの番号、道路種別、リンク長(リンクコスト)、所要時間、車線数、車道幅などが含まれる。道路リンクデータにはさらに、リンク属性として橋、トンネル、踏切、料金所などのデータが付与される。道路種別は、高速道路や有料道路の別および国道や都道府県道などの別を含む情報である。
The
また、地図記憶部192には、道路データの他、地図画像を見やすく表示するためにベクター形式で記憶された背景画像データを含んでいてもよい。道路データと背景画像データを含む地図画像データは、制御手段100により、ナビゲーション装置10を使用する際に、ナビゲーション装置10の現在位置を含む所定範囲が地図記憶部192から抽出され、現在位置を示す現在位置マークや案内経路の画像と重ね合わされて表示手段160に表示される。
In addition to road data, the
次に、図2と図4を参照して、本発明の実施例におけるナビゲーション装置10の軸交換手段133について説明する。
Next, with reference to FIG. 2 and FIG. 4, the axis | shaft exchange means 133 of the
図2(a)で示すように、ナビゲーション装置10が車体に対して正しい姿勢で設置されている場合、加速度センサ131のX軸成分(加速度X)の出力は、ナビゲーション装置10が取り付けられた車体の加速度を検出しており、車体が加速しているときにはプラスの値を出力し、車体が減速しているときにはマイナスの値を出力している。
As shown in FIG. 2A, when the
そして、加速度センサ131のY軸成分(加速度Y)の出力は、車体の右折時あるいは左折時の加速度を検出しており、車体が左折しているときにはプラスの値を出力し、車体が右折しているときにはマイナスの値を出力している。さらに、加速度センサ131のZ軸成分(加速度Z)の出力は、重力加速度を検出しており、プラスの値を出力している。
The output of the Y-axis component (acceleration Y) of the
一方、図4(a)で示すように、Y軸周りの回転角度θ=90°の場合、加速度センサ131のX軸成分(加速度X)の出力は、重力加速度を検出しており、マイナスの値を出力し、加速度センサ131のY軸成分(加速度Y)の出力は、図2(a)で示すθ=0°の場合と同じく、ナビゲーション装置10が取り付けられた車体の右折時あるいは左折時の加速度を検出しており、車体が左折しているときにはプラスの値を出力し、車体が右切しているときにはマイナスの値を出力している。
On the other hand, as shown in FIG. 4A, when the rotation angle θ around the Y axis is 90 °, the output of the X-axis component (acceleration X) of the
そして、加速度センサ131のZ軸成分(加速度Z)の出力は、車体の加速度を検出しており、車体が加速しているときにはプラスの値を出力し、車体が減速しているときにはマイナスの値を出力している。
The output of the Z-axis component (acceleration Z) of the
このように、Y軸周りの回転角度θ=0°とθ=90°において、加速度センサ131の3軸(物理軸)のうち、X軸成分(加速度X)とZ軸成分(加速度Z)の出力値が入れ代わるので、X軸とZ軸の論理軸が交換したものと見なすことができる。したがって、軸交換手段133は、加速度センサ131から出力される出力値に対して回転角算出部183によって算出されたY軸周りの回転角度θの大きさに応じて適した論理値(重力、加速度等)を割り当てる。
As described above, the X-axis component (acceleration X) and the Z-axis component (acceleration Z) of the three axes (physical axes) of the
また、図2(b)で示すように、ナビゲーション装置10が車体に対して正しい姿勢で設置されている場合、ジャイロセンサ132rのX軸成分(ジャイロX)の出力は、ナビゲーション装置10が取り付けられた車体のロールを検出しており、車体が右回転しているときにはプラスの値を出力し、車体が左回転しているときにはマイナスの値を出力している。
As shown in FIG. 2B, when the
そして、ジャイロセンサ132pのY軸成分(ジャイロY)の出力は、車体が走行している路面の傾斜(ピッチ)を検出しており、車体が下り傾斜を走行しているときにはプラスの値を出力し、車体が上り傾斜を走行しているときにはマイナスの値を出力している。さらに、ジャイロセンサ132yのZ軸成分(ジャイロZ)の出力は、車体の右折時あるいは左折時のヨー角を検出しており、車体が右折しているときにはプラスの値を出力し、車体が左折しているときにはマイナスの値を出力している。
The output of the Y-axis component (gyro Y) of the
一方、図4(b)で示すように、Y軸周りの回転角度θ=90°の場合、ジャイロセンサ132rのX軸成分(ジャイロX)の出力は、車体のヨー角を検出しており、車体が右折しているときにはプラスの値を出力し、車体が左折しているときにはマイナスの値を出力し、ジャイロセンサ132pのY軸成分(ジャイロY)の出力は、図4(a)で示すθ=0°の場合と同じく、車体が走行している路面の傾斜(ピッチ)を検出している。
On the other hand, as shown in FIG. 4B, when the rotation angle θ around the Y axis is 90 °, the output of the X axis component (gyro X) of the
そして、ジャイロセンサ132yのZ軸成分(ジャイロZ)の出力は、車体のロールを検出しており、車体が左回転しているときにはプラスの値を出力し、車体が右回転しているときにはマイナスの値を出力している。
The output of the Z-axis component (gyro Z) of the
このように、Y軸周りの回転角度θ=0°とθ=90°において、ジャイロセンサ132の3軸(物理軸)周りの出力のうち、X軸成分(ジャイロX)とZ軸成分(ジャイロZ)の出力値が入れ代わるので、X軸(ロール軸)とZ軸(ヨー軸)の論理軸が交換したものと見なすことができる。したがって、軸交換手段133は、ジャイロセンサ132から出力される出力値に対して回転角算出部183によって算出されたY軸周りの回転角度θの大きさに応じて適した論理値(左右回転、左右折等)を割り当てる。
Thus, of the outputs around the three axes (physical axes) of the
同様に、Y軸周りの回転角度θ=180°やθ=270°においても、回転角度に応じて、加速度センサ131の3軸(物理軸)のうち、X軸成分(加速度X)とZ軸成分(加速度Z)の出力値が入れ代り、また、ジャイロセンサ132の3軸(物理軸)周りの出力のうち、X軸成分(ジャイロX)とZ軸成分(ジャイロZ)の出力値が入れ代わることになる。
Similarly, at the rotation angles θ = 180 ° and θ = 270 ° around the Y axis, the X axis component (acceleration X) and the Z axis out of the three axes (physical axes) of the
さらに、Y軸周りの回転だけではなく、Z軸またはX軸周りの回転についても同様であり、Z軸周りの回転においては、X軸(ロール軸)とY軸(ピッチ軸)の論理軸が交換したものと見なすことができ、X軸周りの回転においては、Y軸(ピッチ軸)とZ軸(ヨー軸)の論理軸が交換したものと見なすことができる。 Further, not only the rotation around the Y axis but also the rotation around the Z axis or the X axis. In the rotation around the Z axis, the logical axes of the X axis (roll axis) and the Y axis (pitch axis) are the same. In rotation around the X axis, the logical axes of the Y axis (pitch axis) and the Z axis (yaw axis) can be regarded as exchanged.
したがって、各軸周りの回転角に対する物理軸と論理軸と関係は、下表のように整理することができる。 Therefore, the relationship between the physical axis and the logical axis with respect to the rotation angle around each axis can be arranged as shown in the table below.
以上説明したように、本発明に係るナビゲーション装置によれば、ナビゲーション装置が所定の取り付け位置から回転した回転軸周りの回転角の大きさに応じて、加速度センサにおける3軸方向の加速度成分の論理値あるいはジャイロセンサにおける3軸周りの角速度成分の論理値を交換するようにしているので、加速度センサおよびジャイロセンサからの出力値を容易に把握することができる。 As described above, according to the navigation device of the present invention, the logic of the acceleration component in the triaxial direction in the acceleration sensor according to the magnitude of the rotation angle around the rotation axis that the navigation device has rotated from the predetermined mounting position. Since the values or the logical values of the angular velocity components around the three axes in the gyro sensor are exchanged, the output values from the acceleration sensor and the gyro sensor can be easily grasped.
また、各軸周りのセンサ出力値の論理値を交換するために用いる各軸周りの回転角を算出する際に、加速度センサにより検出された3軸方向の加速度成分のうちから最も回転角の変化率を正確に検出することが可能な所定の軸に関する加速度成分も用いて回転角を算出することが可能となり、また、これによりナビゲーション装置の姿勢角などを正確に補正することができる。 Further, when calculating the rotation angle around each axis used for exchanging the logical value of the sensor output value around each axis, the change in the rotation angle is the most among the acceleration components in the three-axis directions detected by the acceleration sensor. It is possible to calculate the rotation angle using an acceleration component related to a predetermined axis capable of accurately detecting the rate, and it is possible to accurately correct the attitude angle of the navigation device.
なお、上記実施例においては、携帯機器としてナビゲーション装置10を用いて説明したが、本発明はこれに限定されることなく、移動体の加速度から移動体の移動距離を算出する各種電子機器などにも適用できる。
In the above embodiment, the
10・・・・ナビゲーション装置
100・・・制御手段
110・・・通信手段
120・・・GPS測位手段
130・・・自立航法測位手段
131・・・加速度センサ
132・・・ジャイロセンサ
133・・・軸交換手段
140・・・経路探索手段
150・・・経路案内手段
160・・・表示手段
170・・・入力手段
180・・・姿勢角補正手段
181・・・姿勢角算出部
182・・・回転軸検出部
183・・・回転角算出部
184・・・姿勢角補正部
190・・・記憶手段
191・・・姿勢角度記憶部
192・・・地図記憶部
10.
Claims (4)
前記携帯機器の3軸方向への加速度を検出する加速度検出手段と、
前記加速度検出手段により検出された3軸方向の加速度成分に基づいて、前記携帯機器が回転した回転軸を検出する回転軸検出手段と、
前記回転軸検出手段により検出された回転軸周りの前記携帯機器の回転角を算出する回転角算出手段と、
前記回転角算出手段により算出された前記回転角の大きさに応じて、前記3軸方向の加速度成分の論理値を交換する軸交換手段と、
を備えたことを特徴とする携帯機器。 A mobile device that corrects the attitude angle of the mobile device based on acceleration applied to the mobile device,
Acceleration detecting means for detecting acceleration in the three-axis direction of the portable device;
Rotation axis detection means for detecting a rotation axis that the portable device has rotated based on acceleration components in three axis directions detected by the acceleration detection means;
Rotation angle calculation means for calculating a rotation angle of the portable device around the rotation axis detected by the rotation axis detection means;
Axis exchanging means for exchanging logical values of acceleration components in the three-axis directions according to the magnitude of the rotation angle calculated by the rotation angle calculating means,
A portable device comprising:
前記軸交換手段は、前記回転角の大きさに応じて、前記3軸周りの角速度の論理値を交換することを特徴とする請求項1に記載の携帯機器。 An angular velocity detecting means for detecting an angular velocity around three axes of the portable device;
The portable device according to claim 1, wherein the axis exchange unit exchanges logical values of angular velocities around the three axes according to the magnitude of the rotation angle.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009218759A JP2011069633A (en) | 2009-09-24 | 2009-09-24 | Portable device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009218759A JP2011069633A (en) | 2009-09-24 | 2009-09-24 | Portable device |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2011069633A true JP2011069633A (en) | 2011-04-07 |
Family
ID=44015052
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2009218759A Pending JP2011069633A (en) | 2009-09-24 | 2009-09-24 | Portable device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2011069633A (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011093447A1 (en) * | 2010-01-29 | 2011-08-04 | 独立行政法人産業技術総合研究所 | Calculation device, control method for calculation device, control program, and recording medium |
JP5555367B1 (en) * | 2013-11-18 | 2014-07-23 | 株式会社シーティーエス | Compaction and leveling management system |
KR101859771B1 (en) | 2011-11-16 | 2018-05-21 | 삼성전자주식회사 | Terminal device for correcting gyro-sensor sensing value and accelation sensor sensing value and method for controlling thereof |
-
2009
- 2009-09-24 JP JP2009218759A patent/JP2011069633A/en active Pending
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011093447A1 (en) * | 2010-01-29 | 2011-08-04 | 独立行政法人産業技術総合研究所 | Calculation device, control method for calculation device, control program, and recording medium |
JP5565736B2 (en) * | 2010-01-29 | 2014-08-06 | 独立行政法人産業技術総合研究所 | COMPUTER DEVICE, COMPUTER DEVICE CONTROL METHOD, CONTROL PROGRAM, AND RECORDING MEDIUM |
KR101859771B1 (en) | 2011-11-16 | 2018-05-21 | 삼성전자주식회사 | Terminal device for correcting gyro-sensor sensing value and accelation sensor sensing value and method for controlling thereof |
JP5555367B1 (en) * | 2013-11-18 | 2014-07-23 | 株式会社シーティーエス | Compaction and leveling management system |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104567931B (en) | A kind of heading effect error cancelling method of indoor inertial navigation positioning | |
JP4466705B2 (en) | Navigation device | |
CN111678538B (en) | Dynamic level error compensation method based on speed matching | |
JP3848941B2 (en) | Geomagnetic sensor attitude error compensation apparatus and method | |
CN103712622B (en) | The gyroscopic drift estimation compensation rotated based on Inertial Measurement Unit and device | |
JPH0989584A (en) | Portable navigation system | |
CN201955092U (en) | Platform type inertial navigation device based on geomagnetic assistance | |
CN103439727B (en) | A kind of measuring method of ground coordinate | |
RU2768087C2 (en) | Underground mining vehicle and method for its orientation | |
JP2008216226A (en) | Navigation device and device and method for correcting angular velocity using inclination angle | |
CN108458714A (en) | The Eulerian angles method for solving of acceleration of gravity is free of in a kind of attitude detection system | |
CN103453901A (en) | Position guiding system and position guiding method | |
CN107202578A (en) | A kind of strapdown vertical gyroscope calculation method based on MEMS technology | |
CN105953797B (en) | Utilize the combined navigation device and method of single axis gyroscope, inclinator and odometer | |
JP2004125689A (en) | Position calculation system for self-contained navigation | |
JP5105598B2 (en) | Portable terminal, program and method for determining direction of travel of pedestrian using only geomagnetic sensor | |
JP2011069633A (en) | Portable device | |
JP2011209162A (en) | Navigation system | |
JP2006275523A (en) | Electronic azimuth device and recording medium | |
US7437242B2 (en) | Navigation apparatus | |
JP5008200B2 (en) | Portable terminal, program, and method for determining change of traveling direction using acceleration sensor and geomagnetic sensor | |
JP2001141507A (en) | Inertial navigation system | |
JP2011112591A (en) | Apparatus for loading mobile body | |
CN105486275A (en) | Magnetic declination calculation method based on nine-axis inertial measurement unit | |
JP5891120B2 (en) | Speed calculation device, speed calculation method, speed calculation program, and recording medium |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20111115 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20111128 |
|
A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A712 Effective date: 20120528 |