(19)【発行国】日本国特許庁(JP)
(12)【公報種別】公開特許公報(A)
(11)【公開番号】P2022183697
(43)【公開日】2022-12-13
(54)【発明の名称】制御装置、水中航走体及び制御方法
(51)【国際特許分類】
G05B 13/02 20060101AFI20221206BHJP
B63C 11/48 20060101ALI20221206BHJP
B63C 11/00 20060101ALI20221206BHJP
G05B 11/32 20060101ALI20221206BHJP
【ＦＩ】
G05B13/02 A
B63C11/48 D
B63C11/00 B
G05B11/32 A
G05B13/02 C
【審査請求】未請求
【請求項の数】12
【出願形態】ＯＬ
(21)【出願番号】P 2021091139
(22)【出願日】2021-05-31
(71)【出願人】
【識別番号】000006208
【氏名又は名称】三菱重工業株式会社
(74)【代理人】
【識別番号】100149548
【弁理士】
【氏名又は名称】松沼 泰史
(74)【代理人】
【識別番号】100162868
【弁理士】
【氏名又は名称】伊藤 英輔
(74)【代理人】
【識別番号】100161702
【弁理士】
【氏名又は名称】橋本 宏之
(74)【代理人】
【識別番号】100189348
【弁理士】
【氏名又は名称】古都 智
(74)【代理人】
【識別番号】100196689
【弁理士】
【氏名又は名称】鎌田 康一郎
(72)【発明者】
【氏名】望月 慶佑
(72)【発明者】
【氏名】佐々木 祐成
(72)【発明者】
【氏名】安達 丈泰
(72)【発明者】
【氏名】粟屋 伊智郎
(72)【発明者】
【氏名】中田 昌宏
(72)【発明者】
【氏名】栗田 章央
(72)【発明者】
【氏名】松岡 浩然
(72)【発明者】
【氏名】石川 雄紀
【テーマコード（参考）】
5H004
【Ｆターム（参考）】
5H004GA09
5H004GA36
5H004GB14
5H004JB22
5H004KA52
5H004KA71
5H004LB00
(57)【要約】
【課題】揺動抑制と省エネルギー性能を両立する制御装置を提供する。
【解決手段】制御装置は、船体の位置と目標位置との差に基づいて制御指令値を算出するフィードバック制御器と、前記船体の制御軸間の相互干渉を打ち消す非干渉補償値を算出する非干渉制御器と、外乱を打ち消す外乱補償値を算出する外乱推定器と、速度飽和が生じないような速度飽和補償値を算出する速度飽和補償器と、前記船体に生じる揺動および／または前記アクチュエータの動作に基づいて、非干渉制御器、外乱推定器および速度飽和補償器のうちの少なくとも１つのパラメータを調整する制御系調整器と、を有する。
【選択図】図１
【解決手段】制御装置は、船体の位置と目標位置との差に基づいて制御指令値を算出するフィードバック制御器と、前記船体の制御軸間の相互干渉を打ち消す非干渉補償値を算出する非干渉制御器と、外乱を打ち消す外乱補償値を算出する外乱推定器と、速度飽和が生じないような速度飽和補償値を算出する速度飽和補償器と、前記船体に生じる揺動および／または前記アクチュエータの動作に基づいて、非干渉制御器、外乱推定器および速度飽和補償器のうちの少なくとも１つのパラメータを調整する制御系調整器と、を有する。
【選択図】図１
【特許請求の範囲】
【請求項1】
船体の位置と目標位置との差に基づいて制御指令値を算出するフィードバック制御器と、
前記船体の制御軸間の相互干渉を打ち消すための非干渉補償値を算出する非干渉制御器と、
前記船体の作用する外乱の力を推定し、前記外乱を打ち消すための外乱補償値を算出する外乱推定器と、
前記制御指令値に基づいて前記船体のアクチュエータを制御したときに速度飽和が生じないような速度飽和補償値を算出する速度飽和補償器と、
前記船体に生じる揺動および／または前記アクチュエータの動作に基づいて、前記非干渉制御器、前記外乱推定器および前記速度飽和補償器のうちの少なくとも１つのパラメータを調整する制御系調整器と、
を有する制御装置。
前記船体の制御軸間の相互干渉を打ち消すための非干渉補償値を算出する非干渉制御器と、
前記船体の作用する外乱の力を推定し、前記外乱を打ち消すための外乱補償値を算出する外乱推定器と、
前記制御指令値に基づいて前記船体のアクチュエータを制御したときに速度飽和が生じないような速度飽和補償値を算出する速度飽和補償器と、
前記船体に生じる揺動および／または前記アクチュエータの動作に基づいて、前記非干渉制御器、前記外乱推定器および前記速度飽和補償器のうちの少なくとも１つのパラメータを調整する制御系調整器と、
を有する制御装置。
【請求項2】
前記制御指令値を前記速度飽和補償値によって補償する前記速度飽和補償器を含む第１の制御ループと、前記外乱補償値によって補償した前記制御指令値を前記第１の制御ループへ与える前記外乱推定器を含む第２の制御ループと、前記非干渉補償値によって補償した前記制御指令値を前記第２の制御ループへ与える前記非干渉制御器を含む第３の制御ループと、を有する請求項１に記載の制御装置。
【請求項3】
前記船体の揺動の周波数成分分析の結果に基づいて、上位２つの主成分を選択し、前記２つの主成分の間の周波数を前記外乱推定器が備えるローパスフィルタおよび前記非干渉制御器が備えるローパスフィルタのフィルタ帯域に設定する、
請求項１または請求項２に記載の制御装置。
請求項１または請求項２に記載の制御装置。
【請求項4】
前記制御系調整器は、制御目的が揺動抑制の場合、前記外乱推定器が備える出力ゲインおよび前記非干渉制御器の出力ゲインの値に１を設定する、
請求項１から請求項３の何れか１項に記載の制御装置。
請求項１から請求項３の何れか１項に記載の制御装置。
【請求項5】
前記制御系調整器は、制御目的が省エネルギー化の場合、前記外乱推定器が備える出力ゲインまたは前記非干渉制御器の出力ゲインの値に１より小さい値を設定する、
請求項１から請求項４の何れか１項に記載の制御装置。
請求項１から請求項４の何れか１項に記載の制御装置。
【請求項6】
前記制御系調整器は、前記船体の揺動の周波数解析の結果に基づいて、上位２つの主成分を選択し、そのうち周波数が高い成分の周波数が閾値以上の場合、前記非干渉制御器の出力ゲインの値に１より小さい値を設定する、
請求項５に記載の制御装置。
請求項５に記載の制御装置。
【請求項7】
前記制御系調整器は、前記外乱補償値の高周波成分のピーク値が前記非干渉補償値の高周波成分のピーク値より大きいか又は前記外乱補償値が前記非干渉補償値より大きい場合、前記外乱推定器の出力ゲインの値に１より小さい値を設定し、
前記非干渉補償値の高周波成分のピーク値が前記外乱補償値の高周波成分のピーク値より大きいか又は前記非干渉補償値が前記外乱補償値より大きい場合、前記非干渉制御器の出力ゲインの値に１より小さい値を設定する、
請求項５または請求項６に記載の制御装置。
前記非干渉補償値の高周波成分のピーク値が前記外乱補償値の高周波成分のピーク値より大きいか又は前記非干渉補償値が前記外乱補償値より大きい場合、前記非干渉制御器の出力ゲインの値に１より小さい値を設定する、
請求項５または請求項６に記載の制御装置。
【請求項8】
前記制御系調整器は、船体の方位角またはロール角が、所定の閾値以上揺動している場合、前記非干渉制御器の出力ゲインを１とする、
請求項５から請求項７の何れか１項に記載の制御装置。
請求項５から請求項７の何れか１項に記載の制御装置。
【請求項9】
前記制御系調整器は、省エネルギー制御を向上させる場合、速度飽和を補償する作用が強くなるように速度飽和補償器のパラメータを調整する、
請求項１から請求項８の何れか１項に記載の制御装置。
請求項１から請求項８の何れか１項に記載の制御装置。
【請求項10】
前記外乱推定器が推定した外乱に基づいて、前記船体に生じる揺動を算出し、前記非干渉制御器、前記外乱推定器および前記速度飽和補償器のうちの少なくとも１つのパラメータに様々な値を設定しつつ、算出した前記揺動に対して前記船体を制御するシミュレーションを実行し、前記シミュレーション結果に基づいて、前記パラメータの値を評価して、様々に設定した前記パラメータの値のうち、所定の基準を満たす値を決定するパラメータ算出部、
をさらに有する請求項１から請求項９の何れか１項に記載の制御装置。
をさらに有する請求項１から請求項９の何れか１項に記載の制御装置。
【請求項11】
請求項１から請求項１０の何れか１項に記載の制御装置を備える水中航走体。
【請求項12】
非干渉制御器と、外乱推定器と、速度飽和補償器と、を有する制御装置によって実行される制御方法であって、
船体の位置と目標位置との差に基づいて制御指令値を算出するステップと、
前記非干渉制御器が、前記船体の制御軸間の相互干渉を打ち消すための非干渉補償値を算出するステップと、
前記外乱推定器が、前記船体の作用する外乱の力を推定し、前記外乱を打ち消すための外乱補償値を算出するステップと、
前記速度飽和補償器が、前記制御指令値に基づいて前記船体のアクチュエータを制御したときに速度飽和が生じないような速度飽和補償値を算出するステップと、
前記船体に生じる揺動および／または前記アクチュエータの動作に基づいて、前記非干渉制御器、前記外乱推定器および前記速度飽和補償器のうちの少なくとも１つのパラメータを調整するステップと、
を有する制御方法。
船体の位置と目標位置との差に基づいて制御指令値を算出するステップと、
前記非干渉制御器が、前記船体の制御軸間の相互干渉を打ち消すための非干渉補償値を算出するステップと、
前記外乱推定器が、前記船体の作用する外乱の力を推定し、前記外乱を打ち消すための外乱補償値を算出するステップと、
前記速度飽和補償器が、前記制御指令値に基づいて前記船体のアクチュエータを制御したときに速度飽和が生じないような速度飽和補償値を算出するステップと、
前記船体に生じる揺動および／または前記アクチュエータの動作に基づいて、前記非干渉制御器、前記外乱推定器および前記速度飽和補償器のうちの少なくとも１つのパラメータを調整するステップと、
を有する制御方法。
【発明の詳細な説明】
【技術分野】
【0001】
本開示は、制御装置、水中航走体及び制御方法に関する。
【背景技術】
【0002】
水中航走体の運転では、波浪等の外乱による船体の揺動を抑制する必要がある。非特許文献１には、外乱を推定する外乱推定器が開示されている。非特許文献２には、水中航走体の状態推定を行って、外乱を推定する方法が開示されている。また、特許文献３、４には、水中航走体に加わる外乱の方向、大きさ、周波数などを推定し、推定した外乱を打ち消す舵角などの制御指令を生成する制御装置が開示されている。
【0003】
また、水中航走体の運転中に、深度、ロール角、ピッチ角、方位角等に関する制御軸に対して制御を行うと、特定の軸間に相互干渉が生じることがある。例えば、各軸に対して揺動を抑制する制御を行ったとしても、相互干渉の影響で揺動の収束に時間が掛かることがある。これに対し、特許文献１には、船体の状態に応じて軸間の干渉を補償する舵角指令を算出し、軸間の干渉力を非干渉化する制御方法が開示されている。
【0004】
また、水中航走体の舵が舵角指令の変化に追従できる範囲には制限があり、制限を超える舵角指令が入力されると、実際の舵角が追従できず、速度飽和が生じる。これに対し、特許文献２には、速度飽和が生じる舵角指令を追従可能な範囲の指令値に補償する速度飽和補償器が開示されている。速度飽和補償器を用いることにより、舵の急峻な動きを抑制し、速度飽和の発生を回避することができる。
【先行技術文献】
【特許文献】
【0005】
【特許文献1】特開２０１９－２５９２８号公報
【特許文献2】特許第５９８４６０８号公報
【特許文献3】特開２０１４－１２４９１号公報
【特許文献4】特開２０１４－２１６４９号公報
【非特許文献】
【0006】
【非特許文献1】大西公平、「外乱オブザーバによるロバスト・モーションコントロール」、日本ロボット学会誌、第11巻、第4号、1993年、p.486-493
【非特許文献2】中村昌彦他、「小型AUV"MR-X1"の測線上航走性能向上に関する研究」、日本船舶海洋工学会論文集、第12号、2010年、p.165-173
【発明の概要】
【発明が解決しようとする課題】
【0007】
外乱推定器に基づいて外乱補償することにより、船体の揺動を抑制することができる。しかしながら、例えば、揺動に高周波成分がある場合に揺動に対処しようとすると舵を頻繁に動作させなければならず、省エネルギー性能が悪化する。船体の揺動抑制性能と省エネルギー性能のバランスを調整可能な制御が求められている。
【0008】
本開示は、上記課題を解決することができる制御装置、水中航走体及び制御方法を提供する。
【課題を解決するための手段】
【0009】
本開示の制御装置は、船体の位置と目標位置との差に基づいて制御指令値を算出するフィードバック制御器と、前記船体の制御軸間の相互干渉を打ち消すための非干渉補償値を算出する非干渉制御器と、前記船体の作用する外乱の力を推定し、前記外乱を打ち消すための外乱補償値を算出する外乱推定器と、前記制御指令値に基づいて前記船体のアクチュエータを制御したときに速度飽和が生じないような速度飽和補償値を算出する速度飽和補償器と、前記船体に生じる揺動および／または前記アクチュエータの動作に基づいて、前記非干渉制御器、前記外乱推定器および前記速度飽和補償器のうちの少なくとも１つのパラメータを調整する制御系調整器と、を有する。
【0010】
本開示の水中航走体は、上記の制御装置を備える。
【0011】
本開示の制御方法は、非干渉制御器と、外乱推定器と、速度飽和補償器と、を有する制御装置によって実行される制御方法であって、船体の位置と目標位置との差に基づいて制御指令値を算出するステップと、前記非干渉制御器が、前記船体の制御軸間の相互干渉を打ち消すための非干渉補償値を算出するステップと、前記外乱推定器が、前記船体の作用する外乱の力を推定し、前記外乱を打ち消すための外乱補償値を算出するステップと、前記速度飽和補償器が、前記制御指令値に基づいて前記船体のアクチュエータを制御したときに速度飽和が生じないような速度飽和補償値を算出するステップと、前記船体に生じる揺動および／または前記アクチュエータの動作に基づいて、前記非干渉制御器、前記外乱推定器および前記速度飽和補償器のうちの少なくとも１つのパラメータを調整するステップと、を有する。
【発明の効果】
【0012】
上述の制御装置、水中航走体及び制御方法によれば、揺動抑制性能と省エネルギー性能のバランスを調整することができる。例えば、揺動抑制と省エネルギー性能とを両立することができる。
【図面の簡単な説明】
【0013】
【図1】実施形態に係る制御システムの一例を示す図である。
【図2】実施形態に係る評価指標値の一例を示す図である。
【図3】実施形態に係る制御系切り替えについて説明する図である。
【図4】実施形態に係る制御システムの動作の一例を示すフローチャートである。
【発明を実施するための形態】
【0014】
【0015】
（システム構成）
図１に水中航走体１の制御システムのブロック図を示す。図１に示すように、水中航走体１は、制御装置１０と、機体２０と、を備える。制御装置１０は、ＦＢ（フィードバック）制御器１１と、アクチュエータ制御系１２と、速度飽和補償器１３と、外乱推定器１４と、非干渉制御器１５と、制御系調整器１６と、パラメータ算出部１７と、を備える。機体２０は、水中航走体１が備えるアクチュエータ、センサ類を含む。
図１に水中航走体１の制御システムのブロック図を示す。図１に示すように、水中航走体１は、制御装置１０と、機体２０と、を備える。制御装置１０は、ＦＢ（フィードバック）制御器１１と、アクチュエータ制御系１２と、速度飽和補償器１３と、外乱推定器１４と、非干渉制御器１５と、制御系調整器１６と、パラメータ算出部１７と、を備える。機体２０は、水中航走体１が備えるアクチュエータ、センサ類を含む。
【0016】
ＦＢ制御器１１は、水中航走体１の位置と所定の目標位置との差分に基づいて制御指令値を算出する。例えば、ＦＢ制御器１１は、ＰＩＤ制御等により、水中航走体１の位置を目標位置に一致させるような、深度、ピッチ角、方位角などに関する制御軸（船体運動の６自由度に関するＸＹＺ軸方向および各軸回り方向の何れか）に対する制御指令値を算出する。
【0017】
アクチュエータ制御系１２は、ＦＢ制御器１１によって算出された制御指令値をアクチュエータへ出力する実際の指令値（実指令値と呼ぶ。）に変換して、アクチュエータ（機体２０）を制御する。アクチュエータとは、例えば、水中航走体１が備える複数の舵である。実指令値とは、例えば、それぞれの舵への舵角指令である。図示するように、ＦＢ制御器１１によって算出された制御指令値は、速度飽和補償器１３、外乱推定器１４、非干渉制御器１５が補償値を出力した場合には、それらの補償値によって補償される。
【0018】
速度飽和補償器１３は、アクチュエータ制御系１２へ入力される制御指令値とアクチュエータ制御系１２から出力される実指令値を取得し、アクチュエータ制御系１２へ入力される制御指令値が速度飽和に至らないように速度飽和補償値を算出し、この値を出力する。速度飽和補償値により、アクチュエータ制御系１２へ入力される制御指令値は、アクチュエータの動作が追従可能な範囲となるよう補償される。本実施形態の速度飽和補償器１３には、例えば特許文献２に開示がある速度飽和補償部を用いることができる。速度飽和補償器１３の構成は、特許文献２に開示されているため本明細書では説明を省略する。速度飽和補償器１３は、内部に帯域調整ゲインというパラメータ（特許文献２における理想モデル４１の内部のパラメータ）を有している。この帯域調整ゲインの値を大きくすると、アクチュエータの急峻な変化をより強く抑えるように作用する。速度飽和補償器１３は、アクチュエータの急峻な動作を抑制する働きがあるため、制御の省エネルギー化に寄与する。帯域調整ゲインの値を大きくすると、省エネルギーの効果が向上する。帯域調整ゲインの値は、制御系調整器１６によって調整可能とされている。
【0019】
外乱推定器１４は、アクチュエータ制御系１２から出力される実指令値と水中航走体１の状態を示す情報（実際の操舵角、ジャイロセンサや深度計の計測値など）を取得し、船体に作用する外乱の力を推定し、推定した外乱を打ち消すための外乱補償値を算出する。例えば、外乱推定器１４は、深度、ピッチ角、方位角の各方向に対する波浪による外乱を推定し、外乱を相殺する外乱補償値をそれぞれの方向ごとに算出する。本実施形態の外乱推定器１４における外乱推定方法には特に限定は無く、公知の外乱オブザーバなどを用いることができる（例えば、非特許文献１）。また、推定した外乱を相殺するために必要な舵の制御量等（外乱補償値）を算出する構成についても、一般に水中航走体で採用されている公知の制御器を用いることができる（例えば、特許文献３，４）。また、本実施形態の外乱推定器１４は、内部にローパスフィルタ１４１（図示せず）と、設定可能なパラメータである出力ゲイン１４２（図示せず）を備えている。一般に外乱推定器１４が推定する外乱には複数の周波数成分が含まれている。例えば、ローパスフィルタ１４１は、各制御軸別に設けられていて、推定された各制御軸方向の外乱の周波数成分のうち、所定の周波数以上の帯域を低減する。外乱推定器１４は、ローパスフィルタ１４１を通過した各制御軸方向の低周波帯域の外乱について、その周波数帯の外乱を打ち消す外乱補償値（例えば、揺動の方向に対応する舵についての補償舵角）を算出する。ローパスフィルタ１４１を通過する周波数の帯域を上昇させると、より広い周波数帯の揺動を抑制できるが、揺動の高周波成分にも対処しなければならなくなり、舵はそれだけ頻繁に動作することになる。これは、省エネルギー化の観点からは不利益（消費エネルギーが増大）となる。出力ゲイン１４２は、算出された外乱補償値に乗じて、その値の大きさを調整するためのパラメータである。外乱推定器１４は、推定された様々な方向の外乱に対して、その外乱に対処する舵（例えば、深度方向の外乱を制御するための舵、左右方向の外乱を制御するための舵など）ごとに補償舵角を算出する。出力ゲイン１４２は、これらの舵ごとに用意され、各舵に対する外乱補償値の大きさを調整する。出力ゲイン１４２の値は、０以上１以下の範囲で設定される。例えば、外乱への対応を行わない場合、出力ゲイン１４２には０が設定され、外乱をできるだけ相殺する場合には、出力ゲイン１４２には１が設定される。ローパスフィルタ１４１の帯域設定と出力ゲイン１４２の値は、制御系調整器１６によって調整可能とされている。
【0020】
非干渉制御器１５は、６軸間の軸間干渉による揺動を補償する。非干渉制御器１５は、例えば、水中航走体１の深度、ピッチ角、方位角をそれぞれ所望の位置に制御しようとする場合に、水中航走体１の状態を示す情報（実際の操舵角、ジャイロセンサや深度計の計測値など）を取得し、各制御軸間に生ずる干渉を低減する非干渉補償値（非干渉化に関係する各舵についての補償舵角）を算出する。非干渉制御器１５には、例えば特許文献１に開示がある非干渉制御部を用いることができる。非干渉制御器１５の構成は、特許文献１に開示されているため本明細書では説明を省略する。特許文献１に開示された構成に追加して、本実施形態の非干渉制御器１５は、内部にローパスフィルタ１５１（図示せず）と、出力ゲイン１５２（図示せず）を備えている。一般に非干渉制御器１５が取得する水中航走体１の状態を示す情報には複数の周波数成分が含まれている。例えば、ローパスフィルタ１５１は、各制御軸別に設けられていて、推定された各制御軸方向の複数の周波数成分のうち、所定の周波数以上の帯域を低減する。非干渉制御器１５は、ローパスフィルタ１５１を通過した各制御軸方向の低周波帯域の揺動（軸間干渉によって生じる揺動）について、その周波数帯の揺動を打ち消す非干渉補償値を算出する。ローパスフィルタ１５１を通過する周波数の帯域を上昇させると、揺動の高周波成分にも対処しなければならなくなり、舵はそれだけ頻繁に動作することになるため、消費エネルギーの増大につながる。出力ゲイン１５２は、非干渉補償値に乗じて、その大きさを調整するためのパラメータである。出力ゲイン１５２は、複数の舵ごとに設定することができる。出力ゲイン１５２の値は、０以上１以下の範囲で設定される。ローパスフィルタ１５１の帯域設定と出力ゲイン１５２の値は、制御系調整器１６によって調整可能とされている。
【0021】
図示するように、アクチュエータ制御系１２と速度飽和補償器１３とで構成される第１のループの外側に外乱推定器１４を含む第２のループが構成される。これにより、理想的には第２のループ内では外乱が相殺される。それでも機体２０から得られる水中航走体１の状態を示す情報によって揺動が確認される場合には、その揺動は軸間干渉によるものと考えられる。その為、軸間干渉によって生じる揺動の分だけを対象として非干渉補償値を算出することができるように、非干渉制御器１５は、最も外側のループに配置される構成となっている。
【0022】
制御系調整器１６は、アクチュエータ制御系１２から出力される実指令値と水中航走体１の状態を示す情報（実際の操舵角、ジャイロセンサや深度計の計測値など）を機体２０から取得し、以下で説明する評価指標値を算出し、算出した評価指標値に基づいて、速度飽和補償器１３の帯域調整ゲインの値、外乱推定器１４のローパスフィルタ１４１の帯域設定および出力ゲイン１４２の値、非干渉制御器１５のローパスフィルタ１５１の帯域設定および出力ゲイン１５２の値のうちの何れか１つ又は複数を必要に応じて変更する。この処理をパラメータの調整、または、制御系の切り替えと呼ぶ。
【0023】
（評価指標）
図２に制御系調整器１６が算出する評価指標の一例を示す。
（１）揺動状態の評価値・・・制御系調整器１６は、深度計やジャイロセンサの計測値を取得して深度、ピッチ角、方位角などの各制御軸方向の揺動について、所定時間内における計測値のPeak to Peak値（所定時間内に計測された計測値の最大値と最小値の差）またはＲＭＳ値(root mean square value)を計算する。計測された制御軸方向別のPeak to Peak値やＲＭＳ値が揺動状態の評価値である。
図２に制御系調整器１６が算出する評価指標の一例を示す。
（１）揺動状態の評価値・・・制御系調整器１６は、深度計やジャイロセンサの計測値を取得して深度、ピッチ角、方位角などの各制御軸方向の揺動について、所定時間内における計測値のPeak to Peak値（所定時間内に計測された計測値の最大値と最小値の差）またはＲＭＳ値(root mean square value)を計算する。計測された制御軸方向別のPeak to Peak値やＲＭＳ値が揺動状態の評価値である。
【0024】
（２）アクチュエータ動作評価値・・・制御系調整器１６は、水中航走体１から時々刻々と実際のアクチュエータの動作量（例えば、時々刻々の実際の操舵角）を取得し、所定時間内の総動作量（絶対値積分）、アクチュエータ動作速度の絶対値積分を計算する。これらの値がアクチュエータ動作評価値である。
【0025】
（３）揺動周波数成分の評価値・・・制御系調整器１６は、深度計やジャイロセンサの計測値を取得して、各制御軸方向別に所定時間内の揺動を示す波形データをＦＦＴ（高速フーリエ変換）等により周波数成分分析する。周波数成分分析の結果が揺動周波数成分の評価値である。
【0026】
（４）アクチュエータ補償量の評価値・・・制御系調整器１６は、外乱推定器１４、非干渉制御器１５が出力する時々刻々の補償舵角（それぞれ外乱補償値、非干渉補償値）を取得し、補償舵角のPeak to Peak値を計算する。または（あるいは、Peak to Peak値に加えて）、制御系調整器１６は、補償舵角についてＦＦＴ等により、周波数成分分析を実行する。補償舵角のPeak to Peak値や周波数成分分析の結果がアクチュエータ補償量の評価値である。
【0027】
上記の評価指標値の（１）と（３）は、水中航走体１の揺動を示す評価指標値で、アクチュエータ動作に関する（２）と（４）は、省エネルギー性能の評価指標値である。制御系調整器１６は、これらの評価指標値を用いて、水中航走体１の揺動抑制と省エネルギー化が両立できるように外乱推定器１４、非干渉制御器１５のパラメータ調整を行う。また、以下に説明するように、制御系調整器１６は、揺動抑制と省エネルギー化の両立を前提としつつ、さらに揺動抑制を重視する制御モードと省エネルギー化を重視する制御モードを切り替えて実行する機能を有しており、制御の目的別に各補償器（速度飽和補償器１３、外乱推定器１４、非干渉制御器１５）のパラメータ（ローパスフィルタ帯域、出力ゲインなど）の調整を行う。
【0028】
（制御系の切り替えタイミング）
制御系調整器１６は、一定時間（例えば５分、１０分など）おきに自動的に制御系の切り替え（パラメータの調整）を行う。または、制御系調整器１６は、水中航走体１の運用モードの切り替え（例えば、航行と停泊）や制御目的の切り替え（揺動抑制重視か省エネルギー重視）、あるいは海域が変更されるタイミングで自動的に制御系の切り替えを行う。または、制御系調整器１６は、ユーザの手動操作によって制御系の切り替えを行う。なお、波浪などによる揺動の周期は、一般的に数秒～数１０秒であるため、自動で制御系の切り替えを行う場合、制御装置１０の計算周期ではなく、揺動周期よりも長い周期で制御系の切り替えを実行する。
制御系調整器１６は、一定時間（例えば５分、１０分など）おきに自動的に制御系の切り替え（パラメータの調整）を行う。または、制御系調整器１６は、水中航走体１の運用モードの切り替え（例えば、航行と停泊）や制御目的の切り替え（揺動抑制重視か省エネルギー重視）、あるいは海域が変更されるタイミングで自動的に制御系の切り替えを行う。または、制御系調整器１６は、ユーザの手動操作によって制御系の切り替えを行う。なお、波浪などによる揺動の周期は、一般的に数秒～数１０秒であるため、自動で制御系の切り替えを行う場合、制御装置１０の計算周期ではなく、揺動周期よりも長い周期で制御系の切り替えを実行する。
【0029】
（制御系切り替え）
図３に本実施形態の制御系の切り替えに際し、調整するパラメータの概要を示す。
（Ａ）制御系調整器１６は、制御目的に関係なく、外乱推定器１４のローパスフィルタ１４１と非干渉制御器１５のローパスフィルタ１５１のフィルタ帯域を調整する。
（Ａ１）制御系調整器１６は、評価指標値“（３）揺動周波数成分の評価値”に基づいて、各制御軸方向の揺動について、揺動を構成する周波数成分のうち、ピーク値が大きい上位２つの成分である第１の主成分ｆ１と第２の主成分ｆ２を識別する。ここで、第１の主成分ｆ１と第２の主成分ｆ２の周波数がｆ１＜ｆ２の関係であるとする。制御系調整器１６は、各制御軸別のローパスフィルタ１４１とローパスフィルタ１５１のフィルタ帯域（および近似微分帯域）ｆを、ｆ１とｆ２のピーク値の大小関係に関わりなく、周波数の高低関係に基づいてｆ１＜ｆ＜ｆ２となるように設定する。ここでｆ１は船体の揺動を構成する主要な周波成分のうち最も低周波の成分である。水中航走体１の運転において、低周波成分ｆ１の影響が最も支配的であって、上記のようにフィルタ帯域ｆを設定することにより、この低周波成分に対処する補償値（補償舵角）を算出することができる。また、ｆ１より高周波のｆ２の揺動にまで対処するとなると揺動抑制効果は向上するものの（その効果に比べて）、アクチュエータ（舵）の動作量が多くなり、エネルギー消費量が増大する。従って、各制御軸別のローパスフィルタ１４１、１５１の帯域設定をｆ２より低周波のｆに設定することにより、ｆ２の周波数成分を遮断し、アクチュエータの動作が過剰にならないようにする。このように現実の揺動の周波数成分に応じて、ローパスフィルタ１４１、１５１のフィルタ帯域ｆを調整することにより、揺動抑制と省エネルギー化の両立を図る。
図３に本実施形態の制御系の切り替えに際し、調整するパラメータの概要を示す。
（Ａ）制御系調整器１６は、制御目的に関係なく、外乱推定器１４のローパスフィルタ１４１と非干渉制御器１５のローパスフィルタ１５１のフィルタ帯域を調整する。
（Ａ１）制御系調整器１６は、評価指標値“（３）揺動周波数成分の評価値”に基づいて、各制御軸方向の揺動について、揺動を構成する周波数成分のうち、ピーク値が大きい上位２つの成分である第１の主成分ｆ１と第２の主成分ｆ２を識別する。ここで、第１の主成分ｆ１と第２の主成分ｆ２の周波数がｆ１＜ｆ２の関係であるとする。制御系調整器１６は、各制御軸別のローパスフィルタ１４１とローパスフィルタ１５１のフィルタ帯域（および近似微分帯域）ｆを、ｆ１とｆ２のピーク値の大小関係に関わりなく、周波数の高低関係に基づいてｆ１＜ｆ＜ｆ２となるように設定する。ここでｆ１は船体の揺動を構成する主要な周波成分のうち最も低周波の成分である。水中航走体１の運転において、低周波成分ｆ１の影響が最も支配的であって、上記のようにフィルタ帯域ｆを設定することにより、この低周波成分に対処する補償値（補償舵角）を算出することができる。また、ｆ１より高周波のｆ２の揺動にまで対処するとなると揺動抑制効果は向上するものの（その効果に比べて）、アクチュエータ（舵）の動作量が多くなり、エネルギー消費量が増大する。従って、各制御軸別のローパスフィルタ１４１、１５１の帯域設定をｆ２より低周波のｆに設定することにより、ｆ２の周波数成分を遮断し、アクチュエータの動作が過剰にならないようにする。このように現実の揺動の周波数成分に応じて、ローパスフィルタ１４１、１５１のフィルタ帯域ｆを調整することにより、揺動抑制と省エネルギー化の両立を図る。
【0030】
なお、フィルタ帯域ｆの設定方法は任意である。例えば、制御系調整器１６は、ｆ１とｆ２の平均値をｆとしてもよいし、平均値よりも所定値だけｆ１側またはｆ２側へ移動した値をｆに設定してもよい。または、制御系調整器１６は、ｆ１およびｆ２とｆの関係を定めたテーブルや関数を記憶していて、ＦＦＴ結果のｆ１およびｆ２と、事前に定めたテーブルに基づいてfを設定してもよい。
【0031】
（Ａ２）別の方法として、制御系調整器１６は、外乱推定器１４で推定した推定外乱値の周波数成分分析の結果から、第１の主成分ｆ１と第２の主成分ｆ２を識別し、ｆ１＜ｆ＜ｆ２となるフィルタ帯域ｆを各制御軸別のローパスフィルタ１４１、１５１に設定してもよい。
【0032】
制御系調整器１６は、ローパスフィルタ１４１、１５１のフィルタ帯域の設定に加え、制御目的に応じてパラメータを調整する。
【0033】
（制御目的：揺動抑制重視の場合）
（Ｂ）制御系調整器１６は、外乱推定器１４と非干渉制御器１５の両方をＯＮとする。つまり、制御系調整器１６は、出力ゲイン１４２と出力ゲイン１５２の値を１に設定する。これにより、外乱による揺動と制御軸間の干渉による揺動の両方が抑制され、水中航走体１の揺動が抑制される。
（Ｂ）制御系調整器１６は、外乱推定器１４と非干渉制御器１５の両方をＯＮとする。つまり、制御系調整器１６は、出力ゲイン１４２と出力ゲイン１５２の値を１に設定する。これにより、外乱による揺動と制御軸間の干渉による揺動の両方が抑制され、水中航走体１の揺動が抑制される。
【0034】
（制御目的：省エネルギー重視の場合）
（Ｃ）制御系調整器１６は、外乱推定器１４の出力ゲイン１４２、非干渉制御器１５の出力ゲイン１５２を、揺動の周波数、補償舵角の周波数や補償舵角の大きさ等に基づいて０～１の間で調整する。
（Ｃ）制御系調整器１６は、外乱推定器１４の出力ゲイン１４２、非干渉制御器１５の出力ゲイン１５２を、揺動の周波数、補償舵角の周波数や補償舵角の大きさ等に基づいて０～１の間で調整する。
【0035】
（Ｃ１）制御系調整器１６は、揺動が高周波となる場合には、その揺動に対応するアクチュエータについての非干渉制御器１５の出力ゲイン１５２を１より小さい値に設定する。揺動が高周波となる場合とは、評価指標値“（３）揺動周波数成分の評価値”から得られる上記の第１の主成分ｆ１と第２の主成分ｆ２のうちのｆ２のピーク値が所定の閾値以上となる場合である。揺動が高周波となる場合には、軸間干渉に対する補償により揺動が起こることが多いことが分かっている。従って、非干渉制御器１５の出力ゲイン１５２を低下させ、非干渉制御の悪影響を低減する。例えば、深度方向（縦方向）の揺動に関し、ｆ２のピーク値が閾値を超過した場合、深度方向の制御に用いる舵への補償舵角に対する出力ゲイン１５２の値を１未満とする。なお、具体的な出力ゲイン１５２の値は、例えば、事前にｆ２の周波数およびピーク値と出力ゲイン１５２の関係を定めたテーブルを作成しておき、出力ゲイン１５２の値を調整する直前の所定期間（例えば、５分や１０分）に計測された揺動の周波数成分分析結果の主成分ｆ２と、事前に作成したテーブルに基づいて出力ゲイン１５２を設定してもよい。
【0036】
（Ｃ２）制御系調整器１６は、評価指標値“（４）アクチュエータ補償量の評価値”に基づいて、外乱推定器１４が出力する外乱補償値と非干渉制御器１５が出力する非干渉補償値のそれぞれについて、揺動の場合と同様に上位２つの主要な周波数成分ｆ１、ｆ２（ｆ１＜ｆ２）を識別する。そして、制御系調整器１６は、外乱補償値のｆ２と非干渉補償値ｆ２のうちピーク値が大きい方の補償器の出力ゲインを１より小さい値（例えば０でも良い。）とする。例えば、ある制御軸方向（例えば、深度）について算出された外乱補償値の主成分ｆ２をｆ２１４、非干渉補償値の主成分ｆ２をｆ２１５としたときに、ｆ２１４のピーク値＜ｆ２１５のピーク値が成立すれば、出力ゲイン１５２に１より小さい値を設定する。反対にｆ２１４のピーク値＞ｆ２１５のピーク値が成立すれば、出力ゲイン１４２に１より小さい値を設定する。出力ゲイン１４２や出力ゲイン１５２の具体的な値は、例えば、事前に外乱推定器１４と非干渉制御器１５のそれぞれについて個別に定めたｆ２の周波数およびピーク値と出力ゲインの大きさの関係を示すテーブルに基づいて決定する。これにより、舵の頻繁動作を招く補償値を小さくまたは０とすることができ、省エネルギー性能を向上することができる。
【0037】
（Ｃ３）制御系調整器１６は、評価指標値“（２）アクチュエータ動作評価値”に基づいて、外乱推定器１４が出力する外乱補償値（例えば、補償舵角の絶対値積分）と非干渉制御器１５が出力する非干渉補償値（補償舵角の絶対値積分）のうち値が大きい方の出力ゲインを（Ｃ２）の場合と同様にして設定する。例えば、制御系調整器１６は、外乱補償値＞非干渉補償値であれば、出力ゲイン１４２に１より小さい値を設定し、外乱補償値＞非干渉補償値であれば、出力ゲイン１５２に１より小さい値を設定する。アクチュエータ動作の増大に寄与する補償器の動作を抑制することで、省エネルギー性能を向上することができる。
【0038】
（Ｃ４）制御系調整器１６は、省エネルギー重視での運転中に、評価指標値”（１）揺動評価値”に基づいて、船体の方位角やロール角が、ある閾値以上揺動している場合は、非干渉制御器１５の出力ゲイン１５２を自動的に１とする。方位角やロール角が大きく変化する場合、船体には横からの波が入っている条件となる。この場合は、方位角、ロール角の揺動（外乱）に対する制御が、深度、ピッチ角の制御に干渉するため、横方向の揺動がある閾値以上となった場合は、非干渉制御を自動的にＯＮとする。
【0039】
（Ｃ５）制御系調整器１６は、省エネルギー重視での運転中に、評価指標値”（２）アクチュエータ動作評価値“に基づいて、評価指標値（例えば、アクチュエータ動作速度の絶対値積分）が所定の閾値以上だったら、評価指標値と帯域調整ゲインの関係を定めた所定のテーブルに基づいて速度飽和補償器１３のパラメータ（帯域調整ゲイン）を変更する。例えば、アクチュエータ動作が大きい状況において、帯域調整ゲインを上げることによって、省エネルギー性能を向上させることができる。
【0040】
パラメータ算出部１７は、制御系調整器１６による制御系の切り替えで調整対象となる各種パラメータの値を決定する為のテーブルを作成する。パラメータ算出部１７は、外乱情報記憶部１７１と、シミュレーション評価部１７２と、を備えている。
外乱情報記憶部１７１は、水中航走体１の運転中に、出力ゲイン１４２を０とした状態で外乱推定器１４が推定した各制御軸方向別の外乱を示す外乱情報（外乱の波形データ）を取得し、記憶する。
シミュレーション評価部１７２は、水中航走体１の動作や状態を模擬する船体モデルを有していて、水中航走体１に外乱を与えたときの揺動や、各補償器のパラメータに任意の値を設定して制御を行ったときの水中航走体１の状態を算出することができる。シミュレーション評価部１７２は、外乱情報記憶部１７１が記憶する外乱情報を船体モデルに入力し、外乱情報と同じ外乱を水中航走体１に加えたときの揺動を模擬する。また、シミュレーション評価部１７２は、船体モデルを用いて、模擬した揺動に対し、速度飽和補償器１３の帯域調整ゲイン、外乱推定器１４のローパスフィルタ１４１のフィルタ帯域と出力ゲイン１４２、非干渉制御器１５のローパスフィルタ１５１のフィルタ帯域と出力ゲイン１５２のそれぞれに様々な値を設定して水中航走体１を運転したときの制御シミュレーションを実行し、各パラメータに設定した値の評価を行う。シミュレーション評価部１７２は、制御シミュレーション中に算出された揺動やアクチュエータ動作の情報から上述の（１）～（４）の評価指標値を計算し、例えば“（１）揺動状態の評価値”に基づいて揺動が収束するまでの時間（例えば、peak to peak値が閾値以下となるまでの時間）を算出し、“（２）アクチュエータ動作評価値”に基づいて制御実行中のアクチュエータの動作量を算出し、それぞれが所定の基準を満たす場合のパラメータの値を選択する。シミュレーション評価部１７２は、外乱情報記憶部１７１が記憶する外乱情報ごとに、各パラメータの値を選択し、その結果をテーブルに登録する。例えば、シミュレーション評価部１７２は、制御系の切り替え（Ａ１）に関し、主成分ｆ１、ｆ２とローパスフィルタ１４１，１５１のフィルタ帯域ｆの関係を定めたテーブル、（Ｃ１）に関し主成分ｆ２と出力ゲイン１５２の値を定めたテーブル、・・・などを作成する。シミュレーション評価部１７２は、水中航走体１の速度別に制御シミュレーションを行い、各テーブルを作成してもよい。そして、パラメータ算出部１７は、シミュレーション評価部１７２が作成したテーブルを制御系調整器１６へ出力する。制御系調整器１６は、シミュレーション評価部１７２が作成したテーブルに基づいて、上記の制御系の切り替え（Ａ１）～（Ｃ５）パラメータ調整を行う。事前にあらゆる種類の外乱を想定してパラメータのテーブルを準備しておくことは難しい。その一方で、例えば同じ海域であれば、所定時間に観測（実際には外乱推定器１４により推定）された外乱と同様の外乱が定常的に発生する可能性が高い。パラメータ算出部１７によれば、実際に水中航走体１が航行している海域の波浪に応じた外乱に対して適切なパラメータの値を用いて制御を行うことができる。
外乱情報記憶部１７１は、水中航走体１の運転中に、出力ゲイン１４２を０とした状態で外乱推定器１４が推定した各制御軸方向別の外乱を示す外乱情報（外乱の波形データ）を取得し、記憶する。
シミュレーション評価部１７２は、水中航走体１の動作や状態を模擬する船体モデルを有していて、水中航走体１に外乱を与えたときの揺動や、各補償器のパラメータに任意の値を設定して制御を行ったときの水中航走体１の状態を算出することができる。シミュレーション評価部１７２は、外乱情報記憶部１７１が記憶する外乱情報を船体モデルに入力し、外乱情報と同じ外乱を水中航走体１に加えたときの揺動を模擬する。また、シミュレーション評価部１７２は、船体モデルを用いて、模擬した揺動に対し、速度飽和補償器１３の帯域調整ゲイン、外乱推定器１４のローパスフィルタ１４１のフィルタ帯域と出力ゲイン１４２、非干渉制御器１５のローパスフィルタ１５１のフィルタ帯域と出力ゲイン１５２のそれぞれに様々な値を設定して水中航走体１を運転したときの制御シミュレーションを実行し、各パラメータに設定した値の評価を行う。シミュレーション評価部１７２は、制御シミュレーション中に算出された揺動やアクチュエータ動作の情報から上述の（１）～（４）の評価指標値を計算し、例えば“（１）揺動状態の評価値”に基づいて揺動が収束するまでの時間（例えば、peak to peak値が閾値以下となるまでの時間）を算出し、“（２）アクチュエータ動作評価値”に基づいて制御実行中のアクチュエータの動作量を算出し、それぞれが所定の基準を満たす場合のパラメータの値を選択する。シミュレーション評価部１７２は、外乱情報記憶部１７１が記憶する外乱情報ごとに、各パラメータの値を選択し、その結果をテーブルに登録する。例えば、シミュレーション評価部１７２は、制御系の切り替え（Ａ１）に関し、主成分ｆ１、ｆ２とローパスフィルタ１４１，１５１のフィルタ帯域ｆの関係を定めたテーブル、（Ｃ１）に関し主成分ｆ２と出力ゲイン１５２の値を定めたテーブル、・・・などを作成する。シミュレーション評価部１７２は、水中航走体１の速度別に制御シミュレーションを行い、各テーブルを作成してもよい。そして、パラメータ算出部１７は、シミュレーション評価部１７２が作成したテーブルを制御系調整器１６へ出力する。制御系調整器１６は、シミュレーション評価部１７２が作成したテーブルに基づいて、上記の制御系の切り替え（Ａ１）～（Ｃ５）パラメータ調整を行う。事前にあらゆる種類の外乱を想定してパラメータのテーブルを準備しておくことは難しい。その一方で、例えば同じ海域であれば、所定時間に観測（実際には外乱推定器１４により推定）された外乱と同様の外乱が定常的に発生する可能性が高い。パラメータ算出部１７によれば、実際に水中航走体１が航行している海域の波浪に応じた外乱に対して適切なパラメータの値を用いて制御を行うことができる。
【0041】
（動作）
次に制御装置１０の動作について説明する。
図４は、実施形態に係る制御システムの動作の一例を示すフローチャートである。
水中航走体１は運転中であり、ユーザ（操縦者）は、制御モード（揺動抑制重視、省エネルギー重視）を事前に制御装置１０に指示しているとする。制御装置１０は、テーブル作成を行うかどうかを判定する（ステップＳ１）。ユーザは、テーブル作成を行うかどうかの判断し、作成する場合には、その旨を制御装置１０へ入力し、この入力に基づいて、制御装置１０はステップＳ１の判定を行う。例えば、ユーザは、海域の変更や海象の変化などにより、波浪の変化が大きいような場合に、実際の波浪による外乱情報を得るためにテーブル作成指示を制御装置１０へ入力する。事前に制御系調整器１６が記憶している（標準的な）テーブルで対処できると考えられる場合、ユーザは、テーブル作成指示を行わない。テーブル作成指示が入力されると、制御装置１０は、テーブル作成すると判定する。そうでない場合（ステップＳ１；Ｎｏ）には、ステップＳ５の処理へ進む。
次に制御装置１０の動作について説明する。
図４は、実施形態に係る制御システムの動作の一例を示すフローチャートである。
水中航走体１は運転中であり、ユーザ（操縦者）は、制御モード（揺動抑制重視、省エネルギー重視）を事前に制御装置１０に指示しているとする。制御装置１０は、テーブル作成を行うかどうかを判定する（ステップＳ１）。ユーザは、テーブル作成を行うかどうかの判断し、作成する場合には、その旨を制御装置１０へ入力し、この入力に基づいて、制御装置１０はステップＳ１の判定を行う。例えば、ユーザは、海域の変更や海象の変化などにより、波浪の変化が大きいような場合に、実際の波浪による外乱情報を得るためにテーブル作成指示を制御装置１０へ入力する。事前に制御系調整器１６が記憶している（標準的な）テーブルで対処できると考えられる場合、ユーザは、テーブル作成指示を行わない。テーブル作成指示が入力されると、制御装置１０は、テーブル作成すると判定する。そうでない場合（ステップＳ１；Ｎｏ）には、ステップＳ５の処理へ進む。
【0042】
テーブル作成すると判定した場合（ステップＳ１；Ｙｅｓ）、まず制御系調整器１６が、出力ゲイン１４２に０を設定する。外乱推定器１４では、出力ゲイン１４２が０となった後も外乱推定処理は継続される。外乱推定器１４は、時々刻々、深度方向の揺動を計測する深度計やピッチ角や方位角の揺動を検出するジャイロセンサが計測する計測値を取得し、制御軸方向別に外乱推定を行う（ステップＳ２）。外乱推定器１４は、推定した外乱情報をパラメータ算出部１７へ出力する。外乱情報記憶部１７１は、外乱推定器１４から外乱情報を取得して記憶する。外乱情報記憶部１７１は、水中航走体１の速度と外乱情報とを対応付けて記憶してもよい。外乱情報の採取が終わると、制御系調整器１６が、出力ゲイン１４２に１を設定する。次にシミュレーション評価部１７２が、推定された外乱情報を船体モデルに与えて、各種パラメータに様々な値を設定しながら制御シミュレーションを行い、制御系切り替え（Ａ１）～（Ｃ５）で使用する評価指標値と対応付けて適切なパラメータを決定する（ステップＳ３）。次にシミュレーション評価部１７２は、決定したパラメータを登録したテーブルを作成する（ステップＳ４）。テーブルは、制御系切り替え（Ａ１）～（Ｃ５）で設定するパラメータごとに作成される。例えば、制御系切り替え（Ａ２）については、実際に観測（推定）された外乱の範囲で、外乱ごとの主成分ｆ１および主成分ｆ２とローパスフィルタ１４１のフィルタ帯域ｆを対応付けたテーブルと、主成分ｆ１および主成分ｆ２とローパスフィルタ１５１のフィルタ帯域ｆを対応付けたテーブルが作成される。制御系切り替え（Ｃ３）については、実際に観測（推定）された外乱に対する制御シミュレーションで得られた省エネルギー性能の低下を最も防ぐことができる出力ゲイン１４２や出力ゲイン１５２の値が登録されたテーブルが作成される。
【0043】
テーブルが作成されると、あるいはテーブルを作成しない場合、制御系調整器１６は、機体２０からセンサの計測値などを取得して、上記の（１）～（４）の評価指標値を算出する（ステップＳ５）。例えば、制御系調整器１６は、一定期間（１０分など）における（１）～（４）それぞれの評価指標値を算出する。次に制御系調整器１６は、算出した評価指標値に基づいて、ローパスフィルタ１４１、１５１のフィルタ帯域ｆの調整（制御系切り替えの（Ａ１）又は（Ａ２））を行う（ステップＳ６）。次に制御系調整器１６は、算出した評価指標値に基づいて、制御目的に応じたパラメータ調整を行う（ステップＳ７）。例えば、制御目的が揺動重視の場合、制御系調整器１６は、制御系切り替えの（Ｂ）を行う。制御目的が省エネルギー重視の場合、制御系調整器１６は、制御系切り替えの（Ｃ１）～（Ｃ５）を行う。
【0044】
制御系調整器１６は、ステップＳ６，Ｓ７の処理を一定期間（１０分など）ごとに実行する。又は、制御系調整器１６は、ステップＳ６，Ｓ７の処理を運転モード、制御目的、海域が変更になったタイミング、ユーザから指示されたタイミングで実行する。制御装置１０は、ステップＳ１～Ｓ７の処理を繰り返し行う。
【0045】
なお、制御目的の設定は、ユーザが手動で切り替えてもよいし、制御系調整器１６が（１）～（４）の評価指標値に基づいて自動的に切り替えてもよい。例えば、制御系調整器１６は、省エネルギー重視での制御中に“（１）揺動状態の評価値”のPeak to Peak値が閾値を超過する時間の合計が所定時間より長くなると制御モードを揺動抑制重視に切り替えてもよい。又は、制御系調整器１６は、揺動抑制重視での制御中に“（２）アクチュエータ動作評価値”が閾値を超過する時間の合計が所定時間より長くなると、制御モードを省エネルギー重視に切り替えてもよい。
【0046】
（効果）
以上説明したように、本実施形態によれば、外乱推定器１４によって外乱の直接的な補償を行い、非干渉制御器１５によって船体の干渉特性の中での揺動発生の抑制を行いつつ、速度飽和補償器１３によってアクチュエータの急峻な動作は抑制し、それらを揺動状態に応じて適切なバランスで運用することで、揺動抑制とアクチュエータ動作の低減（省エネルギー化）の相反事象を両立することができる。また、揺動抑制性能と省エネルギー性能のバランスを任意に調整することができる。
以上説明したように、本実施形態によれば、外乱推定器１４によって外乱の直接的な補償を行い、非干渉制御器１５によって船体の干渉特性の中での揺動発生の抑制を行いつつ、速度飽和補償器１３によってアクチュエータの急峻な動作は抑制し、それらを揺動状態に応じて適切なバランスで運用することで、揺動抑制とアクチュエータ動作の低減（省エネルギー化）の相反事象を両立することができる。また、揺動抑制性能と省エネルギー性能のバランスを任意に調整することができる。
【0047】
上述の制御装置１０は、ＣＰＵ（Central Processing Unit）等のプロセッサ、主記憶装置、補助記憶装置などを備えるコンピュータに実装され、上述した各機能は、プロセッサが、補助記憶装置が記憶するプログラムを実行することにより実現される。プロセッサは、プログラムに従って、記憶領域を主記憶装置に確保する。プロセッサは、プログラムに従って、処理中のデータを記憶する記憶領域を補助記憶装置に確保する。なお、制御装置１０の各処理のうち一部又は全部は、ＬＳＩ（Large Scale Integration）、ＡＳＩＣ（Application Specific Integrated Circuit）、ＦＰＧＡ（Field-Programmable Gate Array）等のハードウェアが実行してもよい。
【0048】
以上のとおり、本開示に係るいくつかの実施形態を説明したが、これら全ての実施形態は、例として提示したものであり、発明の範囲を限定することを意図していない。これらの実施形態は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で種々の省略、置き換え、変更を行うことができる。これらの実施形態及びその変形は、発明の範囲や要旨に含まれると同様に、特許請求の範囲に記載された発明とその均等の範囲に含まれる。
【0049】
＜付記＞
各実施形態に記載の制御装置、水中航走体、制御方法及びプログラムは、例えば以下のように把握される。
各実施形態に記載の制御装置、水中航走体、制御方法及びプログラムは、例えば以下のように把握される。
【0050】
（１）第１の態様に係る制御装置１０は、船体の位置と目標位置との差に基づいて制御指令値を算出するフィードバック制御器１１と、前記船体の制御軸間の相互干渉を打ち消すための非干渉補償値を算出する非干渉制御器１５と、前記船体の作用する外乱の力を推定し、前記外乱を打ち消すための外乱補償値を算出する外乱推定器１４と、前記制御指令に基づいて前記船体のアクチュエータを制御したときに速度飽和が生じないような速度飽和補償値を算出する速度飽和補償器１３と、前記船体に生じる揺動および／または前記アクチュエータの動作に基づいて、前記非干渉制御器、外乱推定器および速度飽和補償器のうちの少なくとも１つのパラメータを更新する制御系調整器１６と、を有する。
これにより、揺動抑制性能と省エネルギー性能のバランスを調整することができる。
これにより、揺動抑制性能と省エネルギー性能のバランスを調整することができる。
【0051】
（２）第２の態様に係る制御装置１０は、（１）の制御装置であって、前記制御指令を前記速度飽和補償値によって補償する前記速度飽和補償器を含む第１の制御ループと、前記外乱補償値によって補償した前記制御指令を前記第１の制御ループへ与える前記外乱推定器を含む第２の制御ループと、前記非干渉補償値によって補償した前記制御指令を前記第２の制御ループへ与える前記非干渉制御器を含む第３の制御ループと、を有する。
これにより、適切に制御軸間の干渉を非干渉化することができ、その結果、効果的に外乱を抑制することができる。
これにより、適切に制御軸間の干渉を非干渉化することができ、その結果、効果的に外乱を抑制することができる。
【0052】
（３）第３の態様に係る制御装置は、（１）～（２）の制御装置であって、前記船体の揺動の周波数成分分析の結果に基づいて、上位２つの主成分を選択し、前記２つの主成分の間の周波数を前記外乱推定器が備えるローパスフィルタおよび前記非干渉制御器が備えるローパスフィルタのフィルタ帯域に設定する。
これにより、揺動抑制とアクチュエータ動作の低減（省エネルギー化）の相反事象を両立することができる。
これにより、揺動抑制とアクチュエータ動作の低減（省エネルギー化）の相反事象を両立することができる。
【0053】
（４）第４の態様に係る制御装置は、（１）～（３）の制御装置であって、前記制御系調整器は、制御目的が揺動抑制の場合、前記外乱推定器が備える出力ゲインおよび前記非干渉制御器が備える出力ゲインの値に１を設定する。
これにより、揺動を抑制することができる。
これにより、揺動を抑制することができる。
【0054】
（５）第５の態様に係る制御装置は、（１）～（４）の制御装置であって、前記制御系調整器は、制御目的が省エネルギー化の場合、前記外乱推定器が備える出力ゲインまたは前記非干渉制御器が備える出力ゲインの値に１より小さい値を設定する。
これにより、アクチュエータ動作を抑制することができる。
これにより、アクチュエータ動作を抑制することができる。
【0055】
（６）第６の態様に係る制御装置は、（５）の制御装置であって、前記制御系調整器は、制御目的が省エネルギー化の場合、前記船体の揺動の周波数解析の結果に基づいて、上位２つの主成分を選択し、そのうち周波数が高い成分の周波数が閾値以上の場合、前記非干渉制御器が備える出力ゲインの値に１より小さい値を設定する。
非干渉制御器が出力する補償値の影響による過剰なアクチュエータ動作を抑制することができる。
非干渉制御器が出力する補償値の影響による過剰なアクチュエータ動作を抑制することができる。
【0056】
（７）第７の態様に係る制御装置は、（５）～（６）の制御装置であって、前記制御系調整器は、制御目的が省エネルギー化の場合、前記外乱補償値の高周波成分が前記非干渉補償値の高周波成分より大きいか又は前記外乱補償値が前記非干渉補償値より大きい場合、前記外乱推定器の出力ゲインの値に１より小さい値を設定し、前記非干渉補償値の高周波成分が前記外乱補償値の高周波成分より大きいか又は前記非干渉補償値が前記外乱補償値より大きい場合、前記非干渉制御器の出力ゲインの値に１より小さい値を設定する。
これにより、アクチュエータ動作を大きくする原因となる補償値の影響を低減し、省エネルギー性能を向上することができる。
これにより、アクチュエータ動作を大きくする原因となる補償値の影響を低減し、省エネルギー性能を向上することができる。
【0057】
（８）第８の態様に係る制御装置は、（５）～（７）の制御装置であって、前記制御系調整器は、制御目的が省エネルギー化の場合、船体の方位角またはロール角が、所定の閾値以上揺動している場合、前記非干渉制御器の出力ゲインを１とする。
軸間干渉が生じる状況では、省エネルギー化を目的とする制御下でも、非干渉制御器をＯＮとし、軸間干渉を抑制する。
軸間干渉が生じる状況では、省エネルギー化を目的とする制御下でも、非干渉制御器をＯＮとし、軸間干渉を抑制する。
【0058】
（９）第９の態様に係る制御装置は、（１）～（８）の制御装置であって、前記制御系調整器は、省エネルギー制御を向上させる場合、速度飽和を補償する作用が強くなるように速度飽和補償器のパラメータを調整する。
これにより、アクチュエータの急峻な動作を抑制し、省エネルギー性能を向上することができる。
これにより、アクチュエータの急峻な動作を抑制し、省エネルギー性能を向上することができる。
【0059】
（１０）第１０の態様に係る制御装置は、（１）～（９）の制御装置であって、前記外乱推定器が推定した外乱に基づいて、前記船体に生じる揺動を算出し、前記非干渉制御器、前記外乱推定器および前記速度飽和補償器のうちの少なくとも１つの前記パラメータに様々な値を設定しつつ、算出した前記揺動に対して前記船体を制御するシミュレーションを実行し、前記シミュレーション結果に基づいて、前記パラメータの値を評価して、様々に設定した前記パラメータの値のうち、所定の基準を満たす値を決定するパラメータ算出部、をさらに有する。
これにより、非干渉制御器、外乱推定器および速度飽和補償器のパラメータに適切な値を設定することができる。
これにより、非干渉制御器、外乱推定器および速度飽和補償器のパラメータに適切な値を設定することができる。
【0060】
（１１）第１１の態様に係る水中航走体は、（１）～（１０）の何れか１つに記載の制御装置を備える。
【0061】
（１２）第１２の態様に係る制御方法は、非干渉制御器と、外乱推定器と、速度飽和補償器と、を有する制御装置によって実行される制御方法であって、船体の位置と目標位置との差に基づいて制御指令値を算出するステップと、前記非干渉制御器が、前記船体の制御軸間の相互干渉を打ち消すための非干渉補償値を算出するステップと、前記外乱推定器が、前記船体の作用する外乱の力を推定し、前記外乱を打ち消すための外乱補償値を算出するステップと、前記速度飽和補償器が、前記制御指令値に基づいて前記船体のアクチュエータを制御したときに速度飽和が生じないような速度飽和補償値を算出するステップと、前記船体に生じる揺動および／または前記アクチュエータの動作に基づいて、前記非干渉制御器、前記外乱推定器および前記速度飽和補償器のうちの少なくとも１つのパラメータを調整するステップと、を有する。
【符号の説明】
【0062】
１・・・水中航走体、１０・・・制御装置、１１・・・ＦＢ制御器、１２・・・アクチュエータ制御系、１３・・・速度飽和補償器、１４・・・外乱推定器、１５・・・非干渉制御器、１６・・・制御系調整器、１７・・・パラメータ算出部、１７１・・・外乱情報記憶部、１７２・・・シミュレーション評価部
【図1】
【図2】
【図3】
【図4】