33
無人機開発における MATLAB ® /Simulink ® の活用事例 発表日:2017-10-31 発表者:青木 啓高

MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

  • Upload
    others

  • View
    14

  • Download
    0

Embed Size (px)

Citation preview

Page 1: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人機開発における

MATLAB®/Simulink®の活用事例

発表日:2017-10-31発表者:青木 啓高

Page 2: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

目次

• UMS事業推進部の事業紹介

• MATLAB/Simulinkの活用事例

– 無人バギー車

– 無人小型艇

– 産業用ヘリコプター

• まとめ

Page 3: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

UMS事業推進部の事業紹介

Page 4: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

UMS事業推進部の事業紹介2013年、産業用ヘリコプターを取り扱っていたスカイ事業

推進部から、無人バギー車、無人小型艇の事業化を含めた

UMS(UnManned Systems)事業推進部として発足。

Page 5: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

UMS事業推進部の事業紹介

※講演時は動画

Page 6: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

MATLAB/Simulinkの活用事例

~ 無人バギー車 ~

Page 7: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人バギー車の紹介

無人バギー車は、オフロードに加えて、GNSSのみでの運用

が厳しい環境下での活用を目的に研究され、現在、農業分野

のビジネスモデルを構築中。

アグリビジネス創出フェア2013のパネル

試験用バギー車#1

Page 8: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人バギー車の紹介

※講演時は動画

Page 9: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人バギー車の事例①

■ 測量用無人バギー車の課題抽出

0 5 10 15 20 25 30 35 40 450

1

2

3

4

5

時間 (sec)

前進

速度

 (m

/sec)

cour05@3v20

NG

v50up

OK

2nd

0 5 10 15 20 25 30 35 40 45-10

-5

0

5

10

時間 (sec)操

舵角

 (d

eg)

0 5 10 15 20 25 30 35 40 450

0.2

0.4

0.6

0.8

時間 (sec)

|位

置誤

差|

 (m

)

指令値

実機平面を想定した測量用の制御では傾斜面では速度指令に追従できない。

傾斜面における経路追従試験結果

Page 10: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人バギー車の事例①

※講演時は動画

Page 11: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

0 5 10 15 20 25 30-15

-10

-5

0

5

10

15

(m)

(m

)

pose.dat

無人バギー車の事例②

■ GSH∞速度+操舵制御

各制御器の設計は、Robust Control Toolbox™ を使用

実機試験結果の描画

自己位置

参照車両

GPS(精度20cm)

Page 12: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人バギー車の事例②

※講演時は動画

Page 13: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人バギー車の事例③

■ 無人電動車のシステム構築(CAN通信)

CAN通信確認用簡易車両モデル

無人電動車の研究対象部分

無人電動車の概観

モータドライバの検証等にも使用

CANoeによるCAN実バス検証

Page 14: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人バギー車まとめ

・挙動の可視化により制御仕様の策定へ寄与

・MATLABによる特性解析や適合結果の確認

・ Robust Control Toolboxを用いることで

開発期間短縮と信頼性確保

・車両運動シミュレートを含めたCANバス確認とHILSの実施

Page 15: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人バギー車の事例

参考文献

(1)深尾隆則, 石山健二, 青木啓高, 村上則幸,

果樹園UGV , 第55回自動制御連合講演会, CD-ROM, 2012

(2)加藤彰一, 倉鋪圭太, 深尾隆則, 青木啓高, 石山健二, 村上則幸,

UGV のH∞制御によるロバストな経路追従, 自動車技術会春期大会前刷集, Vol.16-12, (2012), pp.1-4.

(3)吉本達也, 倉鋪圭太, 深尾隆則, 青木啓高, 石山健二, 村上則幸,

H∞制御によるUGVの速度制御系設計法、日本機械学会ロボティクス・メカトロニクス講演会講演論文集,

CD-ROM,2012

(4)深尾隆則, 石山健二, 青木啓高, 村上則幸,

果樹園UGVの実用化に向けて, システム制御情報学会研究発表講演会講演論文集。CD-ROM, 2013

(5)加藤彰一, 深尾隆則, 青木啓高, 石山健二, 村上則幸,

UGVのゲインスケジュールドH∞制御による不整地での経路追従,

第13回計測自動制御学会システムインテグレーション部門講演会, 2012

(6)吉本達也, 深尾隆則, 青木啓高, 石山健二, 村上則幸,

ゲインスケジュールドH∞制御によるUGVの速度制御,

第13回計測自動制御学会システムインテグレーション部門講演会, 2012

Page 16: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

MATLAB/Simulinkの活用事例

~ 無人小型艇 ~

Page 17: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人小型艇の紹介

無人小型艇は、ダム湖等の平水面環境下での監視役務や

マルチビームによる水中測量、マリン事業への展開を目的

に研究され、現在、ビジネスモデルを検証中。

夜間での監視役務

ダム湖での測量試験

Page 18: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人小型艇の紹介

※講演時は動画

Page 19: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人小型艇の事例①

LAN

CAN バス

自律制御系

MicroAutoBox モータドライバ

主機X2 舵サーボモータX2バウ

スラスタ

推進器制御系

UPPER PC基地局 PC

船体側地上基地局側

無線LANルータ

通信系

無線LANアンテナ

無線LANアンテナ

無線LANルータ

通信系

GPSアンテナ

姿勢センサ

方位センサ

GPS/INS

GPS受信機

測位系

■ 無人小型艇システム【実機】

Page 20: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人小型艇の事例①

マルチコアのPCでは、操作部と制御部のSimulinkモデルを同時に実行。各部毎にCANのチャンネルを設定。(MATLAB起動数:2)

操作部

制御部

運動モデル部

操作部

制御部

図. PC画面

■ 無人小型艇システム【シミュレータ】(2014年4月当時)

Simulink

MATLAB

Page 21: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人小型艇の事例②

■ 簡易モデルと線形制御理論

線形制御理論でロバスト安定化

自動着桟の試験風景

0 5 10 15-30

-20

-10

0

10

20

30

time (sec)

angle

(deg)

ラダー角

方位(モデル)

方位(実機データ)

0 5 10 15-30

-20

-10

0

10

20

30

time (sec)

angula

r ra

te (

deg/sec)

ラダー角

角速度(モデル)

角速度(実機データ)

モデル同定

δψψ KT =+ T :時定数 Ψ:方位角K:定数ゲイン δ:舵角

Nomoto’s Model

5055

6065

7075

8085

90

5

10

15

20

25

30

0.1

0.2

0.3

0.4

0.5

舵角 (deg)モータDuty (%)

時定

数T (

sec)

Page 22: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人小型艇の事例③

0 10 20 30 40 50 60 70 80 90-1

-0.5

0

0.5

1

1.5

time (sec)

速度

(m

/sec)

舵角

(ra

d)

実機:進行速度X(m/sec)

実機:横方向速度Y(m/sec)

モデル:進行速度X(m/sec)モデル:横方向速度Y(m/sec)

ラダー角(rad)

0 10 20 30 40 50 60 70 80 90-5

0

5

10

15

20

time (sec)

YA

W r

ate

(deg/sec)

実機:YAW Rate(deg/sec)

モデル:YAW Rate(deg/sec)

-35 -30 -25 -20 -15 -10 -5 0 5 10 15

0

5

10

15

20

25

30

35

40

(m)

(m

)

■ 平面内運動モデルと非線形制御理論

実験データから非線形モデル導出 モデル同定結果の確認

-20 -10 0 10 20 30 40 50 60 70

-40

-30

-20

-10

0

10

20

30

40

50

(m)

(m

)

0 200

-2

0

2

4

6

8

Time (sec)

Y e

rr (

m)

0 200

-150

-100

-50

0

50

100

150

Time (sec)

Psi err

(deg)

0 100 200 3000

0.2

0.4

0.6

0.8

1

Time (sec)

u (

m/sec)

0 100 200 300

-0.4

-0.2

0

0.2

0.4

0.6

Time (sec)

v (

m/sec)

0 100 200 300

-0.1

0

0.1

0.2

Time (sec)

r (r

ad/sec)

実測値

推定値

非線形制御理論による検証

GPS周期10Hz+ジャイロなしでの運用見通し(非線形サンプル値制御+低次元オブザーバ)

Page 23: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人小型艇の事例④■ 地図とセンサ情報の統合による

経路生成シミュレート

地図情報とセンサ情報を統合

統合情報から経路を生成

地図情報の取得2値化処理で

航行域判別

センサ仮想値の入力画面

Page 24: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人小型艇まとめ

・艇体運動シミュレートを含めた制御アルゴリズムの動作検証

・艇体運動の特性解析と制御設計

・MATLABを用いた経路生成アルゴリズム検討

Page 25: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

無人小型艇の事例

参考文献

(1) Thor I.Fossen ,Marine Control Systems

(2) H. Katayama and H. Aoki, Reduced-order observers for nonlinear sampled-data systems with application to marine systems, Proceeding of the 52nd IEEE Conference on Decision and Control, pp. 5072-5077, Firenze, Italy (2013)

(3) H. Katayama and H. Aoki, Sampled-data straight-line path following control for underactuated ships, Proceeding of 50th IEEE Conference on Decision and Control and European Control Conference, pp. 3946-3951, Orlando, Florida (2011)

(4) 片山仁志, 青木啓高, 厳密フィードバック形の非線形サンプル値系の低次元オブザーバの設計, 第13回 制御部門大会予稿集, CD-ROM, 2013

(5) 青木啓高, 片山仁志, サンプル値劣駆動船舶の Way-Point トラッキング制御, 第55回自動制御連合講演会, CD-ROM, 2012

(6) 片山仁志, 青木啓高, サンプル値劣駆動船舶の直線軌道追従制御: 実機試験による検証, 第41回制御理論シンポジウム予稿集, 2012

(7) 片山仁志, 青木啓高, 劣駆動船舶のサンプル値直線軌道追従制御, 第54回自動制御連合講演会予稿集, CD-ROM, 2011

Page 26: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

MATLAB/Simulinkの活用事例

~ 産業用ヘリコプター ~

Page 27: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

産業用ヘリコプターは、農薬散布を代表とする農業分野の

他に、放射線測定や地上測量の計測業務、空中撮影など

多目的に活用。※但し、ペイロード等の運用条件あり。

訓練用シミュレータ

産業用ヘリコプターの紹介

※2014年航空機製造事業法改正:離陸時最大重量が変更された

2016年10月に発表モデル

Page 28: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

産業用ヘリコプターの紹介

3:41※講演時は動画

Page 29: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

産業用ヘリコプター事例

弊社HPより

※NHKスペシャル 「新島誕生 西之島~大地創成の謎に迫る~」として2015年8月に放送されました。

https://global.yamaha-motor.com/jp/profile/technology/chassis_hulls/008/

Page 30: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

産業用ヘリコプター事例

「MATLAB」によるジャイロの特性解析

「Simulink」を用いた推定アルゴリズム

「Embedded Coder®」で実装 ⇒ 検証へ

■ 要約

ジャイロセンサーは電源をONする毎に角速度のオフセットが入る。地上では静止時に除去するが、揺れる小型船の上では静止状態を得られず、拡張型カルマンフィルターと呼ぶ推定システムで解決

結果はMATLABで解析

Page 31: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

MATLAB/Simulinkの活用事例

~ まとめ ~

Page 32: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

まとめ

■ 制御設計だけでなく、運動のシミュレートや特性解析等にも、MATLAB/Simulink を活用。

■ 本事例では、制御理論とMATLABを積極的に活用することで、短期で機能を実現している。

■ ヤマハ発動機の製品と活用事例を紹介した。

■ シミュレ-トや解析結果を視覚化する機能は、自動運転のみならず、開発の一助となっている。

Page 33: MATLAB /Simulink...Simulink MATLAB 無人小型艇の事例② 簡易モデルと線形制御理論 線形制御理論でロバスト安定化 自動着桟の試験風景 0 5 10 15-30-20-10

ご清聴ありがとうございました。

ヤマハ発動機㈱ ビークル&ソリューション事業本部

UMS事業推進部 開発部 UAV開発グループ