Embed Size (px)
Citation preview
1
超小型クアッドロータ Quadruptor の製作とその制御
東京工業大学 工学部 制御システム工学科 B410g @tokoro10g
東京工業大学 ロボット技術研究会 第 59 回 研究報告会07/05/2014 @ 東京工業大学
研究報告書を読んでね！
16
これまでの制作物
VR 音楽ゲームコントローラ
オムニホイール車両ロボットクモ型 8 脚ロボット『 VORAS 』フィジカルコンピューティングツールキット『 konashi 』
Web サービス『 BGM ShareHouse 』マイクロマウス『カブトガニ野郎』フレッシュマンクラス 準優勝
小型クアッドロータ『 Quadruptor 』
学部 1 年
学部 2 年
学部 3 年
現在
Works
17
これまでの制作物
小型クアッドロータ『 Quadruptor 』
某自動車 CM に触発されて試作．
Works
18
Quadruptor
https://www.youtube.com/watch?v=I8g8uwbOPzg
19
Quadruptor の制御
Controlling Quadruptor
動力学モデル導出状態推定姿勢制御則まとめ
20
動力学モデル Model of Dynamics
21
動力学モデル
プロペラの動推力も考慮プロペラが並進→ プロペラに起因する 空気の質量流量減少→ 推力の低下
Model of Dynamics
22
状態推定
機体に積めるセンサの種類は限られている加速度センサ角速度センサ（いわゆるジャイロセンサ）地磁気センサ大気圧センサ超音波距離センサ など…
< 問題設定 >「機体の位置や角度を知りたい」→ 位置や角度を直接測定できるセンサが理想的使えないことが多い → 状態推定不可避
State Observer
23
カルマンフィルタ
< 状況設定 >システムの動的振る舞いは知っている出力として状態の一部しか知ることができないしかもノイズが乗っている
カルマンフィルタ状態オブザーバの一つ状態推定誤差を最小化する最適オブザーバモデルベースド占い（よく当たる）
Model-based “Uranai”
25
EKF
EKF (Extended Kalman Filter)カルマンフィルタは線形システムを仮定実際のシステムは非線形であることが多い線形近似がある程度有効→非線形モデルを近似線形化しつつ カルマンフィルタを適用
Extended Model-based “Uranai”
27
カルマンフィルタ
カルマンフィルタの問題点むずい ( 完全に理解できない )
1 ステップごとの計算が多い計算誤差の蓄積 →突然の死ダイナミクスがはっきりしていないと使い物にならない
Model-based “Uranai”
28
Madgwick Filter [1]
Madgwick Filterクォータニオンと角速度・重力ベクトルの関係に着目
1. 角速度ベクトルからクォータニオンの変位を計算2. 重力ベクトルから勾配法によって変位を修正→ 定常特性の改善，過渡特性の維持
[1] S.O.H. Madgwick, et al. Estimation of IMU and MARG orientation using a gradient descent algorithm. In2011 IEEE ICORR, pp. 1-7, June 2011.
29
Madgwick Filter
入力信号 加速度
30
Madgwick Filter
入力信号 角速度
31
Madgwick Filter
出力信号 クォータニオン
32
Madgwick Filter
意味のあるデータが 得られた！
ノイズだらけの値から
33
姿勢制御則 Attitude Control Law
頭をあまり使わない方法PID補償ひたすらチューニング物理的に非直感的
頭を少しだけ使う方法Fresk, et al. [2] の制御則
[2] E. Fresk and G. Nikolakopoulos. Full quaternion based attitude control for a quadrotor. In ECC 2013,pp. 3864-3869, July 2013.
34
姿勢制御則 Attitude Control Law
Fresk の制御則シミュレーションクォータニオンのステップ応答
35
姿勢制御則 Attitude Control Law
Fresk の制御則シミュレーション の物理的意味
大で整定時間短縮
36
姿勢制御則 Attitude Control Law
Fresk の制御則シミュレーション の物理的意味
大で角速度抑制
37
姿勢制御則 Attitude Control Law
Fresk の制御則シミュレーション は (位相差の意味での ) 安定余裕に寄与しない (?)
大きな値
38
姿勢制御則 Attitude Control Law
Fresk の制御則シミュレーション は安定余裕に影響 角速度抑制の必要性
小さな値
39
姿勢制御則 Attitude Control Law
Fresk の制御則2つの制御パラメータに明確な物理的意味→パラメータチューニングの煩雑さ解消原理的に角速度指令までの時間遅れがない
報告書内で紹介したカスケード制御器には，角度偏差から角速度指令までに遅れが存在比較して過渡特性が良い可能性大
実機に現在実装を進めている→比較・検討の必要あり
40
まとめ Summary
クアッドロータ系の動力学モデルを導出したプロペラの動推力を考慮
状態推定の手法について解説したカルマンフィルタの長所・短所Madgwick Filter の紹介と実践
Fresk の制御則を紹介したパラメータ設計のしやすいシンプルな制御則今後実装して従来手法と性能を比較
41
ご清聴ありがとうございました
ご質問，まさかり等お気軽にどうぞ
