船舶用自動操舵装置
【課題】船体モデルにおける船体パラメータを同定する同定機能を有する船舶用自動操舵装置において、同定演算部から得られた同定値に制限を加えた更新値でノミナル値を更新するようにして、同定誤差の影響を低減する。
【解決手段】各変針モードの度に船体パラメータを同定する同定演算部３２と、同定演算部３２で同定された船体パラメータに対して制限をかけた更新値を使用するべき船体パラメータとして出力する更新判断部３４を備える。更新判断部３４は、各変針モードの度に更新される前記更新値の中から選択された複数の更新値の平均値を求め、同定演算部３２から出力された船体パラメータの同定値に対して、その少なくとも１つの船体パラメータの同定値が前記平均値から規定尺度以上離れた場合に、平均値算出部で求めた平均値を新たな更新値とする。
【解決手段】各変針モードの度に船体パラメータを同定する同定演算部３２と、同定演算部３２で同定された船体パラメータに対して制限をかけた更新値を使用するべき船体パラメータとして出力する更新判断部３４を備える。更新判断部３４は、各変針モードの度に更新される前記更新値の中から選択された複数の更新値の平均値を求め、同定演算部３２から出力された船体パラメータの同定値に対して、その少なくとも１つの船体パラメータの同定値が前記平均値から規定尺度以上離れた場合に、平均値算出部で求めた平均値を新たな更新値とする。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、船体モデルにおける船体パラメータを同定する同定機能を有する船舶用自動操舵装置に関する。
【背景技術】
【０００２】
船舶用自動操舵装置は、設定方位にジャイロコンパスからの船首方位を追従させるために舵を制御する装置であり、その制御系は、設定方位と船首方位との入力から偏差と旋回角速度とを求め制御ゲインを乗じて制御量である命令舵角を操舵機に出力する。操舵機は舵を動かして、船体に旋回角速度を誘起させて方位を変化させる。
【０００３】
図１を参照して自動操舵装置を含む全体のシステムを説明すると、１２は自動操舵装置、１４は操舵機、１６は船体であり、自動操舵装置１２は、さらに、軌道演算部２２、フィードフォワード制御器２６、フィードバック制御器２８、加算器２４、３０、同定演算部３２を備えている。
【０００４】
軌道演算部２２は設定方位ψSを入力し、設定方位ψSから軌道計画に基づいた参照針路ψRを演算するものである。加算器２４で参照針路ψRと船体１６の船首方位ψとの偏差ψeがとられ、フィードバック制御器２８において、制御ゲインが乗じられる。フィードフォワード制御器２６及びフィードバック制御器２８の出力が加算器３０で加算されて、命令舵角δcとなる。
【０００５】
同定演算部３２は、船体パラメータを同定するもので、同定された船体パラメータは、軌道演算部２２、フィードフォワード制御器２６及びフィードバック制御部２８へと入力されて、各演算及び制御に用いられる。
【０００６】
例えば、貨物船やタンカーなどの船舶は荷物の積み下ろしにより喫水が変化する。そのため、船体特性が変化し積み下ろし前の制御ゲインを用いると、操舵系の閉ループ安定性が低下しヨーイングを生じる場合を起こす。この状況を回避するために船体パラメータを同定し、制御ゲインを設定する方法として、本出願人による特許文献１が提案されている。
【０００７】
特許文献１では、同定演算部は、入力データとしての命令舵角と出力データとしての船首方位が供給されてそれぞれのデータを蓄積し、蓄積された入力データから同定モデルを用いてモデル出力データを出力し、該同定モデルからのモデル出力データと前記出力データとの比較結果から船体パラメータを調節する。
【先行技術文献】
【特許文献】
【０００８】
【特許文献１】特開２００６−３２１４５５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００９】
しかしながら、実際の船体は非線形特性をもつことが知られている。非線形特性の影響を受けないようにするために、例えば、同定計算を開始するための条件として制約（船速条件，変針条件）を加えることにより線形モデルに近似して、船体パラメータを求めることができる。
【００１０】
しかしながら、変針の形態は本船状態、変針条件、操船者による趣向および海象により均一にならない。例えば１５度の自動変針を、１５度変針で一回にするか、５度変針で三回にするかによって非線形特性の影響が異なる。同定値の誤差は前者の場合問題にならないが、後者の場合非線形特性が強く表れると考えられる。また荒天時の波浪外乱の増加に比例して、同定誤差は増加する。その結果通常の海象において、同定誤差は殆ど制御系の許容範囲内に収まるが、稀に変針形態によって許容範囲外になる状況が想定される。従って同定誤差が大きいと見なされる場合は、同定演算部で得られた同定値を制限する必要がある。
【００１１】
本発明はかかる課題に鑑みなされたもので、同定演算部から得られた同定値に制限を加えた更新値で船体パラメータを更新するようにして、同定誤差の影響を低減することができる船舶用自動操舵装置を提供することをその目的とする。
【課題を解決するための手段】
【００１２】
前述した目的を達成するために、請求項１記載の発明は、設定方位と船首方位に基づいて複数の船体パラメータを使用して命令舵角を求め、該命令舵角を制御対象に出力して舵を動かして船体を制御する船舶用自動操舵装置であって、閾値より大きい変化量の設定方位の入力により開始して設定方位に一致するように変針させる変針モードと、一定の設定方位に保針する保針モードとを持つ船舶用自動操舵装置において、
各変針モードの度に船体パラメータの同定値を出力する同定演算部を備え、該同定演算部は、
制御対象の入力データと出力データとが供給されてそれぞれのデータを蓄積する記憶部と、
蓄積された入力データからモデル出力データを出力する同定モデルと、
該同定モデルからのモデル出力データと前記出力データとの比較結果から船体パラメータを調節するパラメータ調節部と、を備え、
さらに、変針モード後に同定演算部から出力された船体パラメータの同定値に対して制限をかけた更新値をその変針モード後に使用するべき船体パラメータの新たな更新値として出力する更新判断部を備え、該更新判断部は、
各変針モードの度に更新される前記更新値の中から選択された複数の更新値の平均値を求める平均値算出部と、
同定演算部から出力された船体パラメータの同定値に対して、その少なくとも１つの船体パラメータの同定値が前記平均値から規定尺度以上離れた場合に、平均値算出部で求めた平均値を新たな更新値とする更新処理部と、
を備えることを特徴とする。
【００１３】
請求項２記載の発明は、請求項１記載の船舶用自動操舵装置において、前記更新処理部は、前記少なくとも１つの船体パラメータの同定値とその船体パラメータの前記平均値との比を表す指数を求め、該指数と１との差異を前記尺度とすることを特徴とする。
【００１４】
請求項３記載の発明は、請求項２記載の船舶用自動操舵装置において、前記更新処理部は、
前記指数が１を含む第１範囲内にあるときは、同定演算部から出力された船体パラメータの同定値を更新値とし、前記指数が前記第１範囲外にあって、且つ前記第１範囲内よりも広い第２範囲内にあるときは、同定値をその指数に依存する係数を乗算した更新値とし、前記指数が前記第２範囲を超えるときは、前記平均値算出部で求めた平均値を更新値とする広い更新処理手段と、
前記指数が１を含む第１範囲内にあるときは、同定演算部から出力された船体パラメータの同定値を更新値とし、前記指数が前記第１範囲を超えるときは、前記平均値算出部で求めた平均値を更新値とする狭い更新処理手段と、
を備えることを特徴とする。
【００１５】
請求項４記載の発明は、請求項１ないし３のいずれか１項に記載の船舶用自動操舵装置において、前記更新判断部は、
各保針モード中で、所定期間毎に制御対象に関するデータのばらつきを表す評価量を求めて、複数の評価量の中の最小評価量を求め、その最小評価量を各保針モードに対応する評価量とする評価量算出部と、
各保針モードに対応する評価量と、それに対応する船体パラメータの更新値とを蓄積するパラメータ蓄積部と、
を備え、
前記平均値算出部は、パラメータ蓄積部で蓄積された評価値の中から、評価量の値が小さい少なくとも１つの評価量に対応する船体パラメータの平均値を求めることを特徴とする。
【００１６】
請求項５記載の発明は、請求項１ないし４のいずれか１項に記載の船舶用自動操舵装置において、前記同定演算部から出力された少なくとも１つの船体パラメータの同定値に対して、その値が規定条件範囲に入るか否かを判定する同定値制限部を備え、同定値制限部によって規定条件範囲に入るものと判定された同定値に対して、前記更新処理部による更新値の処理を行うことを特徴とする。
【００１７】
請求項６記載の発明は、請求項５記載の船舶用自動操舵装置において、前記同定値制限部は、前記規定条件範囲に入らないものと判定された同定値に対して、前記平均値に更新する手段を備えることを特徴とする。
【００１８】
請求項７記載の発明は、請求項２または３記載の船舶用自動操舵装置において、前記同定モデルは船体モデルを含み、該船体モデルの伝達関数は、
【００１９】
【数１】
で表され、
前記指数は、Ｋs／Ｔsの同定値と、前記平均値算出部で求めたＫs／Ｔsの平均値との比とすることを特徴とする。
【発明の効果】
【００２０】
本発明によれば、同定演算部を備えた従来の装置に対して、更新判断部を追加するだけでよいために、適用が容易である。複数の船体パラメータの更新値の平均値を新たな更新値として採用するため、バラツキを抑制できる。
【００２１】
また、制御対象に関するデータのばらつきを表す評価量を導入し、その評価量が小さいときの船体パラメータの更新値の平均値を用いて、更新処理を行うために、実際の状況に適応した、適切な更新値とすることができる。
【００２２】
また、各保針モード中で最小評価量を求めてそれを各保針モードに対応する評価量とすることで、波浪外乱の影響を低減した実応答によって、同定値の適合性を評価するため、信頼性が得られる。
【００２３】
規定尺度を決めるための指数として、少なくとも１つの船体パラメータの同定値とその船体パラメータの平均値との比を採用することにより、指数が無次元となるために、小型船から大型船まで広範囲に適用できる。
【００２４】
同定値に制限をかけることで、同定値の信頼性を向上させ、実用範囲の値を提供することができる。
【図面の簡単な説明】
【００２５】
【図１】本発明の船舶用自動操舵装置を含む全体のシステムを表すブロック図である。
【図２】図１の同定演算部の構成を表すブロック図である。
【図３】制御対象の構成を表すブロック図である。
【図４】同定モデルの構成を表すブロック図である。
【図５】同定演算部及び更新判断部のシーケンスを表す図である。
【図６】更新判断部の構成を表すブロック図である
【図７】Ｋsn／Ｔsnのフル・バラスト特性を表すグラフである。
【図８】Ｋsn／Ｔsnと評価量Ｊとの関係を表すグラフである。
【図９】フィードバック制御器の構成を表すブロック図である。
【図１０】安定船のγに対するＴγとＫsn／Ｔsnとの関係を表すグラフである。
【図１１】安定船のγに対するＫd とＫsn／Ｔsnとの関係を表すグラフである。
【図１２】安定船と不安定船のγに対する１／ＴsnとＫsn／Ｔsnとの関係を表すグラフである。
【図１３】広い更新判断の特性を示す図である。
【図１４】狭い更新判断の特性を示す図である。
【図１５Ａ】更新判断部による処理を示すフローチャートである。
【図１５Ｂ】更新判断部による処理を示すフローチャートである。
【図１５Ｃ】更新判断部による処理を示すフローチャートである。
【図１６】本発明によるシミュレーション結果を表すグラフである。
【図１７】本発明によるシミュレーション結果を表すグラフである。
【発明を実施するための形態】
【００２６】
以下、図面を用いて本発明の実施の形態を説明する。
【００２７】
図１は、本発明の船舶用自動操舵装置を含む全体のシステムを表すブロック図である。図において、１２は自動操舵装置、１４は操舵機、１６は船体である。操舵機１４及び船体１６を合わせたものが制御対象となる船体プラント１８である。自動操舵装置１２は、さらに、軌道演算部２２、フィードフォワード制御器２６、フィードバック制御器２８、加算器３０、２４、同定演算部３２及び更新判断部３４を備えている。加算器２４で参照針路ψRと船体１６の船首方位ψとの偏差ψeがとられ、フィードバック制御器２８は偏差ψe及びフィードバック制御器２８の出力から推定偏差、推定角速度を求める推定器を含むことができる。背景技術にて既に説明した部分については、説明を省略する。
【００２８】
更新判断部３４は、同定演算部３２で演算された同定値に対して制限をかけた更新値を、船体パラメータのノミナル値として、軌道演算部２２、フィードフォワード制御器２６、フィードバック制御器２８に対して、出力する。軌道演算部２２、フィードフォワード制御器２６、フィードバック制御器２８では、これらの船体パラメータのノミナル値を用いて各演算及び制御を行う。尚、船体パラメータの初期値は、航海毎にデフォルト値を設定する。
【００２９】
図２は、同定演算部３２の構成を表すブロック図である。同定演算部３２には、実プロセスから制御対象の入出力データが時系列データとして供給されるので、これらの入力データ及び出力データを蓄積する入力データ記憶部４０、出力データ記憶部４２を備える。入力データ記憶部４０及び出力データ記憶部４２は、リングバッファ型メモリとすることができる。さらに、同定演算部３２は、データ抽出部４３、同定モデル４４、減算器４６及びパラメータ調節部４８を備える。
【００３０】
同定モデル４４で得られる出力と、制御対象の出力との同定誤差γを求め、パラメータ調節部４８によってγが最小になるようにモデルのパラメータを調整する。
【００３１】
まず、同定演算の原理について以下、簡単に説明する。
１．同定モデル
同定モデル４４は、船体モデル、外乱モデル及び船体運動の初期値とから構成され、入力データである命令舵角δcを入力しモデル出力データであるモデル船首方位ψmを出力する。以下、船体モデル、外乱モデル及び船体運動についてそれぞれ説明する。
【００３２】
１．１ 船体モデル
船体モデルは、操舵機と船体とを一体化したものとし、操舵機の時定数（船体の時定数に比較して十分に小さい）やオンオフ制御の非線形性などの不確定特性を時定数の大きい船体特性に吸収させて、舵速度や許容舵角などの確定要素を残存させる。そして、船体モデルとしては、以下の式を採用する（図３参照）。
【００３３】
【数２】
【００３４】
ここで、Ｐは船体モデルの伝達関数、ψ（ｓ）は船首方位、Ｋsn、Ｔsn、Ｔ3snは、操縦性指数を表す船体パラメータのノミナル値であり、それぞれ旋回力ゲイン［１/ｓ/ｄｅｇ］、二つの時定数［ｓ］をそれぞれ示し、Ｔs＞Ｔ3sである。これらは、安定船の場合、Ｋsn＞０，Ｔsn＞０，Ｔ3sn＞０、不安定船の場合、Ｋsn＜０，Ｔsn＜０，Ｔs3n＞０となっている。また、Ｋsm、Ｔsm、Ｔ3smまたはその組み合わせであるｘ1、ｘ2、ｘ3を同定するべき船体パラメータとする。
【００３５】
１．２ 外乱モデル
外乱モデルは、船体と風との相対速度によって発生する船体の方位軸まわりのモーメントを舵角オフセットに換算したδoffsetで表す。相対速度ベクトルの絶対値の時間変化が微小とすれば、相対速度ベクトルは方位ψの関数として扱えるので、このことから舵角オフセットを、
【００３６】
【数３】
と近似する。ここで、δoffsetは外乱モデルの舵角成分を、δO（時間微分δO・＝０）は変針前または保針時の舵角オフセットを、ｃδは変針後の舵角オフセット係数を示す。
【００３７】
１．３ 船体運動
船体運動の初期値は（２）式より直接取得できる方位と取得できない旋回角速度とがある。角速度の初期値応答は、
【００３８】
【数４】
になり、方位変化は、
【００３９】
【数５】
になり、方位定常値は（１−Ｔ3s／Ｔs）ｒ0Ｔsである。角速度初期値ｒ0を考慮しないと、方位変化が同定誤差の原因になるが、角速度初期値は直接取得することはできないから、角速度初期値を同定パラメータとして同定モデルに含ませることにより、同定誤差を防止する。
【００４０】
１．４ 同定モデル
以上の船体モデル、舵角オフセット及び角速度初期値から図４に示す同定モデルを構成する。舵角オフセットに関しては、命令舵角に追加される。尚、δ０／ｓとするのは、一定値の入力とするためである。
同定モデルの伝達関数は、
【００４１】
【数６】
になる。ここで、添字（・）mは、モデル値を意味する。よって、同定モデルは３次系となり、同定パラメータはｘ1m、ｘ2m、ｘ3m、δom、ｃδm、ｒ0mの６個となる。
【００４２】
２． 入力データと出力データ
同定演算部３２は、操船者または自動操船による命令舵角δcを入力データとし、船首方位ψを出力データとする。
【００４３】
簡単のため船体モデルのみを考慮すると、同定誤差γhは、（１）式及び（２）式を用いて制御対象の船首方位とモデル船首方位との差となり、
【００４４】
【数７】
になる。
【００４５】
上式よりＰ−Ｐm＝０、即ちγh＝０となるパラメータ条件を求めると、ｘ1m＝ｘ1、ｘ2m＝ｘ2、ｘ3m＝ｘ3、Ｔ3sm＝Ｔ3snを得る。
【００４６】
３． 評価関数及び同定範囲
３．１ 評価関数
パラメータ調節部４８には、上述のごとく図２に示すように、命令舵角δcを入力データとし、船首方位ψを出力データとして蓄積されたデータに対して、同定モデル４４のモデル出力データと、実プロセスの出力データとの差異となる、減算器４６による同定誤差γが順次入力される。パラメータ調節部４８では、同定誤差γをスカラー量に変換した評価関数Ｊを求め、該評価関数Jを最小にするパラメータを調整する。評価関数Jとして、同定誤差γの二乗和とし、
【００４７】
【数８】
と定義することができる。ここでｎは同定の時間範囲内にある同定データ数を表す。勿論、二乗和とする他に、同定誤差の絶対値の和とすることもでき、または適宜重み付け係数をかけることもでき、任意の評価関数を採用することができる。
【００４８】
モデルの出力はパラメータに依存するので、評価関数Jは非線形関数となる。よって、パラメータ調節部４８では、多変数関数である評価関数Jを最小化するモデルのパラメータを求める。かかる演算は、公知の任意の手段、例えば、ＳＱＰ（逐次型二次計画法sequential quadratic programming algorithm）のアルゴリズムを用いて行うことができ、評価関数の極小解を求め、該極小解となる値を同定値とする。
【００４９】
４． シーケンス
図５は、同定演算部３２及び更新判断部３４のシーケンスを表す。自動操舵装置１２は、閾値より大きい変化量の設定方位の入力により開始して設定方位に一致するように変針させる変針モードと、一定の設定方位に保針する保針モードと、を有しており、閾値より大きい変化量の設定方位の入力により変針モードが開始され所定時間経過すると、保針モードとなる。
【００５０】
同定演算部３２による処理は、主として、変針モード開始と同時に開始され、入力データ記憶部４０及び出力データ記憶部４２による入力データ及び出力データの蓄積は、変針モード中においてなされる。所定時間経過後に開始する保針モードで、蓄積されたデータに基づき、同定モデル４４、減算器４６及びパラメータ調節部４８による同定パラメータの同定値の計算がなされる。
【００５１】
同定値の計算がなされると、引き続き、保針モードにおいて更新判断部３４により、更新値の計算がなされる。計算後、更新値が各船体パラメータのノミナル値となり、軌道演算部２２、フィードフォワード制御器２６及びフィードバック制御器２８へと出力される。一方、更新判断部３４では、更新値の計算後、次の変針モードが開始されるまで、評価量等の計算を行う。
【００５２】
５． 更新処理
図６は、更新判断部３４の構成を表すブロック図である。更新判断部３４は、データ記憶部６２、評価量算出部６４、パラメータ配列蓄積部６５、平均値算出部６６、同定値制限部６８、更新処理部７０及び更新記憶部７２を備える。
【００５３】
船体パラメータは正負をもつが、比率Ｋsn／Ｔsnは常に正になるために安定船及び不安定船の両方で兼用できる。従って、更新判断に当たっては、このＫsn／Ｔsnの船体パラメータを用いて行うことにする。
【００５４】
図７に、参考文献Kensaku Nomoto：Response Analysis of Manoeuvrability and its Application to Ship Design，60th Anniversary Series，Society of Naval Architects of Japan，Vol.11， pp.43-51，1966 から引用したＫsn／Ｔsnのフル・バラスト特性を示す。同図からフル⇔バラスト間のＫsn／Ｔsn比率は
【００５５】
【数９】
になる。ここで ’：無次元指数，B：バラスト，F：フルを表す。上の比率は有次元指数においても等価である。よって、上記Ｋsn／Ｔsn比率を参考にすると
・Ｋsn／Ｔsnの比率の変動範囲は喫水変化も含めて１．３倍以内に収まる
・Ｋsn／Ｔsnは喫水変化に対して、Ｋsn、Ｔsnと共に比例的に変動する
ことを仮定することができる。
【００５６】
６． 評価量の計算
保針モード中に船体パラメータのノミナル値の適合具合を見積もるための指数を、評価量として導入する。図８は評価量の特性を表し、ノミナル値（船速修正による変化は無視する）が実際の船体パラメータにほぼ一致すると評価量は最小値に近づく。
【００５７】
評価量が波浪外乱の影響を受けないようにするために、変針から次の変針までの各保針モード中で最小値をとる外乱最小評価量を各保針モードの評価量として選ぶ。選ばれた評価量は１つの保針モードの中で海象が最も穏やかな状態だった場合に相当する。そして、各保針モード毎に選ばれた評価量の中からさらに選ばれた評価量に対応する船体パラメータのノミナル値の平均値を求めて、その平均値から更新値を求める。
【００５８】
６．１ 時系列データ処理
データ記憶部６２は、保針モードの制御対象に関する時系列データｘψ，ｘδ（添え字ψ：方位，δ：舵角（命令舵角δcとしてもよい））を所定時間毎（例えば１秒）に収録している。データ記憶部６２は、リングバッファ型メモリとすることができる。
【００５９】
６．２． 評価量算出
評価量算出部６４は、それぞれの各保針モードの時系列データｘψ，ｘδの標準偏差σψ，σδを
【００６０】
【数１０】
より算出する。ここでx：時系列データ、ｘ-：平均値、σ：標準偏差、Ｎ：データ数（例えば５１２個）である。
さらに、船体パラメータのノミナル値の適合具合を計る評価量として、
【００６１】
【数１１】
【００６２】
【数１２】
を算出する。ここでJkeepiは１つの保針モード中のデータ数Ｎ毎の評価量であり、Ｊは、その複数の評価量の中の最小値である外乱最小評価量である（パラメータ調節部４８のＪと異なることに注意されたい）。ここで、１つの保針モード中は、船体パラメータのノミナル値は同じ値が維持されていることに留意されたい。また、weightKP は、データ収録中に比例ゲインＫp（図９参照）が変化する場合（例えば、比例ゲインが、Ｋpopen＝１とＫpconf＝２．２５または１．５との間で変化できるものとする）に、その比例ゲインの変化による舵角変動を抑制するための重みづけ係数で
【００６３】
【数１３】
を示す。ここでＴopen，Ｔconf：それぞれ比例ゲインＫpopenとＫpconfの印加時間、Ｔweight ＝Ｎ×１［ｓ］とする。比例ゲインＫp＝１で固定である場合には、weightKP＝１である。
【００６４】
外乱最小評価量は、各保針モード中で、制御対象に関するデータのばらつきが最も小さいことを表しており、つまり、１つの保針モードの中で、海象が最も穏やかな状態だった期間に相当すると考えられる。この外乱最小評価量を、その保針モードの評価量として定めることで、波浪外乱の影響を低減した状態での船体パラメータのノミナル値の適合性を判断することができる。
【００６５】
尚、（６）式の評価量は、制御対象の出力である方位と、制御対象の入力側にある舵角の両方のデータのばらつきを評価対象としているが、これに限るものではなく、制御対象の出力側、入力側及び中間におけるそれぞれのデータのいずれか１つ以上を評価対象とすることができる。
【００６６】
７． パラメータ配列設定と平均値計算
パラメータ配列蓄積部６５は、保針モードに対応する評価量Ｊ1〜Ｊnとそれに対応する船体パラメータのノミナル値、即ち、更新値を対応付けて、それらのパラメータ配列
【００６７】
【数１４】
を蓄積する。ここでｎ：更新回数である。変針が行われる度に、更新回数ｎが増加する。
【００６８】
平均値算出部６６は、蓄積されたＪ1〜Ｊnのうちでさらに最小値Jminを与える船体パラメータを
【００６９】
【数１５】
で求める。ここで添え字min：評価量が最小値を意味し、初回時は初期値を設定する。Ｐminを小さい順に並べると次のようになる。
【００７０】
【数１６】
【００７１】
バラツキを抑制するために、船体パラメータのＰmini からｉ＝１〜ｋset 個の平均値（（４）式参照）を算出する（ｋset＝１の場合は、Ｐmin1 の船体パラメータとする）。例えば、ｋsetとしては、ｋset＝３と設定することができる。このとき
【００７２】
【数１７】
【００７３】
【数１８】
になり、次式の関係をもつ。
【００７４】
【数１９】
【００７５】
尚、同じ船でも安定船と不安定船との間で変化する場合があるので、パラメータ配列は、安定船用と不安定船用とでそれぞれ設け、平均値も安定船用と不安定船用とでそれぞれ分けて計算するようにするとよい。
【００７６】
８． 同定値の制限
同定値制限部６８は、同定演算部３２より得られた船体パラメータの同定値を受け取り、これに制限をかける。即ち、同定演算部３２から求められた船体パラメータの同定値は同定誤差を含むために、まず、その制限をかけて、制限を通過したものと、制限を通過しないものとで、異なる処理を施すようにする。
【００７７】
この制限は、船体パラメータのうちのＴsmに対して直接かけるようにする。
【００７８】
また同定値は変針時の船速に依存するので、船速変化に対応するために基準船速に換算し、更新の際現在の船速に換算し直す。
【００７９】
ここで、船速換算の範囲は基準船速の０．５倍以上１．５倍以下とし、同定時と更新時との船速差によるパラメータ変動を抑制するために
【００８０】
【数２０】
によって船速換算する。ここで添え字V1：変針時船速、Ｖ1，Ｖ2，ＶS：それぞれ変針時船速，更新時船速，基準船速である。
【００８１】
８．１ 第１の制限
時定数Ｔsmは、
【００８２】
【数２１】
とし、ここで、Ｔsnlow、Ｔsnhighは時定数Ｔsmとして、許容できる範囲の下限値と上限値とする。これらの値は、経験則上、妥当な値を適宜採用することができ、例えば以下の表の値を用いることができる。
【００８３】
【表１】
【００８４】
８．２ 第２の制限
許容できる微分ゲインＫdに基づきＴsmの上限値と下限値を定めて、Ｔsmをその範囲内に制限する。
【００８５】
８．２．１ フィードバック制御器
ここで、微分ゲインＫdと船体パラメータとの関係について説明する。フィードバック制御器２８は、図９のように構成され、フィードバック制御器２８は、偏差ψe＝ψR-ψ及びフィードバック制御器２８の出力の命令舵角δcから推定偏差ψe＾、推定角速度ｒ＾を求める推定器５２と、比例ゲイン５４、微分ゲイン５６と、を含む。ＫP，Ｋd はフィードバックゲインでそれぞれ比例ゲインと微分ゲインとを示す。フィードバック制御器２８は、推定器５２からの推定偏差ψe＾に対して比例ゲインＫPを乗算し、推定器５２からの推定角速度ｒ＾に対して微分ゲインＫdを乗算し、これらを加算して、命令舵角δcを出力する。
船体モデルを表す（１）、（２）式から（図３参照）、
【００８６】
【数２２】
と表すことができる。ここでｘは状態量で
【００８７】
【数２３】
を、ψは方位を、ｒx，ｒ はそれぞれ角速度を、添字(・)T は転置行列を意味する。
命令舵角δcは、方位ψと角速度ｒ，ｒxとを用いて
【００８８】
【数２４】
と表すことができる。
【００８９】
閉ループ特性を調べるために、（２１）式の命令舵角δcを（１８）式の船体モデルに代入すると
【００９０】
【数２５】
になる。上式の特性多項式を２次標準系に対応させると
【００９１】
【数２６】
になる。ここでλn はノミナル値による操舵系の特性多項式を、detは行列式を、sはラプラス演算子を意味し、Ｉは２×２ の単位行列を示す。ζn，ωn は２次標準系の操舵系のそれぞれ減衰係数，固有周波数[rad/s]を示す。
【００９２】
（２２）式から、フィードバックゲインＫp，Ｋdを特性多項式λnから定めると、
【００９３】
【数２７】
になる。設計パラメータを比例ゲインＫP（例えば、ＫP＝１）と減衰係数ζn（例えば、ζn＝１／√２）とに選ぶと、上式と（２２）式の２次標準系とから微分ゲインＫdと固有周波数ωnとはそれぞれ
【００９４】
【数２８】
となる。
【００９５】
８．２．２ Ｔsnの範囲
Ｔsnの上限値と下限値とを微分ゲインＫd に基づいて定め、上限値と下限値との間でＴsnの制限をかける。簡単化のためＴs3n =０とおくと、（２４）、（２５）式は、
【００９６】
【数２９】
となり、その微分ゲインＫdの最大値は、
【００９７】
【数３０】
を得る。ここでζn ＝１／√２：減衰係数，Ｋp＝１：比例ゲインとする。上式から不安定船の微分ゲインの最大値の分子はＴsn＜０によらず正になるが、安定船の微分ゲインの最大値の分子は、Ｔsn の値によっては、ゼロになることが分かる。よって、Ｔsnの制限値を
【００９８】
【数３１】
と定める。ここでγ ：スケールファクタ（同定演算部３２のγ と異なることに注意されたい）で、γ＝１のときＫd＝０に相当するので、下限値としては、γ＞１の値を選ぶ。図１０及び図１１は、γ に対するそれぞれＴγ（表１の制限：一点破線）、Ｋd を示す。図１２は安定船と不安定船とを含めた１／Ｔγ制限を示す。図１１から微分ゲインＫdは、γ＝６〜８でほとんど変化がない。これより
【００９９】
【数３２】
を選ぶ。表２に参考値を示す。
【０１００】
【表２】
８．３ Ｔsmの制限
安定船の同定値Ｔsm は、以上の第１の制限及び第２の制限を受けるものとする。即ち、
【０１０１】
【数３３】
の制限を受ける。図１０より通常の範囲で、（１７）式より（２７）式の方の制限の方が厳しい。不安定船は、（２７）式の制限を受ける。
【０１０２】
制限から外れた同定値に対しては、平均値算出部６６で求めた平均値（（１２）〜（１４）式）を更新値として出力するようにする。
【０１０３】
９． 更新判断と更新値出力
更新処理部７０では、制限を通過した同定値に対して次の更新判断を行い、この判断において、平均値算出部６６で求めた平均値と制限を通過した同定値とを用いて、広い範囲と狭い範囲との更新条件で判断して更新値を求める。更新回数が少ないと広い更新判断になり、同定値のバラツキが小さくなると狭い更新判断に遷移する。狭い更新判断はその航海が終了するまで保持し、次の航海で広い更新判断にリセットする。
【０１０４】
無次元指数ＣRを導入し、この指数を尺度として同定値が平均値算出部６６で求めた平均値（（１４）式）からどの程度離れているかを測り、その離反程度に応じて更新を行う。無次元指数ＣRは、平均値と同定値から
【０１０５】
【数３４】
に定める。ここで添え字update：更新値、ＳＶは、更新範囲を設定する係数であり、その最大値をＳＶmaxとする。ＳＶは、平均値からの離反程度を表す規定尺度であり、前述の図７に基づくＫsn／Ｔsnの比率の変動範囲が１．３倍以内に収まっていることから、例えば、１．３に設定し、ＳＶmaxは、経験則上２．５程度に設定するとよい。
【０１０６】
無次元指数ＣRを導入することで、小型船から大型船まで各船舶によらずに汎用性を持たせた判定を行うことができる。
【０１０７】
９．１ 判断切替
広い更新判断から狭い更新判断への切り替えは、同定値による更新
【０１０８】
【数３５】
が所定回数連続したとき（例えば、ｋmode ＝２ｋset 回）連続したときに実施するものとする。
【０１０９】
広い更新判断は同定値が変動するとき、適度な更新値を出力する。ただし同定値の変動が連続して小さくなっても、更新値がその後の変動に連動してしまうという現象が起こるため、その現象を回避するために、狭い更新判断では同定値の突発性変動に対して同定値を更新しないようにする。
【０１１０】
９．２ 広い更新判断
広い更新判断では、無次元指数ＣRに対して、その更新値ＣRupdateを図１３に示すように、
【０１１１】
【数３６】
に定める。ここで１：ノミナル値の平均値への更新を意味し、結果として、更新値は
【０１１２】
【数３７】
になる。ここで
【０１１３】
【数３８】
を示す。
即ち、無次元指数ＣRが、
【０１１４】
【数３９】
となるとき、ＳＶ−1，ＳＶの尺度で同定値を抑制し、無次元指数ＣRが、
【０１１５】
【数４０】
のとき同定値を平均値とすることで、同定値の変動を抑制する。
【０１１６】
９．３ 狭い更新判断
狭い更新判断では、無次元指数ＣRに対して、その更新値Ｃupdateを図１４に示すように定める。但し、無次元指数は、Ｋsm／Ｔsmによっているため、ＣR＝１でも、
【０１１７】
【数４１】
は保証されないので、微分ゲインが必要な値より小さく設定される場合（またはその逆の場合）がある。それらの場合を回避するため、Ｔsmに制限を設ける。すなわち（２６）式より
【０１１８】
【数４２】
を用いて（Ｋp＝１）、安定船の下限値を設定すると
【０１１９】
【数４３】
になる。ここでz＊＝０．５：減衰係数の下限許容値、ＳＶT ＝２．０：上限値であり、Ｔsnlow，Ｔsnhighは表１を参照されたい。これより
【０１２０】
【数４４】
になる。狭い更新判断では広い更新判断よりも、同定値の変動をさらに抑制するように、更新値の尺度が設定される。このとき更新値は
【０１２１】
【数４５】
になる。
【０１２２】
１０． アルゴリズム
更新判断部３４による処理を図１５Ａ〜１５Ｃに示す。
【０１２３】
保針モードにおいて、同定値制限部６８または更新処理部７０による更新がなされると、図１５Ａに示す処理が開始される。データ記憶部６２に順次蓄積されるデータに基づき、評価量算出部６４が評価量の算出を行い、外乱最小評価量を更新して（ステップＳ１０）、パラメータ配列蓄積部６５に蓄積をする（ステップＳ１２）。また、平均値算出部６６は、パラメータ配列蓄積部６５で蓄積された評価量に基づき、ｋset個の評価量に対応する船体パラメータの平均値を求めて、その最新の平均値を保持する（ステップＳ１４）。この図１５ＡのステップＳ１０〜ステップＳ１４の処理は、保針モード中繰り返される(ステップＳ１６)。
【０１２４】
次に、変針モード後、同定値演算部３２で同定値計算がなされると、図１５Ｂに示す処理が開始される。同定値制限部６８で、同定値が制限を通過したか否かを、（２７）式（不安定船）または（２８）式（安定船）に基づき、判定する（ステップＳ２０）。
【０１２５】
その判断結果で通過したと判定された場合には、更新処理部７０による更新判断に進む（ステップＳ２２）。
【０１２６】
一方、ステップＳ１０の判定において、同定値が制限を通過しなかった場合には、同定値制限部６８は、直前の評価量Ｊが上位ｋset内に入るか否かを判定する（ステップＳ２８）。上位ｋset内に入る場合には、今までの更新値、即ちノミナル値をそのまま新たな更新値とする（ステップＳ３０）。また、上位ｋset内に入らない場合には、平均値（（３３）式）を新たな更新値として更新する（ステップＳ３２）。
【０１２７】
また、図１５ＢのステップＳ２２の更新判断に進んだときには、図１５Ｃに示す処理が開始され、狭い更新判断の切り替え条件を満足するかを判定し（ステップＳ４０）、条件を満足するか否かに応じて何れかの更新判断に基づいて、（３２）式（ステップＳ４２）、または（４２）式（ステップＳ４４）で更新値を求めて、軌道演算部２２、フィードフォワード制御器２６及びフィードバック制御器２８に出力すると共に、更新記憶部７２に同定値演算部での同定値計算を行った変針方向（右舷ＣＷ，左舷ＣＣＷ）に応じて及び船体特性（安定船，不安定船）に応じて記憶する(ステップＳ４６)。
【０１２８】
また、変針モードになったときに、変針方向に応じた更新値が出力されるようにする。
【０１２９】
１１． 検証
本発明をシミュレーションによって検証する。
【０１３０】
条件：真値：Ｋs ＝０．０３［１／ｓ］，Ｔs ＝５０［ｓ］，Ｔs3＝０．０１［ｓ］，初期値：Ｋsn＝２Ｋs，Ｔsn ＝２Ｔs，Ｔs3n ＝Ｔs3，初期方位誤差３度。上記条件でシミュレーションした結果を図１６及び図１７に示す。繰返し回数は３０回で，１から１５回（前半）と１６から３０回（後半）との同定値（図中model）は同一である。前半が広い更新判断に，後半が狭い更新判断になっている。図１６の中段でＣR nominal＝ＣR update とおく。
【０１３１】
図１６より，前半は更新値（図中nominal）の変動が大きいがＫsn／Ｔsnの抑制が効き、後半は更新値単体の抑制も効くことが分かる。図１７より、前半はＫsn／Ｔsnの誤差は抑制されるがＫsn、Ｔsnの誤差は抑制されないことが分かる。後半は同定値の変動があっても平均値に更新されるため、変動が少ない。
【０１３２】
１２． まとめ
以上のように、ノミナル値の適正具合を実際の保針モードから評価し，その評価量に基づいて同定値の更新判断を実施することにより、船体パラメータの更新が円滑に実施され、突発性変動を除去することができる。
【符号の説明】
【０１３３】
１２ 自動操舵装置
１８ 制御対象
３２ 同定演算部
３４ 更新判断部
４８ パラメータ調節部
６２ データ記憶部
６４ 評価量算出部
６５ パラメータ配列蓄積部
６６ 平均値算出部
６８ 同定値制限部
７０ 更新処理部
【技術分野】
【０００１】
本発明は、船体モデルにおける船体パラメータを同定する同定機能を有する船舶用自動操舵装置に関する。
【背景技術】
【０００２】
船舶用自動操舵装置は、設定方位にジャイロコンパスからの船首方位を追従させるために舵を制御する装置であり、その制御系は、設定方位と船首方位との入力から偏差と旋回角速度とを求め制御ゲインを乗じて制御量である命令舵角を操舵機に出力する。操舵機は舵を動かして、船体に旋回角速度を誘起させて方位を変化させる。
【０００３】
図１を参照して自動操舵装置を含む全体のシステムを説明すると、１２は自動操舵装置、１４は操舵機、１６は船体であり、自動操舵装置１２は、さらに、軌道演算部２２、フィードフォワード制御器２６、フィードバック制御器２８、加算器２４、３０、同定演算部３２を備えている。
【０００４】
軌道演算部２２は設定方位ψSを入力し、設定方位ψSから軌道計画に基づいた参照針路ψRを演算するものである。加算器２４で参照針路ψRと船体１６の船首方位ψとの偏差ψeがとられ、フィードバック制御器２８において、制御ゲインが乗じられる。フィードフォワード制御器２６及びフィードバック制御器２８の出力が加算器３０で加算されて、命令舵角δcとなる。
【０００５】
同定演算部３２は、船体パラメータを同定するもので、同定された船体パラメータは、軌道演算部２２、フィードフォワード制御器２６及びフィードバック制御部２８へと入力されて、各演算及び制御に用いられる。
【０００６】
例えば、貨物船やタンカーなどの船舶は荷物の積み下ろしにより喫水が変化する。そのため、船体特性が変化し積み下ろし前の制御ゲインを用いると、操舵系の閉ループ安定性が低下しヨーイングを生じる場合を起こす。この状況を回避するために船体パラメータを同定し、制御ゲインを設定する方法として、本出願人による特許文献１が提案されている。
【０００７】
特許文献１では、同定演算部は、入力データとしての命令舵角と出力データとしての船首方位が供給されてそれぞれのデータを蓄積し、蓄積された入力データから同定モデルを用いてモデル出力データを出力し、該同定モデルからのモデル出力データと前記出力データとの比較結果から船体パラメータを調節する。
【先行技術文献】
【特許文献】
【０００８】
【特許文献１】特開２００６−３２１４５５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００９】
しかしながら、実際の船体は非線形特性をもつことが知られている。非線形特性の影響を受けないようにするために、例えば、同定計算を開始するための条件として制約（船速条件，変針条件）を加えることにより線形モデルに近似して、船体パラメータを求めることができる。
【００１０】
しかしながら、変針の形態は本船状態、変針条件、操船者による趣向および海象により均一にならない。例えば１５度の自動変針を、１５度変針で一回にするか、５度変針で三回にするかによって非線形特性の影響が異なる。同定値の誤差は前者の場合問題にならないが、後者の場合非線形特性が強く表れると考えられる。また荒天時の波浪外乱の増加に比例して、同定誤差は増加する。その結果通常の海象において、同定誤差は殆ど制御系の許容範囲内に収まるが、稀に変針形態によって許容範囲外になる状況が想定される。従って同定誤差が大きいと見なされる場合は、同定演算部で得られた同定値を制限する必要がある。
【００１１】
本発明はかかる課題に鑑みなされたもので、同定演算部から得られた同定値に制限を加えた更新値で船体パラメータを更新するようにして、同定誤差の影響を低減することができる船舶用自動操舵装置を提供することをその目的とする。
【課題を解決するための手段】
【００１２】
前述した目的を達成するために、請求項１記載の発明は、設定方位と船首方位に基づいて複数の船体パラメータを使用して命令舵角を求め、該命令舵角を制御対象に出力して舵を動かして船体を制御する船舶用自動操舵装置であって、閾値より大きい変化量の設定方位の入力により開始して設定方位に一致するように変針させる変針モードと、一定の設定方位に保針する保針モードとを持つ船舶用自動操舵装置において、
各変針モードの度に船体パラメータの同定値を出力する同定演算部を備え、該同定演算部は、
制御対象の入力データと出力データとが供給されてそれぞれのデータを蓄積する記憶部と、
蓄積された入力データからモデル出力データを出力する同定モデルと、
該同定モデルからのモデル出力データと前記出力データとの比較結果から船体パラメータを調節するパラメータ調節部と、を備え、
さらに、変針モード後に同定演算部から出力された船体パラメータの同定値に対して制限をかけた更新値をその変針モード後に使用するべき船体パラメータの新たな更新値として出力する更新判断部を備え、該更新判断部は、
各変針モードの度に更新される前記更新値の中から選択された複数の更新値の平均値を求める平均値算出部と、
同定演算部から出力された船体パラメータの同定値に対して、その少なくとも１つの船体パラメータの同定値が前記平均値から規定尺度以上離れた場合に、平均値算出部で求めた平均値を新たな更新値とする更新処理部と、
を備えることを特徴とする。
【００１３】
請求項２記載の発明は、請求項１記載の船舶用自動操舵装置において、前記更新処理部は、前記少なくとも１つの船体パラメータの同定値とその船体パラメータの前記平均値との比を表す指数を求め、該指数と１との差異を前記尺度とすることを特徴とする。
【００１４】
請求項３記載の発明は、請求項２記載の船舶用自動操舵装置において、前記更新処理部は、
前記指数が１を含む第１範囲内にあるときは、同定演算部から出力された船体パラメータの同定値を更新値とし、前記指数が前記第１範囲外にあって、且つ前記第１範囲内よりも広い第２範囲内にあるときは、同定値をその指数に依存する係数を乗算した更新値とし、前記指数が前記第２範囲を超えるときは、前記平均値算出部で求めた平均値を更新値とする広い更新処理手段と、
前記指数が１を含む第１範囲内にあるときは、同定演算部から出力された船体パラメータの同定値を更新値とし、前記指数が前記第１範囲を超えるときは、前記平均値算出部で求めた平均値を更新値とする狭い更新処理手段と、
を備えることを特徴とする。
【００１５】
請求項４記載の発明は、請求項１ないし３のいずれか１項に記載の船舶用自動操舵装置において、前記更新判断部は、
各保針モード中で、所定期間毎に制御対象に関するデータのばらつきを表す評価量を求めて、複数の評価量の中の最小評価量を求め、その最小評価量を各保針モードに対応する評価量とする評価量算出部と、
各保針モードに対応する評価量と、それに対応する船体パラメータの更新値とを蓄積するパラメータ蓄積部と、
を備え、
前記平均値算出部は、パラメータ蓄積部で蓄積された評価値の中から、評価量の値が小さい少なくとも１つの評価量に対応する船体パラメータの平均値を求めることを特徴とする。
【００１６】
請求項５記載の発明は、請求項１ないし４のいずれか１項に記載の船舶用自動操舵装置において、前記同定演算部から出力された少なくとも１つの船体パラメータの同定値に対して、その値が規定条件範囲に入るか否かを判定する同定値制限部を備え、同定値制限部によって規定条件範囲に入るものと判定された同定値に対して、前記更新処理部による更新値の処理を行うことを特徴とする。
【００１７】
請求項６記載の発明は、請求項５記載の船舶用自動操舵装置において、前記同定値制限部は、前記規定条件範囲に入らないものと判定された同定値に対して、前記平均値に更新する手段を備えることを特徴とする。
【００１８】
請求項７記載の発明は、請求項２または３記載の船舶用自動操舵装置において、前記同定モデルは船体モデルを含み、該船体モデルの伝達関数は、
【００１９】
【数１】
で表され、
前記指数は、Ｋs／Ｔsの同定値と、前記平均値算出部で求めたＫs／Ｔsの平均値との比とすることを特徴とする。
【発明の効果】
【００２０】
本発明によれば、同定演算部を備えた従来の装置に対して、更新判断部を追加するだけでよいために、適用が容易である。複数の船体パラメータの更新値の平均値を新たな更新値として採用するため、バラツキを抑制できる。
【００２１】
また、制御対象に関するデータのばらつきを表す評価量を導入し、その評価量が小さいときの船体パラメータの更新値の平均値を用いて、更新処理を行うために、実際の状況に適応した、適切な更新値とすることができる。
【００２２】
また、各保針モード中で最小評価量を求めてそれを各保針モードに対応する評価量とすることで、波浪外乱の影響を低減した実応答によって、同定値の適合性を評価するため、信頼性が得られる。
【００２３】
規定尺度を決めるための指数として、少なくとも１つの船体パラメータの同定値とその船体パラメータの平均値との比を採用することにより、指数が無次元となるために、小型船から大型船まで広範囲に適用できる。
【００２４】
同定値に制限をかけることで、同定値の信頼性を向上させ、実用範囲の値を提供することができる。
【図面の簡単な説明】
【００２５】
【図１】本発明の船舶用自動操舵装置を含む全体のシステムを表すブロック図である。
【図２】図１の同定演算部の構成を表すブロック図である。
【図３】制御対象の構成を表すブロック図である。
【図４】同定モデルの構成を表すブロック図である。
【図５】同定演算部及び更新判断部のシーケンスを表す図である。
【図６】更新判断部の構成を表すブロック図である
【図７】Ｋsn／Ｔsnのフル・バラスト特性を表すグラフである。
【図８】Ｋsn／Ｔsnと評価量Ｊとの関係を表すグラフである。
【図９】フィードバック制御器の構成を表すブロック図である。
【図１０】安定船のγに対するＴγとＫsn／Ｔsnとの関係を表すグラフである。
【図１１】安定船のγに対するＫd とＫsn／Ｔsnとの関係を表すグラフである。
【図１２】安定船と不安定船のγに対する１／ＴsnとＫsn／Ｔsnとの関係を表すグラフである。
【図１３】広い更新判断の特性を示す図である。
【図１４】狭い更新判断の特性を示す図である。
【図１５Ａ】更新判断部による処理を示すフローチャートである。
【図１５Ｂ】更新判断部による処理を示すフローチャートである。
【図１５Ｃ】更新判断部による処理を示すフローチャートである。
【図１６】本発明によるシミュレーション結果を表すグラフである。
【図１７】本発明によるシミュレーション結果を表すグラフである。
【発明を実施するための形態】
【００２６】
以下、図面を用いて本発明の実施の形態を説明する。
【００２７】
図１は、本発明の船舶用自動操舵装置を含む全体のシステムを表すブロック図である。図において、１２は自動操舵装置、１４は操舵機、１６は船体である。操舵機１４及び船体１６を合わせたものが制御対象となる船体プラント１８である。自動操舵装置１２は、さらに、軌道演算部２２、フィードフォワード制御器２６、フィードバック制御器２８、加算器３０、２４、同定演算部３２及び更新判断部３４を備えている。加算器２４で参照針路ψRと船体１６の船首方位ψとの偏差ψeがとられ、フィードバック制御器２８は偏差ψe及びフィードバック制御器２８の出力から推定偏差、推定角速度を求める推定器を含むことができる。背景技術にて既に説明した部分については、説明を省略する。
【００２８】
更新判断部３４は、同定演算部３２で演算された同定値に対して制限をかけた更新値を、船体パラメータのノミナル値として、軌道演算部２２、フィードフォワード制御器２６、フィードバック制御器２８に対して、出力する。軌道演算部２２、フィードフォワード制御器２６、フィードバック制御器２８では、これらの船体パラメータのノミナル値を用いて各演算及び制御を行う。尚、船体パラメータの初期値は、航海毎にデフォルト値を設定する。
【００２９】
図２は、同定演算部３２の構成を表すブロック図である。同定演算部３２には、実プロセスから制御対象の入出力データが時系列データとして供給されるので、これらの入力データ及び出力データを蓄積する入力データ記憶部４０、出力データ記憶部４２を備える。入力データ記憶部４０及び出力データ記憶部４２は、リングバッファ型メモリとすることができる。さらに、同定演算部３２は、データ抽出部４３、同定モデル４４、減算器４６及びパラメータ調節部４８を備える。
【００３０】
同定モデル４４で得られる出力と、制御対象の出力との同定誤差γを求め、パラメータ調節部４８によってγが最小になるようにモデルのパラメータを調整する。
【００３１】
まず、同定演算の原理について以下、簡単に説明する。
１．同定モデル
同定モデル４４は、船体モデル、外乱モデル及び船体運動の初期値とから構成され、入力データである命令舵角δcを入力しモデル出力データであるモデル船首方位ψmを出力する。以下、船体モデル、外乱モデル及び船体運動についてそれぞれ説明する。
【００３２】
１．１ 船体モデル
船体モデルは、操舵機と船体とを一体化したものとし、操舵機の時定数（船体の時定数に比較して十分に小さい）やオンオフ制御の非線形性などの不確定特性を時定数の大きい船体特性に吸収させて、舵速度や許容舵角などの確定要素を残存させる。そして、船体モデルとしては、以下の式を採用する（図３参照）。
【００３３】
【数２】
【００３４】
ここで、Ｐは船体モデルの伝達関数、ψ（ｓ）は船首方位、Ｋsn、Ｔsn、Ｔ3snは、操縦性指数を表す船体パラメータのノミナル値であり、それぞれ旋回力ゲイン［１/ｓ/ｄｅｇ］、二つの時定数［ｓ］をそれぞれ示し、Ｔs＞Ｔ3sである。これらは、安定船の場合、Ｋsn＞０，Ｔsn＞０，Ｔ3sn＞０、不安定船の場合、Ｋsn＜０，Ｔsn＜０，Ｔs3n＞０となっている。また、Ｋsm、Ｔsm、Ｔ3smまたはその組み合わせであるｘ1、ｘ2、ｘ3を同定するべき船体パラメータとする。
【００３５】
１．２ 外乱モデル
外乱モデルは、船体と風との相対速度によって発生する船体の方位軸まわりのモーメントを舵角オフセットに換算したδoffsetで表す。相対速度ベクトルの絶対値の時間変化が微小とすれば、相対速度ベクトルは方位ψの関数として扱えるので、このことから舵角オフセットを、
【００３６】
【数３】
と近似する。ここで、δoffsetは外乱モデルの舵角成分を、δO（時間微分δO・＝０）は変針前または保針時の舵角オフセットを、ｃδは変針後の舵角オフセット係数を示す。
【００３７】
１．３ 船体運動
船体運動の初期値は（２）式より直接取得できる方位と取得できない旋回角速度とがある。角速度の初期値応答は、
【００３８】
【数４】
になり、方位変化は、
【００３９】
【数５】
になり、方位定常値は（１−Ｔ3s／Ｔs）ｒ0Ｔsである。角速度初期値ｒ0を考慮しないと、方位変化が同定誤差の原因になるが、角速度初期値は直接取得することはできないから、角速度初期値を同定パラメータとして同定モデルに含ませることにより、同定誤差を防止する。
【００４０】
１．４ 同定モデル
以上の船体モデル、舵角オフセット及び角速度初期値から図４に示す同定モデルを構成する。舵角オフセットに関しては、命令舵角に追加される。尚、δ０／ｓとするのは、一定値の入力とするためである。
同定モデルの伝達関数は、
【００４１】
【数６】
になる。ここで、添字（・）mは、モデル値を意味する。よって、同定モデルは３次系となり、同定パラメータはｘ1m、ｘ2m、ｘ3m、δom、ｃδm、ｒ0mの６個となる。
【００４２】
２． 入力データと出力データ
同定演算部３２は、操船者または自動操船による命令舵角δcを入力データとし、船首方位ψを出力データとする。
【００４３】
簡単のため船体モデルのみを考慮すると、同定誤差γhは、（１）式及び（２）式を用いて制御対象の船首方位とモデル船首方位との差となり、
【００４４】
【数７】
になる。
【００４５】
上式よりＰ−Ｐm＝０、即ちγh＝０となるパラメータ条件を求めると、ｘ1m＝ｘ1、ｘ2m＝ｘ2、ｘ3m＝ｘ3、Ｔ3sm＝Ｔ3snを得る。
【００４６】
３． 評価関数及び同定範囲
３．１ 評価関数
パラメータ調節部４８には、上述のごとく図２に示すように、命令舵角δcを入力データとし、船首方位ψを出力データとして蓄積されたデータに対して、同定モデル４４のモデル出力データと、実プロセスの出力データとの差異となる、減算器４６による同定誤差γが順次入力される。パラメータ調節部４８では、同定誤差γをスカラー量に変換した評価関数Ｊを求め、該評価関数Jを最小にするパラメータを調整する。評価関数Jとして、同定誤差γの二乗和とし、
【００４７】
【数８】
と定義することができる。ここでｎは同定の時間範囲内にある同定データ数を表す。勿論、二乗和とする他に、同定誤差の絶対値の和とすることもでき、または適宜重み付け係数をかけることもでき、任意の評価関数を採用することができる。
【００４８】
モデルの出力はパラメータに依存するので、評価関数Jは非線形関数となる。よって、パラメータ調節部４８では、多変数関数である評価関数Jを最小化するモデルのパラメータを求める。かかる演算は、公知の任意の手段、例えば、ＳＱＰ（逐次型二次計画法sequential quadratic programming algorithm）のアルゴリズムを用いて行うことができ、評価関数の極小解を求め、該極小解となる値を同定値とする。
【００４９】
４． シーケンス
図５は、同定演算部３２及び更新判断部３４のシーケンスを表す。自動操舵装置１２は、閾値より大きい変化量の設定方位の入力により開始して設定方位に一致するように変針させる変針モードと、一定の設定方位に保針する保針モードと、を有しており、閾値より大きい変化量の設定方位の入力により変針モードが開始され所定時間経過すると、保針モードとなる。
【００５０】
同定演算部３２による処理は、主として、変針モード開始と同時に開始され、入力データ記憶部４０及び出力データ記憶部４２による入力データ及び出力データの蓄積は、変針モード中においてなされる。所定時間経過後に開始する保針モードで、蓄積されたデータに基づき、同定モデル４４、減算器４６及びパラメータ調節部４８による同定パラメータの同定値の計算がなされる。
【００５１】
同定値の計算がなされると、引き続き、保針モードにおいて更新判断部３４により、更新値の計算がなされる。計算後、更新値が各船体パラメータのノミナル値となり、軌道演算部２２、フィードフォワード制御器２６及びフィードバック制御器２８へと出力される。一方、更新判断部３４では、更新値の計算後、次の変針モードが開始されるまで、評価量等の計算を行う。
【００５２】
５． 更新処理
図６は、更新判断部３４の構成を表すブロック図である。更新判断部３４は、データ記憶部６２、評価量算出部６４、パラメータ配列蓄積部６５、平均値算出部６６、同定値制限部６８、更新処理部７０及び更新記憶部７２を備える。
【００５３】
船体パラメータは正負をもつが、比率Ｋsn／Ｔsnは常に正になるために安定船及び不安定船の両方で兼用できる。従って、更新判断に当たっては、このＫsn／Ｔsnの船体パラメータを用いて行うことにする。
【００５４】
図７に、参考文献Kensaku Nomoto：Response Analysis of Manoeuvrability and its Application to Ship Design，60th Anniversary Series，Society of Naval Architects of Japan，Vol.11， pp.43-51，1966 から引用したＫsn／Ｔsnのフル・バラスト特性を示す。同図からフル⇔バラスト間のＫsn／Ｔsn比率は
【００５５】
【数９】
になる。ここで ’：無次元指数，B：バラスト，F：フルを表す。上の比率は有次元指数においても等価である。よって、上記Ｋsn／Ｔsn比率を参考にすると
・Ｋsn／Ｔsnの比率の変動範囲は喫水変化も含めて１．３倍以内に収まる
・Ｋsn／Ｔsnは喫水変化に対して、Ｋsn、Ｔsnと共に比例的に変動する
ことを仮定することができる。
【００５６】
６． 評価量の計算
保針モード中に船体パラメータのノミナル値の適合具合を見積もるための指数を、評価量として導入する。図８は評価量の特性を表し、ノミナル値（船速修正による変化は無視する）が実際の船体パラメータにほぼ一致すると評価量は最小値に近づく。
【００５７】
評価量が波浪外乱の影響を受けないようにするために、変針から次の変針までの各保針モード中で最小値をとる外乱最小評価量を各保針モードの評価量として選ぶ。選ばれた評価量は１つの保針モードの中で海象が最も穏やかな状態だった場合に相当する。そして、各保針モード毎に選ばれた評価量の中からさらに選ばれた評価量に対応する船体パラメータのノミナル値の平均値を求めて、その平均値から更新値を求める。
【００５８】
６．１ 時系列データ処理
データ記憶部６２は、保針モードの制御対象に関する時系列データｘψ，ｘδ（添え字ψ：方位，δ：舵角（命令舵角δcとしてもよい））を所定時間毎（例えば１秒）に収録している。データ記憶部６２は、リングバッファ型メモリとすることができる。
【００５９】
６．２． 評価量算出
評価量算出部６４は、それぞれの各保針モードの時系列データｘψ，ｘδの標準偏差σψ，σδを
【００６０】
【数１０】
より算出する。ここでx：時系列データ、ｘ-：平均値、σ：標準偏差、Ｎ：データ数（例えば５１２個）である。
さらに、船体パラメータのノミナル値の適合具合を計る評価量として、
【００６１】
【数１１】
【００６２】
【数１２】
を算出する。ここでJkeepiは１つの保針モード中のデータ数Ｎ毎の評価量であり、Ｊは、その複数の評価量の中の最小値である外乱最小評価量である（パラメータ調節部４８のＪと異なることに注意されたい）。ここで、１つの保針モード中は、船体パラメータのノミナル値は同じ値が維持されていることに留意されたい。また、weightKP は、データ収録中に比例ゲインＫp（図９参照）が変化する場合（例えば、比例ゲインが、Ｋpopen＝１とＫpconf＝２．２５または１．５との間で変化できるものとする）に、その比例ゲインの変化による舵角変動を抑制するための重みづけ係数で
【００６３】
【数１３】
を示す。ここでＴopen，Ｔconf：それぞれ比例ゲインＫpopenとＫpconfの印加時間、Ｔweight ＝Ｎ×１［ｓ］とする。比例ゲインＫp＝１で固定である場合には、weightKP＝１である。
【００６４】
外乱最小評価量は、各保針モード中で、制御対象に関するデータのばらつきが最も小さいことを表しており、つまり、１つの保針モードの中で、海象が最も穏やかな状態だった期間に相当すると考えられる。この外乱最小評価量を、その保針モードの評価量として定めることで、波浪外乱の影響を低減した状態での船体パラメータのノミナル値の適合性を判断することができる。
【００６５】
尚、（６）式の評価量は、制御対象の出力である方位と、制御対象の入力側にある舵角の両方のデータのばらつきを評価対象としているが、これに限るものではなく、制御対象の出力側、入力側及び中間におけるそれぞれのデータのいずれか１つ以上を評価対象とすることができる。
【００６６】
７． パラメータ配列設定と平均値計算
パラメータ配列蓄積部６５は、保針モードに対応する評価量Ｊ1〜Ｊnとそれに対応する船体パラメータのノミナル値、即ち、更新値を対応付けて、それらのパラメータ配列
【００６７】
【数１４】
を蓄積する。ここでｎ：更新回数である。変針が行われる度に、更新回数ｎが増加する。
【００６８】
平均値算出部６６は、蓄積されたＪ1〜Ｊnのうちでさらに最小値Jminを与える船体パラメータを
【００６９】
【数１５】
で求める。ここで添え字min：評価量が最小値を意味し、初回時は初期値を設定する。Ｐminを小さい順に並べると次のようになる。
【００７０】
【数１６】
【００７１】
バラツキを抑制するために、船体パラメータのＰmini からｉ＝１〜ｋset 個の平均値（（４）式参照）を算出する（ｋset＝１の場合は、Ｐmin1 の船体パラメータとする）。例えば、ｋsetとしては、ｋset＝３と設定することができる。このとき
【００７２】
【数１７】
【００７３】
【数１８】
になり、次式の関係をもつ。
【００７４】
【数１９】
【００７５】
尚、同じ船でも安定船と不安定船との間で変化する場合があるので、パラメータ配列は、安定船用と不安定船用とでそれぞれ設け、平均値も安定船用と不安定船用とでそれぞれ分けて計算するようにするとよい。
【００７６】
８． 同定値の制限
同定値制限部６８は、同定演算部３２より得られた船体パラメータの同定値を受け取り、これに制限をかける。即ち、同定演算部３２から求められた船体パラメータの同定値は同定誤差を含むために、まず、その制限をかけて、制限を通過したものと、制限を通過しないものとで、異なる処理を施すようにする。
【００７７】
この制限は、船体パラメータのうちのＴsmに対して直接かけるようにする。
【００７８】
また同定値は変針時の船速に依存するので、船速変化に対応するために基準船速に換算し、更新の際現在の船速に換算し直す。
【００７９】
ここで、船速換算の範囲は基準船速の０．５倍以上１．５倍以下とし、同定時と更新時との船速差によるパラメータ変動を抑制するために
【００８０】
【数２０】
によって船速換算する。ここで添え字V1：変針時船速、Ｖ1，Ｖ2，ＶS：それぞれ変針時船速，更新時船速，基準船速である。
【００８１】
８．１ 第１の制限
時定数Ｔsmは、
【００８２】
【数２１】
とし、ここで、Ｔsnlow、Ｔsnhighは時定数Ｔsmとして、許容できる範囲の下限値と上限値とする。これらの値は、経験則上、妥当な値を適宜採用することができ、例えば以下の表の値を用いることができる。
【００８３】
【表１】
【００８４】
８．２ 第２の制限
許容できる微分ゲインＫdに基づきＴsmの上限値と下限値を定めて、Ｔsmをその範囲内に制限する。
【００８５】
８．２．１ フィードバック制御器
ここで、微分ゲインＫdと船体パラメータとの関係について説明する。フィードバック制御器２８は、図９のように構成され、フィードバック制御器２８は、偏差ψe＝ψR-ψ及びフィードバック制御器２８の出力の命令舵角δcから推定偏差ψe＾、推定角速度ｒ＾を求める推定器５２と、比例ゲイン５４、微分ゲイン５６と、を含む。ＫP，Ｋd はフィードバックゲインでそれぞれ比例ゲインと微分ゲインとを示す。フィードバック制御器２８は、推定器５２からの推定偏差ψe＾に対して比例ゲインＫPを乗算し、推定器５２からの推定角速度ｒ＾に対して微分ゲインＫdを乗算し、これらを加算して、命令舵角δcを出力する。
船体モデルを表す（１）、（２）式から（図３参照）、
【００８６】
【数２２】
と表すことができる。ここでｘは状態量で
【００８７】
【数２３】
を、ψは方位を、ｒx，ｒ はそれぞれ角速度を、添字(・)T は転置行列を意味する。
命令舵角δcは、方位ψと角速度ｒ，ｒxとを用いて
【００８８】
【数２４】
と表すことができる。
【００８９】
閉ループ特性を調べるために、（２１）式の命令舵角δcを（１８）式の船体モデルに代入すると
【００９０】
【数２５】
になる。上式の特性多項式を２次標準系に対応させると
【００９１】
【数２６】
になる。ここでλn はノミナル値による操舵系の特性多項式を、detは行列式を、sはラプラス演算子を意味し、Ｉは２×２ の単位行列を示す。ζn，ωn は２次標準系の操舵系のそれぞれ減衰係数，固有周波数[rad/s]を示す。
【００９２】
（２２）式から、フィードバックゲインＫp，Ｋdを特性多項式λnから定めると、
【００９３】
【数２７】
になる。設計パラメータを比例ゲインＫP（例えば、ＫP＝１）と減衰係数ζn（例えば、ζn＝１／√２）とに選ぶと、上式と（２２）式の２次標準系とから微分ゲインＫdと固有周波数ωnとはそれぞれ
【００９４】
【数２８】
となる。
【００９５】
８．２．２ Ｔsnの範囲
Ｔsnの上限値と下限値とを微分ゲインＫd に基づいて定め、上限値と下限値との間でＴsnの制限をかける。簡単化のためＴs3n =０とおくと、（２４）、（２５）式は、
【００９６】
【数２９】
となり、その微分ゲインＫdの最大値は、
【００９７】
【数３０】
を得る。ここでζn ＝１／√２：減衰係数，Ｋp＝１：比例ゲインとする。上式から不安定船の微分ゲインの最大値の分子はＴsn＜０によらず正になるが、安定船の微分ゲインの最大値の分子は、Ｔsn の値によっては、ゼロになることが分かる。よって、Ｔsnの制限値を
【００９８】
【数３１】
と定める。ここでγ ：スケールファクタ（同定演算部３２のγ と異なることに注意されたい）で、γ＝１のときＫd＝０に相当するので、下限値としては、γ＞１の値を選ぶ。図１０及び図１１は、γ に対するそれぞれＴγ（表１の制限：一点破線）、Ｋd を示す。図１２は安定船と不安定船とを含めた１／Ｔγ制限を示す。図１１から微分ゲインＫdは、γ＝６〜８でほとんど変化がない。これより
【００９９】
【数３２】
を選ぶ。表２に参考値を示す。
【０１００】
【表２】
８．３ Ｔsmの制限
安定船の同定値Ｔsm は、以上の第１の制限及び第２の制限を受けるものとする。即ち、
【０１０１】
【数３３】
の制限を受ける。図１０より通常の範囲で、（１７）式より（２７）式の方の制限の方が厳しい。不安定船は、（２７）式の制限を受ける。
【０１０２】
制限から外れた同定値に対しては、平均値算出部６６で求めた平均値（（１２）〜（１４）式）を更新値として出力するようにする。
【０１０３】
９． 更新判断と更新値出力
更新処理部７０では、制限を通過した同定値に対して次の更新判断を行い、この判断において、平均値算出部６６で求めた平均値と制限を通過した同定値とを用いて、広い範囲と狭い範囲との更新条件で判断して更新値を求める。更新回数が少ないと広い更新判断になり、同定値のバラツキが小さくなると狭い更新判断に遷移する。狭い更新判断はその航海が終了するまで保持し、次の航海で広い更新判断にリセットする。
【０１０４】
無次元指数ＣRを導入し、この指数を尺度として同定値が平均値算出部６６で求めた平均値（（１４）式）からどの程度離れているかを測り、その離反程度に応じて更新を行う。無次元指数ＣRは、平均値と同定値から
【０１０５】
【数３４】
に定める。ここで添え字update：更新値、ＳＶは、更新範囲を設定する係数であり、その最大値をＳＶmaxとする。ＳＶは、平均値からの離反程度を表す規定尺度であり、前述の図７に基づくＫsn／Ｔsnの比率の変動範囲が１．３倍以内に収まっていることから、例えば、１．３に設定し、ＳＶmaxは、経験則上２．５程度に設定するとよい。
【０１０６】
無次元指数ＣRを導入することで、小型船から大型船まで各船舶によらずに汎用性を持たせた判定を行うことができる。
【０１０７】
９．１ 判断切替
広い更新判断から狭い更新判断への切り替えは、同定値による更新
【０１０８】
【数３５】
が所定回数連続したとき（例えば、ｋmode ＝２ｋset 回）連続したときに実施するものとする。
【０１０９】
広い更新判断は同定値が変動するとき、適度な更新値を出力する。ただし同定値の変動が連続して小さくなっても、更新値がその後の変動に連動してしまうという現象が起こるため、その現象を回避するために、狭い更新判断では同定値の突発性変動に対して同定値を更新しないようにする。
【０１１０】
９．２ 広い更新判断
広い更新判断では、無次元指数ＣRに対して、その更新値ＣRupdateを図１３に示すように、
【０１１１】
【数３６】
に定める。ここで１：ノミナル値の平均値への更新を意味し、結果として、更新値は
【０１１２】
【数３７】
になる。ここで
【０１１３】
【数３８】
を示す。
即ち、無次元指数ＣRが、
【０１１４】
【数３９】
となるとき、ＳＶ−1，ＳＶの尺度で同定値を抑制し、無次元指数ＣRが、
【０１１５】
【数４０】
のとき同定値を平均値とすることで、同定値の変動を抑制する。
【０１１６】
９．３ 狭い更新判断
狭い更新判断では、無次元指数ＣRに対して、その更新値Ｃupdateを図１４に示すように定める。但し、無次元指数は、Ｋsm／Ｔsmによっているため、ＣR＝１でも、
【０１１７】
【数４１】
は保証されないので、微分ゲインが必要な値より小さく設定される場合（またはその逆の場合）がある。それらの場合を回避するため、Ｔsmに制限を設ける。すなわち（２６）式より
【０１１８】
【数４２】
を用いて（Ｋp＝１）、安定船の下限値を設定すると
【０１１９】
【数４３】
になる。ここでz＊＝０．５：減衰係数の下限許容値、ＳＶT ＝２．０：上限値であり、Ｔsnlow，Ｔsnhighは表１を参照されたい。これより
【０１２０】
【数４４】
になる。狭い更新判断では広い更新判断よりも、同定値の変動をさらに抑制するように、更新値の尺度が設定される。このとき更新値は
【０１２１】
【数４５】
になる。
【０１２２】
１０． アルゴリズム
更新判断部３４による処理を図１５Ａ〜１５Ｃに示す。
【０１２３】
保針モードにおいて、同定値制限部６８または更新処理部７０による更新がなされると、図１５Ａに示す処理が開始される。データ記憶部６２に順次蓄積されるデータに基づき、評価量算出部６４が評価量の算出を行い、外乱最小評価量を更新して（ステップＳ１０）、パラメータ配列蓄積部６５に蓄積をする（ステップＳ１２）。また、平均値算出部６６は、パラメータ配列蓄積部６５で蓄積された評価量に基づき、ｋset個の評価量に対応する船体パラメータの平均値を求めて、その最新の平均値を保持する（ステップＳ１４）。この図１５ＡのステップＳ１０〜ステップＳ１４の処理は、保針モード中繰り返される(ステップＳ１６)。
【０１２４】
次に、変針モード後、同定値演算部３２で同定値計算がなされると、図１５Ｂに示す処理が開始される。同定値制限部６８で、同定値が制限を通過したか否かを、（２７）式（不安定船）または（２８）式（安定船）に基づき、判定する（ステップＳ２０）。
【０１２５】
その判断結果で通過したと判定された場合には、更新処理部７０による更新判断に進む（ステップＳ２２）。
【０１２６】
一方、ステップＳ１０の判定において、同定値が制限を通過しなかった場合には、同定値制限部６８は、直前の評価量Ｊが上位ｋset内に入るか否かを判定する（ステップＳ２８）。上位ｋset内に入る場合には、今までの更新値、即ちノミナル値をそのまま新たな更新値とする（ステップＳ３０）。また、上位ｋset内に入らない場合には、平均値（（３３）式）を新たな更新値として更新する（ステップＳ３２）。
【０１２７】
また、図１５ＢのステップＳ２２の更新判断に進んだときには、図１５Ｃに示す処理が開始され、狭い更新判断の切り替え条件を満足するかを判定し（ステップＳ４０）、条件を満足するか否かに応じて何れかの更新判断に基づいて、（３２）式（ステップＳ４２）、または（４２）式（ステップＳ４４）で更新値を求めて、軌道演算部２２、フィードフォワード制御器２６及びフィードバック制御器２８に出力すると共に、更新記憶部７２に同定値演算部での同定値計算を行った変針方向（右舷ＣＷ，左舷ＣＣＷ）に応じて及び船体特性（安定船，不安定船）に応じて記憶する(ステップＳ４６)。
【０１２８】
また、変針モードになったときに、変針方向に応じた更新値が出力されるようにする。
【０１２９】
１１． 検証
本発明をシミュレーションによって検証する。
【０１３０】
条件：真値：Ｋs ＝０．０３［１／ｓ］，Ｔs ＝５０［ｓ］，Ｔs3＝０．０１［ｓ］，初期値：Ｋsn＝２Ｋs，Ｔsn ＝２Ｔs，Ｔs3n ＝Ｔs3，初期方位誤差３度。上記条件でシミュレーションした結果を図１６及び図１７に示す。繰返し回数は３０回で，１から１５回（前半）と１６から３０回（後半）との同定値（図中model）は同一である。前半が広い更新判断に，後半が狭い更新判断になっている。図１６の中段でＣR nominal＝ＣR update とおく。
【０１３１】
図１６より，前半は更新値（図中nominal）の変動が大きいがＫsn／Ｔsnの抑制が効き、後半は更新値単体の抑制も効くことが分かる。図１７より、前半はＫsn／Ｔsnの誤差は抑制されるがＫsn、Ｔsnの誤差は抑制されないことが分かる。後半は同定値の変動があっても平均値に更新されるため、変動が少ない。
【０１３２】
１２． まとめ
以上のように、ノミナル値の適正具合を実際の保針モードから評価し，その評価量に基づいて同定値の更新判断を実施することにより、船体パラメータの更新が円滑に実施され、突発性変動を除去することができる。
【符号の説明】
【０１３３】
１２ 自動操舵装置
１８ 制御対象
３２ 同定演算部
３４ 更新判断部
４８ パラメータ調節部
６２ データ記憶部
６４ 評価量算出部
６５ パラメータ配列蓄積部
６６ 平均値算出部
６８ 同定値制限部
７０ 更新処理部
【特許請求の範囲】
【請求項１】
設定方位と船首方位に基づいて複数の船体パラメータを使用して命令舵角を求め、該命令舵角を制御対象に出力して舵を動かして船体を制御する船舶用自動操舵装置であって、閾値より大きい変化量の設定方位の入力により開始して設定方位に一致するように変針させる変針モードと、一定の設定方位に保針する保針モードとを持つ船舶用自動操舵装置において、
各変針モードの度に船体パラメータの同定値を出力する同定演算部を備え、該同定演算部は、
制御対象の入力データと出力データとが供給されてそれぞれのデータを蓄積する記憶部と、
蓄積された入力データからモデル出力データを出力する同定モデルと、
該同定モデルからのモデル出力データと前記出力データとの比較結果から船体パラメータを調節するパラメータ調節部と、を備え、
さらに、変針モード後に同定演算部から出力された船体パラメータの同定値に対して制限をかけた更新値をその変針モード後に使用するべき船体パラメータの新たな更新値として出力する更新判断部を備え、該更新判断部は、
各変針モードの度に更新される前記更新値の中から選択された複数の更新値の平均値を求める平均値算出部と、
同定演算部から出力された船体パラメータの同定値に対して、その少なくとも１つの船体パラメータの同定値が前記平均値から規定尺度以上離れた場合に、平均値算出部で求めた平均値を新たな更新値とする更新処理部と、
を備えることを特徴とする船舶用自動操舵装置。
【請求項２】
前記更新処理部は、前記少なくとも１つの船体パラメータの同定値とその船体パラメータの前記平均値との比を表す指数を求め、該指数と１との差異を前記尺度とすることを特徴とする請求項１記載の船舶用自動操舵装置。
【請求項３】
前記更新処理部は、
前記指数が１を含む第１範囲内にあるときは、同定演算部から出力された船体パラメータの同定値を更新値とし、前記指数が前記第１範囲外にあって、且つ前記第１範囲内よりも広い第２範囲内にあるときは、同定値をその指数に依存する係数を乗算した更新値とし、前記指数が前記第２範囲を超えるときは、前記平均値算出部で求めた平均値を更新値とする広い更新処理手段と、
前記指数が１を含む第１範囲内にあるときは、同定演算部から出力された船体パラメータの同定値を更新値とし、前記指数が前記第１範囲を超えるときは、前記平均値算出部で求めた平均値を更新値とする狭い更新処理手段と、
を備えることを特徴とする請求項２記載の船舶用自動操舵装置。
【請求項４】
前記更新判断部は、
各保針モード中で、所定期間毎に制御対象に関するデータのばらつきを表す評価量を求めて、複数の評価量の中の最小評価量を求め、その最小評価量を各保針モードに対応する評価量とする評価量算出部と、
各保針モードに対応する評価量と、それに対応する船体パラメータの更新値とを蓄積するパラメータ蓄積部と、
を備え、
前記平均値算出部は、パラメータ蓄積部で蓄積された評価値の中から、評価量の値が小さい少なくとも１つの評価量に対応する船体パラメータの平均値を求めることを特徴とする請求項１ないし３のいずれか１項に記載の船舶用自動操舵装置。
【請求項５】
前記同定演算部から出力された少なくとも１つの船体パラメータの同定値に対して、その値が規定条件範囲に入るか否かを判定する同定値制限部を備え、同定値制限部によって規定条件範囲に入るものと判定された同定値に対して、前記更新処理部による更新値の処理を行うことを特徴とする請求項１ないし４のいずれか１項に記載の船舶用自動操舵装置。
【請求項６】
前記同定値制限部は、前記規定条件範囲に入らないものと判定された同定値に対して、前記平均値に更新する手段を備えることを特徴とする請求項５記載の船舶用自動操舵装置。
【請求項７】
前記同定モデルは船体モデルを含み、該船体モデルの伝達関数は、
【数１】
で表され、
前記指数は、Ｋs／Ｔsの同定値と、前記平均値算出部で求めたＫs／Ｔsの平均値との比とすることを特徴とする請求項２または３記載の船舶用自動操舵装置。
【請求項１】
設定方位と船首方位に基づいて複数の船体パラメータを使用して命令舵角を求め、該命令舵角を制御対象に出力して舵を動かして船体を制御する船舶用自動操舵装置であって、閾値より大きい変化量の設定方位の入力により開始して設定方位に一致するように変針させる変針モードと、一定の設定方位に保針する保針モードとを持つ船舶用自動操舵装置において、
各変針モードの度に船体パラメータの同定値を出力する同定演算部を備え、該同定演算部は、
制御対象の入力データと出力データとが供給されてそれぞれのデータを蓄積する記憶部と、
蓄積された入力データからモデル出力データを出力する同定モデルと、
該同定モデルからのモデル出力データと前記出力データとの比較結果から船体パラメータを調節するパラメータ調節部と、を備え、
さらに、変針モード後に同定演算部から出力された船体パラメータの同定値に対して制限をかけた更新値をその変針モード後に使用するべき船体パラメータの新たな更新値として出力する更新判断部を備え、該更新判断部は、
各変針モードの度に更新される前記更新値の中から選択された複数の更新値の平均値を求める平均値算出部と、
同定演算部から出力された船体パラメータの同定値に対して、その少なくとも１つの船体パラメータの同定値が前記平均値から規定尺度以上離れた場合に、平均値算出部で求めた平均値を新たな更新値とする更新処理部と、
を備えることを特徴とする船舶用自動操舵装置。
【請求項２】
前記更新処理部は、前記少なくとも１つの船体パラメータの同定値とその船体パラメータの前記平均値との比を表す指数を求め、該指数と１との差異を前記尺度とすることを特徴とする請求項１記載の船舶用自動操舵装置。
【請求項３】
前記更新処理部は、
前記指数が１を含む第１範囲内にあるときは、同定演算部から出力された船体パラメータの同定値を更新値とし、前記指数が前記第１範囲外にあって、且つ前記第１範囲内よりも広い第２範囲内にあるときは、同定値をその指数に依存する係数を乗算した更新値とし、前記指数が前記第２範囲を超えるときは、前記平均値算出部で求めた平均値を更新値とする広い更新処理手段と、
前記指数が１を含む第１範囲内にあるときは、同定演算部から出力された船体パラメータの同定値を更新値とし、前記指数が前記第１範囲を超えるときは、前記平均値算出部で求めた平均値を更新値とする狭い更新処理手段と、
を備えることを特徴とする請求項２記載の船舶用自動操舵装置。
【請求項４】
前記更新判断部は、
各保針モード中で、所定期間毎に制御対象に関するデータのばらつきを表す評価量を求めて、複数の評価量の中の最小評価量を求め、その最小評価量を各保針モードに対応する評価量とする評価量算出部と、
各保針モードに対応する評価量と、それに対応する船体パラメータの更新値とを蓄積するパラメータ蓄積部と、
を備え、
前記平均値算出部は、パラメータ蓄積部で蓄積された評価値の中から、評価量の値が小さい少なくとも１つの評価量に対応する船体パラメータの平均値を求めることを特徴とする請求項１ないし３のいずれか１項に記載の船舶用自動操舵装置。
【請求項５】
前記同定演算部から出力された少なくとも１つの船体パラメータの同定値に対して、その値が規定条件範囲に入るか否かを判定する同定値制限部を備え、同定値制限部によって規定条件範囲に入るものと判定された同定値に対して、前記更新処理部による更新値の処理を行うことを特徴とする請求項１ないし４のいずれか１項に記載の船舶用自動操舵装置。
【請求項６】
前記同定値制限部は、前記規定条件範囲に入らないものと判定された同定値に対して、前記平均値に更新する手段を備えることを特徴とする請求項５記載の船舶用自動操舵装置。
【請求項７】
前記同定モデルは船体モデルを含み、該船体モデルの伝達関数は、
【数１】
で表され、
前記指数は、Ｋs／Ｔsの同定値と、前記平均値算出部で求めたＫs／Ｔsの平均値との比とすることを特徴とする請求項２または３記載の船舶用自動操舵装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図１３】
【図１４】
【図１５Ａ】
【図１５Ｂ】
【図１５Ｃ】
【図１６】
【図１７】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図１３】
【図１４】
【図１５Ａ】
【図１５Ｂ】
【図１５Ｃ】
【図１６】
【図１７】
【公開番号】特開２０１２−７１６２１（Ｐ２０１２−７１６２１Ａ）
【公開日】平成２４年４月１２日（２０１２．４．１２）
【国際特許分類】
【出願番号】特願２０１０−２１５８５４（Ｐ２０１０−２１５８５４）
【出願日】平成２２年９月２７日（２０１０．９．２７）
【出願人】（０００００３３８８）東京計器株式会社 (103)
【公開日】平成２４年４月１２日（２０１２．４．１２）
【国際特許分類】
【出願日】平成２２年９月２７日（２０１０．９．２７）
【出願人】（０００００３３８８）東京計器株式会社 (103)
[ Back to top ]