JP2022160019A - 船舶の方位制御装置および方位制御方法 - Google Patents

Abstract

【課題】情報処理に過大な記憶容量と計算時間を必要とせず、変化する船体パラメータをオンラインで算定して制御ゲインを適応的に調整し、外乱に対応できる方位制御装置および方位制御方法を得ることを目的とする。【解決手段】方位指令生成部によって生成された方位指令信号、ヨー角信号、ヨー角速度信号、に基づいて船舶を進行すべき方位へ向かわせる舵角指令信号を出力する方位制御部、舵角指令信号に基づいて舵を制御する舵角制御部、舵角検出部によって出力された舵角信号に対するヨー角信号およびヨー角速度信号の周波数特性を算定して方位制御部の制御ゲインを調整する制御ゲイン調整部、を備えた船舶の方位制御装置。【選択図】図１

Description

本願は、船舶の方位制御装置および方位制御方法に関するものである。

船舶の進む方向を指定の進路に乗せ、維持するべく操舵する方位制御装置が存在する。船舶の方位制御装置のことを、船舶の自動操舵装置またはオートパイロットとも称する。船舶の方位制御装置は、船舶の重心を通る上下方向の軸の周りの回転角度であるヨー角を、指示された方位に一致させるように舵を制御する。

船舶の方位制御装置は、指示方位に船首方位（ヨー角）を追従させるために舵を制御する装置である。指示方位と船首方位との偏差に対して、所定の制御ゲインを乗じて舵角指令を生成し、舵角指令に従って舵を制御する。船舶の方位制御装置は、舵駆動部によって舵を駆動する。舵駆動部は舵を駆動し、船体にヨーレートを誘起させて船首方位を変化させる。

船舶の方位制御装置では、潮流、波浪、風雨等の船舶への外乱要因に対して、船体の振動が助長されることを予防するために、制御ゲインを最適化しなければならない。制御ゲインは、船体パラメータに基づいて決定することができる。しかしながら、船体パラメータは、船速、喫水の変化等によって変動する。

そこで、船体パラメータの変化への対応が必要とされる。実際の船舶を航走させて、入力データ（舵角）と出力データ（船首方位）を蓄積する。蓄積されたデータ群に対して、予め船体パラメータを仮決めして構築した船体モデルに入力データ（舵角）を流し込み、出力データ（船首方位）を算出する。この算出された船首方位と、実際に計測した船首方位との比較結果から、船体パラメータを調節（修正）する技術が開示されている（例えば特許文献１）。

特開２００６－３２１４５５号公報

しかしながら、特許文献１の船舶の方位制御装置にあっては、舵角指令と船首方位のデータを蓄積してＳＱＰ(Sequential Quadratic Programming)のアルゴリズムを用いて船体パラメータを同定するため、船舶の方位制御装置の情報処理には多くの記憶容量と計算時間を必要とする。その結果、大きなメモリ容量と高速かつ高機能の演算処理装置が必要となり、船舶の方位制御装置のコストアップにつながる。また、同定対象とする船体モデルに、単純な１次のモデルを使用すると、変針時にオーバーシュートが発生しない。このため、船速によってヨーイング振動が生じるような船体には対応できないといった課題がある。

また、制御ゲインの最適化のためには、船速が変化した際に船体パラメータを再度算定する必要がある。しかし、先行技術の方法では記憶容量と計算時間を要するため、即座に船体パラメータの修正ができないといった課題がある。

本願は、上記のような問題点を解決するためになされたものであり、情報処理に過大な記憶容量と計算時間を必要とせず、変化する船体パラメータをオンラインで算定して制御ゲインを適切に調整し、外乱に対応できる方位制御装置および方位制御方法を得ることを目的とする。

本願に係る船舶の方位制御装置は、
船舶が進行すべき方位を示す方位指令信号を生成する方位指令生成部、
船舶の重心を通る上下方向の軸の周りの回転角度を示すヨー角信号を出力するヨー角検出部、
船舶の重心を通る上下方向の軸の周りの回転角速度を示すヨー角速度信号を出力するヨー角速度検出部、
船舶の舵の角度を示す舵角信号を出力する舵角検出部、
方位指令生成部によって生成された方位指令信号と、ヨー角検出部によって出力されたヨー角信号と、ヨー角速度検出部によって出力されたヨー角速度信号と、に基づいて船舶を進行すべき方位へ向かわせる舵角指令信号を出力する方位制御部、
方位制御部によって出力された舵角指令信号に基づいて舵を制御する舵角制御部、
舵角検出部によって出力された舵角信号に対するヨー角信号およびヨー角速度信号の周波数特性を算定して方位制御部の制御ゲインを調整する制御ゲイン調整部、を備えたものである。

また、本願に係る船舶の方位制御方法は、
方位指令生成部によって船舶が進行すべき方位を示す方位指令信号が生成されるステップと、
ヨー角検出部によって船舶の重心を通る上下方向の軸の周りの回転角度を示すヨー角信号が出力されるステップと、
ヨー角速度検出部によって船舶の重心を通る上下方向の軸の周りの回転角速度を示すヨー角速度信号が出力されるステップと、
舵角検出部によって船舶の舵の角度を示す舵角信号が出力されるステップと、
方位制御部によって方位指令生成部が生成した方位指令信号と、ヨー角検出部が出力したヨー角信号と、ヨー角速度検出部が出力したヨー角速度信号と、に基づいて船舶を進行すべき方位へ向かわせる舵角指令信号が出力されるステップと、
舵角制御部によって舵角指令信号に基づいて舵が制御されるステップと、
制御ゲイン調整部によって、舵角検出部によって出力された舵角信号に対してヨー角信号およびヨー角速度信号の周波数特性が算定され、方位制御部の制御ゲインが調整されるステップと、を有するものである。

本願に係る船舶の方位制御装置および方位制御方法によれば、情報処理に過大な記憶容量と計算時間を必要とせず、変化する船体パラメータをオンラインで算定して制御ゲインを適切に調整し、外乱に対応できる方位制御装置および方位制御方法を得ることができる。

実施の形態１に係る方位制御装置の構成図である。 実施の形態１に係る方位制御装置のハードウェア構成図である。 実施の形態１に係る方位制御装置が設置された船舶の座標系の説明図である。 実施の形態１に係る方位制御装置の基本動作を示すフロー図である。 実施の形態１に係る方位制御装置の方位指令生成部の構成を示すブロック図である。 実施の形態１に係る方位制御装置の方位制御部の構成を示すブロック図である。 実施の形態１に係る方位制御装置の制御演算部の構成を示すブロック図である。 実施の形態１に係る方位制御装置の制御ゲイン調整部の構成を示すブロック図である。 実施の形態１に係る方位制御装置の船舶特性情報を示す図である。 実施の形態１に係る方位制御装置の周波数特性算定部の構成を示すブロック図である。 実施の形態２に係る方位制御装置の構成図である。 実施の形態２に係る方位制御装置の周波数特性算定部の構成を示すブロック図である。

以下、船舶の方位制御装置および方位制御方法の好適な実施の形態について、図面を参照して説明する。なお、各実施の形態において、同一もしくは相当部分には同一符号を付し、説明を省略する。

１．実施の形態１
＜方位制御装置の構成＞
図１には実施の形態１に係る船舶の方位制御装置１０を搭載した船舶１の構成例を示す。船舶１に設置された方位制御装置１０は、操作装置３０およびセンサ群２０から操作情報ＣＩと各種センサ情報を受信し、舵角駆動指令信号ＲＵＡＤを出力する。方位制御装置１０は、方位指令生成部１００、方位制御部２００、ゲイン調整部３００と周波数特性算定部４００から成る制御ゲイン調整部５００、舵角制御部６００より構成される。方位制御装置１０は、センサ群２０から各検出部の信号を入力し、方位指令生成部１００から進行すべき方位指令信号ＤＲＣを受けとる。そして、舵角駆動部４０に舵角駆動指令信号ＲＵＡＤを出力して舵角を制御する。舵角駆動部４０は舵角駆動指令信号ＲＵＡＤに応じて船舵を操作する。これにより、方位制御装置１０は、進行すべき方位指令信号ＤＲＣを出力することで、船舶１の方位を変更または保持せしめるものである。

図１において、船舶１には、船舶を推進するために図示されない推進器が備えられている。推進器の出力は操作装置３０から操作される。船舶１の推進器には、船外機を用いることができる。船外機は、船舶の推進、操舵機構として、エンジンの下にスクリューが一体に設けられている。そして、船外機は本体が船体の外側に取り付けられた推進装置である。船外機による進行方位の制御は、船外機本体の船体への取り付け角度を変えて実施する。船外機は小型船舶に多く採用される。船外機は複数機具備されていてもよい。

実施の形態１に係る方位制御装置１０の適用は船外機を備えた船舶に限定されない。大型船には船内機を備えた場合が多く見られる。船内機は、エンジン等の駆動部が船体内部にあり、この駆動部と繋がれた回転方向が可変のスクリューが船外に露出し、舵がスクリューと別体となっている形態の推進、操舵機構である。実施の形態１に係る方位制御装置１０は、船内機による推進装置を備えた船舶にも適用可能である。

その他船内外機を備えた船舶が存在する。船内外機は、エンジン等の駆動部が船内にあり、船外でこの駆動部と繋がれた回転方向が可変のスクリューと舵とが一体となっている形態の推進、操舵機構である。実施の形態１に係る方位制御装置１０は、船内外機を備えた船舶にも適用可能である。

操作装置３０は、操船者が船舶の航走の初期条件と終端条件を入力する場合にも用いられる。センサ群２０は、例えば、船舶１の緯度・経度を計測する全球測位衛星システム（以下、ＧＮＳＳ（Global Navigation Satellite System）と称す）および船舶１の方位角を計測する磁方位センサから構成される。センサ群２０は、船舶１の角速度を計測するジャイロ、船舶１の並進加速度を計測する加速度センサ等に接続された慣性航法装置を備えていてもよい。

センサ群２０として具体的には、船舶１の重心を通る上下方向の軸の周りの回転角度を示すヨー角信号Ｙを出力するヨー角検出部２１が設けられている。船舶１の重心を通る上下方向の軸の周りの回転角速度を示すヨー角速度信号ＹＲを出力するヨー角速度検出部２２が設けられている。船舶１の船速を示す船速信号Ｖを出力する船速検出部２３が設けられている。さらに船舶１の舵角を示す舵角信号ＲＵＡを出力する舵角検出部２４を設けてもよい。ここで、ヨー角速度検出部２２として、角速度検出のためのセンサを独自に備えてもよいが、ヨー角検出部２１の出力であるヨー角信号Ｙを時間微分した値から求めることとしてもよい。船速検出部２３は船速を、スクリュー回転速度計、対水面速度計、対気速度計、加速度センサ、ＧＮＳＳ、電波またはレーザによるドップラ計測器等から求めることもできる。

＜方位制御装置の機能＞
方位制御装置１０は、船舶が進行すべき方位を示す方位指令信号ＤＲＣを生成する方位指令生成部１００を備える。方位制御装置１０は、センサ群２０よりヨー角信号Ｙ、ヨー角速度信号ＹＲ、舵角信号ＲＵＡ、船速信号Ｖを入力する。方位制御装置１０は、操作装置３０より操作情報ＣＩを入力する。

方位指令生成部１００によって生成された方位指令信号ＤＲＣに対して、方位制御部２００はヨー角信号Ｙ、ヨー角速度信号ＹＲ、船速信号Ｖを入力して、安定性と応答性を両立した制御ゲインで舵角指令信号ＲＵＡＣを出力する。舵角制御部６００は舵角指令信号ＲＵＡＣを入力して舵角駆動指令信号ＲＵＡＤを生成して、舵角駆動部４０へ出力し船舶１の舵を制御する。

方位制御部２００は、操作装置３０からの操作情報ＣＩによって船舶１の舵角信号ＲＵＡに対するヨー角信号Ｙ、ヨー角速度信号ＹＲの周波数特性を取得するための指示を出力する。具体的には、矩形波状または鋸波状の舵角指令信号ＲＵＡＣを出力し、これに対する、ヨー角信号Ｙ、ヨー角速度信号ＹＲの出力データを制御ゲイン調整部５００で取得する。

制御ゲイン調整部５００は、取得した出力データから周波数特性を算定し、これに応じて、方位制御部２００の制御ゲインを調整する。この調整によって、船舶１の船体パラメータが、船速、喫水の変化等によって変動しても、この変動に対応した制御ゲインを獲得することが可能となる。その結果、外乱に対応できる方位制御装置および方位制御方法を得ることができる。

ここでは、船舶１の舵角信号ＲＵＡに対するヨー角信号Ｙ、ヨー角速度信号ＹＲの周波数特性を取得するための指示を、操作装置３０から操作情報ＣＩによって行う場合の説明をした。しかし、方位制御部２００が船舶１の安定した同一方位への航走継続を検出した場合に、必要に応じて周波数特性を取得する判断をし、矩形波状または鋸波状の舵角指令信号ＲＵＡＣを出力することとしてもよい。例えば方位制御部２００が、所定時間ごとに、または方位制御装置１０の起動ごとに、周波数特性の取得動作を行い、制御ゲイン調整部５００に周波数特性を算定させ、方位制御部２００の制御ゲインを調整させることとしてもよい。

＜方位制御装置のハードウェア構成＞
図２は、方位制御装置１０のハードウェア構成図である。図２のハードウェア構成は、方位制御装置１０ａにも適用できる。以下では代表して方位制御装置１０について説明する。本実施の形態では、方位制御装置１０は、船舶の方位を制御する電子制御装置である。方位制御装置１０の各機能は、方位制御装置１０が備えた処理回路により実現される。具体的には、方位制御装置１０は、処理回路として、ＣＰＵ（Central Processing Unit）等の演算処理装置９０（コンピュータ）、演算処理装置９０とデータのやり取りをする記憶装置９１、演算処理装置９０に外部の信号を入力する入力回路９２、および演算処理装置９０から外部に信号を出力する出力回路９３等を備えている。

演算処理装置９０として、ＡＳＩＣ（Application Specific Integrated Circuit）、ＩＣ（Integrated Circuit）、ＤＳＰ（Digital Signal Processor）、ＦＰＧＡ（Field Programmable Gate Array）、各種の論理回路、および各種の信号処理回路等が備えられてもよい。また、演算処理装置９０として、同じ種類のものまたは異なる種類のものが複数備えられ、各処理が分担して実行されてもよい。記憶装置９１として、演算処理装置９０からデータを読み出しおよび書き込みが可能に構成されたＲＡＭ（Random Access Memory）、演算処理装置９０からデータを読み出し可能に構成されたＲＯＭ（Read only Memory）等が備えられている。記憶装置９１としては、フラッシュメモリー、ＥＰＲＯＭ、ＥＥＰＲＯＭ等の、不揮発性または揮発性の半導体メモリ、磁気ディスク、フレキシブルディスク、光ディスク、コンパクトディスク、ミニディスク、ＤＶＤ等を使用してもよい。入力回路９２は、センサ群２０、操作装置３０の出力信号を含む各種のセンサ、スイッチ、および通信線が接続され、これらセンサ、スイッチの出力信号と通信情報を演算処理装置９０に入力するＡ／Ｄ変換器、通信回路等を備えている。出力回路９３は、舵角駆動部４０を含む駆動装置に演算処理装置９０からの制御信号を出力する駆動回路等を備えている。

方位制御装置１０が備える各機能は、演算処理装置９０が、ＲＯＭ等の記憶装置９１に記憶されたソフトウェア（プログラム）を実行し、記憶装置９１、入力回路９２、および出力回路９３等の方位制御装置１０の他のハードウェアと協働することにより実現される。なお、方位制御装置１０が用いる閾値、判定値等の設定データは、ソフトウェア（プログラム）の一部として、ＲＯＭ等の記憶装置９１に記憶されている。方位制御装置１０の有する各機能は、それぞれソフトウェアのモジュールで構成されるものであってもよいが、ソフトウェアとハードウェアの組み合わせによって構成されるものであってもよい。

＜座標系とヨー角＞
図３は、実施の形態１に係る方位制御装置１０が設置された船舶１の座標系の説明図である。座標系Ｘ１－Ｙ１－Ｚ１は、海抜０ｍの地上または水上における固定点を基準にした座標系を示す。座標系Ｘ０－Ｙ０－Ｚ０は船舶の船体を基準にした座標系を示す。これらの座標系は右手系である。地球上の海上、河川または湖沼の水面上を航行する船舶の位置は、地球の表面上にあり地球が球体である影響を受ける。しかし、海抜０ｍの地上または水上の固定点と船舶１の距離が小さければ、両者は同一平面上にあるとみなして単純化して考えることができる。

海抜０ｍの地上または水上における固定点の座標系Ｘ１－Ｙ１－Ｚ１は、Ｘ１が南北方向（矢印は北）を示し、Ｙ１が東西方向（矢印は東）を示す。Ｚ１は垂直方向（矢印は下）を示す。船舶１は、Ｘ１－Ｙ１平面上に存在し、船体を基準にした座標系Ｘ０－Ｙ０－Ｚ０は、Ｘ０が船体の重心を通る前後方向（矢印は前であり船首方向）を示し、Ｙ０が船体の重心を通る左右方向（矢印が右で右舷方向）を示し、Ｚ０が船体の重心を通る船体構造の上下方向（矢印は下）を示す。

ヨー角ＹＡ（方位角とも言う）はＺ０軸周りの回転角度であり、ヨー角速度（ヨーレート）はＺ０軸周りの回転角速度である。

船舶が進行すべき方位が方位指令生成部１００によって指示された場合、方位指令信号ＤＲＣは、海抜０ｍの地上または水上における固定点の座標系Ｘ１－Ｙ１－Ｚ１のＸ１方向（図２では北）を基準として示される。また、船舶１の船体の方向はＸ１方向を基準としてヨー角で示される。例えば船舶が北東に進路を取るべく指示された場合は、Ｘ１方向である北を基準として時計回りに４５度の角度のヨー角ＹＡを維持するように運航する。

海抜０ｍの地上または水上の固定点と船舶１の距離が大きければ、両者は同一平面上にあると単純化して考えることができず、地球が球体であることを考慮して計算する必要がある。この場合でも、船舶が置かれた水面上で北を基準として指示されたヨー角を維持するように運航することは同じである。

＜基本動作を示すフローチャート＞
図４は、実施の形態１に係る方位制御装置１０の基本動作を示すフローチャートである。方位制御部２００は、操作装置３０からの指示、または方位制御部２００の判断によって船体パラメータの取得による制御ゲインの調整を行う。

方位制御部２００は調整を実施しなくても、初期状態で規範伝達関数が設定されているので、方位指令生成部１００の指示に基づいて、舵角指令信号ＲＵＡＣを算出することができる。しかし、船舶１の舵角信号ＲＵＡに対するヨー角信号Ｙ、ヨー角速度信号ＹＲの周波数特性を取得することによって、方位制御部２００の制御ゲインを最新の船舶１の状態に対応して調整することができる。

図４のフローチャートは、方位制御装置１０が船体パラメータの取得による制御ゲインの調整を行うたびに実行される。ステップＳ１００で、航走中において、方位制御部２００が舵角指令信号ＲＵＡＣを矩形波状または鋸波状の舵角指令として出力する。

ステップＳ１０１では、周波数特性算定部４００が舵角信号ＲＵＡに対するヨー角信号Ｙ、ヨー角速度信号ＹＲの時系列データを取得する。周波数特性算定部４００で船舶特性情報ＦＣとして周波数特性を算定する。このとき、同時に船速信号Ｖのデータも取得して、船速に応じた周波数特性を算定することとしてもよい。

ステップＳ１０３では、目標応答性能情報ＴＣを読み出す。目標応答性能情報ＴＣは、船舶１について予め定められており、目標応答性能情報ＴＣから基本となる規範伝達関数が設定される。

ステップＳ１０４では、ステップＳ１０１で算定した周波数特性（船舶特性情報ＦＣ）を用いて、目標応答性能情報ＴＣから設定した規範伝達関数をもとに制御ゲイン情報ＧＩを算出する。ステップＳ１０５で、制御ゲイン情報ＧＩを用いて方位制御部２００で方位制御演算が実行されて舵角指令信号ＲＵＡＣが出力される。舵角指令信号ＲＵＡＣに応じて舵角制御部６００から舵角駆動指令信号ＲＵＡＤが出力され舵角駆動部４０が制御されることによって船舶１の方位制御がされる。このとき、ステップＳ１０１からステップＳ１０５において同時に船速信号Ｖのデータを取得して、船速に応じた制御ゲイン情報ＧＩを算定することとしてもよい。

船舶の方位制御装置１０を構成する方位指令生成部１００、方位制御部２００、ゲイン調整部３００、および周波数特性算定部４００について、その機能を詳細に説明する。

＜方位指令生成部＞
図５は、実施の形態１に係る方位制御装置１０の方位指令生成部１００の構成を示すブロック図である。方位指令生成部１００は、運動条件設定部１０１と方位演算部１０２で構成される。この運動条件設定部１０１は、船舶１の航走の初期条件と終端条件を設定するもので、操船者が船舶１の操作装置３０に入力することにより操作情報ＣＩによって設定される。

操船者は船舶１の操作装置３０によって、航走開始前の初期状態と、所望の航走が完了した時点での終端状態における姿勢角（方位角またはヨー角と同義）、角速度（姿勢角の１回時間微分）および角加速度（姿勢角の２回時間微分）の情報を設定する。この条件設定は、姿勢角、角速度および角加速度を数値化した値で与えてもよい。ＧＮＳＳのタッチパネル化されたユーザインターフェースを用いて設定することもできる。初期状態は、センサ群２０の検出値をセンサ群情報として自動的に取込み、終端状態のみをユーザインターフェース画面でタッチ入力することによって設定してもよい。

方位演算部１０２は、運動条件設定部１０１の出力する初期状態の情報ＳＣＩと終端状態の情報ＥＣＩとを受けて、方位指令信号ＤＲＣを演算する。ここで、方位指令信号ＤＲＣの演算方法は、複数考えられる。例えば、運動条件設定部１０１で得られた船舶１の初期状態の情報ＳＣＩと終端状態の情報ＥＣＩにおける姿勢角、角速度および角加速度に基づいて、時間の多項式として与えられた軌道を演算することができる。

また、初期状態の情報ＳＣＩと終端状態の情報ＥＣＩを最短時間で結ぶ直線軌道を演算することもできる。初期状態と終端状態の間を最少燃料で到達可能な軌道を演算することもできる。すなわち、初期状態から終端状態に遷移する際、予め設定された評価関数を最小化する最適な軌道、例えば時間最短の意味で最適な軌道または最少燃料の意味で最適な軌道として演算してもよい。

＜方位制御部＞
図６は実施の形態１に係る方位制御装置１０の方位制御部２００の構成を示すブロック図である。方位制御部２００は、制御演算部２１０およびセンサ情報処理部２２０で構成される。センサ情報処理部２２０は、センサ群２０の出力であるヨー角信号Ｙとヨー角速度信号ＹＲを制御演算部２１０へ出力する。このとき、同時に船速信号Ｖのデータも取得して、制御演算部２１０へ出力することとしてもよい。

センサ情報処理部２２０は、センサ群２０から送られてきた各種センサの情報を、シリアル信号からパラレル信号に変換する機能を有していてもよい。また、ヨー角信号Ｙを時間微分してヨー角速度信号ＹＲを生成する機能を有していてもよい。

制御演算部２１０は、方位指令生成部１００の出力である方位指令信号ＤＲＣと、ゲイン調整部３００の出力である制御ゲイン情報ＧＩ（ＧＩ１、ＧＩ２、ＧＩ３）、センサ情報処理部２２０の出力であるヨー角信号Ｙとヨー角速度信号ＹＲとに基づいて、舵角指令信号ＲＵＡＣを舵角制御部６００へ出力する。このとき、同時に船速信号Ｖのデータに応じて制御ゲインを切替えて、舵角指令信号ＲＵＡＣを算出し出力することとしてもよい。

＜制御演算部＞
図７は、実施の形態１に係る方位制御装置１０の制御演算部２１０の構成を示すブロック図である。制御演算部２１０は、第一の制御演算部２１１、第二の制御演算部２１２、第三の制御演算部２１３、および加算器２１４からなる。

第一の制御演算部２１１は、ＤＲＣとヨー角信号Ｙとの偏差を零とするように、第一の制御ゲイン情報ＧＩ１を用いた公知のＰ（Proportional）制御でヨー角速度指令信号ＹＲＣを演算し出力する。第二の制御演算部２１２は、第一の制御演算部２１１の出力であるヨー角速度指令信号ＹＲＣとヨー角速度信号ＹＲのヨー角速度偏差を零とするように、第二の制御ゲイン情報ＧＩ２を用いた公知のＰＩ（Proportional Integral）制御でＦＢ（Feedback）舵角指令ＦＢＣを演算し出力する。

第三の制御演算部２１３は、第一の制御演算部２１１の出力であるヨー角速度指令信号ＹＲＣと第三の制御ゲイン情報ＧＩ３に基づいて、ＦＦ（Feedforward）舵角指令ＦＦＣを演算し出力する。加算器２１４は、第二の制御演算部２１２の出力であるＦＢ舵角指令ＦＢＣに第三の制御演算部２１３の出力であるＦＦ舵角指令ＦＦＣを加算する。

加算器２１４は、加算した結果として舵角指令信号ＲＵＡＣを出力する。制御演算部２１０をこのような構成にすることで、第一および第二の制御演算部２１１、２１２によって方位安定性を向上させ、第三の制御演算部２１３によって方位応答性を向上させることができる。また、上記の第一の制御演算部２１１、第二の制御演算部２１２、第三の制御演算部２１３について、同時に船速信号Ｖのデータに応じて制御ゲインを切替えて、出力することとしてもよい。

＜制御ゲイン調整部＞
図８は、実施の形態１に係る方位制御装置１０のゲイン調整部３００の構成を示すブロック図である。船舶１の方位運動は、一般的に舵角信号ＲＵＡに対するヨー角速度信号ＹＲの周波数特性として特徴付けることができる。例えば、特許文献１では、舵角信号ＲＵＡに対するヨー角速度信号ＹＲの周波数特性として、１次のモデルが扱われている。

しかしながら、船舶１の周波数特性は、船舶１の運動状態、例えば船舶の速度（以下、船速）によって大きく変化し、例えば、舵角を所定量だけ所定速度で切った場合、船速が低い領域ではヨー角速度信号ＹＲが小さく、船速が高い領域ではヨー角速度信号ＹＲが大きい性質がある。したがって、船速による制御応答のばらつきを小さくしつつ、制御系の応答を決める交差周波数を船速に依らず一定とするためには、制御演算部２１０に入力する制御ゲイン情報を船速に応じて可変とする必要がある。

図９は、実施の形態１に係る方位制御装置１０の船舶特性情報を示す図である。ここでは、舵角信号ＲＵＡに対するヨー角速度信号ＹＲの周波数特性をゲインと位相について示している。船速が低い低速の領域（実線で示す）では、１次のモデルで比較的近似しやすい特性を有す。しかしながら、船速が高い高速の領域（破線で示す）では、ゲインが増大するとともに、条件によっては高周波側に緩やかなピークゲインを有する形状となり、１次のモデルでは近似できない。図９では、ヨー角速度信号ＹＲの周波数特性を示したが、ヨー角信号Ｙについても同様なことが言える。

制御演算部２１０内の制御ゲイン情報ＧＩを船速に応じて適切に設計ないし設定するために、ゲイン調整部３００は、後述する周波数特性算定部４００の出力である船舶特性情報と目標応答性能情報ＴＣに基づき、制御ゲイン情報ＧＩを演算し出力する。図８に示したゲイン調整部３００は、規範伝達関数設定部３０１およびオンラインゲイン調整部３０２で構成される。

規範伝達関数設定部３０１は、任意に選定した目標応答性能情報ＴＣ、例えばゲイン交差周波数に基づいて、目標応答性能を達成する舵角信号ＲＵＡに対するヨー角信号Ｙの周波数特性を表す規範伝達関数と舵角信号ＲＵＡに対するヨー角速度信号ＹＲの周波数特性を表す規範伝達関数を出力する。そして、オンラインゲイン調整部３０２は、前述した制御演算部２１０内の第一から第三の制御演算部（２１１～２１３）に係る制御ゲイン情報ＧＩ（ＧＩ１、ＧＩ２、ＧＩ３）を演算し出力する。

オンラインゲイン調整部３０２は、第一と第二の制御演算部２１１、２１２に係る制御ゲイン情報ＧＩ１、ＧＩ２を、後述する周波数特性算定部４００の出力である船舶特性情報ＦＣと、規範伝達関数設定部３０１の出力である規範伝達関数をもとに、例えば公知の部分的モデルマッチング法にて、算出する。

一方、第三の制御演算部２１３に係る制御ゲイン情報ＧＩ３は、船舶特性情報に基づいて、例えば舵角信号ＲＵＡに対するヨー角速度信号ＹＲの周波数特性の逆モデルである、ヨー角速度信号ＹＲに対する舵角信号ＲＵＡの周波数特性を利用して算出する。このとき、前記逆モデルが高次、例えば２回の時間微分を含む場合には、第三の制御演算部２１３の出力であるＦＦ舵角指令ＦＦＣが急峻に変化することを抑えるため、ローパスフィルタまたは移動平均処理を逆モデルの後段に備えても良い。また、逆モデル自体の次数を減らす近似処理を導入してもよい。

図８のゲイン調整部３００の入力として、同時に船速信号Ｖのデータを追加し、船速に応じた制御ゲインをもとめることとしてもよい。

＜周波数特性算定部＞
図１０は、実施の形態１に係る方位制御装置１０の周波数特性算定部４００の構成を示すブロック図である。周波数特性算定部４００は、ゲイン調整部３００に船舶特性情報ＦＣを入力する。船舶１の方位運動の周波数特性は、一般的に船速に応じて変化する。

この周波数特性は、例えば、船舶１が一定の船速で航走中に、正弦波状の舵角指令信号ＲＵＡＣを周波数掃引しながら印加した時の、舵角信号ＲＵＡとヨー角速度信号ＹＲの応答の増幅率と位相差から求める方法が考えられる。しかしながら、このような方法は、低周波での特性取得に膨大な計測時間と記憶容量を要すため、上記周波数特性を特徴付ける船舶特性情報ＦＣをオンライン推定するには不向きである。

これに対し、周波数特性算定部４００は、周波数特性において注目したい帯域幅で十分なパワーを有する矩形波状あるいは鋸波状の信号を舵角指令信号ＲＵＡＣとして所定時間だけ印加した時のセンサ群２０の出力であるセンサ群情報を入力とし、船舶特性情報をオンライン推定し出力するものである。周波数特性算定部４００は、データ処理部４０１と逐次推定フィルタ部４０２で構成される。

データ処理部４０１は、センサ群２０の出力であるセンサ群情報に基づいて、舵角信号ＲＵＡとヨー角速度信号ＹＲ、および船速信号Ｖに重畳した観測雑音を除去するフィルタである。データ処理部４０１の出力は舵角信号ＲＵＡとヨー角速度信号ＹＲ、および船速信号Ｖ等の処理後データである。

逐次推定フィルタ部４０２は、データ処理部４０１の出力である処理後データに基づいて、船舶特性情報ＦＣを出力する。例えば公知の逐次最小二乗法にて、舵角信号ＲＵＡに対するヨー角速度信号ＹＲの周波数特性モデルを逐次的に推定し、船舶特性情報ＦＣとして出力する。前述したとおり、船速が高い高速領域では、高周波側にピークゲインが発生する場合がある。このため、ピークゲインが発生するような高速領域に対応すべく、周波数特性モデルの次数を２次以上にして、舵角信号ＲＵＡに対するヨー角速度信号ＹＲの周波数特性モデルを逐次的に推定する。舵角信号ＲＵＡに対するヨー角信号Ｙの周波数特性についても周波数特性モデルを同様に推定してもよい。

この逐次推定フィルタ部４０２で使用する手法は、前述した逐次最小二乗法に限定されない。公知のカルマンフィルタ、カルマンスムーザ、逐次部分空間同定法等、さまざまな逐次推定手法を利用して船舶特性情報ＦＣを得ることができる。

ＳＱＰ(Sequential Quadratic Programming)のアルゴリズムを始めとする従来のオフライン推定方法は、データを多く取りためてオフラインでパラメータを推定するため、記憶容量と計算時間を多く必要とする。このようなオフライン推定方法と比べ、逐次推定手法を用いることで、新しい計測データが得られるたびに過去の不要なデータを逐次削除することができる。このため、記憶容量の削減が可能となる。また、逐次的にデータを処理するために、扱うデータ量が少なくなり、計算時間が短くなる。

ここで、推定した周波数特性モデルをデータ処理部４０１の出力である船速に紐づけることで、船舶特性情報ＦＣを船速の関数あるいはマップとして蓄積することができる。船舶特性情報ＦＣを蓄積することで、船速が変化した場合、あるいは目標応答性能情報ＴＣを変更した場合にも即応できる。再度周波数特性を推定することなく、蓄積した船舶特性情報ＦＣをもとに制御ゲイン情報ＧＩを適切に設計ないし設定することができる。

以上のように、実施の形態１に係る船舶１を所望の方位で航走させる船舶の方位制御装置１０について説明した。方位制御装置１０は、方位指令信号ＤＲＣを出力する方位指令生成部１００と、船舶に搭載されたセンサ群２０からのセンサ群情報を入力とし、船舶特性情報ＦＣを出力する周波数特性算定部４００と、周波数特性算定部４００の出力である船舶特性情報ＦＣに基づいて制御ゲイン情報ＧＩを出力するゲイン調整部３００を有する。そして、方位制御部２００は方位指令生成部１００の出力である方位指令信号ＤＲＣと、ゲイン調整部３００による制御ゲイン情報ＧＩと、センサ群２０からのセンサ群情報と、に基づいて舵角指令信号ＲＵＡＣを出力する。

これによって、船速等で変化しえる制御対象のモデル化誤差に対して、即座に適切な制御ゲインを演算することができる。その結果、制御対象の特性変化に対してロバストな設計を可能とし、かつ方位制御に関わる外乱抑圧性能と目標値応答性能を適正に調整できる。さらに、潮流、波浪、風雨等の船舶への外乱要因で励起される振動を助長すること無く、安定な方位制御を実現できる。さらに、ＳＱＰ等のアルゴリズムを用いて船体パラメータを同定する必要が無いため、船舶の方位制御装置の情報処理には過大な記憶容量と計算時間を必要としない。

２．実施の形態２
図１１は、実施の形態２に係る方位制御装置１０ａの構成図である。図１２は、実施の形態２に係る方位制御装置１０ａの周波数特性算定部４００ａの構成を示すブロック図である。

図１１の、実施の形態２に係る方位制御装置１０ａにおいて、実施の形態１に係る方位制御装置１０との違いは、方位制御部２００への入力されるセンサ群情報が、制御ゲイン調整部５００ａの周波数特性算定部４００ａで演算された補正後のセンサ群情報である点である。その他の構成は、図１と同様であるため、同一符号を付して説明を省略する。

周波数特性算定部４００ａは、データ処理部４０１と逐次推定フィルタ部４０２ａで構成される。実施の形態１にて、逐次推定フィルタ部４０２の出力が船舶特性情報ＦＣのみであった。しかし、実施の形態２によれば、逐次推定フィルタ部４０２ａは、例えば公知の逐次最小二乗法、カルマンフィルタ、カルマンスムーザ、逐次部分空間同定法等の逐次推定手法を用いて、船舶特性情報ＦＣを推定し出力しつつ、センサ群情報に重畳された観測雑音、システム雑音の影響を除去した補正後ヨー角速度信号ＹＲｃｐ及び補正後ヨー角信号Ｙｃｐを、補正センサ群情報（すなわち新たな制御量）として方位制御部２００へ出力し、方位制御を行う。

このような構成とすることで、観測雑音等が重畳しやすいセンサ群を用いた場合においても、外乱抑圧性能と目標値応答性能の適正な調整が可能となり、安定な方位制御が実現できる。

前述の実施の形態１および２において、図１に記載された方位制御装置１０の方位指令生成部１００、方位制御部２００、ゲイン調整部３００、周波数特性算定部４００、４００ａ、舵角制御部６００さらにはこれらを構成する図４から図８、および図１０から図１２に示された各機能からなる制御ブロックは、別々の制御回路で構成してもよい。あるいはこれらを１つの制御回路でまとめて構成してもよい。また、前述の制御ブロックにおいては、船外機および船内機の舵角を制御する舵角駆動機構までを含めて統合してもよい。これらの機能を実現する処理回路は、専用のハードウェアであってもよい。これらの機能は、メモリに格納されるプログラムを実行するＣＰＵ（中央処理装置、処理装置、演算装置、マイクロプロセッサ、マイクロコンピュータ、プロセッサ、ＤＳＰともいう）であっても構成可能である。

実施の形態１および実施の形態２に係る船舶の方位制御装置１０、１０ａにおける、制御部分をソフトウェアで構成した場合、各実施の形態のそれぞれの制御部分の機能は、ソフトウェアを実行のたびにメモリにダウンロードして実行するタイプのソフトウェア、コンピュータの不揮発性記憶装置に固定化されたファームウェア、または前述のタイプのソフトウェアとファームウェアとの組み合わせにより実現される。前述のタイプのソフトウェアとファームウェアはプログラムとして記述され、メモリに格納される。処理回路であるプロセッサは、メモリに記憶されたプログラムを読み出して実行することにより、各部の機能を実現する。これらのプログラムは、前述の各部の手順、方法をコンピュータに実行させるものである。ここで、メモリとは、たとえば、ＲＡＭ、ＲＯＭ、フラッシュメモリー、ＥＰＲＯＭ、ＥＥＰＲＯＭ等の、不揮発性または揮発性の半導体メモリ、磁気ディスク、フレキシブルディスク、光ディスク、コンパクトディスク、ミニディスク、ＤＶＤ等が該当する。

なお、前述の各制御ブロックの機能について、一部を専用のハードウェアで実現し、一部を前述のタイプのソフトウェアまたはファームウェアで実現するようにしてもよい。このように、各実施の形態の処理回路は、ハードウェア、前述のタイプのソフトウェア、ファームウェア、またはこれらの組み合わせによって、各機能を実現することができる。また処理に必要な各種情報は、ハードウェア構成の場合は回路に予め設定され、またソフトウェア構成の場合にはメモリに予め記憶させておく。

なお、上述の全ての実施の形態において、制御演算部の構成は、角度メジャーループのみ、角度メジャーループと角速度マイナーループの２重ループの他に、角度メジャーループと角速度マイナーループと角加速度マイナーループの３重ループとすることも当然可能である。このとき、角加速度は、センサ群情報の１つであるヨー角信号Ｙを２回時間微分で求めてもよく、あるいはヨー角速度信号ＹＲを１回時間微分して求めてもよい。

さらに、全ての実施の形態において、制御器の形態は、古典制御系のみならず、状態フィードバック制御のための現代制御系も利用することができる。

本願は、様々な例示的な実施の形態および実施例が記載されているが、１つ、または複数の実施の形態に記載された様々な特徴、態様、および機能は特定の実施の形態の適用に限られるのではなく、単独で、または様々な組み合わせで実施の形態に適用可能である。従って、例示されていない無数の変形例が、本願明細書に開示される技術の範囲内において想定される。例えば、少なくとも１つの構成要素を変形する場合、追加する場合または省略する場合、さらには、少なくとも１つの構成要素を抽出し、他の実施の形態の構成要素と組み合わせる場合が含まれるものとする。

１ 船舶、１０、１０ａ 方位制御装置、２０ センサ群、２１ ヨー角検出部、２２ ヨー角速度検出部、２３ 船速検出部、２４ 舵角検出部、３０ 操作装置、４０ 舵角駆動部、１００ 方位指令生成部、２００ 方位制御部、２１０ 制御演算部、２１１ 第一の制御演算部、２１２ 第二の制御演算部、２１３ 第三の制御演算部、２１４ 加算器、２２０ センサ情報処理部、３００ ゲイン調整部、３０１ 規範伝達関数設定部、３０２ オンラインゲイン調整部、４００、４００ａ 周波数特性算定部、４０１ データ処理部、４０２、４０２ａ 逐次推定フィルタ部、５００、５００ａ 制御ゲイン調整部、６００ 舵角制御部、ＣＩ 操作情報、ＤＲＣ 方位指令信号、ＥＣＩ 終端状態の情報、ＦＢＣ ＦＢ舵角指令、ＦＣ 船舶特性情報、ＦＦＣ ＦＦ舵角指令、ＧＩ１ 第一の制御ゲイン情報、ＧＩ２ 第二の制御ゲイン情報、ＧＩ３ 第三の制御ゲイン情報、ＧＩ 制御ゲイン情報、ＲＵＡ 舵角信号、ＲＵＡＣ 舵角指令信号、ＲＵＡＤ 舵角駆動指令信号、ＳＣＩ 初期状態の情報、ＴＣ 目標応答性能情報、Ｖ 船速信号、Ｙ ヨー角信号、Ｙｃｐ 補正後ヨー角信号、ＹＡ ヨー角、ＹＲ ヨー角速度信号、ＹＲｃｐ 補正後ヨー角速度信号、ＹＲＣ ヨー角速度指令信号

本願に係る船舶の方位制御装置は、
船舶が進行すべき方位を示す方位指令信号を生成する方位指令生成部、
船舶の重心を通る上下方向の軸の周りの回転角度を示すヨー角信号を出力するヨー角検出部、
船舶の重心を通る上下方向の軸の周りの回転角速度を示すヨー角速度信号を出力するヨー角速度検出部、
船舶の舵の角度を示す舵角信号を出力する舵角検出部、
方位指令生成部によって生成された方位指令信号と、ヨー角検出部によって出力されたヨー角信号と、ヨー角速度検出部によって出力されたヨー角速度信号と、に基づいて船舶を進行すべき方位へ向かわせる舵角指令信号を出力する方位制御部、
方位制御部によって出力された舵角指令信号に基づいて舵を制御する舵角制御部、および、
舵角検出部によって出力された舵角信号に対するヨー角信号およびヨー角速度信号の周波数特性を算定して方位制御部の制御ゲインを調整する制御ゲイン調整部、を備え、
方位制御部は、
方位指令信号と、ヨー角信号との偏差を０とするヨー角速度指令信号を演算する第一の制御演算部、
第一の制御演算部によって演算されたヨー角速度指令信号と、ヨー角速度信号との偏差を０とするフィードバック舵角指令信号を演算する第二の制御演算部、
ヨー角速度指令信号に基づいてフィードフォワード舵角指令信号を演算する第三の制御演算部、および、
第二の制御演算部によって演算されたフィードバック舵角指令信号と、第三の制御演算部によって演算されたフィードフォワード舵角指令信号を加算して舵角指令信号を出力する加算器、を有するものである。

また、本願に係る船舶の方位制御方法は、
方位指令生成部によって船舶が進行すべき方位を示す方位指令信号が生成されるステップと、
ヨー角検出部によって船舶の重心を通る上下方向の軸の周りの回転角度を示すヨー角信号が出力されるステップと、
ヨー角速度検出部によって船舶の重心を通る上下方向の軸の周りの回転角速度を示すヨー角速度信号が出力されるステップと、
舵角検出部によって船舶の舵の角度を示す舵角信号が出力されるステップと、
方位制御部によって方位指令生成部が生成した方位指令信号と、ヨー角検出部が出力したヨー角信号と、ヨー角速度検出部が出力したヨー角速度信号と、に基づいて船舶を進行すべき方位へ向かわせる舵角指令信号が出力されるステップと、
舵角制御部によって舵角指令信号に基づいて舵が制御されるステップと、
制御ゲイン調整部によって、舵角検出部によって出力された舵角信号に対してヨー角信号およびヨー角速度信号の周波数特性が算定され、方位制御部の制御ゲインが調整されるステップと、を有し、
方位制御部によって舵角指令信号が出力されるステップは、
第一の制御演算部によって、方位指令信号と、ヨー角信号との偏差を０とするヨー角速度指令信号が演算されるステップと、
第二の制御演算部によって、第一の制御演算部によって演算されたヨー角速度指令信号と、ヨー角速度信号との偏差を０とするフィードバック舵角指令信号が演算されるステップと、
第三の制御演算部によって、ヨー角速度指令信号に基づいてフィードフォワード舵角指令信号が演算されるステップと、
加算器によって、第二の制御演算部によって演算されたフィードバック舵角指令信号と、第三の制御演算部によって演算されたフィードフォワード舵角指令信号が加算されて舵角指令信号が出力されるステップと、を有するものである。

Claims (12)

1. 船舶が進行すべき方位を示す方位指令信号を生成する方位指令生成部、
   前記船舶の重心を通る上下方向の軸の周りの回転角度を示すヨー角信号を出力するヨー角検出部、
   前記船舶の前記重心を通る上下方向の軸の周りの回転角速度を示すヨー角速度信号を出力するヨー角速度検出部、
   前記船舶の舵の角度を示す舵角信号を出力する舵角検出部、
   前記方位指令生成部によって生成された前記方位指令信号と、前記ヨー角検出部によって出力された前記ヨー角信号と、前記ヨー角速度検出部によって出力された前記ヨー角速度信号と、に基づいて前記船舶を前記進行すべき方位へ向かわせる舵角指令信号を出力する方位制御部、
   前記方位制御部によって出力された前記舵角指令信号に基づいて舵を制御する舵角制御部、
   前記舵角検出部によって出力された前記舵角信号に対する前記ヨー角信号および前記ヨー角速度信号の周波数特性を算定して前記方位制御部の制御ゲインを調整する制御ゲイン調整部、を備えた船舶の方位制御装置。
2. 前記船舶の速度を示す船速信号を出力する船速検出部を備え、
   前記制御ゲイン調整部は、前記船速検出部によって出力された前記船速信号に応じて前記周波数特性を算定し、前記方位制御部の制御ゲインを前記船速信号に応じて調整する請求項１に記載の船舶の方位制御装置。
3. 前記方位制御部は、
   前記方位指令信号と、前記ヨー角信号との偏差を０とするヨー角速度指令信号を演算する第一の制御演算部、
   第一の制御演算部によって演算された前記ヨー角速度指令信号と、前記ヨー角速度信号との偏差を０とするフィードバック舵角指令信号を演算する第二の制御演算部、
   前記ヨー角速度指令信号に基づいてフィードフォワード舵角指令信号を演算する第三の制御演算部、
   前記第二の制御演算部によって演算された前記フィードバック舵角指令信号と、前記第三の制御演算部によって演算された前記フィードフォワード舵角指令信号を加算して舵角指令信号を出力する加算器、を有する請求項１または２に記載の船舶の方位制御装置。
4. 前記ヨー角信号および前記ヨー角速度信号に重畳されたノイズを除去するノイズ除去部を備え、
   前記方位制御部は、前記ノイズ除去部によってノイズが除去された前記ヨー角信号および前記ヨー角速度信号に基づいて前記舵角指令信号を出力する請求項１から３のいずれか一項に記載の船舶の方位制御装置。
5. 前記制御ゲイン調整部は、２次以上の周波数特性モデルを用いて制御ゲインを調整する請求項１から４のいずれか一項に記載の船舶の方位制御装置。
6. 前記方位制御部は、前記方位指令信号と、前記ヨー角信号の偏差を０とする前記舵角指令信号を出力する請求項１から５のいずれか一項に記載の船舶の方位制御装置。
7. 前記制御ゲイン調整部は、
   前記舵角信号に対し、前記ヨー角信号について目標とすべき周波数特性を有するヨー角信号規範伝達関数と、前記ヨー角速度信号について目標とすべき周波数特性を有するヨー角速度信号規範伝達関数と、を設定する規範伝達関数設定部と、
   前記規範伝達関数設定部によって設定された前記ヨー角信号規範伝達関数と前記ヨー角速度信号規範伝達関数に基づいて、前記方位制御部の制御ゲインを調整するオンラインゲイン調整部を有する、請求項１から６のいずれか１項に記載の船舶の方位制御装置。
8. 方位指令生成部によって船舶が進行すべき方位を示す方位指令信号が生成されるステップと、
   ヨー角検出部によって前記船舶の重心を通る上下方向の軸の周りの回転角度を示すヨー角信号が出力されるステップと、
   ヨー角速度検出部によって前記船舶の前記重心を通る上下方向の軸の周りの回転角速度を示すヨー角速度信号が出力されるステップと、
   舵角検出部によって前記船舶の舵の角度を示す舵角信号が出力されるステップと、
   方位制御部によって前記方位指令生成部が生成した前記方位指令信号と、前記ヨー角検出部が出力した前記ヨー角信号と、前記ヨー角速度検出部が出力した前記ヨー角速度信号と、に基づいて前記船舶を前記進行すべき方位へ向かわせる舵角指令信号が出力されるステップと、
   舵角制御部によって前記舵角指令信号に基づいて舵が制御されるステップと、
   制御ゲイン調整部によって、前記舵角検出部によって出力された前記舵角信号に対して前記ヨー角信号および前記ヨー角速度信号の周波数特性が算定され、前記方位制御部の制御ゲインが調整されるステップと、を有する船舶の方位制御方法。
9. 船速検出部によって前記船舶の速度を示す船速信号が出力されるステップを有し、
   前記制御ゲイン調整部によって前記方位制御部の制御ゲインが調整されるステップでは、前記制御ゲイン調整部によって、前記船速検出部により出力された前記船速信号に応じて、前記周波数特性が算定され、前記方位制御部の前記制御ゲインが前記船速信号に応じて調整される請求項８に記載の船舶の方位制御方法。
10. 前記方位制御部によって前記舵角指令信号が出力されるステップは、
    第一の制御演算部によって、前記方位指令信号と、前記ヨー角信号との偏差を０とするヨー角速度指令信号が演算されるステップと、
    第二の制御演算部によって、第一の制御演算部によって演算された前記ヨー角速度指令信号と、前記ヨー角速度信号との偏差を０とするフィードバック舵角指令信号が演算されるステップと、
    第三の制御演算部によって、前記ヨー角速度指令信号に基づいてフィードフォワード舵角指令信号が演算されるステップと、
    加算器によって、前記第二の制御演算部によって演算された前記フィードバック舵角指令信号と、前記第三の制御演算部によって演算された前記フィードフォワード舵角指令信号が加算されて舵角指令信号が出力されるステップと、を有する請求項８または９に記載の船舶の方位制御方法。
11. ノイズ除去部によって、前記ヨー角信号および前記ヨー角速度信号に重畳されたノイズが除去されるステップを有し、
    前記方位制御部によって前記舵角指令信号が出力されるステップでは、前記ノイズ除去部によりノイズが除去された前記ヨー角信号および前記ヨー角速度信号に基づいて前記舵角指令信号が出力される請求項８から１０のいずれか一項に記載の船舶の方位制御方法。
12. 前記制御ゲイン調整部によって制御ゲインが調整されるステップでは、予め定められた期間、矩形波状または鋸波状の信号が方位指令生成部によって前記舵角指令信号として生成され、前記舵角制御部によって舵が制御され、前記舵角検出部によって出力された前記舵角信号に対する前記ヨー角信号および前記ヨー角速度信号の周波数特性が前記制御ゲイン調整部によって算定され前記方位制御部の制御ゲインが調整される、請求項８から１１のいずれか一項に記載の船舶の方位制御方法。

Images