JP2004163168A

JP2004163168A - Portable autonomous navigation device

Info

Publication number: JP2004163168A
Application number: JP2002327119A
Authority: JP
Inventors: Kenji Komaki; 賢治小巻; Eiji Shimizu; 英二志水; Susumu Ihara; 將井原; Yoshimi Fujita; 嘉美藤田
Original assignee: Sumitomo Precision Products Co Ltd; Sumitomo Densetsu Co Ltd
Current assignee: Sumitomo Precision Products Co Ltd; Sumitomo Densetsu Co Ltd
Priority date: 2002-11-11
Filing date: 2002-11-11
Publication date: 2004-06-10
Anticipated expiration: 2022-11-11
Also published as: JP4205930B2

Abstract

<P>PROBLEM TO BE SOLVED: To perform exact positioning without being dependent on positioning by GPS. <P>SOLUTION: Walking rippling is detected from vertical direction acceleration measured by a three-axis acceleration sensor 2, and the number of steps and walking periods in the case that pedestrian walks are detected. Azimuth in the case that the pedestrian walks is detected by a three-axis angular velocity sensor 4. When GPS information cannot be received, acceleration in the direction of travel per step is measured by the sensor 2, and a step is presumed from the acceleration and the walking periods. When the GPS information can be received, the step is presumed by using the information. Pedestrian's distance traversed is computed from the detected number of steps and the presumed step. A self-position on a map is identified from the distance traversed and the detected azimuth. <P>COPYRIGHT: (C)2004,JPO

Description

【０００１】
【発明の属する技術分野】
本発明は、歩行者用の携帯ナビゲーションシステムとして使用される携帯用自律航法装置に関する。
【０００２】
【従来の技術】
歩行者の自位置を検出する携帯ナビゲーションシステムは、歩行者の歩数と歩幅とから移動距離を算出し、その移動距離と方位とから自位置を逐次積算検出するシステムであり、ＧＰＳにより積算誤差を補正することにより精度よく位置検出を行うことができる。また、その位置データを無線等で送ることにより管理者が携帯者を管理したり、携帯者が相互に位置情報をやり取りできるシステムを構築できる。
【０００３】
ここで、歩行者の歩数は、歩数計や加速度センサにより直接的に検出できる。しかし、歩行者の歩幅は直接的な検出が不可能であり、他の情報から間接的な推定を行わざるを得ない。そして、その推定方法として、ＧＰＳ情報を用いて歩行途中の２点間の距離（歩行者の移動距離）を求め、その移動距離を、その間に検出された歩数で除することにより歩幅を算出する方法が特許文献１に記載されている。
【０００４】
【特許文献１】
特開平０９−０８９５８４号公報
【０００５】
【発明が解決しようとする課題】
ＧＰＳ情報を用いて歩幅を推定する方法は、演算間隔を短く詰めることにより誤差を排除でき，高い精度を確保できる。しかしながら、ＧＰＳ信号を精度よく受信できない屋内、地下、森、ビルの谷間、高速道路下などでは使用できず、この間に測位誤差が累積されて測位精度が落ちる。特に、屋内では地図情報もないため、地図とのマッチングも行えず、測位精度の低下は顕著となる。
【０００６】
また、ＧＰＳによる測位は消費電力が大きく、この観点から極力ＧＰＳ測位に依存しないことが求められているが、ＧＰＳによる測位に依存しない場合は前述した測位精度の低下が問題になる。
【０００７】
同様に、方位の検出には、誤差が積算されない地磁気センサが主に使用されるが、最近の歩行環境として地下、エレベータ内、鉄骨近くというような地磁気が乱れた環境が少なくなく、このような環境下では方位の正確な検出が困難になる。角速度センサを併用することも考えられているが、併用のタイミングなどが明らかでないため、高精度な補完は困難である。
【０００８】
本発明の目的は、ＧＰＳによる測位に依存することなく正確な測位が可能な携帯用自律航法装置を提供することにある。
【０００９】
本発明の他の目的は、地磁気が乱れた環境下でも正確な測位が可能な携帯用自律航法装置を提供することにある。
【００１０】
【課題を解決するための手段】
上記目標を達成するために、本発明の第１の携帯用自律航法装置は、歩行者が歩行するときの歩数を検出する歩数検出手段と、歩行者が歩行するときの方位を検出する方位検出手段と、歩行者が歩行するときの歩幅を推定する歩幅推定手段と、検出された歩数と推定された歩幅とから歩行者の移動距離を算出し、その移動距離と検出された方位とから地図上の自位置を特定する測位手段とを備えており、前記歩幅推定手段は、加速度センサにより一歩あたりの移動方向加速度を測定し、その移動方向加速度及び歩行周期から歩幅を推定するように構成されている。
【００１１】
また、本発明の第２の携帯用自律航法装置は、歩行者が歩行するときの歩数を検出する歩数検出手段と、歩行者が歩行するときの方位を検出する方位検出手段と、歩行者が歩行するときの歩幅を推定する歩幅推定手段と、検出された歩数と設定された歩幅とから歩行者の移動距離を算出し、その移動距離と検出された方位とから地図上の自位置を特定する測位手段とを備えており、前記方位検出手段は、地磁気センサ及び角速度センサを有しており、地磁気センサの出力が基準値より低下したときに地磁気センサから角速度センサに切り替えて方位の検出を行うように構成されている。
【００１２】
本発明の第１の携帯用自律航法装置においては、歩行者の歩幅が次のようにして正確に推定される。歩行においては、表１に示すように、歩行ペースと歩幅との積により移動距離が求まる。その移動距離には移動方向加速度がよく対応する（図４参照）。しかし、移動方向加速度だけから歩幅を求めることはできない。移動距離は歩幅だけでなく、歩行ペースの影響も受けるからである。そこで歩行周期も考慮する。歩行周期とは一歩あたりの所要時間であり、これと歩行周期とを考慮することにより、ＧＰＳ情報に依存せずとも歩幅の正確な推定が可能になる。
【００１３】
【表１】

【００１４】
移動方向加速度の測定には、歩数及び歩行周期を検出するための上下方向加速度の測定に使用される３軸の加速度センサを流用できる。これによりハードウエアの増大を伴わずに移動方向加速度の測定が可能になる。ちなみに、歩行者の一歩ごとに上下方向加速度が変化するので、その上下方向加速度の変化から歩行振動が検知され、歩数及び歩行周期が直接的に検出される。
【００１５】
歩行者の歩行振動を検出する際の問題として、歩行ペースが遅くなると、歩行振動が小さくなるため、センサ出力のＳ／Ｎ比が低減する。このため、歩行振動の検出が困難となり、誤差も増大する。この場合は、歩行運動面内（歩行方向に平行な垂直面内）の角速度から歩数及び歩幅を求める（表１参照）。歩行においては、図５に示すように、歩行運動面内の角速度ωの変化より歩行運動が検出され、その大きさより歩幅が推定される。これを組み合わせることにより、歩行ペースにも影響されることなく、歩幅の正確な推定が可能になる。
【００１６】
歩行運動面内の角速度の検出には、方位の検出に使用される３軸の角速度センサを流用できる。これによりハードウエアの増大を伴わずに歩行運動面内の角速度の検出が可能になる。ちなみに、方位の検出は、水平面内の角速度を検出することにより可能である。
【００１７】
歩行ペースの緩急に関係なく、歩行運動面内の角速度ωのみから歩行運動を検出することもできるが、角速度ωによる歩行の検出では、感度は高いものの個人差による影響や誤差の累積が大きく、常時使用は好ましくない。角速度ωによる歩行運動の検出は、移動方向加速度及び歩行周期からの歩幅推定の補完に用いることにより特に効力を発揮する。
【００１８】
ＧＰＳ信号が受信可能は場所では、これを歩幅の推定に使用したり、測定位置の補正に使用することにより、誤差の累積の少ない測位が可能となる。消費電力を低減するために、ＧＰＳ信号が受信可能な場所でも、移動方向加速度及び歩行周期から歩幅を推定することは有効である。ただし、この推定のみでは誤差の累積が問題になる。このため、ＧＰＳ信号の併用は重要である。
【００１９】
また、本発明の第２の携帯用自律航法装置においては、地磁気センサの出力が基準値より低下したときに地磁気センサから角速度センサに切り替えて方位の検出を行うことにより地磁気が乱れた環境下でも正確な方位検出が可能となる。方位誤差は数度を超えると問題になる。エレベータを例にとると、図６に示すように、扉前で地磁気レベルは定格レベルの９０％以下に低下し、これに伴って方位誤差は５度を超え問題となる。エレベータ内では地磁気レベルは更に下がり、方位誤差は９０度にも達する。基準値として定格地磁気レベルの９０％を選択すると、これ以下では角速度センサにより正確な方位検出が可能となる。
【００２０】
角速度センサのみによる方位検出では、誤差の累積が問題になる。地磁気センサの出力低下時に角速度センサを限定的に使用することにより、高精度で安定な方位検出が可能となるのである。
【００２１】
この角速度センサが歩行運動面内の角速度の検出に流用可能なことは前述したとおりである。
【００２２】
【発明の実施の形態】
以下に本発明の実施形態を図面に基づいて説明する。図１は本発明の一実施形態を示す携帯用自律航法装置の構成図、図２は軸方向及び面の説明図、図３は同携帯用自律航法装置の機能を示すフローチャートである。
【００２３】
本実施形態の携帯用自律航法装置は、図１に示すように、周知構成のマイクロコンピュータ１を備えている。マイクロコンピュータ１の入力側には、３軸の加速度センサ２、３軸の地磁気センサ３、３軸のジャイロセンサ４、ＧＰＳレシーバ５及び操作部６が接続されている。また、その出力側には表示部７が接続され、入出力側には地図情報を記憶した記憶媒体８が接続されている。
【００２４】
３軸の加速度センサ２は、図２に示すように、Ｘ軸方向、Ｙ軸方向、Ｚ軸方向の各加速度を測定する。その測定データはマイクロコンピュータ１に入力され、上下方向加速度の測定（歩数及び歩行周期の検出）及び移動方向加速度の測定（歩幅の検出）に使用される。３軸の地磁気センサ３も同様に地磁気の強度をＸ軸方向、Ｙ軸方向、Ｚ軸方向について各検出する。その検出データはマイクロコンピュータ１に入力され、方位の検出に使用される。３軸のジャイロセンサ４は、Ｘ軸及びＹ軸を含む平面（α面）におけるＺ軸回りの角速度、Ｘ軸及びＺ軸を含む平面（β面）におけるＹ軸回りの角速度、及びＹ軸及びＺ軸を含む平面（γ面）におけるＸ軸回りの角速度をそれぞれ測定する。その測定データはマイクロコンピュータ１に入力され、方位の検出、歩数の検出及び歩幅の検出に使用される。
【００２５】
マイクロコンピュータ１は、ソフトウエアにより内部に測位手段を構成している。測位手段は、上記各センサからのデータと共に、ＧＰＳレシーバ５を介して入力されるＧＰＳ情報を処理し、記憶媒体８との間で情報の授受を行いながら、携帯者の自位置を特定して表示部８に表示された地図上に表示する。測位手段の機能を図３のフローチャートにより詳細に説明する。
【００２６】
歩幅の推定は以下のようにして行われる。３軸の加速度センサ２の３出力より、歩行者の歩行に伴う上下方向加速度及び移動方向加速度が検出される（ステップＳ１）。この検出においては、上記３出力より重力方向が検出され、この方向から当該装置の上下方向が特定される。また、上下方向加速度からは歩行振動が検知され、歩数が求められる。次いで、ＧＰＳ電波強度からＧＰＳ情報が使用可能か否かが判断される（ステップＳ２）。ＧＰＳ情報が使用可能の場合は、ＧＰＳ情報から求めた歩行者の移動距離と歩数とから、歩幅が算出される（ステップＳ３，Ｓ７）。
【００２７】
ＧＰＳ情報が受信不可能の場合は、上下方向加速度をしきい値と比較する（ステップＳ４）。上下方向加速度がしきい値より大きい場合は、一歩ごとの移動方向加速度最大値を検出する。また、前記歩数から歩行周期を求める（ステップＳ５）。歩行周期は、単位歩行時間を歩数で除することにより求められる。そして、求めた移動方向加速度最大値及び歩行周期を表１のテーブルと照合して、歩幅を求める（ステップＳ６，Ｓ７）。
【００２８】
例えば移動方向加速度の最大値が「中」で歩行周期が「小」の場合、歩幅は「大」となる。また、それぞれ「小」「中」の場合は「小」、「大」「中」の場合は「大」、「中」「大」の場合は「小」となる。
【００２９】
ＧＰＳ情報が受信不可能の場合で、且つ上下方向加速度がしきい値より小さい場合は、３軸のジャイロセンサ４の３出力より、歩行運動面内の角速度を検出する（ステップＳ８）。その角速度の変化から歩数及び歩幅を検出する。
【００３０】
このようにして、ＧＰＳ情報が受信不可能の環境下で歩数及び歩幅が検出される。検出された歩数及び歩幅から歩行者の移動距離が算出される。
【００３１】
一方、方位は以下のようにして検出される。３軸の地磁気センサ３の３出力が取り込まれる（ステップＳ１１）。その出力強度がしきい値と比較される（ステップＳ１２）。しきい値は、例えば定格強度の９０％レベルとされる。出力強度がしきい値より大きい場合は、３軸の地磁気センサ３の３出力から方位が検出される（ステップＳ１３）。
【００３２】
出力強度がしきい値より小さい場合は、水平面内の角速度が検出され（ステップＳ１４）、その角速度から方位が検出される。歩行者の移動距離と方位とから自位置が求められることは前述したとおりである。
【００３３】
上記実施形態では、ＧＰＳ情報が受信不可能の場合に移動方向加速度と歩行周期とから歩幅を推定したが、ＧＰＳ情報が受信可能の場合にこの推定を行うこともできる。これにより、消費電力が嵩むＧＰＳ測位の依存度を低減でき、消費電力の節減を図ることかできる。
【００３４】
【発明の効果】
以上に説明したとおり、本発明の携帯型自律航法装置は、加速度センサにより一歩あたりの移動方向加速度を測定し、その移動方向加速度及び歩行周期から歩幅を推定することことにより、ＧＰＳによる測位に依存することなく正確な測位を行うことができる。これにより全環境で正確な携帯ナビゲーションを可能にすると共に、ＧＰＳによる測位時間を短くして消費電力の低減を可能にする。
【００３５】
また、本発明の携帯型自律航法装置は、方位の検出に地磁気センサ及び角速度センサを併用し、地磁気センサの出力が基準値より低下したときに地磁気センサから角速度センサに切り替えて方位の検出を行うことにより、地磁気が乱れた環境下でも正確な測位を行うことができる。
【図面の簡単な説明】
【図１】本発明の一実施形態を示す携帯用自律航法装置の構成図である。
【図２】軸方向及び面の説明図である。
【図３】同携帯用自律航法装置の機能を示すフローチャートである。
【図４】歩幅と移動方向加速度との関係を示すグラフである。
【図５】歩行運動面内の角速度の説明図である。
【図６】地磁気レベルと方位誤差との関係を示すグラフである。
【符号の説明】
１マイクロコンピュータ
２加速度センサ
３地磁気センサ
４ジャイロセンサ
５ＧＰＳレシーバ
６操作部
７表示部
８記憶媒体[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a portable autonomous navigation device used as a portable navigation system for pedestrians.
[0002]
[Prior art]
A portable navigation system that detects the pedestrian's own position is a system that calculates the travel distance from the number of steps and the step length of the pedestrian, and successively integrates and detects the own position from the travel distance and azimuth. By correcting, position detection can be performed with high accuracy. In addition, by sending the position data wirelessly or the like, it is possible to construct a system in which the administrator can manage the carrier and the carrier can exchange the position information with each other.
[0003]
Here, the number of steps of the pedestrian can be directly detected by a pedometer or an acceleration sensor. However, the pedestrian's stride cannot be detected directly and must be indirectly estimated from other information. Then, as the estimation method, the distance between two points during walking (the movement distance of the pedestrian) is obtained using GPS information, and the stride is calculated by dividing the movement distance by the number of steps detected during that time. A method is described in Patent Document 1.
[0004]
[Patent Document 1]
Japanese Patent Laid-Open No. 09-089584
[Problems to be solved by the invention]
In the method of estimating the stride using GPS information, errors can be eliminated by shortening the calculation interval, and high accuracy can be ensured. However, it cannot be used indoors, underground, forests, valleys of buildings, under highways, etc., where GPS signals cannot be received with high accuracy, and positioning errors are accumulated during this time, resulting in poor positioning accuracy. In particular, since there is no map information indoors, matching with a map cannot be performed, and the degradation of positioning accuracy becomes remarkable.
[0006]
In addition, positioning by GPS consumes a large amount of power, and from this point of view, it is required to be independent of GPS positioning as much as possible. However, in the case of not depending on positioning by GPS, the above-described decrease in positioning accuracy becomes a problem.
[0007]
Similarly, geomagnetic sensors that do not accumulate errors are mainly used for direction detection, but there are not many environments in which geomagnetism is disturbed, such as underground, in elevators, and near steel frames. Under the environment, it is difficult to accurately detect the orientation. The use of an angular velocity sensor is also considered, but since the timing of the combination is not clear, it is difficult to perform high-precision complementation.
[0008]
An object of the present invention is to provide a portable autonomous navigation device capable of accurate positioning without depending on positioning by GPS.
[0009]
Another object of the present invention is to provide a portable autonomous navigation device capable of accurate positioning even in an environment in which geomagnetism is disturbed.
[0010]
[Means for Solving the Problems]
In order to achieve the above goal, the first portable autonomous navigation apparatus of the present invention includes a step number detecting means for detecting the number of steps when a pedestrian walks and a direction detection for detecting the direction when the pedestrian walks. A pedestrian's moving distance is calculated from the means, a stride estimating means for estimating a stride when the pedestrian walks, and the number of detected steps and the estimated stride, and the map is calculated from the moving distance and the detected azimuth. Positioning means for specifying the self position above, and the stride estimation means is configured to measure a moving direction acceleration per step by an acceleration sensor and estimate a stride from the moving direction acceleration and a walking cycle. ing.
[0011]
In addition, the second portable autonomous navigation device of the present invention includes a step detection unit that detects the number of steps when a pedestrian walks, a direction detection unit that detects a direction when the pedestrian walks, and a pedestrian Calculates the walking distance of the pedestrian from the step estimation means that estimates the stride when walking, and the detected number of steps and the set stride, and identifies its position on the map from the moving distance and the detected direction The azimuth detecting means has a geomagnetic sensor and an angular velocity sensor, and switches the geomagnetic sensor to the angular velocity sensor to detect the azimuth when the output of the geomagnetic sensor falls below a reference value. Configured to do.
[0012]
In the first portable autonomous navigation apparatus of the present invention, the pedestrian's stride is accurately estimated as follows. In walking, as shown in Table 1, the moving distance is obtained by the product of the walking pace and the stride. The movement direction acceleration corresponds well to the movement distance (see FIG. 4). However, the stride cannot be obtained only from the acceleration in the moving direction. This is because the movement distance is affected not only by the stride but also by the walking pace. Therefore, the walking cycle is also considered. The walking cycle is a required time per step, and by taking this into consideration and the walking cycle, it is possible to accurately estimate the stride without depending on the GPS information.
[0013]
[Table 1]

[0014]
For the measurement of the acceleration in the moving direction, a triaxial acceleration sensor used for the measurement of the vertical acceleration for detecting the number of steps and the walking cycle can be used. This makes it possible to measure the acceleration in the moving direction without increasing hardware. Incidentally, since the vertical acceleration changes for each step of the pedestrian, walking vibration is detected from the change in the vertical acceleration, and the number of steps and the walking cycle are directly detected.
[0015]
As a problem when detecting walking vibrations of pedestrians, when the walking pace is slowed down, walking vibrations are reduced, and the S / N ratio of the sensor output is reduced. This makes it difficult to detect walking vibrations and increases errors. In this case, the number of steps and the step length are obtained from the angular velocity in the walking motion plane (in the vertical plane parallel to the walking direction) (see Table 1). In walking, as shown in FIG. 5, the walking motion is detected from the change in the angular velocity ω in the walking motion plane, and the stride is estimated from the magnitude thereof. By combining this, the stride can be accurately estimated without being affected by the walking pace.
[0016]
For detection of the angular velocity in the walking motion plane, a triaxial angular velocity sensor used for detecting the azimuth can be used. This makes it possible to detect the angular velocity in the walking motion plane without increasing hardware. Incidentally, the direction can be detected by detecting the angular velocity in the horizontal plane.
[0017]
Regardless of the pace of walking, the walking motion can be detected only from the angular velocity ω in the walking motion plane, but the detection of walking by the angular velocity ω is highly sensitive, but the effects of individual differences and the accumulation of errors are large, Regular use is not preferred. The detection of the walking motion based on the angular velocity ω is particularly effective when used for complementing the step length estimation from the acceleration in the moving direction and the walking cycle.
[0018]
In places where GPS signals can be received, this can be used for estimating the stride or for correcting the measurement position, thereby enabling positioning with a small error accumulation. In order to reduce power consumption, it is effective to estimate the stride from the acceleration in the moving direction and the walking cycle even in a place where GPS signals can be received. However, the accumulation of errors becomes a problem only with this estimation. For this reason, the combined use of GPS signals is important.
[0019]
In the second portable autonomous navigation device of the present invention, even when the geomagnetic sensor output is lower than the reference value, the azimuth sensor is switched from the geomagnetic sensor to the angular velocity sensor to detect the azimuth, so that the geomagnetism is disturbed. Accurate azimuth detection is possible. Azimuth error becomes a problem when it exceeds several degrees. Taking an elevator as an example, as shown in FIG. 6, the geomagnetic level is lowered to 90% or less of the rated level in front of the door, and accordingly, the azimuth error exceeds 5 degrees and becomes a problem. In the elevator, the geomagnetic level further decreases, and the azimuth error reaches 90 degrees. If 90% of the rated geomagnetic level is selected as the reference value, the azimuth can be accurately detected by the angular velocity sensor below this level.
[0020]
In azimuth detection using only the angular velocity sensor, accumulation of errors becomes a problem. By using the angular velocity sensor in a limited manner when the output of the geomagnetic sensor is reduced, highly accurate and stable azimuth detection becomes possible.
[0021]
As described above, this angular velocity sensor can be used to detect the angular velocity in the walking motion plane.
[0022]
DETAILED DESCRIPTION OF THE INVENTION
Embodiments of the present invention will be described below with reference to the drawings. FIG. 1 is a configuration diagram of a portable autonomous navigation apparatus showing an embodiment of the present invention, FIG. 2 is an explanatory view of an axial direction and a plane, and FIG. 3 is a flowchart showing functions of the portable autonomous navigation apparatus.
[0023]
As shown in FIG. 1, the portable autonomous navigation device of the present embodiment includes a microcomputer 1 having a well-known configuration. A three-axis acceleration sensor 2, a three-axis geomagnetic sensor 3, a three-axis gyro sensor 4, a GPS receiver 5, and an operation unit 6 are connected to the input side of the microcomputer 1. A display unit 7 is connected to the output side, and a storage medium 8 storing map information is connected to the input / output side.
[0024]
As shown in FIG. 2, the triaxial acceleration sensor 2 measures accelerations in the X axis direction, the Y axis direction, and the Z axis direction. The measurement data is input to the microcomputer 1 and is used for measurement of vertical acceleration (detection of the number of steps and walking cycle) and measurement of acceleration in the movement direction (detection of stride). Similarly, the triaxial geomagnetic sensor 3 detects the geomagnetism intensity in the X axis direction, the Y axis direction, and the Z axis direction. The detection data is input to the microcomputer 1 and used for detecting the direction. The triaxial gyro sensor 4 includes an angular velocity around the Z axis in a plane (α plane) including the X axis and the Y axis, an angular velocity around the Y axis in a plane (β plane) including the X axis and the Z axis, and the Y axis and The angular velocities around the X axis in a plane (γ plane) including the Z axis are each measured. The measurement data is input to the microcomputer 1 and used for detecting the direction, detecting the number of steps, and detecting the step length.
[0025]
The microcomputer 1 constitutes positioning means inside by software. The positioning means processes the GPS information input via the GPS receiver 5 together with the data from each of the sensors, and specifies the position of the wearer while exchanging information with the storage medium 8. It is displayed on the map displayed on the display unit 8. The function of the positioning means will be described in detail with reference to the flowchart of FIG.
[0026]
The stride is estimated as follows. From the three outputs of the triaxial acceleration sensor 2, the vertical acceleration and the moving direction acceleration accompanying the walking of the pedestrian are detected (step S 1). In this detection, the direction of gravity is detected from the above three outputs, and the vertical direction of the device is specified from this direction. Further, walking vibration is detected from the vertical acceleration, and the number of steps is obtained. Next, it is determined whether GPS information can be used from the GPS radio wave intensity (step S2). When the GPS information is usable, the stride is calculated from the pedestrian's moving distance and the number of steps obtained from the GPS information (steps S3 and S7).
[0027]
If GPS information cannot be received, the vertical acceleration is compared with a threshold value (step S4). When the vertical acceleration is larger than the threshold value, the maximum acceleration value in the moving direction for each step is detected. Further, a walking cycle is obtained from the number of steps (step S5). The walking cycle is obtained by dividing the unit walking time by the number of steps. Then, by comparing the obtained movement direction acceleration maximum value and walking cycle with the table in Table 1, the stride is obtained (steps S6 and S7).
[0028]
For example, when the maximum value of the acceleration in the moving direction is “medium” and the walking cycle is “small”, the stride is “large”. Further, “small” and “medium” are “small”, “large” and “medium” are “large”, and “medium” and “large” are “small”.
[0029]
When the GPS information cannot be received and the vertical acceleration is smaller than the threshold value, the angular velocity in the walking motion plane is detected from the three outputs of the triaxial gyro sensor 4 (step S8). The number of steps and the step length are detected from the change in angular velocity.
[0030]
In this way, the number of steps and the stride are detected in an environment where GPS information cannot be received. The moving distance of the pedestrian is calculated from the detected number of steps and step length.
[0031]
On the other hand, the orientation is detected as follows. Three outputs of the triaxial geomagnetic sensor 3 are captured (step S11). The output intensity is compared with a threshold value (step S12). The threshold value is, for example, a 90% level of the rated strength. If the output intensity is greater than the threshold value, the direction is detected from the three outputs of the triaxial geomagnetic sensor 3 (step S13).
[0032]
When the output intensity is smaller than the threshold value, the angular velocity in the horizontal plane is detected (step S14), and the azimuth is detected from the angular velocity. As described above, the own position is obtained from the movement distance and direction of the pedestrian.
[0033]
In the above embodiment, when GPS information is not receivable, the stride is estimated from the moving direction acceleration and the walking cycle. However, when GPS information is receivable, this estimation can be performed. Thereby, the dependence of GPS positioning that power consumption increases can be reduced, and power consumption can be reduced.
[0034]
【The invention's effect】
As described above, the portable autonomous navigation device of the present invention is dependent on the positioning by GPS by measuring the acceleration in the moving direction per step by the acceleration sensor and estimating the stride from the moving direction acceleration and the walking cycle. Accurate positioning can be performed without doing. This enables accurate mobile navigation in the entire environment and shortens the positioning time by GPS, thereby reducing power consumption.
[0035]
In addition, the portable autonomous navigation device of the present invention uses a geomagnetic sensor and an angular velocity sensor in combination to detect the azimuth, and detects the azimuth by switching from the geomagnetic sensor to the angular velocity sensor when the output of the geomagnetic sensor falls below the reference value. Thus, accurate positioning can be performed even in an environment where the geomagnetism is disturbed.
[Brief description of the drawings]
FIG. 1 is a configuration diagram of a portable autonomous navigation apparatus showing an embodiment of the present invention.
FIG. 2 is an explanatory diagram of an axial direction and a surface.
FIG. 3 is a flowchart showing functions of the portable autonomous navigation device.
FIG. 4 is a graph showing a relationship between a stride and a moving direction acceleration.
FIG. 5 is an explanatory diagram of angular velocities in the walking motion plane.
FIG. 6 is a graph showing a relationship between a geomagnetic level and an azimuth error.
[Explanation of symbols]
DESCRIPTION OF SYMBOLS 1 Microcomputer 2 Acceleration sensor 3 Geomagnetic sensor 4 Gyro sensor 5 GPS receiver 6 Operation part 7 Display part 8 Storage medium

Claims

Step detection means for detecting the number of steps when the pedestrian walks, direction detection means for detecting the direction when the pedestrian walks, and step length estimation means for estimating the step length when the pedestrian walks are detected. Calculating the pedestrian's moving distance from the estimated number of steps and the estimated stride, and positioning means for specifying the position on the map from the moving distance and the detected azimuth, the stride estimating means, A portable autonomous navigation apparatus characterized by measuring a moving direction acceleration per step by an acceleration sensor and estimating a step length from the moving direction acceleration and a walking cycle.

The portable autonomous navigation apparatus according to claim 1, wherein a three-axis acceleration sensor used for measuring the vertical acceleration for detecting the number of steps and the walking cycle is used in combination as the acceleration sensor.

The portable autonomous navigation device according to claim 1, wherein the stride estimation means uses an angular velocity in a walking motion plane as a reference signal.

4. The portable autonomous navigation apparatus according to claim 3, wherein a three-axis angular velocity sensor used for detecting a bearing is used in combination as the sensor for detecting the angular velocity.

The portable autonomous navigation apparatus according to claim 1, wherein the stride measuring means uses a GPS signal as a reference signal.

Step detection means for detecting the number of steps when the pedestrian walks, direction detection means for detecting the direction when the pedestrian walks, and step length estimation means for estimating the step length when the pedestrian walks are detected. Calculating the pedestrian's moving distance from the number of steps and the set step length, and positioning means for specifying the position on the map from the moving distance and the detected azimuth, the azimuth detecting means, A portable autonomous navigation device having a geomagnetic sensor and an angular velocity sensor, wherein the direction is detected by switching from the geomagnetic sensor to the angular velocity sensor when the output of the geomagnetic sensor falls below a reference value.