JP7059114B2 - 位置計測装置および位置計測方法 - Google Patents
位置計測装置および位置計測方法 Download PDFInfo
- Publication number
- JP7059114B2 JP7059114B2 JP2018114745A JP2018114745A JP7059114B2 JP 7059114 B2 JP7059114 B2 JP 7059114B2 JP 2018114745 A JP2018114745 A JP 2018114745A JP 2018114745 A JP2018114745 A JP 2018114745A JP 7059114 B2 JP7059114 B2 JP 7059114B2
- Authority
- JP
- Japan
- Prior art keywords
- value
- acceleration
- global
- traveling direction
- position measuring
- 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
Landscapes
- Navigation (AREA)
Description
θ=ΔT√(ω2 u(t)+ω2 v(t)+ω2 w(t)) (2)
q(t)=q(t-ΔT)(cos(θ/2)+n sin(θ/2)) (3)
Average(Ay(t))=0 (8)
Average(Az(t))=G (9)
Sy=Σ{Aby(t)Adz(t)} (13)
歩行位置y[i]=y[i-1]+歩幅[i]sin(進行方向[i]) (16)
vx'(t)=(C√2sin(Ct))/(2(E/m-cos(Ct))1/2)cos(θ) (20)
vy'(t)=(C√2sin(Ct))/(2(E/m-cos(Ct))1/2)sin(θ) (21)
=Σ{(C√2 sin(Ct))/(2(E/m-cos(Ct))1/2)cos(θ) C2 sin(Ct)}
=C3√2 Σ{sin2(Ct)/(2(E/m-cos(Ct))1/2)}cos(θ) (23)
=Σ{(C√2sin(Ct))/(2(E/m-cos(Ct))1/2)sin(θ) C2sin(Ct)}
=C3√2 Σ{sin2(Ct)/(2(E/m-cos(Ct))1/2)}sin(θ) (24)
={C3√2 Σ{sin2(Ct)/(2(E/m-cos(Ct))1/2)}sin(θ)}
/{C3√2 Σ{sin2(Ct)/(2(E/m-cos(Ct))1/2)}cos(θ)}
=sin(θ)/cos(θ)
=θ (25)
max(ωv(t))-min(ωv(t)),
max(ωw(t))-min(ωw(t)) の最大値 (26)
Claims (11)
- 位置計測の対象となる対象者の動作により変化する3軸の角速度をセンシングする角速度センサと、
前記対象者の動作により変化する3軸方向の加速度をセンシングする加速度センサと、
前記3軸の角速度により求められる回転を示す値に基づいて前記3軸方向の加速度をグローバル座標の水平方向および垂直方向に対応するグローバル加速度に変換する座標変換部と、
前記グローバル加速度に基づいて前記グローバル座標の1歩の区間および歩幅を求める歩幅推定部と、
前記1歩の区間における垂直方向の前記グローバル加速度の位相を進めた値と水平方向の前記グローバル加速度の値とに基づいて進行方向を求める進行方向推定部と、
前記歩幅と前記進行方向に基づいて歩行位置を求める位置推定部と、
を備える位置計測装置。 - 垂直方向の前記グローバル加速度の値または前記3軸方向の加速度の合計値における変化の1周期を前記1歩の区間とし、この1歩の区間に対応する垂直方向の前記グローバル加速度の値または前記3軸方向の加速度の合計値における最大値および最小値に基づいて前記歩幅を求め、前記1歩の区間における垂直方向の前記グローバル加速度の位相を進めた値と水平方向の前記グローバル加速度の値とを乗算および累積した値を求め、この値の逆正接に基づいて進行方向を求める、ように構成されている、請求項1に記載の位置計測装置。
- 3軸方向の磁界ベクトルをセンシングする磁界センサを備え、
前記座標変換部は、前記3軸方向の磁界ベクトルを前記グローバル座標の水平方向および垂直方向に対応するグローバル磁界ベクトルに変換し、前記グローバル磁界ベクトルが使用場所の磁界の方向に対応するように前記回転を示す値を補正する請求項1または請求項2に記載の位置計測装置。 - 前記磁界の方向は、地磁気に基づいて求められる請求項3に記載の位置計測装置。
- 前記磁界の方向は、前記使用場所にて予め測定された磁界の値に基づいて求められる請求項3に記載の位置計測装置。
- 前記座標変換部は、前記グローバル加速度の平均値により前記グローバル座標の垂直方向を求め、この垂直方向に基づいて前記進行方向の演算に関する値を補正する請求項1から請求項5のいずれか1項に記載の位置計測装置。
- 前記歩幅推定部は、垂直方向の前記グローバル加速度の値をバンドパスフィルタで処理し、この処理した値がプラスからマイナスになる時点から、次にプラスからマイナスになる時点までを前記1歩の区間として求める請求項1から請求項6のいずれか1項に記載の位置計測装置。
- 前記進行方向推定部は、垂直方向の前記グローバル加速度の値をバンドパスフィルタで処理し、この処理した値の時間の差分をとることで、前記グローバル加速度の位相を進めた値を求める請求項1から請求項7のいずれか1項に記載の位置計測装置。
- 前記進行方向推定部は、前記1歩の区間における垂直方向の前記グローバル加速度の最小値が走行判定値以下の場合に、前記対象者が走行していると判定し、前記進行方向を180°変換する請求項1から請求項8のいずれか1項に記載の位置計測装置。
- 前記座標変換部は、一定時間内の前記3軸の角速度の最大値と最小値の差が静止判定値以下の場合に、前記対象者が静止していると判定し、この静止しているときの前記角速度の平均値を求め、この平均値とオフセット値として設定する請求項1から請求項9のいずれか1項に記載の位置計測装置。
- 位置計測の対象となる対象者の動作により変化する3軸の角速度を角速度センサによりセンシングするステップと、
前記対象者の動作により変化する3軸方向の加速度を加速度センサによりセンシングするステップと、
前記3軸の角速度により求められる回転を示す値に基づいて前記3軸方向の加速度をグローバル座標の水平方向および垂直方向に対応するグローバル加速度に変換するステップと、
前記グローバル加速度に基づいて前記グローバル座標の1歩の区間および歩幅を求めるステップと、
前記1歩の区間における垂直方向の前記グローバル加速度の位相を進めた値と水平方向の前記グローバル加速度の値とに基づいて進行方向を求めるステップと、
前記歩幅と前記進行方向に基づいて歩行位置を求めるステップと、
を含む位置計測方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018114745A JP7059114B2 (ja) | 2018-06-15 | 2018-06-15 | 位置計測装置および位置計測方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018114745A JP7059114B2 (ja) | 2018-06-15 | 2018-06-15 | 位置計測装置および位置計測方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2019219187A JP2019219187A (ja) | 2019-12-26 |
JP7059114B2 true JP7059114B2 (ja) | 2022-04-25 |
Family
ID=69096118
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2018114745A Active JP7059114B2 (ja) | 2018-06-15 | 2018-06-15 | 位置計測装置および位置計測方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7059114B2 (ja) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011093447A1 (ja) | 2010-01-29 | 2011-08-04 | 独立行政法人産業技術総合研究所 | 計算装置、計算装置の制御方法、制御プログラム、及び記録媒体 |
JP2014167461A (ja) | 2013-02-04 | 2014-09-11 | Ricoh Co Ltd | 慣性装置、方法及びプログラム |
WO2015107853A1 (ja) | 2014-01-14 | 2015-07-23 | 旭化成株式会社 | 進行方向情報出力装置、マップマッチング装置、進行方向情報出力方法、およびプログラム |
JP2015184159A (ja) | 2014-03-25 | 2015-10-22 | セイコーエプソン株式会社 | 相関係数補正方法、運動解析方法、相関係数補正装置及びプログラム |
WO2017104646A1 (ja) | 2015-12-18 | 2017-06-22 | 株式会社リコー | 情報処理システム、情報処理装置、情報処理方法、プログラム、および記録媒体 |
-
2018
- 2018-06-15 JP JP2018114745A patent/JP7059114B2/ja active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011093447A1 (ja) | 2010-01-29 | 2011-08-04 | 独立行政法人産業技術総合研究所 | 計算装置、計算装置の制御方法、制御プログラム、及び記録媒体 |
JP2014167461A (ja) | 2013-02-04 | 2014-09-11 | Ricoh Co Ltd | 慣性装置、方法及びプログラム |
WO2015107853A1 (ja) | 2014-01-14 | 2015-07-23 | 旭化成株式会社 | 進行方向情報出力装置、マップマッチング装置、進行方向情報出力方法、およびプログラム |
JP2015184159A (ja) | 2014-03-25 | 2015-10-22 | セイコーエプソン株式会社 | 相関係数補正方法、運動解析方法、相関係数補正装置及びプログラム |
WO2017104646A1 (ja) | 2015-12-18 | 2017-06-22 | 株式会社リコー | 情報処理システム、情報処理装置、情報処理方法、プログラム、および記録媒体 |
Also Published As
Publication number | Publication date |
---|---|
JP2019219187A (ja) | 2019-12-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6322960B2 (ja) | 慣性装置、方法及びプログラム | |
JP6268945B2 (ja) | 慣性装置、方法及びプログラム | |
CA2843747C (en) | Moving direction determination with noisy signals from inertial navigation systems on mobile devices | |
Zhang et al. | Inertial sensor based indoor localization and monitoring system for emergency responders | |
Lan et al. | Using smart-phones and floor plans for indoor location tracking-Withdrawn | |
US20210247189A1 (en) | Positioning apparatus, positioning method, and program | |
JP5704561B2 (ja) | 進行方向推定装置、携帯端末、制御プログラム、コンピュータ読み取り可能な記録媒体、および進行方向推定方法 | |
KR101693629B1 (ko) | 로코모션 인터페이스 장치상에서 보행하는 보행자의 위치 추정 방법 및 장치 | |
TW201403029A (zh) | 運算裝置之步距計算方法 | |
JP5511088B2 (ja) | 自律測位に用いる重力ベクトルを補正する携帯装置、プログラム及び方法 | |
JP2015152559A (ja) | 慣性装置、制御方法及びプログラム | |
Zhou et al. | An improved dead reckoning algorithm for indoor positioning based on inertial sensors | |
JP5821513B2 (ja) | 参照値生成方法及び参照値生成装置 | |
Kim et al. | Performance improvement and height estimation of pedestrian dead-reckoning system using a low cost MEMS sensor | |
EP3227634A1 (en) | Method and system for estimating relative angle between headings | |
JP7059114B2 (ja) | 位置計測装置および位置計測方法 | |
JP2013108865A (ja) | 慣性航法演算方法及び慣性航法演算装置 | |
CN112904884A (zh) | 足式机器人轨迹跟踪方法、设备及可读存储介质 | |
JP2015017858A (ja) | 参照値生成装置及び参照値生成方法 | |
Bahillo et al. | Low-cost Bluetooth foot-mounted IMU for pedestrian tracking in industrial environments | |
Bravo et al. | Comparison of step length and heading estimation methods for indoor environments | |
Cho et al. | Gyro signal processing-based stance phase detection method in foot mounted PDR | |
Cui et al. | Pedestrian navigation with INS measurements and gait models | |
Li et al. | Research on ZUPT technology for pedestrian navigation | |
CN110579212B (zh) | 室内定位方法及装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20210208 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220105 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220302 |
|
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: 20220315 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220413 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7059114 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |