(57)【特許請求の範囲】
【請求項１】
制御対象の出力を目標指令に一致させるような制御指令を生成するフィードバック制御手段と、所定の参照信号に応じて、前記フィードバック制御手段で用いられる制御ゲインを調整するゲインスケジュール手段とを備える制御装置であって、
前記ゲインスケジュール手段は、前記制御ゲインの変化率が所定の変化率制限値以下となるように制限する変化率制限手段と、
前記制御対象の出力変動の大きさに応じて、前記変化率制限値を変更する変化率制限値設定手段と
を具備する制御装置。
【請求項２】
前記変化率制限値設定手段は、前記制御対象の出力と前記目標指令との関係に基づいて、前記制御対象の出力変動の大きさを判定する請求項１に記載の制御装置。
【請求項３】
前記変化率制限手段は、前記所定の参照信号の変化率が変化率制限値以下となるように制限することにより、前記制御ゲインの変化率を前記変化率制限値以下とする請求項１または請求項２に記載の制御装置。
【請求項４】
請求項１から請求項３に記載の制御装置を備える水中航走体。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、制御装置及び水中航走体に関するものである。
【背景技術】
【０００２】
従来、フィードバック制御を行う制御装置において、フィードバック制御で用いられる制御ゲインを調整するゲインスケジュール制御が知られている。
例えば、特許文献１には、現在の船速及び翼深度に基づいて制御ゲインを決定するゲインスケジューリング装置が開示されている。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特公平８−３２５２３号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
ゲインスケジューリング制御を用いたフィードバック制御では、ゲインスケジューリング制御によって適切なゲインが得られない場合、フィードバック制御部から出力される制御指令が振動してしまい、制御が不安定になってしまう。また、制御が不安定になると、消費されるエネルギーも増大してしまい。
特に、水中を航走する水中航走体では、エネルギー補充のために浮上する必要があり、不安定な制御による消費エネルギーの増大は深刻な問題となる。
【０００５】
本発明は、このような事情に鑑みてなされたものであって、安定したフィードバック制御を実現することのできる制御装置及び水中航走体を提供することを目的とする。
【課題を解決するための手段】
【０００６】
上記課題を解決するために、本発明は以下の手段を採用する。
本発明は、制御対象の出力を目標指令に一致させるような制御指令を生成するフィードバック制御手段と、所定の参照信号に応じて、前記フィードバック制御手段で用いられる制御ゲインを調整するゲインスケジュール手段とを備える制御装置であって、前記ゲインスケジュール手段は、前記制御ゲインの変化率が所定の変化率制限値以下となるように制限する変化率制限手段と、前記制御対象の出力変動の大きさに応じて、前記変化率制限値を変更する変化率制限値設定手段とを具備する制御装置を提供する。
【０００７】
フィードバック制御が不安定になる要因として、ゲインスケジュール機構で得られる制御ゲインの変動が大きいことが考えられる。
本発明によれば、フィードバック制御手段で用いられる制御ゲインの変化率を所定の変化率制限値以下に制限するので、フィードバック制御手段に出力される制御ゲインの変動を抑制することができる。これにより、制御対象の出力の振動を抑制することができ、安定した制御の実現に寄与する。この結果、消費エネルギーの増大を抑制することができる。
また、制御の不安定を解消する対策として、一般的に、制御ゲインを通常よりも小さく設定することが挙げられるが、この場合、外乱に対するロバスト性が劣化するおそれがある。本発明によれば、変化率が変化率制限値を超える場合に限って制御ゲインを小さめに設定するので、制御系の外乱に対するロバスト性の低下を回避することが可能となる。
上記変化率制限手段の実現手法としては、レートリミッタ、平滑化手段等が挙げられる。平滑化手段としては、ローパスフィルタや、平均化処理等が挙げられる。
【０００８】
上記制御装置において、前記変化率制限値設定手段は、前記制御対象の出力と前記目標指令との関係に基づいて、前記制御対象の出力変動の大きさを判定することとしてもよい。
【０００９】
制御対象の出力と目標指令との関係に基づいて、制御対象の出力変動の大きさを判定して変化率制限値を変更するので、制御対象の状態に応じた適切な変化率制限値を設定することができる。これにより、フィードバック制御手段において使用される制御ゲインを更に適切な値とすることができ、応答性を向上させることが可能となる。
【００１０】
上記制御装置において、前記変化率制限手段は、前記所定の参照信号の変化率が変化率制限値以下となるように制限することにより、前記ゲインの変化率を前記変化率制限値以下とすることとしてもよい。
【００１１】
ゲインの変化率が増大する原因として、ゲインを決定する際に参照される参照信号が変動していることが挙げられる。したがって、参照信号の変動を抑制することで、これに基づいて決定される制御ゲインの変動を間接的に抑制することが可能となる。
【００１２】
本発明は、上記いずれかに記載の制御装置を備える水中航走体を提供する。
【発明の効果】
【００１３】
本発明によれば、安定したフィードバック制御を実現することができ、消費エネルギーの増大を抑制することができるという効果を奏する。
【図面の簡単な説明】
【００１４】
【図１】本発明の第１実施形態に係る水中航走体を示した図であって、（ａ）は概略平面図、（ｂ）は概略右側面図である。
【図２】本発明の第１実施形態に係る制御装置が備える機能を概略的に示した機能ブロック図である。
【図３】本発明の第２実施形態に係る制御装置が備える機能を概略的に示した機能ブロック図である。
【図４】目標指令をステップ関数的に与えたときの制御指令と出力応答の一例と、変化率制限値の与え方について説明するための図である。
【図５】本発明の第３実施形態に係る制御装置が備える機能を概略的に示した機能ブロック図である。
【発明を実施するための形態】
【００１５】
以下、本発明に係る制御装置を水中航走体に適用した場合を例に挙げてそれぞれの実施形態として説明する。なお、本発明の制御装置は、以下に説明する水中航走体に適用される場合に限られず、フィードバック制御におけるゲインを調整する機能を備える制御装置に広く適用されるものである。
【００１６】
〔第１実施形態〕
以下に、本発明の第１実施形態に係る制御装置及び水中航走体について、図面を参照して説明する。図１（ａ）は、本実施形態に係る水中航走体の概略平面図を示した図、図１（ｂ）は、本実施形態に係る水中航走体の概略右側面図である。
図１に示すように、本実施形態に係る水中航走体１は、船体２と、主推進器３と、水平推進器４と、垂直推進器５とを備えている。
【００１７】
主推進器３は、船体２の後端部に船体２の左右方向（幅方向）に延びる水平軸線に沿って並べて配置された右側推進プロペラ３ａと左側推進プロペラ３ｂとを備えている。右側推進プロペラ３ａと左側推進プロペラ３ｂとは、図示しない駆動源（例えば、バッテリ駆動の電動モータ等）によって正回転または逆回転させられるものである。そして、これらの右側推進プロペラ３ａと左側推進プロペラ３ｂとが、後述する制御装置１０（図２参照）からの回転数指令に応じて正回転又は逆回転することによって、船体２が船首尾線に沿って前進または後進するようになっている。
【００１８】
水平推進器４は、船体２の前方に設けられた前方水平推進器４ａ及び船体２の後方に設けられた後方水平推進器４ｂを有している。前方水平推進器４ａは、船体２の左右方向に延びる水平軸線に沿って船体２を貫通するスラスタトンネル６ａと、このスラスタトンネル６ａの略中央に配置された前方水平プロペラ７ａとを備えている。後方水平推進器４ｂは、水平軸線に沿って船体２を貫通するスラスタトンネル６ｂと、このスラスタトンネル６ｂの略中央に配置された後方水平プロペラ７ｂとを備えている。
【００１９】
前方水平プロペラ７ａと後方水平プロペラ７ｂとは、図示しない駆動源（例えば、バッテリ駆動の電動モータ等）により正回転又は逆回転させられるものである。そして、前方水平プロペラ７ａと後方水平プロペラ７ｂとが、制御装置１０（図２参照）からの回転数指令に応じて正回転または逆回転することによって船体２が左進または右進するようになっている。更に、制御装置１０からの信号に応じて、前方水平プロペラ７ａ及び後方水平プロペラ７ｂのそれぞれの回転数が異なるように制御されることにより、方位（ヨー角度）が制御されるようになっている。
【００２０】
垂直推進器５は、船体２の前方に設けられた前方垂直推進器５ａ及び船体２の後方に設けられた後方垂直推進器５ｂを有している。前方垂直推進器５ａは、船体の上下方向に延びる垂直軸線に沿って船体２を貫通するスラスタトンネル８ａと、このスラスタトンネル８ａの略中央に配置された前方垂直プロペラ９ａとを備えている。後方垂直推進器５ｂは、垂直軸線に沿って船体２を貫通するスラスタトンネル８ｂと、このスラスタトンネル８ｂの略中央に配置された後方垂直プロペラ９ｂとを備えている。
【００２１】
前方垂直プロペラ９ａと後方垂直プロペラ９ｂとは、図示しない駆動源（例えば、バッテリ駆動の電動モータ等）により正回転又は逆回転させられるものである。そして、前方垂直プロペラ９ａと後方垂直プロペラ９ｂが、制御装置１０（図２参照）からの回転数指令に応じて正回転または逆回転することによって船体２が浮上又は潜行するようになっている。更に、制御装置１０からの信号に応じて、前方垂直プロペラ９ａ及び後方垂直プロペラ９ｂのそれぞれの回転数が異なるように制御されることにより、船首尾線と水平面とのなす角度（ピッチ角）が制御されるようになっている。
【００２２】
上述のように、本実施形態に係る水中航走体１は、主推進器３、水平推進器４、垂直推進器４が備える各プロペラの回転数が制御装置１０からの制御指令に基づいて制御されることにより、船首尾線方向、水平軸線方向、垂直軸線方向における航走と、方位制御及びピッチ角制御による旋回制御とを実現することができるものである。
【００２３】
制御装置１０は、例えば、コンピュータであり、図示しないＣＰＵ（中央演算装置）、ＲＡＭ（Random Access Memory）、及びコンピュータ読み取り可能な記録媒体等から構成されている。後述の各種機能を実現するための一連の処理の過程は、プログラムの形式で記録媒体等に記録されており、このプログラムをＣＰＵがＲＡＭ等に読み出して、情報の加工・演算処理を実行することにより、後述の各種機能が実現される。
【００２４】
以下、説明の便宜上、制御装置１０が備える各種機能のうち、旋回制御に関する機能について主に説明する。
図２は、制御装置１０が備える各種機能のうち、旋回制御に関する機能を抽出して概略的に示した機能ブロック図である。
図２に示すように、制御装置１０は、フィードバック制御部１１と、ゲインスケジューリング部１２とを備えている。
【００２５】
フィードバック制御部１１は、目標旋回角度に現在の船体２の旋回角度を追従させるための旋回回転数指令を生成する。フィードバック制御部１１は、例えば、目標旋回角度と現在の船体２の旋回角度との偏差に対して、比例積分微分制御（ＰＩＤ制御）を行うことにより、旋回回転数指令を生成する。目標旋回角度が方位に関する指令であった場合、旋回回転数指令は水平推進器４が備える前方水平プロペラ７ａ、後方水平プロペラ７ｂをそれぞれ駆動するモータ等の駆動源に与えられる。また、目標旋回角度がピッチ角に関する指令であった場合には、旋回回転数指令は垂直推進器５が備える前方垂直プロペラ９ａ、後方垂直プロペラ９ｂをそれぞれ駆動するモータ等の駆動源に与えられる。
【００２６】
上記フィードバック制御部１１における比例積分微分制御のそれぞれの制御ゲインＫｐ、Ｋｉ、Ｋｄは、ゲインスケジューリング部１２によって調整される。
【００２７】
ゲインスケジューリング部１２は、記憶部２１と、ゲイン取得部２２と、変化率制限部２３とを備えている。
記憶部２１は、例えば、船体速度（参照信号）と制御ゲインＫｐ，Ｋｉ，Ｋｄとがそれぞれ関連付けられたゲインテーブルを有している。
ゲイン取得部２２は、現在の船体速度に対応する制御ゲインＫｐ，Ｋｉ，Ｋｄをゲインテーブルから取得する。
【００２８】
変化率制限部２３は、各制御ゲインの変化率が予め設定されている所定の変化率制限値以下となるように制限する。所定の変化率制限値は、例えば、設計者により適宜設定される値である。変化率制限値は、例えば、実際に船体を運転させたときの制御の安定性を解析し、そのシミュレーション結果から求めた値に基づいて設定される。
このように、変化率制限部２３を有しているので、フィードバック制御部１１に出力される制御ゲインが所定量以上変動することを抑制することができる。
【００２９】
変化率制限部２３の具体的な構成としては、例えば、レートリミッタが挙げられる。レートリミッタは信号の立ち上がりと立下りの制限値を設定するものであり、広く汎用されている。従って、レートリミッタを採用することにより、コストダウンや構成の簡素化を図ることができる。
【００３０】
また、変化率制限部２３の他の具体例としては、例えば、平滑化処理を行う平滑化手段が挙げられる。平滑化手段の一例としては、ローパスフィルタや、平均化処理が挙げられる。
ローパスフィルタは、制御ゲインを平滑化する効果を持つので、制御ゲインの急激な変化を効果的に抑制することができる。この場合、ローパスフィルタの次数は特に制限されない。
また、平均化処理は、今回の制御ゲインと過去Ｎ（Ｎは１以上の整数）回分の制御ゲインの平均を算出し、平均制御ゲインを出力する移動平均等が挙げられる。このような平均化処理では、制御ゲインが急激に変化しても、その変化分が過去の制御ゲインによって平滑化されるため、制御ゲインの変動を抑制することができる。
【００３１】
このような構成を備える水中航走体１においては、旋回角度が旋回角度検出部１３によって検出されるとともに、水中航走体１の船体速度が図示しないセンサによって検出されて制御装置１０に入力される。なお、旋回角度、船体速度をセンサによって検出する態様に代えて、例えば、制御装置１０における制御指令（例えば、プロペラの回転数指令）に基づいて所定の演算を行うことにより、船体速度や旋回角度を推定することとしてもよい。
【００３２】
船体速度は、ゲインスケジューリング部１２に入力され、制御ゲインの取得に用いられる。具体的には、ゲインスケジューリング部１２のゲイン取得部２２により、船体速度に応じた各種制御ゲインが記憶部２１に記憶されているゲインテーブルから取得され、取得された各種制御ゲインが変化率制限部２３に出力される。変化率制限部２３は、各種制御ゲインの変化率が予め設定されている変化率制限値以下である場合には、制御ゲインをそのままフィードバック部１１に出力し、また、変化率が変化率制限値を超えている場合には、その制御ゲインの変化率を変化率制限値に制限してフィードバック制御部１１に出力する。
【００３３】
フィードバック制御部１１には、現在の船体２の旋回角度と目標旋回角度との偏差及びゲインスケジューリング部１２からの制御ゲインが入力される。フィードバック制御部１１では、ゲインスケジューリング部１２からの制御ゲインを用いた比例積分微分制御が偏差に対して行われることにより、旋回回転数指令が生成される。そして、目標旋回角度が方位に関するものであれば、生成された旋回回転数指令は、水平推進器４が備える前方水平プロペラ７ａ、後方水平プロペラ７ｂをそれぞれ駆動するモータ等の駆動源に対して出力される。また、目標旋回角度がピッチ角に関するものであれば、旋回回転数指令は垂直推進器５が備える前方垂直プロペラ９ａ、後方垂直プロペラ９ｂをそれぞれ駆動するモータ等の駆動源に対して出力される。
そして、上述の処理が繰り返し行われることにより、現在の船体２の旋回角度を目標旋回角度に徐々に近づけることができる。
【００３４】
以上説明したように、本実施形態に係る水中航走体１及び制御装置１０によれば、ゲインスケジューリング部１２が制御ゲインの変化率を制限する変化率制限部２３を有しているので、制御ゲインの変動を抑制することができる。これにより、制御対象の出力の振動を抑制することができ、安定した制御を実現することが可能となる。これにより、消費エネルギーの増大を防止することができる。
また、制御ゲインの変化率が変化率制限値を超える場合に限って制御ゲインが小さい方向に調整されるので、制御系の外乱に対するロバスト性の低下を抑制することができる。
【００３５】
〔第２実施形態〕
次に、本発明の第２実施形態に係る水中航走体及び制御装置について説明する。
図３は、本実施形態に係る水中航走体の制御装置１０ａの機能ブロック図である。なお、図３は、上述した第１実施形態と同様に、旋回制御に関する機能のみを抽出して示したものである。
図３に示すように、本実施形態に係る制御装置１０ａのスケジューリング部１５は、図２に示した第１実施形態に係るスケジューリング部１２の構成に加えて、変化率制限値設定部２４を備えている。
変化率制限値設定部２４は、船体２の旋回角度（制御対象の出力）と目標旋回角度（目標指令）との関係に応じて、変化率制限部２３で用いられる変化率制限値を変更するものである。
【００３６】
例えば、変化率制限値設定部２４は、以下の（１）式で表わされるように、船体２の旋回角度θと目標旋回角度θ＊とをパラメータとして含む変化率制限値Ｒの関数式を有しており、この関数式を用いて変化率制限値を設定することとしてもよい。ここで、変化率制限値は、目標旋回角度θ＊と船体２の旋回角度θとの偏差の絶対値及びその偏差の微分値の絶対値が小さくなるほど、小さな値に設定されることが好ましい。
【００３７】
Ｒ＝Ｆ（θ，θ＊）      （１）
【００３８】
また、他の例として、旋回角度θと目標旋回角度θ＊と変化率制限値とが関連付けられたテーブルを有しており、このテーブルに基づいて変化率制限値を切り替えることとしてもよい。
【００３９】
例えば、図４に示すように、一般的に、ステップ関数的に目標指令が与えられた場合、それに対する制御指令は図４の破線で示されるような一次遅れの関数として表わされ、また、この制御指令に対する制御対象の出力は、図４に実線で示すように制御の立ち上がり時においては変動が大きく、徐々に目標旋回角度に収束していくこととなる。
【００４０】
制御対象の出力の変動が大きい期間においては、制御ゲインの変化率制限値はある程度大きい値に設定されることが好ましく、また、制御対象の出力が安定してきた期間においては、制御ゲインの変化率制限値はある程度小さい値に設定されることが好ましい。
【００４１】
制御対象の出力の変動が大きいか否かの判断としては、例えば、目標指令（目標旋回角度）と制御対象の出力（船体２の旋回角度）との偏差の絶対値が予め設定されている第１閾値以上であり、その偏差の微分値の絶対値が予め設定されている第２閾値以上である場合に、制御対象の出力の変動が大きいと判断し、該偏差の絶対値が第１閾値未満であり、その偏差の微分値の絶対値が第２閾値未満である場合に、制御対象の出力の変動が小さいと判断することが一例として挙げられる。
【００４２】
上記判断において、制御対象の出力の変動が大きい場合には、比較的大きな変化率制限値を設定し、制御対象の出力の変動が小さい場合には、比較的小さな変化率制限値を設定する。このように、出力変動が大きな期間においては制御ゲインの変動をある程度許容することにより追従性を向上させ、出力変動が小さな期間においては制御ゲインの変動を小さく抑えて略一定とすることで、外乱に対して高いロバスト性を確保する。
【００４３】
なお、上記例では、２段階に変化率制限値を切り替える場合について説明したが、制御を細かくし、多段階に切り替えることとしてもよい。
【００４４】
以上説明したように、本実施形態に係る制御装置１０ａ及び水中航走体によれば、船体２の旋回角度（制御対象の出力）と目標旋回角度（目標指令）との関係に応じて変化率制限値を変更する変化率制限値設定部２４を備えるので、フィードバック制御部１１において使用される制御ゲインを更に適切な値とすることができる。これにより、応答性を向上させることが可能となる。
【００４５】
なお、変化率制限部２３がレートリミッタを用いて制御ゲインの変化率を制限する場合には、変化率制限値設定部２４は、レートリミッタの立ち上がり制限値、立下り制限値を変更し、変化率制限部２３がローパスフィルタの場合には、変化率制限値設定部２４は、遮断周波数を変更し、変化率制限値２３が平均化処理を行うものである場合には、移動平均の回数等を変更することにより、変化率制限値を変更する。
【００４６】
〔第３実施形態〕
次に、本発明の第３実施形態に係る水中航走体及び制御装置について説明する。
上述した第１実施形態では、ゲイン取得部２２によって取得された制御ゲインに対して変化率の制限をかけていたが、本実施形態では、ゲイン取得部２２に入力される参照信号、すなわち、船体速度の変動を抑制することとしている。船体速度の変動を抑制することにより、ゲイン取得部２２によって取得される制御ゲインの変動を間接的に抑制することが可能となる。
【００４７】
図５は、本実施形態に係る水中航走体の制御装置１０ｂの機能ブロック図である。なお、図５は、上述した第１実施形態と同様に、旋回制御に関する機能のみを抽出して示したものである。
図５に示すように、本実施形態に係るゲインスケジューリング部１７は、参照信号である船体速度の変化率を制限する変化率制限部２７を有している。
【００４８】
変化率制限部２７は、入力情報である参照信号の変化率を所定の変化率制限値以下に制限する。これにより、ゲイン取得部２２に出力される参照信号の変動を変化率制限値以下に制限することが可能となり、制御ゲインの変動を抑制することができる。
変化率制限部２７としては、上述した第１実施形態と同様に、レートリミッタや平滑化手段等を採用することができる。
【００４９】
更に、変化率制限部２７の変化率制限値は、第１実施形態における変化率制限部２３のように固定とされていてもよいし、第２実施形態のように、変化率制限値が制御対象の出力である旋回角度と目標旋回角度との関係に応じて変更されるような構成とされていてもよい。
【００５０】
上記のように、本実施形態に係る制御装置１０ｂ及び水中航走体によれば、制御ゲインを決定する際に参照される参照信号の変動率を抑制するので、間接的に制御ゲインの変動を抑制することが可能となる。これにより、フィードバック制御を安定化させることができ、応答性を向上させることができるとともに、消費エネルギー増大を回避することができる。
【００５１】
なお、上記制御装置１０ｂでは、制御ゲインを決定する際の参照信号として船体速度を用いることとしたが、参照信号は、これに限られない。例えば、参照信号として、船体速度に関連する他のパラメータを用いることとしてもよいし、また、参照信号は１つに限られず複数のパラメータに基づいて制御ゲインを決定することとしてもよい。
【００５２】
また、上述の各実施形態では、本発明の一実施形態に係る制御装置１０、１０ａ，１０ｂが図１に示すような推進器を有する水中航走体１に適用される場合を例示して説明したが、制御装置１０、１０ａ、１０ｂが適用される水中航走体１の構成については特に限定されない。例えば、旋回制御が舵によって行われる水中航走体でもよいし、方位制御、ピッチ角制御に加えて、船首尾線方向回りのロール角制御が可能な水中航走体にも適用可能である。
また、フィードバック制御部１１は、比例積分微分制御を行うことで制御指令を生成することとしたが、これに代えて、比例積分制御を行うこととしてもよいし、積分制御を行うこととしてもよい。そして、フィードバック制御部１１の構成に対応した制御ゲインがゲインスケジューリング部１２によって調整される。
【符号の説明】
【００５３】
１  水中航走体
２  船体
３  主推進器
３ａ  右側推進プロペラ
３ｂ  左側推進プロペラ
４  水平推進器
４ａ  前方水平推進器
４ｂ  後方水平推進器
５  垂直推進器
５ａ  前方垂直推進器
５ｂ  後方垂直推進器
７ａ  前方水平プロペラ
７ｂ  後方水平プロペラ
９ａ  前方垂直プロペラ
９ｂ  後方垂直プロペラ
１０、１０ａ，１０ｂ  制御装置
１１  フィードバック制御部
１２、１５、１７  ゲインスケジューリング部
２１  記憶部
２２  ゲイン取得部
２３、２７  変化率制限部
２４  変化率制限値設定部
【図１】
0005822722.tif 000002
【図２】
0005822722.tif 000003
【図３】
0005822722.tif 000004
【図４】
0005822722.tif 000005
【図５】
0005822722.tif 000006