JP4726134B2 - 移動体制御装置及び移動体制御方法 - Google Patents
移動体制御装置及び移動体制御方法 Download PDFInfo
- Publication number
- JP4726134B2 JP4726134B2 JP2006101456A JP2006101456A JP4726134B2 JP 4726134 B2 JP4726134 B2 JP 4726134B2 JP 2006101456 A JP2006101456 A JP 2006101456A JP 2006101456 A JP2006101456 A JP 2006101456A JP 4726134 B2 JP4726134 B2 JP 4726134B2
- Authority
- JP
- Japan
- Prior art keywords
- information
- posture
- moving body
- speed
- error
- 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
- 238000000034 method Methods 0.000 title claims description 8
- VJYFKVYYMZPMAB-UHFFFAOYSA-N ethoprophos Chemical compound CCCSP(=O)(OCC)SCCC VJYFKVYYMZPMAB-UHFFFAOYSA-N 0.000 title 2
- 230000001133 acceleration Effects 0.000 description 17
- 238000006243 chemical reaction Methods 0.000 description 4
- 230000005484 gravity Effects 0.000 description 4
- 239000002131 composite material Substances 0.000 description 3
- 150000001875 compounds Chemical class 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 239000000654 additive Substances 0.000 description 1
- 230000000996 additive effect Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Description
D.Choukroun, "A Novel QianternionKalman Filter", Paper 2002-4460 at 42th AIAA Guidance, Navigation, andControl Conference 2004. F.Landis Markley,"Multiplicative vs. Additive Filtering for Spacecraft AttitudeDetermination", 6th Dynamics and Control of Systems and Structures inSpace, 2004
(1)地球中心を原点として、地球の自転軸と平行になるようZ軸を定めた右手系直交座標系(以下、iフレームと呼ぶ)と、
(2)地球中心を原点として、緯度0度、経度0度方向をX軸とし、かつ地球の自転軸と平行になるようZ軸を定めた右手系直交座標系(以下、eフレームと呼ぶ)と、
(3)移動体を原点として、北方向をX軸、地球による重力の方向をZ軸とした右手系直交座標系(以下、gフレームと呼ぶ)と、
(4)移動体を原点として、地球による重力方向をZ軸とした右手系直交座標系であって、gフレームにおけるZ軸を中心にgフレームをα(rad)だけ回転させたときの座標系(以下、nフレームと呼ぶ)と、
(5)移動体を原点として、移動体の進行方向をX軸、揚力方向をZ軸とした右手系直交座標系(以下、bフレームと呼ぶ)と、
のいずれかの座標系にて表現される。
ここで誤差モデルは、
Claims (2)
- 慣性航法データと測位データとに基づいて状態推定フィルタ演算を行い、移動体の位置、姿勢、速度の情報を出力する状態推定フィルタ演算手段と、
前記慣性航法データについての前記状態推定フィルタ演算における、移動体の位置、姿勢、速度の各誤差を演算する誤差演算手段と、
を含み、
前記誤差演算手段が、前記状態推定フィルタ演算手段が出力する、位置、姿勢、速度の各々を表す状態変数に係り、それよりも要素数の少ない状態変数で特定される微小変化単位四元数として表示された誤差情報を用いて、前記位置、姿勢、速度の各誤差を演算し、
前記状態推定フィルタ演算手段が出力する、移動体の位置、姿勢、速度の各情報が、前記誤差演算手段によって演算された誤差情報を乗じることで補正され、移動体の制御に供されることを特徴とする移動体制御装置。 - 慣性航法データと測位データとに基づいて状態推定フィルタ演算を行い、移動体の位置、姿勢、速度の情報を出力する工程と、
前記慣性航法データについての前記状態推定フィルタ演算における、移動体の位置、姿勢、速度の各誤差を演算する工程と、
を含み、
前記誤差演算工程において、前記状態推定フィルタ演算手段が出力する、位置、姿勢、速度の各々を表す状態変数に係り、それよりも要素数の少ない状態変数で特定される微小変化単位四元数として表示された誤差情報を用いて、前記位置、姿勢、速度の各誤差を演算し、
前記状態推定フィルタ演算手段が出力する、移動体の位置、姿勢、速度の各情報が、前記誤差演算手段によって演算された誤差情報を乗じることで補正され、移動体の制御に供することを特徴とする移動体制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006101456A JP4726134B2 (ja) | 2006-04-03 | 2006-04-03 | 移動体制御装置及び移動体制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006101456A JP4726134B2 (ja) | 2006-04-03 | 2006-04-03 | 移動体制御装置及び移動体制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2007276507A JP2007276507A (ja) | 2007-10-25 |
JP4726134B2 true JP4726134B2 (ja) | 2011-07-20 |
Family
ID=38678443
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2006101456A Active JP4726134B2 (ja) | 2006-04-03 | 2006-04-03 | 移動体制御装置及び移動体制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4726134B2 (ja) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5569681B2 (ja) * | 2010-04-23 | 2014-08-13 | 国立大学法人 東京大学 | 慣性センサ,磁気センサおよび速度計を用いた移動体の姿勢推定装置および姿勢推定方法 |
CN101881971B (zh) * | 2010-06-25 | 2012-03-07 | 深圳市东方华创投资有限公司 | 微型无人旋翼飞行器的飞行状态控制方法及装置 |
JP5747752B2 (ja) * | 2011-09-06 | 2015-07-15 | トヨタ自動車株式会社 | 姿勢推定装置、姿勢推定方法、姿勢推定プログラム |
CN102424112B (zh) * | 2011-11-30 | 2014-01-22 | 东北大学 | 微小型四旋翼飞行器的三层机载飞控装置 |
JP5061264B1 (ja) * | 2012-03-23 | 2012-10-31 | 国立大学法人 千葉大学 | 小型姿勢センサ |
JP6255924B2 (ja) | 2013-11-11 | 2018-01-10 | セイコーエプソン株式会社 | センサー用ic、センサーデバイス、電子機器及び移動体 |
CN103591955B (zh) * | 2013-11-21 | 2016-03-30 | 西安中科光电精密工程有限公司 | 组合导航系统 |
US10901095B2 (en) | 2014-04-25 | 2021-01-26 | Nec Corporation | Position and attitude estimation device, image processing device, and position and attitude estimation method |
KR101644263B1 (ko) * | 2015-01-19 | 2016-07-29 | 한양대학교 산학협력단 | 차량 위치 추정 방법 및 장치 |
JP2017146721A (ja) * | 2016-02-16 | 2017-08-24 | 日本飛行機株式会社 | 航空機データバスライン連接方法 |
WO2018034033A1 (ja) | 2016-08-16 | 2018-02-22 | 本郷飛行機株式会社 | 通信制御装置 |
CN106066648B (zh) * | 2016-08-19 | 2017-09-26 | 北京航天自动控制研究所 | 一种对时变调姿目标的程序四元数在线规划方法 |
EP3633483A4 (en) | 2017-05-26 | 2020-12-30 | Guangzhou Xaircraft Technology Co., Ltd. | PROCESS FOR DETERMINING A HEADING OF AN UNPILOT AIR VEHICLE, AND UNPILOT AIR VEHICLE |
CN109916399B (zh) * | 2019-04-04 | 2019-12-24 | 中国人民解放军火箭军工程大学 | 一种阴影下的载体姿态估计方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6454217B1 (en) * | 2000-09-28 | 2002-09-24 | Space Systems/Loral, Inc. | Method and apparatus for rate integration supplement for attitude referencing with quaternion differencing |
US7346452B2 (en) * | 2003-09-05 | 2008-03-18 | Novatel, Inc. | Inertial GPS navigation system using injected alignment data for the inertial system |
JP4876204B2 (ja) * | 2006-01-05 | 2012-02-15 | ヒロボー株式会社 | 小型姿勢センサ |
-
2006
- 2006-04-03 JP JP2006101456A patent/JP4726134B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2007276507A (ja) | 2007-10-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4726134B2 (ja) | 移動体制御装置及び移動体制御方法 | |
CN109813311B (zh) | 一种无人机编队协同导航方法 | |
KR100815152B1 (ko) | 다중 필터 융합을 이용한 복합 항법 장치 및 이를 이용한항법 정보 제공 방법 | |
JP6094026B2 (ja) | 姿勢判定方法、位置算出方法及び姿勢判定装置 | |
JP5602070B2 (ja) | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム | |
EP3040680B1 (en) | Magnetic anomaly tracking for an inertial navigation system | |
JP2012173190A (ja) | 測位システム、測位方法 | |
JP2007232443A (ja) | 慣性航法装置およびその誤差補正方法 | |
JP5164645B2 (ja) | カルマンフィルタ処理における繰り返し演算制御方法及び装置 | |
JPH095104A (ja) | 移動物体の三次元姿勢角測定法および三次元姿勢角計測装置 | |
Bisgaard et al. | Full state estimation for helicopter slung load system | |
US9217639B1 (en) | North-finding using inertial navigation system | |
Hazry et al. | Study of inertial measurement unit sensor | |
JP4946562B2 (ja) | 姿勢検出装置および方法 | |
CN103616026A (zh) | 一种基于h∞滤波的auv操纵模型辅助捷联惯导组合导航方法 | |
CN112649001B (zh) | 一种小型无人机姿态与位置解算方法 | |
Tang et al. | An attitude estimate method for fixed-wing UAV s using MEMS/GPS data fusion | |
Saini et al. | Implementation of Multi-Sensor GPS/IMU Integration Using Kalman Filter for Autonomous Vehicle | |
JP2010202069A (ja) | 姿勢制御装置 | |
CA3081595A1 (en) | Drone control device using model prediction control | |
JP6969131B2 (ja) | 移動体の移動予測方法および移動予測システム | |
Huang et al. | Integration of MEMS inertial sensor-based GNC of a UAV | |
Braga et al. | Navigation scheme for the LSTS SEACON vehicles: Theory and application | |
JPH11325951A (ja) | 宇宙航行体の姿勢センサによる軌道決定方法および軌道決定装置 | |
Kumar et al. | Optimized inertial navigation system with kalman filter based altitude determination for aircraft in GPS deprived regions |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20090317 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20110228 |
|
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: 20110329 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20110408 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4726134 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140422 Year of fee payment: 3 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |