JP6014711B2 - 携帯機器と自律航法演算法 - Google Patents
携帯機器と自律航法演算法 Download PDFInfo
- Publication number
- JP6014711B2 JP6014711B2 JP2015085671A JP2015085671A JP6014711B2 JP 6014711 B2 JP6014711 B2 JP 6014711B2 JP 2015085671 A JP2015085671 A JP 2015085671A JP 2015085671 A JP2015085671 A JP 2015085671A JP 6014711 B2 JP6014711 B2 JP 6014711B2
- Authority
- JP
- Japan
- Prior art keywords
- axis
- acceleration
- mobile device
- sensor
- portable device
- 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.)
- Active
Links
Images
Description
ンサが検出した加速度データから前記携帯機器の姿勢角度を算出し、前記姿勢角度が第一閾値より小さい際は前記携帯機器の姿勢を縦向きと判定し、大きい際は横向きと判定し、前記携帯機器の姿勢が縦向きと判定された場合、前記3軸の地磁気センサが検出するY軸方向が前記移動体の移動方向であると推定し、前記携帯機器の姿勢が横向きと判定された場合、前記3軸の地磁気センサが検出するX軸方向が前記移動体の移動方向であると推定することを特徴とする。
。
で保持され、歩行時には歩行者の前面に横向き又は縦向きに保持されているか、または、図8に示すように歩行者の左右の側面で前後に振られ、加速度センサのY軸センサ13が感知するY軸方向が回転中心(歩行者の肩)から外側に向き、加速度センサのZ軸センサ14が感知するZ軸方向が歩行者に向いた状態を想定している。
移動方向(θ‘)=携帯機器の方向62(θ)
とする。また、この結果は、移動経路演算部34に出力される。
移動方向(θ‘)=携帯機器の方向62(θ)
とする。また、この結果は、移動経路演算部34に出力される。
移動方向(θ‘)=携帯機器の方向62(θ)−90
と補正される。その結果は、移動経路演算部34に出力される。
移動方向(θ‘)=携帯機器の方向62(θ)+90
と補正される。その結果は、移動経路演算部34に出力される。
後に携帯機器1が振られる一周期の間に、歩行者は2歩進む。この結果は、移動経路演算部34に出力される。
移動方向(θ‘)=携帯機器の方向62(θ)
に歩幅×0歩の距離を現時点までの移動経路に繋いで、移動経路を算出する。ただし、この際は、歩幅×0歩のため移動距離はゼロなので、移動経路は生じない。
移動方向(θ‘)=携帯機器の方向62(θ)
に歩幅×0歩の距離を現時点までの移動経路に繋いで、移動経路64を算出する。ただし、この際は、歩幅×0歩のため移動距離はゼロなので、移動経路は生じない。
移動方向(θ‘)=携帯機器の方向62(θ)
に歩幅×1歩の距離を現時点までの移動経路に繋いで、移動経路を算出する。
×niとなる。歩行者の前面に携帯機器1が保持され歩行者が歩行する際は歩数は1であり、歩行者の側面で携帯機器1が振られ歩行者が歩行する際は歩数は2である。移動方向θ1からθnまで、移動方向θiに歩幅×歩数×niの移動距離を繋ぐことで、起点(始動点)から現時点までの移動経路が算出される。この算出方法は一例であって、移動経路を正しく算出できる他の算出方法を用いても構わない。
移動方向(θ‘)=携帯機器の方向62(θ)+90
または
移動方向(θ‘)=携帯機器の方向62(θ)−90
に歩幅×0歩の距離を現時点までの移動経路に繋いで、移動経路を算出する。ただし、この際は、歩幅×0歩のため移動距離はゼロなので、移動経路は生じない。また、3軸加速度の分散値σが、第五閾値より大きければ異常時であり、移動経路は算出しない。
移動方向(θ‘)=携帯機器の方向62(θ)+90
または
移動方向(θ‘)=携帯機器の方向62(θ)−90
に歩幅×0歩の距離を現時点までの移動経路に繋いで、移動経路を算出する。ただし、この際は、歩幅×0歩のため移動距離はゼロなので、移動経路は生じない。
移動方向(θ‘)=携帯機器の方向62(θ)+90
または
移動方向(θ‘)=携帯機器の方向62(θ)−90
に歩幅×2歩の距離を現時点までの移動経路に繋いで、移動経路を算出する。
基づいて、進行方向計測装置に付随する端末座標系から見た歩行者の移動方向を推定する。次に、地磁気データ群と端末座標系の前記移動方向に基づいて、地上座標系での移動方向63を算出している。
2 ブロック図
11 加速度センサ
12 加速度センサのX軸センサ
13 加速度センサのY軸センサ
14 加速度センサのZ軸センサ
21 地磁気センサ
22 地磁気センサのX軸センサ
23 地磁気センサのY軸センサ
24 地磁気センサのZ軸センサ
31 加速度演算部
32 方位演算部
33 移動方向演算部
34 移動経路演算部
35 表示演算部
36 表示部
41 信号処理部
42 記憶部
51 ロール角
52 加速センサのY軸センサ13が感知するY軸方向と水平面とがなす角度
62 携帯機器の方向
90 携帯電話
Claims (6)
- 地磁気を検出するX軸用、Y軸用及びZ軸用からなる3軸の地磁気センサと、
加速度を検出するX軸用、Y軸用及びZ軸用からなる3軸の加速度センサと、
を備え、
前記3軸の加速度センサが検出した加速度データから、携帯機器の姿勢角度、携帯機器の姿勢及び第一の計算値群を算出する加速度演算部と、
前記3軸の地磁気センサが検出した地磁気データから携帯機器の方向を算出する方位演算部と、
前記第一の計算値群を複数の閾値と比較することで前記携帯機器の方向から移動体の移動方向を算出する移動方向演算部と、を備える携帯機器であって、
前記加速度演算部は、前記3軸の加速度センサが検出した加速度データから前記携帯機器の姿勢角度を算出し、前記姿勢角度が第一閾値より小さい際は前記携帯機器の姿勢を縦向きと判定し、大きい際は横向きと判定し、
前記携帯機器の姿勢が縦向きと判定された場合、前記3軸の地磁気センサが検出するY軸方向が前記移動体の移動方向であると推定し、前記携帯機器の姿勢が横向きと判定された場合、前記3軸の地磁気センサが検出するX軸方向が前記移動体の移動方向であると推定することを特徴とする携帯機器。 - 前記加速度演算部が前記携帯機器の姿勢を縦向きと判定した後に、前記3軸の加速度センサのX軸の出力値の絶対値が第二閾値より大きい際は、前記携帯機器が前記移動体の側面で振られていると推定することを特徴とする請求項1に記載の携帯機器。
- 前記携帯機器が前記移動体の側面で振られていると推定された際には、前記振られる動作に対応する前記3軸の加速度センサの出力の一周期を2歩として歩数を算出することを特徴とする請求項2に記載の携帯機器。
- 加速度を検出するX軸用、Y軸用及びZ軸用からなる3軸の加速度センサが検出した加速度データから、携帯機器の姿勢角度、携帯機器の姿勢及び第一の計算値群を算出し、
地磁気を検出するX軸用、Y軸用及びZ軸用からなる3軸の地磁気センサが検出した地磁気データから携帯機器の方向を算出し、
前記第一の計算値群を複数の閾値と比較することで前記携帯機器の方向から移動体の移動方向を算出する自律航法演算法であって、
前記3軸の加速度センサが検出した加速度データから算出された姿勢角度が第一閾値より小さい際は前記携帯機器の姿勢を縦向きと判定し、大きい際は横向きと判定し、
前記携帯機器の姿勢が縦向きと判定された場合、前記3軸の地磁気センサが検出するY軸方向が前記移動体の移動方向であると推定し、前記携帯機器の姿勢が横向きと判定された場合、前記3軸の地磁気センサが検出するX軸方向が前記移動体の移動方向であると推定することを特徴とする自律航法演算法。 - 前記携帯機器の姿勢を縦向きと判定した後に、前記3軸の加速度センサのX軸の出力値の絶対値が第二閾値より大きい際は、前記携帯機器が前記移動体の側面で振られていると推定することを特徴とする請求項4に記載の自律航法演算法。
- 前記携帯機器が前記移動体の側面で振られていると推定された際には、前記振られる動作に対応する前記3軸の加速度センサの出力の一周期を2歩として歩数を算出することを特徴とする請求項5に記載の自律航法演算法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015085671A JP6014711B2 (ja) | 2015-04-20 | 2015-04-20 | 携帯機器と自律航法演算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015085671A JP6014711B2 (ja) | 2015-04-20 | 2015-04-20 | 携帯機器と自律航法演算法 |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2011013223A Division JP5809416B2 (ja) | 2011-01-25 | 2011-01-25 | 携帯機器と自律航法演算法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2015132629A JP2015132629A (ja) | 2015-07-23 |
JP6014711B2 true JP6014711B2 (ja) | 2016-10-25 |
Family
ID=53899896
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015085671A Active JP6014711B2 (ja) | 2015-04-20 | 2015-04-20 | 携帯機器と自律航法演算法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6014711B2 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106403917B (zh) * | 2016-09-06 | 2019-02-01 | 青岛海信移动通信技术股份有限公司 | 墙体垂度检测方法及装置 |
US20200062537A1 (en) * | 2017-05-16 | 2020-02-27 | Mitsubishi Electric Corporation | Elevator system and mobile terminal |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2006104140A1 (ja) * | 2005-03-28 | 2006-10-05 | Asahi Kasei Emd Corporation | 進行方向計測装置及び進行方向計測方法 |
JP2009284468A (ja) * | 2008-04-23 | 2009-12-03 | Sharp Corp | 携帯情報端末、コンピュータ読取可能なプログラムおよび記録媒体 |
JP4621835B2 (ja) * | 2008-12-17 | 2011-01-26 | アイチ・マイクロ・インテリジェント株式会社 | 携帯ナビゲーション装置 |
-
2015
- 2015-04-20 JP JP2015085671A patent/JP6014711B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2015132629A (ja) | 2015-07-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5809416B2 (ja) | 携帯機器と自律航法演算法 | |
US10197587B2 (en) | Device and method for using time rate of change of sensor data to determine device rotation | |
EP2773920B1 (en) | System and method for improving orientation data | |
US10072956B2 (en) | Systems and methods for detecting and handling a magnetic anomaly | |
US8239153B2 (en) | Dynamic compass calibration in a portable device | |
CN106814753B (zh) | 一种目标位置矫正方法、装置及系统 | |
JP5927776B2 (ja) | 携帯機器 | |
US10627237B2 (en) | Offset correction apparatus for gyro sensor, recording medium storing offset correction program, and pedestrian dead-reckoning apparatus | |
CN110954134B (zh) | 陀螺仪偏差校正方法、校正系统、电子设备及存储介质 | |
CN106370178B (zh) | 移动终端设备的姿态测量方法及装置 | |
US20060241883A1 (en) | Method of compensating tilt using two-axis geomagnetic sensor, and acceleration sensor, and apparatus thereof | |
JP5036001B2 (ja) | 地磁気センサを用いて歩行者の端末所持状態を判別する携帯端末及びプログラム | |
JP2012173190A (ja) | 測位システム、測位方法 | |
JP6044971B2 (ja) | 推定方位角評価装置、移動体端末装置、推定方位角評価装置の制御プログラム、コンピュータ読み取り可能な記録媒体、推定方位角評価装置の制御方法、および測位装置 | |
US10533874B2 (en) | Inertial positioning and navigation device featuring a novel walk detection method | |
JP2017166895A (ja) | 電子機器及びセンサ較正方法、センサ較正プログラム | |
JP2008241675A (ja) | 電子コンパス | |
JP6867254B2 (ja) | 測定装置、ナビゲーションシステム、測定方法及びプログラム | |
CN108507567B (zh) | 姿态四元数确定方法、装置及用户朝向确定方法、装置 | |
EP3227634B1 (en) | Method and system for estimating relative angle between headings | |
JP6014711B2 (ja) | 携帯機器と自律航法演算法 | |
JP5105598B2 (ja) | 地磁気センサのみを用いて歩行者の進行方向を決定する携帯端末、プログラム及び方法 | |
WO2014115848A1 (ja) | 回転情報演算方法、回転情報演算プログラム、磁気型ジャイロスコープおよび移動体 | |
CN106931965B (zh) | 一种确定终端姿态的方法及装置 | |
JP2015099153A (ja) | 携帯機器と自律航法演算法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20150420 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20160129 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20160202 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20160401 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20160906 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20160926 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6014711 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |