JP2011069633A - Portable device - Google Patents

Portable device Download PDF

Info

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
Application number
JP2009218759A
Other languages
Japanese (ja)
Inventor
Takaaki Hasegawa
孝明 長谷川
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sanyo Electric Co Ltd
Original Assignee
Sanyo Electric Co Ltd
Sanyo Consumer Electronics Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sanyo Electric Co Ltd, Sanyo Consumer Electronics Co Ltd filed Critical Sanyo Electric Co Ltd
Priority to JP2009218759A priority Critical patent/JP2011069633A/en
Publication of JP2011069633A publication Critical patent/JP2011069633A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Navigation (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide a portable device which can detect fluctuations in the attitude angle of the portable device having various kinds of sensors during its use with high precision and accurately correct the output from the sensors. <P>SOLUTION: The portable device includes: an acceleration sensor 131 for detecting the triaxial acceleration of the portable device; a rotation axis detector 182 for detecting the rotation axis of the portable device on the basis of the triaxial acceleration components; a rotation angle calculator 183 for calculating the rotation angle of the portable device about the detected rotation axis; and an axis exchange means 133 for exchanging the logical values of the triaxial acceleration components in accordance with the magnitude of the calculated rotation angle. <P>COPYRIGHT: (C)2011,JPO&INPIT

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 Patent Document 1, the mounting angle of a posture angle detecting device including a posture angle sensor (gyro sensor, acceleration sensor, geomagnetic sensor, etc.) having only one axis or two axes is 45 ° ± 20 with respect to the angle detection reference plane. By mounting at a degree, it is possible to relax the limitation on the tilt when using the mobile terminal device.

特開2002−164987号公報(段落[0018]〜段落[0019]、図2)JP 2002-164987 (paragraph [0018] to paragraph [0019], FIG. 2)

ところで、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 Patent Document 1, but the detection device is attached to a terminal device such as a mobile phone so as to be suitable when using the mobile phone. Since there is a restriction that it must be mounted at a predetermined angle, there is a problem that it is difficult to apply to a device that can be installed in a vehicle such as a PND in which it is unclear how the posture angle changes during use. Moreover, in the said patent document 1, the point which detects the fluctuation | variation of this attitude angle correctly was not considered.

したがって、本発明は、上記の問題点を解消することを課題とし、各種センサを備えた携帯機器の使用時の姿勢角度の変動を精度良く検出でき、正確にセンサからの出力を補正することが可能な携帯機器を提供することを目的とするものである。   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 claim 1 of the present application is
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, acceleration sensor 131 in the following embodiment);
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 axis detection unit 182 in the following embodiment) that detects a rotation axis that the portable device has rotated;
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 claim 1,
An angular velocity detection means (for example, gyro sensor 132 in the following embodiment) for detecting an angular velocity around three axes of the portable device;
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 claim 1 or 2,
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 angle correction unit 184 in the following embodiment) that corrects the attitude angle based on the rotation angle calculated by the rotation angle calculation unit is provided.

上記の構成により、本発明は下記に示すような優れた効果を奏する。すなわち、請求項1に係る発明においては、携帯機器は、加速度検出手段により検出された3軸方向の加速度成分に基づいて、前記携帯機器が回転した回転軸を検出し、検出された回転軸周りの携帯機器の回転角を算出し、算出された回転角の大きさに応じて、前記3軸方向の加速度成分の論理値を交換するようにしている。   With the above configuration, the present invention has the following excellent effects. That is, in the invention according to claim 1, the portable device detects the rotation axis of the rotation of the portable device based on the acceleration components in the triaxial directions detected by the acceleration detection means, and the detected rotation axis is detected. The rotation angle of the portable device is calculated, and the logical values of the acceleration components in the three-axis directions are exchanged according to the calculated rotation angle.

このような構成によれば、携帯機器の回転角度に関係なく、加速度検出手段により検出された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 claim 1, the output from the angular velocity detecting means for detecting the angular velocity around the three axes of the portable device also depends on the magnitude of the rotation angle. The logical values of the angular velocities around the three axes are exchanged. According to such a configuration, it is possible to provide a portable device that can easily grasp the output values related to the angular velocity components around the three axes detected by the angular velocity detecting means regardless of the rotation angle of the portable device.

また、請求項3に係る発明においては、請求項1または請求項2に係る携帯機器において、算出する回転角の大きさを、前記加速度検出手段により検出された3軸方向の加速度成分のうち所定の軸に関する加速度成分から算出するようにしている。このような構成によれば、携帯機器が回転した回転軸周りの回転角の大きさを、加速度検出手段により検出された3軸方向の加速度成分のうち最も回転角の変化率を正確に検出することが可能な所定の軸に関する加速度成分を用いて回転角を算出することが可能となり、携帯機器の姿勢角などを正確に補正することができる携帯機器を提供できる。   In the invention according to claim 3, in the portable device according to claim 1 or 2, the magnitude of the rotation angle to be calculated is predetermined among the acceleration components in the three-axis directions detected by the acceleration detecting means. It is calculated from the acceleration component related to the axis. According to such a configuration, the rotation angle around the rotation axis around which the portable device is rotated is detected with the most accurate rotation angle change rate among the acceleration components in the three-axis directions detected by the acceleration detection means. Therefore, the rotation angle can be calculated using an acceleration component related to a predetermined axis, and a portable device capable of accurately correcting the posture angle of the portable device can be provided.

また、請求項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.

本発明の実施例におけるナビゲーション装置の構成を示すブロック図である。It is a block diagram which shows the structure of the navigation apparatus in the Example of this invention. 本発明の実施例におけるナビゲーション装置がY軸周りに回転した場合のセンサの出力を説明するための図であり、ナビゲーション装置が正しい姿勢で設置された状態を示す一例である。It is a figure for demonstrating the output of the sensor when the navigation apparatus in the Example of this invention rotates around the Y-axis, and is an example which shows the state in which the navigation apparatus was installed with the correct attitude | position. 本発明の実施例におけるナビゲーション装置がY軸周りに回転した場合のセンサの出力を説明するための図であり、図2におけるナビゲーション装置がY軸周りにθだけ回転した状態を示している。It is a figure for demonstrating the output of the sensor when the navigation apparatus in the Example of this invention rotates around the Y-axis, and has shown the state which the navigation apparatus in FIG. 2 rotated only (theta) around the Y-axis. 本発明の実施例におけるナビゲーション装置がY軸周りに回転した場合のセンサの出力を説明するための図であり、図2におけるナビゲーション装置がY軸周りにθ=90°だけ回転した状態を示している。FIG. 4 is a diagram for explaining the output of the sensor when the navigation device in the embodiment of the present invention rotates around the Y axis, and shows the state where the navigation device in FIG. 2 rotates by θ = 90 ° around the Y axis. Yes. 本発明の実施例におけるY軸周りの回転を検出する場合の角度θに対する加速度センサのX軸成分およびZ軸成分をそれぞれ表示した図である。It is the figure which each displayed the X-axis component and Z-axis component of the acceleration sensor with respect to angle (theta) in the case of detecting the rotation around the Y-axis in the Example of this invention.

以下、本発明の具体例を実施例及び図面を用いて詳細に説明する。但し、以下に示す実施例は、本発明の技術思想を具体化するための携帯機器として車体に搭載可能なナビゲーション装置を例示するものであって、本発明をこのナビゲーション装置に特定することを意図するものではなく、特許請求の範囲に示した技術思想に含まれるその他の実施形態の携帯機器にも等しく適用し得るものである。   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 navigation device 10 includes a control unit 100, a communication unit 110, a GPS positioning unit 120, a self-contained navigation positioning unit 130, a route search unit 140, a route guidance unit 150, a display unit 160, an input unit 170, an attitude angle correction unit 180, and a storage unit. 190 is comprised.

制御手段100は、CPU100a、RAM100b、ROM100cからなるプロセッサで構成され、RAM100b又はROM100cに記憶されているプログラムをCPU100aにおいて実行することによってナビゲーション装置10の各部の動作を制御統括する。   The control unit 100 includes a processor including a CPU 100a, a RAM 100b, and a ROM 100c. The CPU 100a executes a program stored in the RAM 100b or the ROM 100c to control and control the operation of each unit of the navigation device 10.

通信手段110は、制御手段100の制御により、このナビゲーション装置10と通信可能な情報提供サーバ(図示せず)との間で地図データといった各種情報の送受信を行う。   The communication unit 110 transmits / receives various information such as map data to / from an information providing server (not shown) that can communicate with the navigation device 10 under the control of the control unit 100.

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 navigation device 10 is mounted based on the received radio waves. .

自立航法測位手段130は、加速度センサ131とジャイロセンサ132を備えて構成される。加速度センサ131は、予め定められた3軸方向へのナビゲーション装置10の加速度を検出し、ジャイロセンサ132は、ナビゲーション装置10のX軸回り、Y軸回り及びZ軸回りの角速度を検出する。加速度センサ131とジャイロセンサ132は、それぞれ検出した加速度や角速度を制御手段100に出力する。   The self-contained navigation positioning unit 130 includes an acceleration sensor 131 and a gyro sensor 132. The acceleration sensor 131 detects the acceleration of the navigation device 10 in predetermined three-axis directions, and the gyro sensor 132 detects angular velocities around the X axis, the Y axis, and the Z axis of the navigation device 10. The acceleration sensor 131 and the gyro sensor 132 output the detected acceleration and angular velocity to the control means 100, respectively.

加速度センサ131が車体に対して正しい姿勢で設置された場合、図2(a)で示すように、加速度センサ131によって、車体の進行方向(本実施例ではX軸方向とする)への加速度Xと、車体の進行方向に水平面内で直交する方向(本実施例ではY軸方向とする)への加速度Yと、車体の進行方向(X軸方向)及びこの進行方向に水平面内で直交する方向(Y軸方向)に直交する方向(本実施例ではZ軸方向とする)への加速度Zとが検出される。   When the acceleration sensor 131 is installed in the correct posture with respect to the vehicle body, as shown in FIG. 2A, the acceleration sensor 131 accelerates the acceleration X in the vehicle body traveling direction (X-axis direction in this embodiment). And the acceleration Y in a direction orthogonal to the traveling direction of the vehicle body in the horizontal plane (in this embodiment, the Y-axis direction), the traveling direction of the vehicle body (X-axis direction), and the direction orthogonal to the traveling direction in the horizontal plane An acceleration Z in a direction orthogonal to the (Y-axis direction) (in this embodiment, the Z-axis direction) is detected.

ジャイロセンサ132が車体に対して正しい姿勢で設置されている場合、図2(b)で示すように、ジャイロセンサ132rによってX軸回りに車体が回転する際の角速度X(Roll角θr)が検出され、ジャイロセンサ132pによってY軸回りに車体が回転する際の角速度Y(Pitch角θp)が検出され、およびジャイロセンサ132yによってZ軸回りに車体が回転する際の角速度Z(Yaw角θy)が検出される。   When the gyro sensor 132 is installed in the correct posture with respect to the vehicle body, as shown in FIG. 2B, the angular velocity X (Roll angle θr) when the vehicle body rotates around the X axis is detected by the gyro sensor 132r. Then, the angular velocity Y (Pitch angle θp) when the vehicle body rotates around the Y axis is detected by the gyro sensor 132p, and the angular velocity Z (Yaw angle θy) when the vehicle body rotates around the Z axis is detected by the gyro sensor 132y. Detected.

また、自立航法測位手段130は、車体に対して正しい姿勢で設置されていたナビゲーション装置10が所定の軸周りに回転した場合に回転した角度に応じて、加速度センサ131の各軸における出力の論理値あるいはジャイロセンサ132の各軸周りの出力の論理値を交換するための軸交換手段133を備えている。軸交換手段133による軸交換方法については後で詳細に説明する。   In addition, the self-contained navigation positioning means 130 outputs logic on each axis of the acceleration sensor 131 according to the rotation angle when the navigation device 10 installed in a correct posture with respect to the vehicle body rotates around a predetermined axis. A shaft exchanging means 133 for exchanging the value or the logical value of the output around each axis of the gyro sensor 132 is provided. The shaft exchanging method by the shaft exchanging means 133 will be described in detail later.

経路探索手段140は、入力手段170の操作により出発地点や目的地点が指定されると、記憶手段190の地図記憶部192に記憶されている道路データを参照し、出発地点から目的地点に至るまでの最適経路を探索し、案内経路データを作成するものである。経路探索手段140によって探索された案内経路は、制御手段100によって、表示手段160に現在位置周辺の地図画像と共に表示され、目的地点までの案内に用いられる。   When the departure point and the destination point are designated by the operation of the input unit 170, the route search unit 140 refers to the road data stored in the map storage unit 192 of the storage unit 190 and reaches the destination point from the departure point. The optimum route is searched and guide route data is created. The guidance route searched by the route searching means 140 is displayed on the display means 160 together with the map image around the current position by the control means 100 and used for guidance to the destination point.

経路案内手段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 display unit 160 is a display unit having a display screen composed of a display panel such as an LCD, and displays a map image, a guide route, a current position, and the like.

入力手段170は、操作ボタンやタッチパネルなどにより構成され、ナビゲーション装置10の各種機能を操作したり、所要の数値や文字を入力したりするものである。   The input unit 170 includes operation buttons, a touch panel, and the like, and operates various functions of the navigation device 10 and inputs necessary numerical values and characters.

姿勢角補正手段180は、姿勢角算出部181、回転軸検出部182、回転角算出部183、姿勢角補正部184を備えて構成される。   The posture angle correction unit 180 includes a posture angle calculation unit 181, a rotation axis detection unit 182, a rotation angle calculation unit 183, and a posture angle correction unit 184.

姿勢角算出部181は、加速度センサ131やジャイロセンサ132からの出力に基づいて、ナビゲーション装置10の車体に対する姿勢角度(取り付け角度)、或いはナビゲーション装置10を携帯して使用する際の姿勢角度を算出し、姿勢角度記憶部191に記憶させる。   The posture angle calculation unit 181 calculates a posture angle (attachment angle) of the navigation device 10 with respect to the vehicle body or a posture angle when the navigation device 10 is carried and used based on outputs from the acceleration sensor 131 and the gyro sensor 132. And stored in the posture angle storage unit 191.

回転軸検出部182は、加速度センサ131によって検出される重力加速度成分に基づいて、車体に対して設置されたナビゲーション装置10が所定位置からナビゲーション装置10の互いに直交する3軸(X軸、Y軸、Z軸)のうちのいずれの軸周りに対して回転して姿勢角度(取り付け角度)を変動させたか検出する。   Based on the gravitational acceleration component detected by the acceleration sensor 131, the rotation axis detection unit 182 is configured so that the navigation device 10 installed on the vehicle body has three axes (X axis, Y axis) orthogonal to each other from the predetermined position of the navigation device 10. , The Z axis), the rotation angle of the posture angle (attachment angle) is detected.

回転角算出部183は、加速度センサ131から出力される3軸方向の加速度成分に基づいて、回転軸検出部182によって検出された回転軸周りのナビゲーション装置10の回転角を算出する。このとき、加速度センサ131から出力される3軸方向の加速度成分のうちで最も回転角の変化率が大きく、わずかな回転角であっても正確に検出できる軸方向の加速度成分を用いてナビゲーション装置10の回転角を算出する。   The rotation angle calculation unit 183 calculates the rotation angle of the navigation device 10 around the rotation axis detected by the rotation axis detection unit 182 based on the triaxial acceleration components output from the acceleration sensor 131. At this time, the navigation apparatus uses the acceleration component in the axial direction that has the largest change rate of the rotation angle among the acceleration components in the three axis directions output from the acceleration sensor 131 and can be accurately detected even at a slight rotation angle. A rotation angle of 10 is calculated.

すなわち、図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 navigation device 10 are the X axis, the Y axis, and the Z axis (where the X axis is the same axis as the traveling direction of the vehicle body, the Y axis is the horizontal axis of the vehicle body, Assuming that the Z axis is the vertical axis of the vehicle body and the acceleration sensor 131 is arranged coaxially with the three axes orthogonal to each other of the navigation device 10, the rotation angle calculation unit 183 rotates, for example, around the Y axis. Calculate the axis.

図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 navigation device 10 in a stationary state rotates around the Y axis from the correct posture shown in FIG. 2A as shown in FIG. 3A, if the rotation angle is θ, the acceleration sensor 131 The output of the X-axis component (acceleration X) and the Z-axis component (acceleration Z) is X = sin θ
Z = cos θ
It is expressed as However, the gravitational acceleration applied to the navigation device 10 is 1.

図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-1
となり、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 acceleration sensor 131, the rotation angle θ is
θ = 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-1
と求めることによって、姿勢角の補正を精度良く行うことができる。
Further, as shown in FIG. 4A, when the navigation apparatus 10 further rotates around the Y axis from the posture shown in FIG. 3A, sin θ is 1 when the rotation angle is 45 ° ≦ θ ≦ 90 °. On the contrary, cos θ changes greatly. Therefore, from the value of Z = cos θ, which is the Z-axis component of the acceleration sensor 131, the rotation angle θ is
θ = 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 navigation device 10 rotates about the Y axis, sin θ is close to 1 and cos θ changes greatly when the rotation angle is 90 ° ≦ θ ≦ 135 °, and similarly, it is the Z axis component of the acceleration sensor 131. By obtaining θ from the value of Z = cos θ, the posture angle can be corrected with high accuracy.

以下同様に、図5で示すように、
回転角度が135°≦θ≦225°では、θ=sin-1
回転角度が225°≦θ≦315°では、θ=cos-1
回転角度が315°≦θ≦360°では、θ=sin-1
としてθを求めることができる。
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 angle correction unit 184 is based on the rotation angle calculated by the rotation angle calculation unit 183, or the posture angle (attachment angle) calculated by the posture angle calculation unit 181, or already calculated and stored in the posture angle storage unit 191. The stored posture angle (attachment angle) is corrected. The corrected posture angle is stored in the posture angle storage unit 191 again.

記憶手段190は、姿勢角度記憶部191、地図記憶部192を備えて構成される。姿勢角度記憶部191は、FRAM(登録商標)などの不揮発性メモリによって構成されており、姿勢角算出部181によって算出された車体に対するナビゲーション装置10の姿勢角度(取り付け角度)を記憶する。また、姿勢角補正部184によって補正された姿勢角度(取り付け角度)を記憶する。記憶された姿勢角度は、車体の走行距離や現在位置を算出する際に用いられる。   The storage unit 190 includes an attitude angle storage unit 191 and a map storage unit 192. The posture angle storage unit 191 is configured by a non-volatile memory such as FRAM (registered trademark), and stores the posture angle (attachment angle) of the navigation device 10 with respect to the vehicle body calculated by the posture angle calculation unit 181. Further, the posture angle (attachment angle) corrected by the posture angle correction unit 184 is stored. The stored posture angle is used when calculating the travel distance and the current position of the vehicle body.

地図記憶部192には、各道路の交差点や分岐点などの結節点をノードとし、それぞれのノード間を結ぶ経路をリンクとした道路ノードデータと道路リンクデータを含む道路データが記憶されている。道路ノードデータには、道路ノードの番号、位置座標、接続リンク本数、交差点名称などが含まれる。また、道路リンクデータには起点および終点となる道路ノードの番号、道路種別、リンク長(リンクコスト)、所要時間、車線数、車道幅などが含まれる。道路リンクデータにはさらに、リンク属性として橋、トンネル、踏切、料金所などのデータが付与される。道路種別は、高速道路や有料道路の別および国道や都道府県道などの別を含む情報である。   The map storage unit 192 stores road node data including road node data and road link data in which nodes such as intersections and branch points of each road are nodes and links between the nodes are links. The road node data includes road node numbers, position coordinates, the number of connection links, intersection names, and the like. The road link data includes the number of road nodes as starting and ending points, road type, link length (link cost), required time, number of lanes, road width, and the like. Further, data such as bridges, tunnels, railroad crossings, and toll gates are added to the road link data as link attributes. The road type is information including a distinction between an expressway and a toll road and a distinction such as a national road or a prefectural road.

また、地図記憶部192には、道路データの他、地図画像を見やすく表示するためにベクター形式で記憶された背景画像データを含んでいてもよい。道路データと背景画像データを含む地図画像データは、制御手段100により、ナビゲーション装置10を使用する際に、ナビゲーション装置10の現在位置を含む所定範囲が地図記憶部192から抽出され、現在位置を示す現在位置マークや案内経路の画像と重ね合わされて表示手段160に表示される。   In addition to road data, the map storage unit 192 may include background image data stored in a vector format so that a map image can be easily displayed. When the navigation device 10 is used by the control means 100, the map image data including the road data and the background image data is extracted from the map storage unit 192 and a predetermined range including the current position of the navigation device 10 is shown. The current position mark and the guide route image are superimposed and displayed on the display means 160.

次に、図2と図4を参照して、本発明の実施例におけるナビゲーション装置10の軸交換手段133について説明する。   Next, with reference to FIG. 2 and FIG. 4, the axis | shaft exchange means 133 of the navigation apparatus 10 in the Example of this invention is demonstrated.

図2(a)で示すように、ナビゲーション装置10が車体に対して正しい姿勢で設置されている場合、加速度センサ131のX軸成分(加速度X)の出力は、ナビゲーション装置10が取り付けられた車体の加速度を検出しており、車体が加速しているときにはプラスの値を出力し、車体が減速しているときにはマイナスの値を出力している。   As shown in FIG. 2A, when the navigation device 10 is installed in a correct posture with respect to the vehicle body, the output of the X-axis component (acceleration X) of the acceleration sensor 131 is the vehicle body to which the navigation device 10 is attached. When the vehicle body is accelerating, a positive value is output, and when the vehicle body is decelerating, a negative value is output.

そして、加速度センサ131のY軸成分(加速度Y)の出力は、車体の右折時あるいは左折時の加速度を検出しており、車体が左折しているときにはプラスの値を出力し、車体が右折しているときにはマイナスの値を出力している。さらに、加速度センサ131のZ軸成分(加速度Z)の出力は、重力加速度を検出しており、プラスの値を出力している。   The output of the Y-axis component (acceleration Y) of the acceleration sensor 131 detects the acceleration when the vehicle turns right or left, and outputs a positive value when the vehicle turns left, and the vehicle turns right. When it is, a negative value is output. Further, the output of the Z-axis component (acceleration Z) of the acceleration sensor 131 detects gravitational acceleration and outputs a positive value.

一方、図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 acceleration sensor 131 detects the gravitational acceleration and is negative. A value is output, and the output of the Y-axis component (acceleration Y) of the acceleration sensor 131 is the same as when θ = 0 ° shown in FIG. 2A when the vehicle body to which the navigation device 10 is attached is turned right or left. The acceleration is detected, and a positive value is output when the vehicle is turning left, and a negative value is output when the vehicle is turning right.

そして、加速度センサ131のZ軸成分(加速度Z)の出力は、車体の加速度を検出しており、車体が加速しているときにはプラスの値を出力し、車体が減速しているときにはマイナスの値を出力している。   The output of the Z-axis component (acceleration Z) of the acceleration sensor 131 detects the acceleration of the vehicle body, outputs a positive value when the vehicle body is accelerating, and outputs a negative value when the vehicle body is decelerating. Is output.

このように、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 acceleration sensor 131 at the rotation angles θ = 0 ° and θ = 90 ° around the Y-axis. Since the output values are interchanged, it can be considered that the logical axes of the X axis and the Z axis are interchanged. Therefore, the axis exchanging means 133 determines a logical value (gravity, acceleration) suitable for the output value output from the acceleration sensor 131 according to the magnitude of the rotation angle θ around the Y axis calculated by the rotation angle calculation unit 183. Etc.).

また、図2(b)で示すように、ナビゲーション装置10が車体に対して正しい姿勢で設置されている場合、ジャイロセンサ132rのX軸成分(ジャイロX)の出力は、ナビゲーション装置10が取り付けられた車体のロールを検出しており、車体が右回転しているときにはプラスの値を出力し、車体が左回転しているときにはマイナスの値を出力している。   As shown in FIG. 2B, when the navigation device 10 is installed in a correct posture with respect to the vehicle body, the output of the X-axis component (gyro X) of the gyro sensor 132r is attached to the navigation device 10. The vehicle roll is detected and a positive value is output when the vehicle body is rotating clockwise, and a negative value is output when the vehicle body is rotating counterclockwise.

そして、ジャイロセンサ132pのY軸成分(ジャイロY)の出力は、車体が走行している路面の傾斜(ピッチ)を検出しており、車体が下り傾斜を走行しているときにはプラスの値を出力し、車体が上り傾斜を走行しているときにはマイナスの値を出力している。さらに、ジャイロセンサ132yのZ軸成分(ジャイロZ)の出力は、車体の右折時あるいは左折時のヨー角を検出しており、車体が右折しているときにはプラスの値を出力し、車体が左折しているときにはマイナスの値を出力している。   The output of the Y-axis component (gyro Y) of the gyro sensor 132p detects the slope (pitch) of the road surface on which the vehicle body is traveling, and outputs a positive value when the vehicle body is traveling on a downward slope. However, a negative value is output when the vehicle body is traveling uphill. Further, the output of the Z-axis component (gyro Z) of the gyro sensor 132y detects the yaw angle when the vehicle body is turning right or left, and outputs a positive value when the vehicle body is turning right. When it is, a negative value is output.

一方、図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 gyro sensor 132r detects the yaw angle of the vehicle body, When the vehicle is turning right, a positive value is output. When the vehicle is turning left, a negative value is output. The output of the Y-axis component (gyro Y) of the gyro sensor 132p is shown in FIG. As in the case of θ = 0 °, the inclination (pitch) of the road surface on which the vehicle body is traveling is detected.

そして、ジャイロセンサ132yのZ軸成分(ジャイロZ)の出力は、車体のロールを検出しており、車体が左回転しているときにはプラスの値を出力し、車体が右回転しているときにはマイナスの値を出力している。   The output of the Z-axis component (gyro Z) of the gyro sensor 132y detects the roll of the vehicle body, and outputs a positive value when the vehicle body rotates counterclockwise, and minus when the vehicle body rotates clockwise. The value of is output.

このように、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 gyro sensor 132 at the rotation angles θ = 0 ° and θ = 90 ° around the Y axis, the X axis component (gyro X) and the Z axis component (gyro) Since the output value of Z) is interchanged, it can be considered that the logical axes of the X axis (roll axis) and the Z axis (yaw axis) are interchanged. Therefore, the axis exchanging means 133 is a logical value suitable for the output value output from the gyro sensor 132 according to the magnitude of the rotation angle θ around the Y axis calculated by the rotation angle calculation unit 183 (left and right rotation, Assign left and right folds.

同様に、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 acceleration sensor 131 according to the rotation angle. The output value of the component (acceleration Z) is interchanged, and the output values of the X-axis component (gyro X) and the Z-axis component (gyro Z) among the outputs around the three axes (physical axes) of the gyro sensor 132 are interchanged. It will be.

さらに、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.

Figure 2011069633
よって、軸交換手段133は、加速度センサ131やジャイロセンサ132から出力される出力値に対して回転角算出部183によって算出された各軸周りの回転角度θの大きさに応じて適した論理値(重力、加速度等)を割り当てることが可能となる。
Figure 2011069633
Therefore, the axis exchanging means 133 is a logical value suitable for the output value output from the acceleration sensor 131 or the gyro sensor 132 according to the magnitude of the rotation angle θ around each axis calculated by the rotation angle calculation unit 183. (Gravity, acceleration, etc.) can be assigned.

以上説明したように、本発明に係るナビゲーション装置によれば、ナビゲーション装置が所定の取り付け位置から回転した回転軸周りの回転角の大きさに応じて、加速度センサにおける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 navigation device 10 is used as a portable device. However, the present invention is not limited to this, and various electronic devices that calculate the moving distance of the moving body from the acceleration of the moving body are used. Is also applicable.

10・・・・ナビゲーション装置
100・・・制御手段
110・・・通信手段
120・・・GPS測位手段
130・・・自立航法測位手段
131・・・加速度センサ
132・・・ジャイロセンサ
133・・・軸交換手段
140・・・経路探索手段
150・・・経路案内手段
160・・・表示手段
170・・・入力手段
180・・・姿勢角補正手段
181・・・姿勢角算出部
182・・・回転軸検出部
183・・・回転角算出部
184・・・姿勢角補正部
190・・・記憶手段
191・・・姿勢角度記憶部
192・・・地図記憶部
10. Navigation device 100 ... Control means 110 ... Communication means 120 ... GPS positioning means 130 ... Self-contained navigation positioning means 131 ... Acceleration sensor 132 ... Gyro sensor 133 ... Axis exchange means 140... Route search means 150... Route guidance means 160... Display means 170... Input means 180... Attitude angle correction means 181. Axis detection unit 183 ... rotation angle calculation unit 184 ... posture angle correction unit 190 ... storage means 191 ... posture angle storage unit 192 ... map storage unit

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軸周りの角速度を検出する角速度検出手段を備え、
前記軸交換手段は、前記回転角の大きさに応じて、前記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.
前記回転角算出手段は、算出する回転角の大きさを、前記加速度検出手段により検出された3軸方向の加速度成分のうち所定の軸に関する加速度成分から算出することを特徴とする請求項1または請求項2に記載の携帯機器。   The rotation angle calculation unit calculates the magnitude of the rotation angle to be calculated from an acceleration component related to a predetermined axis among the acceleration components in the three-axis directions detected by the acceleration detection unit. The mobile device according to claim 2. 前記回転角算出手段により算出された回転角に基づいて、前記姿勢角を補正する姿勢角補正手段を備えたことを特徴とする請求項3に記載の携帯機器。   The portable device according to claim 3, further comprising an attitude angle correction unit that corrects the attitude angle based on the rotation angle calculated by the rotation angle calculation unit.
JP2009218759A 2009-09-24 2009-09-24 Portable device Pending JP2011069633A (en)

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)

* Cited by examiner, † Cited by third party
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

Cited By (4)

* Cited by examiner, † Cited by third party
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