JP6004877B2 - 制御装置 - Google Patents
制御装置 Download PDFInfo
- Publication number
- JP6004877B2 JP6004877B2 JP2012221348A JP2012221348A JP6004877B2 JP 6004877 B2 JP6004877 B2 JP 6004877B2 JP 2012221348 A JP2012221348 A JP 2012221348A JP 2012221348 A JP2012221348 A JP 2012221348A JP 6004877 B2 JP6004877 B2 JP 6004877B2
- Authority
- JP
- Japan
- Prior art keywords
- rudder
- speed
- actuator
- control system
- control
- 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
- 230000006641 stabilisation Effects 0.000 claims description 50
- 238000011105 stabilization Methods 0.000 claims description 50
- 238000001514 detection method Methods 0.000 claims description 16
- 230000000087 stabilizing effect Effects 0.000 claims description 16
- 238000012546 transfer Methods 0.000 claims description 12
- 230000004044 response Effects 0.000 claims description 8
- 238000000034 method Methods 0.000 claims description 6
- 238000005457 optimization Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 39
- 230000004043 responsiveness Effects 0.000 description 11
- 229920006395 saturated elastomer Polymers 0.000 description 7
- 238000010587 phase diagram Methods 0.000 description 6
- 230000002123 temporal effect Effects 0.000 description 6
- 244000145845 chattering Species 0.000 description 3
- 238000012937 correction Methods 0.000 description 3
- 238000013461 design Methods 0.000 description 3
- 208000019901 Anxiety disease Diseases 0.000 description 1
- 206010011416 Croup infectious Diseases 0.000 description 1
- 230000036506 anxiety Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 201000010549 croup Diseases 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/14—Control of attitude or depth
- B63G8/20—Steering equipment
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/04—Control of altitude or depth
- G05D1/06—Rate of change of altitude or depth
- G05D1/0692—Rate of change of altitude or depth specially adapted for under-water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Mechanical Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
本発明は、制御装置に係り、特に、速度飽和が生ずるシステムに適用されて好適な制御装置に関するものである。
従来、水中航走体等の姿勢制御には、目標姿勢と現在の姿勢との差分に対して比例積分微分制御を行うことで得られた舵角指令を舵へ与え、船体の姿勢を目標姿勢に追従させることが行われている。
図２７に、一般的な従来の制御装置５０のブロック線図を示す。図２７に示すように、船体５１の姿勢θｐと目標指令θｐ＊との差分がＰＩＤ制御部５２に入力され、舵角指令φ＊が生成される。舵角指令φ＊は、舵５４を制御する舵制御系に与えられ、舵５４の舵角が舵角指令φ＊に追従するように制御される。このようにして、舵角指令φ＊に基づいて舵角が変化することで、船体５１の姿勢も変化し、船体５１の姿勢θｐが目標指令θｐ＊に近づくこととなる。
図２７に、一般的な従来の制御装置５０のブロック線図を示す。図２７に示すように、船体５１の姿勢θｐと目標指令θｐ＊との差分がＰＩＤ制御部５２に入力され、舵角指令φ＊が生成される。舵角指令φ＊は、舵５４を制御する舵制御系に与えられ、舵５４の舵角が舵角指令φ＊に追従するように制御される。このようにして、舵角指令φ＊に基づいて舵角が変化することで、船体５１の姿勢も変化し、船体５１の姿勢θｐが目標指令θｐ＊に近づくこととなる。
ところで、近年、目標姿勢に対する船体の応答性をより一層向上させることが要求されている。しかしながら、水中航走体等に設けられている舵は、舵角指令の急激な変化に追従することができないという速度飽和の要素を有している。このため、所定の振幅を超える領域或いは周波数が所定の周波数を超える領域の舵角指令が舵制御系に入力された場合には、実舵角がそのような指令に追従できず、速度飽和が生じてしまう（図９、図１６、図１７参照）。
速度飽和が生ずると、比較的大きな位相遅れが発生し、舵の応答性が極めて悪化する。これにより、例えば、船体の制御が振動してしまい、制御が不安定になるなどの問題があった。更に、このような速度飽和が懸念される水中航走体等では、船体の制御系に設けられているＰＩＤ制御部５２の制御ゲインを上げることができず、動作領域が制限されてしまうため、一層の応答性の悪化を招いていた。
従来は、このような速度飽和を解消する対策として、舵に与える舵角指令の範囲を速度飽和の発生しない周波数領域及び振幅領域に制限するという消極的な解決策しか取られていなかった。
本発明は、このような事情に鑑みてなされたものであって、速度飽和による位相遅れを低減し、制御の安定及び追従性の向上を図ることのできる制御装置を提供することを目的とする。
本発明の第１態様は、制御対象に対して操作量を与えるアクチュエータに速度飽和が生ずるシステムに適用され、前記制御対象を目標状態に一致させるための前記アクチュエータの制御指令を生成する前記制御対象の運動制御系と、前記アクチュエータの制御指令に前記アクチュエータの操作量を追従させるためのアクチュエータの制御系とを備える制御装置であって、前記アクチュエータの制御系のフィードバックループに設けられた位相進み補償要素を有する安定化フィルタと、前記アクチュエータの出力である操作量の速度を検出する速度検出手段と、前記速度検出手段によって検出された速度が前記アクチュエータの動作速度の上限値に基づいて設定された所定の閾値以上か否かを判定する判定手段と、前記判定手段によって、前記速度が前記閾値以上であると判定された場合に、前記安定化フィルタを挿入したフィードバックループとし、前記速度が前記閾値未満であると判定された場合に前記安定化フィルタを除いたフィードバックループとする切替手段とを具備する制御装置である。
このように、アクチュエータの制御系のフィードバックループに位相進み補償要素を有する安定化フィルタを設けることにより、アクチュエータの制御系の速度飽和に起因する位相遅れを低減でき、制御対象の運動制御系の制御を安定させることが可能となる。
更に、アクチュエータの動作速度に応じてフィードバックループを切り替えるので、例えば、アクチュエータの動作速度が速度飽和が生ずる速度に達していなかった場合には、安定化フィルタを経由せずに操作量をフィードバックさせることができる。これにより、速度飽和が発生しないときには、ハイゲインとならずに、従来通りの制御性能を発揮することが可能となる。この結果、より一層の制御の安定化を図ることが可能となる。
更に、アクチュエータの動作速度に応じてフィードバックループを切り替えるので、例えば、アクチュエータの動作速度が速度飽和が生ずる速度に達していなかった場合には、安定化フィルタを経由せずに操作量をフィードバックさせることができる。これにより、速度飽和が発生しないときには、ハイゲインとならずに、従来通りの制御性能を発揮することが可能となる。この結果、より一層の制御の安定化を図ることが可能となる。
本発明の第２態様は、制御対象に対して操作量を与えるアクチュエータに速度飽和が生ずるシステムに適用され、前記制御対象を目標状態に一致させるための前記アクチュエータの制御指令を生成する前記制御対象の運動制御系と、前記アクチュエータの制御指令に前記アクチュエータの操作量を追従させるためのアクチュエータの制御系とを備える制御装置であって、前記アクチュエータの制御系のフィードバックループに設けられた位相進み補償要素を有する安定化フィルタと、前記アクチュエータの出力である操作量の速度を検出する速度検出手段と、前記アクチュエータの出力である操作量の速度と重み付け値が関連付けられた情報に基づいて、前記速度検出手段によって検出された速度に対応する重み付け値を取得する重み付け取得手段と、前記重み付け取得手段によって取得された重み付け値を用いて、前記安定化フィルタが設けられたフィードバックループと、前記安定化フィルタが設けられていないフィードバックループとに重み付けをし、それぞれの前記フィードバックループの出力を加算した値を前記アクチュエータの制御系のフィードバック値とする演算手段とを具備する制御装置である。
このように、アクチュエータの制御系のフィードバックループに位相進み補償要素を有する安定化フィルタを設けることにより、アクチュエータの制御系の速度飽和に起因する位相遅れを低減でき、制御対象の運動制御系の制御を安定させることが可能となる。
更に、安定化フィルタを有していないフィードバックループと安定化フィルタを有しているフィードバックループとの切り替えを緩やかに行うことが可能となる。フィードバックループの切替に伴う舵角速度のチャタリングなどを回避することが可能となる。
更に、安定化フィルタを有していないフィードバックループと安定化フィルタを有しているフィードバックループとの切り替えを緩やかに行うことが可能となる。フィードバックループの切替に伴う舵角速度のチャタリングなどを回避することが可能となる。
上記制御装置において、前記安定化フィルタは、前記アクチュエータの制御系に含まれる速度飽和要素を、記述関数法を用いてモデル化し、前記記述関数を含めた前記アクチュエータの制御系で、前記制御対象の運動制御系の開ループ伝達関数を算出し、前記開ループ伝達関数のボード線図を作成し、前記ボード線図における周波数応答に基づいて作成されることとしてもよい。
上記制御装置において、前記アクチュエータの制御系に含まれる速度飽和要素を示す記述関数は、周波数領域に対応付けて、速度飽和しない場合、１周期のうちの一部において速度飽和する場合、１周期の全域において速度飽和する場合の３つの記述関数が設定されていてもよい。
このように、周波数領域に応じて区分し、それぞれの場合において記述関数を設定するので、安定化フィルタの設計精度を向上させることが可能となる。
本発明の第３態様は、舵の舵角を変化させることにより船体の姿勢を制御する水中航走体に適用され、前記船体を目標姿勢に一致させるための舵角指令を生成する船体の姿勢制御系と、前記舵角指令に舵角を追従させるための舵制御系とを備える制御装置であって、前記舵制御系のフィードバックループに設けられた位相進み補償要素を有する安定化フィルタと、舵角速度を検出する舵角速度検出手段と、前記舵角速度検出手段によって検出された舵角速度が前記舵の動作速度の上限値に基づいて設定された所定の閾値以上か否かを判定する判定手段と、前記判定手段によって、前記舵角速度が前記閾値以上であると判定された場合に、前記安定化フィルタを挿入したフィードバックループとし、前記舵角速度が前記閾値未満であると判定された場合に、前記安定化フィルタを除いたフィードバックループとする切替手段とを備える制御装置である。
本発明の第４態様は、舵の舵角を変化させることにより船体の姿勢を制御する水中航走体に適用され、前記船体を目標姿勢に一致させるための舵角指令を生成する船体の姿勢制御系と、前記舵角指令に舵角を追従させるための舵制御系とを備える制御装置であって、前記舵制御系のフィードバックループに設けられた位相進み補償要素を有する安定化フィルタと、舵角速度を検出する速度検出手段と、舵角速度と重み付け値が関連付けられた情報に基づいて、前記速度検出手段によって検出された前記舵角速度に対応する重み付け値を取得する重み付け取得手段と、前記重み付け取得手段によって取得された重み付け値を用いて、前記安定化フィルタが設けられたフィードバックループと、前記安定化フィルタが設けられていないフィードバックループとに重み付けをし、それぞれの前記フィードバックループの出力を加算した値を前記舵制御系のフィードバック値とする演算手段とを具備する制御装置である。
本発明の第４態様は、舵の舵角を変化させることにより船体の姿勢を制御する水中航走体に適用され、前記船体を目標姿勢に一致させるための舵角指令を生成する船体の姿勢制御系と、前記舵角指令に舵角を追従させるための舵制御系とを備える制御装置であって、前記舵制御系のフィードバックループに設けられた位相進み補償要素を有する安定化フィルタと、舵角速度を検出する速度検出手段と、舵角速度と重み付け値が関連付けられた情報に基づいて、前記速度検出手段によって検出された前記舵角速度に対応する重み付け値を取得する重み付け取得手段と、前記重み付け取得手段によって取得された重み付け値を用いて、前記安定化フィルタが設けられたフィードバックループと、前記安定化フィルタが設けられていないフィードバックループとに重み付けをし、それぞれの前記フィードバックループの出力を加算した値を前記舵制御系のフィードバック値とする演算手段とを具備する制御装置である。
本発明によれば、速度飽和による位相遅れを低減し、制御の安定及び追従性の向上を図ることができるという効果を奏する。
以下に、本発明の各実施形態に係る制御装置について、図面を参照して説明する。なお、本発明は、制御対象に対して操作量を与えるアクチュエータに速度飽和が生ずるシステムに広く適用されるものである。アクチュエータの一例としては、舵、翼などが挙げられ、制御対象の一例としては、船舶、水中航走体、飛翔体、航空機等が挙げられる。
以下、制御対象として水中航走体を、アクチュエータとして舵を想定した場合の実施形態について説明するが、本発明の制御装置は、この範囲に限定されるものではなく、上記のごとく、速度飽和が生ずるシステムに広く利用されるものである。
以下、制御対象として水中航走体を、アクチュエータとして舵を想定した場合の実施形態について説明するが、本発明の制御装置は、この範囲に限定されるものではなく、上記のごとく、速度飽和が生ずるシステムに広く利用されるものである。
〔第１実施形態〕
以下、本発明の第１実施形態に係る制御装置１について、図１を用いて説明する。
図１は、本実施形態に係る制御装置１のブロック線図の一例を示している。図１に示すように、制御装置１が適用される水中航走体は、舵１０の舵角を変化させることにより船体２の姿勢を制御するものである。
以下、本発明の第１実施形態に係る制御装置１について、図１を用いて説明する。
図１は、本実施形態に係る制御装置１のブロック線図の一例を示している。図１に示すように、制御装置１が適用される水中航走体は、舵１０の舵角を変化させることにより船体２の姿勢を制御するものである。
制御装置１は、メジャーループである船体の姿勢制御系（制御対象の運動制御系）２０と、マイナーループである舵制御系（アクチュエータの制御系）３０とを主な構成として備えている。
船体の姿勢制御系２０は、船体２の姿勢θｐを目標姿勢θｐ＊に一致させるための舵１０への舵角指令φ＊を生成する制御系であり、船体２の姿勢θｐをフィードバックするフィードバックループ２１と、この姿勢θｐと目標姿勢θｐ＊との差分を算出する差分演算部２２と、差分演算部２２の出力に対して比例積分微分制御を行い、舵制御系３０に対する舵角指令φ＊を生成するＰＩＤ制御部２３と、外乱を推定してその外乱を相殺するような外乱補正値τｐを出力する外乱制御部２４と、舵角指令φ＊から外乱補正値τｐを減算することにより、最終的な舵角指令φｃ＊を算出する差分演算部２５とを主な構成として備えている。
船体の姿勢制御系２０は、船体２の姿勢θｐを目標姿勢θｐ＊に一致させるための舵１０への舵角指令φ＊を生成する制御系であり、船体２の姿勢θｐをフィードバックするフィードバックループ２１と、この姿勢θｐと目標姿勢θｐ＊との差分を算出する差分演算部２２と、差分演算部２２の出力に対して比例積分微分制御を行い、舵制御系３０に対する舵角指令φ＊を生成するＰＩＤ制御部２３と、外乱を推定してその外乱を相殺するような外乱補正値τｐを出力する外乱制御部２４と、舵角指令φ＊から外乱補正値τｐを減算することにより、最終的な舵角指令φｃ＊を算出する差分演算部２５とを主な構成として備えている。
舵制御系３０は、舵１０の舵角φを舵角指令φｃ＊に一致させるための制御系であり、舵１０の舵角φをフィードバックするフィードバックループ３１と、フィードバックループ３１に設けられた安定化フィルタ３２と、安定化フィルタ３２を介して出力された舵角φ´と舵角指令φｃ＊との差分を算出する差分演算部３３とを主な構成として備えている。
ここで、安定化フィルタ３２は、舵１０の速度飽和による位相遅れを低減させるためのフィルタであり、例えば、位相進み補償要素を有している。この安定化フィルタ３２の設計手法の詳細については後述する。
また、上記ＰＩＤ制御部２３は、舵１０が非線形要素を含まない場合を想定して設計されている。
ここで、安定化フィルタ３２は、舵１０の速度飽和による位相遅れを低減させるためのフィルタであり、例えば、位相進み補償要素を有している。この安定化フィルタ３２の設計手法の詳細については後述する。
また、上記ＰＩＤ制御部２３は、舵１０が非線形要素を含まない場合を想定して設計されている。
このような制御装置１によれば、船体２の姿勢θｐがフィードバックされ、船体２の姿勢θｐと目標姿勢θｐ＊との差分がＰＩＤ制御部２３に出力される。ＰＩＤ制御部２３では、この入力に対して船体２の姿勢θｐを目標姿勢θｐ＊に追従させるための舵角指令φ＊が生成される。舵角指令φ＊は差分演算部２５において、外乱制御部２４からの外乱補正値τｐが差し引かれ、最終的な舵角指令φｃ＊が舵制御系３０に入力される。
舵制御系３０では、舵の実舵角φが安定化フィルタ３２を経由することにより、位相が補償されてフィードバックされる。差分演算部３３において、フィードバックされた位相補償後の舵角φ´と船体の姿勢制御系２０からの舵角指令φｃ＊との差分が算出され、この差分が舵指令として舵１０に与えられる。これにより、舵１０の角度が変化し、船体２の姿勢が目標姿勢に追従する。
次に、上述した安定化フィルタ３２の設計手順について図を参照して説明する。
まず、舵制御系に含まれる速度飽和要素Ｎ（ａ，ω）を、記述関数法を用いてモデル化する。舵の速度飽和の発生状況は、周波数と振幅に依存する。そこで、本実施形態では、周波数領域に応じて、速度飽和しない場合、１周期のうちの一部において速度飽和する場合、１周期の全域において速度飽和する場合の３つの場合に区分し、それぞれの周波数領域における速度飽和要素の記述関数を定義する。
まず、舵制御系に含まれる速度飽和要素Ｎ（ａ，ω）を、記述関数法を用いてモデル化する。舵の速度飽和の発生状況は、周波数と振幅に依存する。そこで、本実施形態では、周波数領域に応じて、速度飽和しない場合、１周期のうちの一部において速度飽和する場合、１周期の全域において速度飽和する場合の３つの場合に区分し、それぞれの周波数領域における速度飽和要素の記述関数を定義する。
具体的には、周波数ωがオンセット周波数ωonset未満の場合には、図２に示すように、舵角及び速度は、舵角指令及び舵角速度指令にそれぞれ一致して変化し、速度飽和は生じない。従って、以下の（１）式のように記述関数を定義する。なお、図２において図２（ａ）は角度の時間的変化、図２（ｂ）は速度の時間的変化を示している。
また、周波数ωがオンセット周波数ωonset以上完全飽和周波数ωg未満の場合には、図３に示すように、１周期のうちの一部（図３では、τ１からτ２の期間以外）で速度飽和が生ずることから、（２）式のように記述関数を定義する。図３において図３（ａ）は角度の時間的変化、図３（ｂ）は速度の時間的変化を示している。
上記（２）式において、τ１は速度飽和が発生している状態から発生していない状態へ切り替わる時刻、τ２は速度飽和が発生していない状態から発生する状態へ切り替わる時刻である。また、オンセット周波数ωonset及び完全飽和周波数ωgは、以下の（３）式、（４）式で定義される。（４）式において、ＶＬはアクチュエータの最大速度、ａはアクチュエータに入力される舵角指令の振幅である。
また、周波数ωが完全飽和周波数ωg以上の場合には、図４に示すように、１周期の全域で速度飽和が生ずることから、（５）式のように記述関数を定義する。図４において図４（ａ）は角度の時間的変化、図４（ｂ）は速度の時間的変化を示している。
次に、上記各周波数領域における記述関数を用いて、図５に示すような船体の姿勢制御系の開ループ伝達関数を算出する。このとき、舵制御系は、速度飽和要素（非線形要素）を含むものとして取り扱われる。図５に示した船体運動制御系の開ループ伝達関数は、例えば、以下の（６）式で与えられる。
（５）式においてＧＰＩＤは、ＰＩＤ制御部２３の伝達関数、ＧＰは船体モデル、ＧＳＶは舵１０の線形モデルである。また、Ｎ（ａ，ω）は舵１０の速度飽和要素であり、対象となる周波数領域に応じて上記（１）式、（２）式、（５）式で表わされる。
次に、上記（６）式の開ループ伝達関数を用いて安定判定を行う。この安定判定は、（６）式の開ループ伝達関数を用いて、入力の振幅と周波数を変化させたときのナイキスト線図に基づいて行われる。具体的には、入力の振幅が最大となるベクトル軌跡が座標（−１，０）を左に見る場合には安定、左に見ない場合には不安定と判定する。
具体的には、（６）式の開ループ伝達関数において、舵１０の振幅（舵の動作舵角）を下限値から上限値まで離散的に変化させたときのナイキスト線図を作成する。図６及び図８は、舵１０の振幅の上限値を１００％とし、舵１０の振幅を３％、１４％、７１％、１００％にそれぞれ変化させたときのナイキスト線図の一例を示している。図６は現行制御時、図８は制御ゲインを現行制御の１．５倍としたときのものである。
図６に示したナイキスト線図では、最大振幅１００％のときでも、座標（−１，０）を左に見ているので、制御は安定していると判定される。このため、例えば、図７に示すように、船体ピッチ角（図７（ａ）参照）、舵角（図７（ｂ）参照）、舵角速度（図７（ｃ）参照）の各指令に対する追従性は優れており、制御が安定していることがわかる。
これに対し、図８に示したナイキスト線図では、最大振幅１００％のときに、座標（−１，０）を右に見ているので、制御は不安定であると判定される。このため、例えば、図９に示すように、船体ピッチ角（図９（ａ）参照）、舵角（図９（ｂ）参照）、舵角速度（図９（ｃ）参照）の各指令に対する追従性は極めて悪く、制御が不安定であることがわかる。特に、舵角の速度飽和が発生し、位相遅れが増大しており、船体ピッチ角制御が不安定となっている。
次に、図８に示したように、ナイキスト線図を用いた安定性判定において、制御が不安定であると判定された場合には、安定化フィルタが必要であると判断し、安定化フィルタの作成を行う。なお、速度飽和が発生することが確実に分かっている場合には、上述したナイキスト線図による安定判定は省略することも可能である。
安定化フィルタの設計では、（６）式の開ループ伝達関数を用いてボード線図、すなわち、ゲイン線図と位相線図とを作成する。図１０にゲイン線図の一例を、図１１に位相線図の一例を示す。ゲイン線図及び位相線図から、速度飽和による位相遅れが発生している周波数領域を特定することができる。したがって、位相遅れが発生している周波数領域において、位相が進むような安定化フィルタを設計することで、速度飽和による位相遅れを低減させることができる。
例えば、位相遅れが発生し始める周波数から制御応答させたい周波数の１０倍程度までの位相を進めるような安定化フィルタの時定数を決定する。
ここでは、一例として、周波数ｆｍｉｎ[Ｈｚ]からｆｍａｘ[Ｈｚ]までの位相を進めることとし、以下の（７）式のような位相進み補償要素を設計する。
例えば、位相遅れが発生し始める周波数から制御応答させたい周波数の１０倍程度までの位相を進めるような安定化フィルタの時定数を決定する。
ここでは、一例として、周波数ｆｍｉｎ[Ｈｚ]からｆｍａｘ[Ｈｚ]までの位相を進めることとし、以下の（７）式のような位相進み補償要素を設計する。
上記（７）式で示される位相進み補償要素のゲイン線図を図１２に、位相線図を図１３に示す。
そして、図１４に示すように、上記手順で設計した進み位相補償要素を有する安定化フィルタ３２を舵制御系３０のフィードバックループ３１に設けることで、速度飽和による位相遅れを低減させることが可能となる。なお、図１４に示したブロック線図では、外乱制御部を省略している。
そして、このような安定化フィルタ３２を設けた場合の制御の安定性を再度ナイキスト線図を作成することで確認する。図１５は、安定化フィルタ３２を設けた後のナイキスト線図を示している。このように、舵１０の振幅を最大にした場合でも、座標（−１，０）の点を左に見ることができ、速度飽和要素を含めた制御系の安定化が実現できていることがわかる。
そして、このような安定化フィルタ３２を設けた場合の制御の安定性を再度ナイキスト線図を作成することで確認する。図１５は、安定化フィルタ３２を設けた後のナイキスト線図を示している。このように、舵１０の振幅を最大にした場合でも、座標（−１，０）の点を左に見ることができ、速度飽和要素を含めた制御系の安定化が実現できていることがわかる。
以上、本実施形態に係る制御装置１によれば、舵を制御する舵制御系３０のフィードバックループに位相進み補償要素を有する安定化フィルタ３２を設けたので、速度飽和による位相遅れを低減することができ、船体の姿勢制御系の制御を安定化させることができる。これにより、船体の姿勢制御の速度飽和要素による不安定化の解消しつつ応答性を向上させることが可能となる。
図１６及び図１７は、図２７に示した従来の制御装置５０に、速度飽和が生じる舵の舵角指令を与えた場合の応答性を示した図であり、図１６は舵角指令と実舵角との関係を、図１７は舵角速度指令と実舵角速度との関係を示した図である。また、図１８及び図１９は、図１に示した本実施形態に係る制御装置１に、速度飽和が生じる舵の制御指令を与えた場合の応答性を示した図であり、図１８は、舵角指令と実舵角との関係を、図１９は舵角速度指令と実舵角速度との関係を示した図である。
図１６及び図１７に示すように、従来の制御装置５０では、舵角指令、舵角速度指令に対する応答に速度飽和が発生し、１７０ｄｅｇの位相遅れが生じており、追従性が極めて悪いことがわかる。これに対し、図１８及び図１９に示すように、本実施形態に係る制御装置１によれば、舵角指令の位相遅れを５３ｄｅｇにまで低減することができ、また、図１７に示されているような速度飽和も発生していないことがわかる。このように、本実施形態に係る制御装置１によれば、従来に比べて速度飽和に対する不安性を解消するとともに高い応答性を実現することができる。
〔第２実施形態〕
次に、本発明の第２実施形態に係る制御装置について説明する。本実施形態に係る制御装置は、図２０に示すように、図１に示した制御装置１の構成に加えて、舵角速度検出部（速度検出手段）３４、判定部（判定手段）３５、及び切替部（切替手段）３６を更に備えている。
次に、本発明の第２実施形態に係る制御装置について説明する。本実施形態に係る制御装置は、図２０に示すように、図１に示した制御装置１の構成に加えて、舵角速度検出部（速度検出手段）３４、判定部（判定手段）３５、及び切替部（切替手段）３６を更に備えている。
舵角速度検出部３４は、実舵角φが入力され、この実舵角φを微分することにより、舵角速度を算出する。ここで、舵角速度検出部３４は、帯域制限付きの微分器とされていてもよい。
判定部３５は、舵角速度検出部３４によって検出された舵角速度が、舵１０の動作速度の上限値に基づいて設定された所定の閾値以上か否かを判定する。例えば、閾値は、動作速度の上限値の９０％付近に設定される。
切替部３６は、判定部３５によって舵角速度が閾値以上であると判定された場合に、安定化フィルタを挿入したフィードバックループ３１ｂとし、舵角速度が閾値未満であると判定された場合に、安定化フィルタ３２を除いたフィードバックループ３１ａとする。
判定部３５は、舵角速度検出部３４によって検出された舵角速度が、舵１０の動作速度の上限値に基づいて設定された所定の閾値以上か否かを判定する。例えば、閾値は、動作速度の上限値の９０％付近に設定される。
切替部３６は、判定部３５によって舵角速度が閾値以上であると判定された場合に、安定化フィルタを挿入したフィードバックループ３１ｂとし、舵角速度が閾値未満であると判定された場合に、安定化フィルタ３２を除いたフィードバックループ３１ａとする。
これにより、例えば、舵角速度が速度飽和が発生しないような速度である場合には、安定化フィルタ３２が設けられていないフィードバックループ３１ａを通じて実舵角φがそのままフィードバックされる。一方、速度飽和が発生するような舵角速度の場合には、安定化フィルタ３２が設けられたフィードバックループ３１ｂを通じて位相補償がなされた実舵角φ´がフィードバックされる。
これにより、舵１０の動作状態に応じて適切な制御系を選択することができ、より一層の制御の安定化を図ることが可能となる。
これにより、舵１０の動作状態に応じて適切な制御系を選択することができ、より一層の制御の安定化を図ることが可能となる。
図２１及び図２２は、図２０に示した本実施形態に係る制御装置に、速度飽和が生じる舵１０の制御指令を与えた場合の応答性を示した図であり、図２１は、舵角指令と実舵角との関係を、図２２は舵角速度指令と実舵角速度との関係を示した図である。
図２１に示すように、本実施形態に係る制御装置によれば、位相遅れを３９ｄｅｇにまで低減することができた。この結果は、図１６及び図１７に示した従来の制御装置５０の場合に比べて、位相遅れを７７％低減できたこととなる。また、図１８及び図１９に示した第１実施形態に係る制御装置１に比べて、位相遅れを更に低減できていることがわかる。このように、安定化フィルタ３２の切替機能を設けることにより、船体の姿勢制御の応答性向上を更に期待することができる。
〔第３実施形態〕
次に、本発明の第３実施形態に係る制御装置について説明する。本実施形態に係る制御装置は、図２３に示すように、図１に示した制御装置１の構成に加えて、舵角速度検出部３４、重み付け取得部３７、及び演算部３８を更に備えている。
次に、本発明の第３実施形態に係る制御装置について説明する。本実施形態に係る制御装置は、図２３に示すように、図１に示した制御装置１の構成に加えて、舵角速度検出部３４、重み付け取得部３７、及び演算部３８を更に備えている。
舵角速度検出部３４は、実舵角φが入力され、この実舵角を微分することにより、舵角速度を算出する。
重み付け取得部３７は、舵角速度と重み付け値が関連付けられたテーブルまたは演算式を有しており、舵角速度検出部３４によって検出された舵角速度に対応する重み付け値を取得する。図２４に、重み付けテーブルの一例を示す。図２４において、横軸は舵角速度［％］、縦軸は重み付け値α（０≦α≦１）である。重み付け値αは、舵１０が追従可能な最大速度、換言すると、速度飽和が生ずる舵角速度を１００％としたときに、その５０％から徐々に重み付けが０から１に向けて比例増加するように設定されている。
重み付け取得部３７は、舵角速度と重み付け値が関連付けられたテーブルまたは演算式を有しており、舵角速度検出部３４によって検出された舵角速度に対応する重み付け値を取得する。図２４に、重み付けテーブルの一例を示す。図２４において、横軸は舵角速度［％］、縦軸は重み付け値α（０≦α≦１）である。重み付け値αは、舵１０が追従可能な最大速度、換言すると、速度飽和が生ずる舵角速度を１００％としたときに、その５０％から徐々に重み付けが０から１に向けて比例増加するように設定されている。
演算部３８は、重み付け取得部３７によって取得された重み付け値αを用いて、安定化フィルタ３２が設けられたフィードバックループ３１ｂと、安定化フィルタ３２が設けられていないフィードバックループ３１ａとに重み付けをし、それぞれのフィードバックループの出力を加算した値を舵制御系３０ｂのフィードバック値とする。具体的には、安定化フィルタ３２の出力φ´に重み付け値αを乗じた値αφ´と、実舵角φに（１−α）を乗じた値（１−α）φとを加算した値（＝αφ´＋（１−α）φ）を舵制御系３０の差分演算部３３にフィードバックする。
これにより、例えば、舵角速度が速度飽和が発生する舵角速度の５０％未満であるときには、実舵角φが差分演算部３３にフィードバックされ、舵角速度が速度飽和が発生する舵角速度であった場合（すなわち、１００％以上の場合）には、安定化フィルタ３２を経由することにより位相進み補償のなされた舵角φ´が差分演算部３３にフィードバックされる。また、舵角速度が速度飽和が発生する舵角速度の５０％以上から１００％未満である場合には、安定化フィルタ３２を経由した舵角φ´と安定化フィルタ３２を経由していない実舵角φとが舵角速度に応じた重み付け値で重み付けされ、それらを加算した値が差分演算部３３にフィードバックされる。このとき、舵角速度が大きいほど安定化フィルタを経由した舵角φ´の配分が大きくなるように調整される。
このように、舵角速度に応じて重み付けを行うことで、安定化フィルタを有していないフィードバックループ３１ａと安定化フィルタ３２を有しているフィードバックループ３１ｂとの切り替えを緩やかに行うことが可能となる。これにより、フィードバックループの切替に伴う不安定要素を排除することが可能となる。
図２５及び図２６は、図２３に示した本実施形態に係る制御装置に、速度飽和が生じる舵の制御指令を与えた場合の応答性を示した図であり、図２５は、舵角指令と実舵角との関係を、図２６は舵角速度指令と実舵角速度との関係を示した図である。
図２５及び図２６に示すように、位相遅れを４０ｄｅｇにまで低減することができた。この結果は、図１６及び図１７に示した従来の制御装置５０の場合に比べて、位相遅れを７６％低減できたこととなる。また、図２１及び図２２に示した第２実施形態に係る制御装置１に比べて、スイッチ切替に伴う舵角速度のチャタリングを解消できていることがわかる。このように、安定化フィルタ３２を有しないフィードバックループ３１ａと安定化フィルタ３２を有するフィードバックループ３１ｂとの切替を緩やかに行うことにより、船体の姿勢制御の応答性向上が期待できるとともに舵のチャタリングを抑制することができる。
１ 制御装置
２ 船体
１０ 舵
２０ 船体の姿勢制御系
２１、３１ フィードバックループ
２２、２５、３３ 差分演算部
２３ ＰＩＤ制御部
２４ 外乱制御部
３０ 舵制御系
３２ 安定化フィルタ
３４ 舵角速度検出部
３５ 判定部
３６ 切替部
３７ 重み付け取得部
３８ 演算部
２ 船体
１０ 舵
２０ 船体の姿勢制御系
２１、３１ フィードバックループ
２２、２５、３３ 差分演算部
２３ ＰＩＤ制御部
２４ 外乱制御部
３０ 舵制御系
３２ 安定化フィルタ
３４ 舵角速度検出部
３５ 判定部
３６ 切替部
３７ 重み付け取得部
３８ 演算部
Claims (6)
- 制御対象に対して操作量を与えるアクチュエータに速度飽和が生ずるシステムに適用され、前記制御対象を目標状態に一致させるための前記アクチュエータの制御指令を生成する前記制御対象の運動制御系と、前記アクチュエータの制御指令に前記アクチュエータの操作量を追従させるためのアクチュエータの制御系とを備える制御装置であって、
前記アクチュエータの制御系のフィードバックループに設けられた位相進み補償要素を有する安定化フィルタと、
前記アクチュエータの出力である操作量の速度を検出する速度検出手段と、
前記速度検出手段によって検出された速度が前記アクチュエータの動作速度の上限値に基づいて設定された所定の閾値以上か否かを判定する判定手段と、
前記判定手段によって、前記速度が前記閾値以上であると判定された場合に、前記安定化フィルタを挿入したフィードバックループとし、前記速度が前記閾値未満であると判定された場合に前記安定化フィルタを除いたフィードバックループとする切替手段と
を具備する制御装置。 - 制御対象に対して操作量を与えるアクチュエータに速度飽和が生ずるシステムに適用され、前記制御対象を目標状態に一致させるための前記アクチュエータの制御指令を生成する前記制御対象の運動制御系と、前記アクチュエータの制御指令に前記アクチュエータの操作量を追従させるためのアクチュエータの制御系とを備える制御装置であって、
前記アクチュエータの制御系のフィードバックループに設けられた位相進み補償要素を有する安定化フィルタと、
前記アクチュエータの出力である操作量の速度を検出する速度検出手段と、
前記アクチュエータの出力である操作量の速度と重み付け値が関連付けられた情報に基づいて、前記速度検出手段によって検出された速度に対応する重み付け値を取得する重み付け取得手段と、
前記重み付け取得手段によって取得された重み付け値を用いて、前記安定化フィルタが設けられたフィードバックループと、前記安定化フィルタが設けられていないフィードバックループとに重み付けをし、それぞれの前記フィードバックループの出力を加算した値を前記アクチュエータの制御系のフィードバック値とする演算手段と
を具備する制御装置。 - 前記安定化フィルタは、
前記アクチュエータの制御系に含まれる速度飽和要素を、記述関数法を用いてモデル化し、
記述関数を含めた前記アクチュエータの制御系で、前記制御対象の運動制御系の開ループ伝達関数を算出し、
前記開ループ伝達関数のボード線図を作成し、
前記ボード線図における周波数応答に基づいて作成される請求項１または請求項２に記載の制御装置。 - 前記アクチュエータの制御系に含まれる速度飽和要素を示す前記記述関数は、周波数領域に対応付けて、速度飽和しない場合、１周期のうちの一部において速度飽和する場合、１周期の全域において速度飽和する場合の３つの記述関数が設定されている請求項３に記載の制御装置。
- 舵の舵角を変化させることにより船体の姿勢を制御する水中航走体に適用され、前記船体を目標姿勢に一致させるための舵角指令を生成する船体の姿勢制御系と、前記舵角指令に舵角を追従させるための舵制御系とを備える制御装置であって、
前記舵制御系のフィードバックループに設けられた位相進み補償要素を有する安定化フィルタと、
舵角速度を検出する舵角速度検出手段と、
前記舵角速度検出手段によって検出された舵角速度が前記舵の動作速度の上限値に基づいて設定された所定の閾値以上か否かを判定する判定手段と、
前記判定手段によって、前記舵角速度が前記閾値以上であると判定された場合に、前記安定化フィルタを挿入したフィードバックループとし、前記舵角速度が前記閾値未満であると判定された場合に、前記安定化フィルタを除いたフィードバックループとする切替手段と
を備える制御装置。 - 舵の舵角を変化させることにより船体の姿勢を制御する水中航走体に適用され、前記船体を目標姿勢に一致させるための舵角指令を生成する船体の姿勢制御系と、前記舵角指令に舵角を追従させるための舵制御系とを備える制御装置であって、
前記舵制御系のフィードバックループに設けられた位相進み補償要素を有する安定化フィルタと、
舵角速度を検出する速度検出手段と、
舵角速度と重み付け値が関連付けられた情報に基づいて、前記速度検出手段によって検出された前記舵角速度に対応する重み付け値を取得する重み付け取得手段と、
前記重み付け取得手段によって取得された重み付け値を用いて、前記安定化フィルタが設けられたフィードバックループと、前記安定化フィルタが設けられていないフィードバックループとに重み付けをし、それぞれの前記フィードバックループの出力を加算した値を前記舵制御系のフィードバック値とする演算手段と
を具備する制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2012221348A JP6004877B2 (ja) | 2012-10-03 | 2012-10-03 | 制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2012221348A JP6004877B2 (ja) | 2012-10-03 | 2012-10-03 | 制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2014073729A JP2014073729A (ja) | 2014-04-24 |
| JP6004877B2 true JP6004877B2 (ja) | 2016-10-12 |
Family
ID=50748253
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2012221348A Active JP6004877B2 (ja) | 2012-10-03 | 2012-10-03 | 制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP6004877B2 (ja) |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP5976530B2 (ja) * | 2012-12-28 | 2016-08-23 | 三菱重工業株式会社 | 制御装置 |
| JP6655166B2 (ja) | 2016-03-17 | 2020-02-26 | ジヤトコ株式会社 | 無段変速機の制御装置及び無段変速機の制御方法 |
| JP6806462B2 (ja) * | 2016-05-19 | 2021-01-06 | 三菱重工業株式会社 | 水中航走体制御装置、水中航走システム、水中航走体制御方法及びプログラム |
| CN116774715B (zh) * | 2023-05-31 | 2024-06-07 | 新兴际华(北京)智能装备技术研究院有限公司 | 水下航行器姿态控制方法及装置 |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6028002B2 (ja) * | 1973-11-16 | 1985-07-02 | 富士重工業株式会社 | 飛しよう体の操舵制御方式 |
| JPS5625095A (en) * | 1979-08-02 | 1981-03-10 | Mitsubishi Heavy Ind Ltd | Automatic steering gear for ship |
| JPS59142603A (ja) * | 1983-02-01 | 1984-08-15 | Sanyo Denki Kk | 高ゲインフイ−ドバツク制御系 |
| JP3381880B2 (ja) * | 1994-07-06 | 2003-03-04 | 株式会社安川電機 | サーボ系の制御装置 |
-
2012
- 2012-10-03 JP JP2012221348A patent/JP6004877B2/ja active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP2014073729A (ja) | 2014-04-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Miao et al. | Compound line-of-sight nonlinear path following control of underactuated marine vehicles exposed to wind, waves, and ocean currents | |
| Huang et al. | A new guidance law for trajectory tracking of an underactuated unmanned surface vehicle with parameter perturbations | |
| Kori et al. | Extended state observer based robust control of wing rock motion | |
| Wang et al. | Integrated guidance and control for hypersonic vehicles in dive phase with multiple constraints | |
| WO2018099198A1 (zh) | 无人机姿态控制方法、装置及无人机 | |
| CN111045432B (zh) | 一种欠驱动水面船非线性路径跟踪控制***及方法 | |
| Nair et al. | Lyapunov based PD/PID in model reference adaptive control for satellite launch vehicle systems | |
| CN107844123A (zh) | 一种非线性飞行器航迹控制方法 | |
| JP5993125B2 (ja) | 船舶用自動操舵装置 | |
| JP6004877B2 (ja) | 制御装置 | |
| Yu et al. | Attitude tracking control of a quadrotor UAV in the exponential coordinates | |
| Mu et al. | Continuous sliding mode controller with disturbance observer for hypersonic vehicles | |
| Wiese et al. | Adaptive control of a generic hypersonic vehicle | |
| US11669055B2 (en) | Vibration suppression device, method and computer-readable medium using estimated vibration torque | |
| CN112180965A (zh) | 一种高精度过载控制方法 | |
| JP5052165B2 (ja) | 船舶用自動操舵装置 | |
| Zhang et al. | Robust nonlinear close formation control of multiple fixed-wing aircraft | |
| Trivedi et al. | Roll stabilization: a higher-order sliding-mode approach | |
| McNinch et al. | Sliding mode setpoint control of an underactuated surface vessel: simulation and experiment | |
| JP2016215357A (ja) | パラメータ推定装置、パラメータ推定方法、プログラム及び制御装置 | |
| JP2015195009A (ja) | スライディングモード制御方法及びスライディングモード制御装置 | |
| Bachtiar et al. | Nonlinear model predictive missile control with a stabilising terminal constraint | |
| Zeng et al. | Suppression of the aeroelastic/aeroservoelastic interaction using adaptive feedback control instead of notching filters | |
| JP3493347B2 (ja) | 自動制御装置 | |
| JP5984608B2 (ja) | 制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20150625 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20160325 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20160426 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20160624 |
|
| 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: 20160809 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20160906 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 6004877 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |