JP4603832B2 - Automatic steering device for ship and design method of estimator for automatic steering device for ship - Google Patents
Automatic steering device for ship and design method of estimator for automatic steering device for ship Download PDFInfo
- Publication number
- JP4603832B2 JP4603832B2 JP2004226670A JP2004226670A JP4603832B2 JP 4603832 B2 JP4603832 B2 JP 4603832B2 JP 2004226670 A JP2004226670 A JP 2004226670A JP 2004226670 A JP2004226670 A JP 2004226670A JP 4603832 B2 JP4603832 B2 JP 4603832B2
- Authority
- JP
- Japan
- Prior art keywords
- model
- wave
- estimator
- natural frequency
- estimated
- 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.)
- Expired - Lifetime
Links
- 238000013461 design Methods 0.000 title claims description 42
- 238000000034 method Methods 0.000 title claims description 12
- 230000035945 sensitivity Effects 0.000 claims description 36
- 238000013016 damping Methods 0.000 claims description 9
- 238000001514 detection method Methods 0.000 claims 5
- 238000012546 transfer Methods 0.000 description 34
- 230000000694 effects Effects 0.000 description 13
- 230000007423 decrease Effects 0.000 description 9
- 238000010586 diagram Methods 0.000 description 8
- 230000008030 elimination Effects 0.000 description 6
- 238000003379 elimination reaction Methods 0.000 description 6
- 238000001574 biopsy Methods 0.000 description 5
- 230000000875 corresponding effect Effects 0.000 description 5
- 230000006866 deterioration Effects 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 238000009795 derivation Methods 0.000 description 3
- 230000006872 improvement Effects 0.000 description 3
- 230000004044 response Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 230000015556 catabolic process Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000006731 degradation reaction Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 238000010348 incorporation Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
Images
Landscapes
- Feedback Control In General (AREA)
Description
本発明は、推定器を有する船舶用自動操舵装置に関し、特にパラメータの不確かさの存在下で波浪等の外乱による無駄舵を防止することができる船舶用自動操舵装置及び船舶用自動操舵装置の推定器の設計方法に関する。 The present invention relates to a marine vessel automatic steering apparatus having an estimator, and in particular, an estimation of a marine vessel automatic steering apparatus and a marine vessel automatic steering apparatus capable of preventing wasteful rudder due to disturbance such as waves in the presence of parameter uncertainty. Relates to the design method of the vessel.
船舶用自動操舵装置は、設定針路に、ジャイロコンパスからの方位を追従させるために舵を制御する装置であり、制御系は、設定針路と船首方位との入力から偏差と旋回角速度とを求めフィードバックゲインを乗じて制御量である指令舵角を操舵機に出力する。操舵機は指令舵角に比例した舵角を動かすため、船体は舵角によって角速度を生じ方位が変化する。 The automatic marine steering system is a device that controls the rudder so that the direction from the gyrocompass follows the set course, and the control system obtains the deviation and turning angular velocity from the input of the set course and heading and feeds back. Multiply the gain and output the commanded steering angle, which is the controlled variable, to the steering machine. Since the steering machine moves the rudder angle proportional to the command rudder angle, the hull generates an angular velocity depending on the rudder angle, and its azimuth changes.
船舶用自動操舵装置の閉ループ系は図11に示すように船体モデルと波浪モデルとからなる制御対象と、推定器とフィードバックループとからなる制御系とから構成される。簡単化のため操舵機を省くので、指令舵角は舵角と等価になる。同図においてsはラプラス演算子を、
はそれぞれ設定方位,検出方位,方位,波浪を、rは角速度を、δは舵角を、νは白色ノイズN(0,1)を、それぞれ示す。方位,舵角及びノイズの単位は[deg]とし、角速度のそれは[deg/s]とする。Ksn,Tsn,Ts3nは、船体パラメータのノミナル値で、それぞれ旋回力ゲイン[1/s],船体時定数[s],舵感度時定数[s]を、ζwn,ωwn,Kwnは波浪パラメータのノミナル値でそれぞれ減衰係数,固有周波数[rad/s],ゲイン[1/s]を、KP,KDはフィードバックゲインでそれぞれ比例ゲインと微分ゲイン[s]を、それぞれ示す。なお添字(・)s,(・)wはそれぞれ船体と波浪とを、(・)n ,(・)aはそれぞれノミナル値と実際値とを、アクセント
は推定値を、それぞれ意味する。
As shown in FIG. 11, the closed-loop system of the marine vessel automatic steering apparatus includes a control target including a hull model and a wave model, and a control system including an estimator and a feedback loop. Since the steering machine is omitted for simplification, the command rudder angle is equivalent to the rudder angle. In the figure, s is the Laplace operator,
Represents the set direction, detected direction, direction and wave, r represents the angular velocity, δ represents the steering angle, and ν represents the white noise N (0, 1). The unit of azimuth, rudder angle and noise is [deg], and that of angular velocity is [deg / s]. K sn , T sn , and T s3n are nominal values of the hull parameters, and the turning force gain [1 / s], hull time constant [s], and rudder sensitivity time constant [s] are respectively ζ wn , ω wn , K wn is the nominal value of the wave parameter, and indicates the attenuation coefficient, natural frequency [rad / s], and gain [1 / s], and K P and K D are feedback gains that indicate the proportional gain and differential gain [s], respectively. . The subscripts (·) s and (·) w are the hull and wave, respectively. (·) N and (·) a are the nominal and actual values, respectively.
Means estimated values, respectively.
荒天時、方位に含まれる外乱成分が制御系を経て舵角に入力するために、操舵機は無効な操舵を行い機器の疲労や磨耗、燃料の損失を招くことになる。かかる無駄舵を防止するために各種のフィルタや天候調節機能が提案されている(非特許文献1、非特許文献2)。その中で外乱モデルとして波浪モデルを組み込んだ推定器の外乱除去効果の有効性が報告されている(非特許文献3、非特許文献4)。
During stormy weather, disturbance components included in the direction are input to the rudder angle through the control system, so the steering machine performs invalid steering, leading to equipment fatigue and wear, and fuel loss. In order to prevent such a rudder, various filters and weather adjustment functions have been proposed (Non-Patent
また、特許文献1では、定常カルマンフィルタを用いて、旋回角速度及び方位誤差の最適値を推定して天候調整を行うようにしたカルマンフィルタを含む自動操舵装置を開示している。
Further,
しかしながら、制御対象の船体モデルは、載荷の変化によるノミナル値のパラメータ不確かさを持ち、図11中のKsn,Tsn,Ts3nはKsa,Tsa,Ts3aに変化する。そのためノミナル値のモデルベースで構成する推定器は載荷の変化によって推定値に誤差を生じる。このため、推定値の状態フィードバックによる閉ループ安定性は、推定誤差によって劣化し、船体を蛇行航行させる(ヨーイング)おそれがある。 However, the hull model to be controlled has a parameter uncertainty of nominal values due to changes in loading, and K sn , T sn , and T s3n in FIG. 11 change to K sa , T sa , and T s3a . For this reason, an estimator configured on the basis of a nominal value model causes an error in the estimated value due to a change in loading. For this reason, the closed loop stability due to the state feedback of the estimated value deteriorates due to the estimation error, and there is a risk that the hull will meander (yaw).
しかしながら、従来の推定器の設計にあたっては、かかるパラメータ不確かさに対する検討については、何らなされていなかった。 However, in designing a conventional estimator, no consideration has been given to such parameter uncertainty.
本発明は、このような状況に鑑みて、船体パラメータのノミナル値のパラメータ不確かさを積極的に考慮に入れて、該パラメータ不確かさを起因とする推定誤差を小さくすることができるようにした船舶用自動操舵装置及びその推定器の設計方法を提供することをその目的とする。本発明のさらなる目的は、波浪モデルまたは舵角オフセットモデルを組み込んだ場合の、パラメータ不確かさを起因とする推定誤差と外乱除去との特性の関係に着目して設計された船舶用自動操舵装置及びその推定器の実用的な設計方法を提供することである。 In view of such circumstances, the present invention positively takes into account the parameter uncertainty of the nominal value of the hull parameters, and can reduce the estimation error caused by the parameter uncertainty. It is an object of the present invention to provide a design method for an automatic steering device for an automobile and its estimator. A further object of the present invention is to provide an automatic steering apparatus for a ship designed by paying attention to the relationship between characteristics of estimation error caused by parameter uncertainty and disturbance elimination when a wave model or a steering angle offset model is incorporated, and It is to provide a practical design method for the estimator.
かかる目的を達成するために、本発明の請求項1に記載の発明は、検出方位
と指令舵角δとを入力とし、推定方位
と推定角速度
とを出力する推定器と、
設定針路と前記推定方位との偏差及び前記推定角速度に対してそれぞれフィードバックゲインを適用して前記指令舵角δを出力するフィードバックゲインループと、
前記フィードバックゲインループから出力された前記指令舵角δに応じて舵角を変化させる操舵機と、
を有する船舶用自動操舵装置において、
前記推定器の特性多項式として、
To achieve the above object, the invention according to
And the command rudder angle δ
And estimated angular velocity
An estimator that outputs and
A feedback gain loop for applying the feedback gain to the deviation between the set course and the estimated azimuth and the estimated angular velocity to output the command steering angle δ,
A steering machine that changes the steering angle according to the command steering angle δ output from the feedback gain loop;
In the ship automatic steering device having
As a characteristic polynomial of the estimator,
λe2は、波浪モデルが仮に無いとしたときの船体モデルの状態量を推定するための特性多項式であり、ζe、ωeがそれぞれ船体モデルの状態量を推定するための減衰係数、固有周波数であり、
ωeを操舵系固有周波数ωnのρ(>1)倍に設定し、ζeを1/√2に設定する、ことを特徴とする。
λ e2 is a characteristic polynomial for estimating the state quantity of the hull model when there is no wave model, and ζ e and ω e are the attenuation coefficient and natural frequency for estimating the state quantity of the hull model, respectively. And
ω e is set to ρ (> 1) times the steering system natural frequency ω n , and ζ e is set to 1 / √2.
請求項2記載の発明は、検出方位
と指令舵角δとを入力とし、推定方位
と推定角速度
とを出力する推定器と、
設定針路と前記推定方位との偏差及び前記推定角速度に対してそれぞれフィードバックゲインを適用して前記指令舵角δを出力するフィードバックゲインループと、
前記フィードバックゲインループから出力された前記指令舵角δに応じて舵角を変化させる操舵機と、
を有する船舶用自動操舵装置において、
前記推定器の特性多項式として、
Invention, biopsy attitude position according to
And the command rudder angle δ
And estimated angular velocity
An estimator that outputs and
A feedback gain loop for applying the feedback gain to the deviation between the set course and the estimated azimuth and the estimated angular velocity to output the command steering angle δ,
A steering machine that changes the steering angle according to the command steering angle δ output from the feedback gain loop;
In the ship automatic steering device having
As a characteristic polynomial of the estimator,
λe2は、波浪モデルが仮に無いとしたときの船体モデルの状態量を推定するための特性多項式であり、ζe、ωeがそれぞれ船体モデルの状態量を推定するための減衰係数、固有周波数であり、λewは、波浪モデルの状態量を推定するための特性多項式であり、ζew、ωewがそれぞれ波浪モデルの状態量を推定するための減衰係数、固有周波数であり、
波浪モデルが無い(λew=1)としたときの推定器の船体パラメータに対する感度が、波浪モデルが有るときの推定器の船体パラメータに対する感度とほぼ等しくなるときの、ωe=ωwn(ωwn:波浪モデルの固有周波数である波浪周波数を表す)を満足するときのωeの値をωx、ωe=ωwnを満足しないときのωeの値をωyとしたときに、
波浪周波数ωwnがωxよりも大きいときには、固有周波数ωeをωyに設定し、固有周波数ωewを波浪周波数ωwnと等しく設定し、
波浪周波数ωwnがωx以下のときには、固有周波数ωeをωxに設定し、波浪周波数ωwnを修正の波浪周波数ωwn *=ωxに修正し、固有周波数ωewを修正の波浪周波数ωwn *と等しく設定する、ことを特徴とする。
λ e2 is a characteristic polynomial for estimating the state quantity of the hull model when there is no wave model, and ζ e and ω e are the attenuation coefficient and natural frequency for estimating the state quantity of the hull model, respectively. Λ ew is a characteristic polynomial for estimating the state quantity of the wave model, and ζ ew and ω ew are an attenuation coefficient and a natural frequency for estimating the state quantity of the wave model, respectively.
Ω e = ω wn (ω) when the sensitivity of the estimator to the hull parameter when there is no wave model (λ ew = 1) is almost equal to the sensitivity of the estimator to the hull parameter when there is a wave model wn: the value of omega e when satisfying represents the wave frequency) is the natural frequency omega x, the value of omega e when not satisfied ω e = ω wn when the omega y of wave model,
When the wave frequency ω wn is larger than ω x , the natural frequency ω e is set to ω y , the natural frequency ω ew is set equal to the wave frequency ω wn ,
When the wave frequency ω wn is less than or equal to ω x , the natural frequency ω e is set to ω x , the wave frequency ω wn is corrected to the corrected wave frequency ω wn * = ω x , and the natural frequency ω ew is corrected to the corrected wave frequency. It is set to be equal to ω wn * .
請求項3記載の発明は、請求項2記載のものにおいて、前記ωx及びωyは、
The invention described in
請求項4記載の発明は、請求項2または3に記載のものにおいて、前記ζewをζeに設定することを特徴とする。 According to a fourth aspect of the present invention, in the second or third aspect, the ζ ew is set to ζ e .
請求項5記載の発明は、請求項2ないし4のいずれか1項に記載のものにおいて、前記ζeを1/√2に設定することを特徴とする。 According to a fifth aspect of the present invention, in the apparatus according to any one of the second to fourth aspects, the ζ e is set to 1 / √2.
請求項6記載の発明は、検出方位
と指令舵角δとを入力とし、推定方位
と推定角速度
と推定舵角オフセット
とを出力する推定器と、
設定針路と前記推定方位との偏差及び前記推定角速度に対してそれぞれフィードバックゲインを適用すると共に前記推定舵角オフセットを用いて前記指令舵角δを出力するフィードバックゲインループと、
前記フィードバックゲインループから出力された前記指令舵角δに応じて舵角を変化させる操舵機と、
を有する船舶用自動操舵装置において、
前記推定器の特性多項式として、
Invention, biopsy attitude position according to
And the command rudder angle δ
And estimated angular velocity
And estimated rudder angle offset
An estimator that outputs and
A feedback gain loop that applies a feedback gain to the deviation between the set course and the estimated azimuth and the estimated angular velocity and outputs the command steering angle δ using the estimated steering angle offset;
A steering machine that changes the steering angle according to the command steering angle δ output from the feedback gain loop;
In the ship automatic steering device having
As a characteristic polynomial of the estimator,
λe2は、波浪モデル及び舵角オフセットモデルが仮に無いとしたときの船体モデルの状態量を推定するための特性多項式であり、ζe、ωeがそれぞれ船体モデルの状態量を推定するための減衰係数、固有周波数であり、λewは、波浪モデルの状態量を推定するための特性多項式であり、ζew、ωewがそれぞれ波浪モデルの状態量を推定するための減衰係数、固有周波数であり、λeoは、舵角オフセットモデルの状態量を推定するための特性多項式であり、ωeoが舵角オフセットモデルの状態量を推定するための固有周波数であり、
固有周波数ωeoを操舵系固有周波数ωnのρo(<1)倍に設定し、
波浪モデル及び舵角オフセットモデルが無い(λewλeo=1)としたときの推定器の船体パラメータに対する感度が、波浪モデル及び舵角オフセットモデルが有るときの推定器の船体パラメータに対する感度とほぼ等しくなるときの、ωe=ωwnを満足するときのωeの値をωx(ωwn:波浪モデルの固有周波数である波浪周波数を表す)、ωe=ωwnを満足しないときのωeの値をωyとしたときに、
波浪周波数ωwnがωxよりも大きいときには、固有周波数ωeをωyに設定し、固有周波数ωewを波浪周波数ωwnと等しく設定し、
波浪周波数ωwnがωx以下のときには、固有周波数ωeをωxに設定し、波浪周波数ωwnを修正の波浪周波数ωwn *=ωxに修正し、固有周波数ωewを修正の波浪周波数ωwn *と等しく設定する、ことを特徴とする。
λ e2 is a characteristic polynomial for estimating the state quantity of the hull model when there is no wave model and rudder angle offset model, and ζ e and ω e are for estimating the state quantity of the hull model, respectively. Λ ew is a characteristic polynomial for estimating the state quantity of the wave model, and ζ ew and ω ew are the attenuation coefficient and natural frequency for estimating the state quantity of the wave model, respectively. Yes , λ eo is a characteristic polynomial for estimating the state quantity of the steering angle offset model, ω eo is a natural frequency for estimating the state quantity of the steering angle offset model,
The natural frequency ω eo is set to ρ o (<1) times the steering system natural frequency ω n ,
The sensitivity of the estimator to the hull parameters when there is no wave model and rudder angle offset model (λ ew λ eo = 1) is almost the same as the sensitivity of the estimator to the hull parameters when there is a wave model and a rudder angle offset model. The value of ω e when ω e = ω wn when equal is expressed as ω x (ω wn : represents the wave frequency that is the natural frequency of the wave model), and ω e when ω e = ω wn is not satisfied. When the value of e is ω y ,
When the wave frequency ω wn is larger than ω x , the natural frequency ω e is set to ω y , the natural frequency ω ew is set equal to the wave frequency ω wn ,
When the wave frequency ω wn is less than or equal to ω x , the natural frequency ω e is set to ω x , the wave frequency ω wn is corrected to the corrected wave frequency ω wn * = ω x , and the natural frequency ω ew is corrected to the corrected wave frequency. It is set to be equal to ω wn * .
請求項7記載の発明は、請求項6に記載のものにおいて、前記ωx及びωyは、
The invention described in
請求項8記載の発明は、請求項6または7記載のものにおいて、前記ζewをζeに設定することを特徴とする。
The invention described in
請求項9記載の発明は、請求項6ないし8のいずれか1項に記載のものにおいて、前記ζeを1/√2に設定することを特徴とする。 A ninth aspect of the invention is characterized in that, in any one of the sixth to eighth aspects, the ζ e is set to 1 / √2.
請求項10記載の発明は、検出方位
と指令舵角δとを入力とし、推定方位
と推定角速度
とを出力する推定器と、
設定針路と前記推定方位との偏差及び前記推定角速度に対してそれぞれフィードバックゲインを適用して前記指令舵角δを出力するフィードバックゲインループと、
前記フィードバックゲインループから出力された前記指令舵角δに応じて舵角を変化させる操舵機と、
を有する船舶用自動操舵装置の推定器の設計方法であって、
まず波浪モデル無しの推定器として船体モデルの状態量を推定するための固有周波数
と減衰係数ζeとを設計し、次に波浪モデル有りの推定器として船体パラメータによる推定誤差が波浪モデル無しの場合とほぼ同一になるような船体モデルの状態量を推定するための固有周波数
を設計し、波浪モデルの状態量を推定するための固有周波数ωewと減衰係数ζewとを設計する、ことを特徴とする。
Invention, biopsy attitude position of
And the command rudder angle δ
And estimated angular velocity
And the estimated Joki you output the door,
A feedback gain loop for applying the feedback gain to the deviation between the set course and the estimated azimuth and the estimated angular velocity to output the command steering angle δ,
A steering machine that changes the steering angle according to the command steering angle δ output from the feedback gain loop;
A estimator design method of marine autopilot to have a,
First, the natural frequency for estimating the state quantity of the hull model as an estimator without a wave model
And the damping coefficient ζ e, and then, as an estimator with a wave model, the natural frequency for estimating the state quantity of the hull model so that the estimation error due to the hull parameters is almost the same as the case without the wave model
And designing the natural frequency ω ew and the attenuation coefficient ζ ew for estimating the state quantity of the wave model.
請求項11記載の発明は、検出方位
と指令舵角δとを入力とし、推定方位
と推定角速度
と推定舵角オフセット
とを出力する推定器と、
設定針路と前記推定方位との偏差及び前記推定角速度に対してそれぞれフィードバックゲインを適用すると共に前記推定舵角オフセットを用いて前記指令舵角δを出力するフィードバックゲインループと、
前記フィードバックゲインループから出力された前記指令舵角δに応じて舵角を変化させる操舵機と、
を有する船舶用自動操舵装置の推定器の設計方法であって、
まず波浪モデル及び舵角オフセットモデル無しの推定器として船体モデルの状態量を推定するための固有周波数
と減衰係数ζeとを設計し、次に波浪モデル及び舵角オフセットモデル有りの推定器として船体パラメータによる推定誤差が波浪モデル無しの場合とほぼ同一になるような船体モデルの状態量を推定するための固有周波数ωeを設計し、波浪モデルの状態量を推定するための固有周波数ωewと減衰係数ζewとを設計し、舵角オフセットモデルの状態量を推定するための固有周波数ωeoを設計する、ことを特徴とする。
Invention, biopsy attitude position of claim 11, wherein
And the command rudder angle δ
And estimated angular velocity
And estimated rudder angle offset
And the estimated Joki you output the door,
A feedback gain loop that applies a feedback gain to the deviation between the set course and the estimated azimuth and the estimated angular velocity and outputs the command steering angle δ using the estimated steering angle offset;
A steering machine that changes the steering angle according to the command steering angle δ output from the feedback gain loop;
A estimator design method of marine autopilot to have a,
First, the natural frequency for estimating the state quantity of the hull model as an estimator without wave model and rudder angle offset model
And the damping coefficient ζ e, and then estimate the state quantity of the hull model so that the estimation error due to the hull parameters is almost the same as the case without the wave model as an estimator with the wave model and rudder angle offset model The natural frequency ω e for designing the natural frequency ω ew and the damping coefficient ζ ew for estimating the state quantity of the wave model are designed, and the natural frequency ω eo for estimating the state quantity of the steering angle offset model is designed. It is characterized by designing.
請求項1記載の発明によれば、ωeを操舵系固有周波数ωnのρ(>1)倍に設定にし、ζeを1/√2に設定することにより、角速度の伝達関数に対する船体パラメータに対する感度を小さくすることができるようになり、船体パラメータの変動による推定誤差を低減し、推定誤差による閉ループ安定性の低下を防ぐことができる。 According to the first aspect of the present invention, the hull parameter for the transfer function of the angular velocity is set by setting ω e to ρ (> 1) times the steering system natural frequency ω n and setting ζ e to 1 / √2. It is possible to reduce the sensitivity to, and to reduce the estimation error due to fluctuations in the hull parameters and prevent the closed loop stability from being lowered due to the estimation error.
請求項2ないし5記載の発明によれば、船体モデルの状態量を推定するためのモデルと、波浪モデルの状態量を推定するためのモデルとに分けて推定器を設計しているために、波浪モデルを導入したことによる船体パラメータの変動を起因とする推定誤差の劣化を把握することができるようになる。この劣化は、波浪周波数が低くなると大きくなることが分かる。そこで、波浪モデルを導入したときの船体パラメータに対する感度を、波浪モデルがない船体モデルだけの場合の感度と、最低限同じになるように、船体モデルの状態量を推定するためのモデルの固有周波数を設定する。
According to the inventions of
これにより、推定誤差特性を、波浪モデル即ち外乱モデルのない、最も単純な制御対象である船体モデルのものと等価とすることができ、推定器を用いた閉ループ系設計を簡単化することができる。 As a result, the estimation error characteristic can be equivalent to that of the hull model that is the simplest control object without the wave model, that is, the disturbance model, and the closed loop system design using the estimator can be simplified. .
請求項3記載の発明によれば、波浪モデルを導入したときの船体パラメータに対する感度を、波浪モデルがない船体モデルだけの場合の感度と同じになるようにする固有周波数の値を、2次方程式の解により求めることができ、簡単に求めることができるようになる。 According to the third aspect of the present invention, the value of the natural frequency is set so that the sensitivity to the hull parameters when the wave model is introduced is the same as the sensitivity of only the hull model without the wave model. It can be obtained by the solution of and can be obtained easily.
請求項6ないし9記載の発明によれば、船体モデルの状態量を推定するためのモデルと、波浪モデルの状態量を推定するためのモデルと、舵角オフセットモデルの状態量を推定するためのモデルとに分けて推定器を設計しているために、波浪モデル及び舵角オフセットモデルを組み込んだことによる船体パラメータの変動を起因とする推定誤差の劣化を把握することができるようになる。この劣化は、波浪周波数が低くなると大きくなることが分かる。そこで、波浪モデル及び舵角オフセットモデルを導入したときの船体パラメータに対する感度を、これらモデルを導入していない場合の感度と、最低限同じになるように、船体モデルの状態量を推定するためのモデルの固有周波数を設定する。
According to the inventions of
これにより、推定誤差特性を、波浪モデル及び舵角オフセットモデルのない、最も単純な制御対象である船体モデルのものと等価とすることができ、推定器を用いた閉ループ系設計を簡単化することができる。 As a result, the estimation error characteristics can be equivalent to those of the hull model that is the simplest control object without the wave model and rudder angle offset model, and the closed-loop system design using the estimator can be simplified. Can do.
請求項7記載の発明によれば、波浪モデル及び舵角オフセットモデルを導入したときの船体パラメータに対する感度を、これらモデルがない船体モデルだけの場合の感度と同じになるようにする固有周波数の値を、2次方程式の解により求めることができ、簡単に求めることができるようになる。 According to the seventh aspect of the invention, the value of the natural frequency is set so that the sensitivity to the hull parameters when the wave model and the rudder angle offset model are introduced is the same as the sensitivity of only the hull model without these models. Can be obtained by the solution of the quadratic equation, and can be easily obtained.
請求項10及び11記載の発明によれば、船体モデルの状態量を推定するためのモデルと、波浪モデルまたは舵角オフセットモデルの状態量を推定するためのモデルとに分けて推定器を設計しているために、波浪モデルまたは舵角オフセットモデルを導入したことによる船体パラメータの変動を起因とする推定誤差の劣化を把握することができるようになる。そこで、推定誤差を外乱モデルのパラメータに依らず仕様どおりに設計できるので、極めて簡単に推定器の設計をすることができるようになる。
According to the invention described in
以下、図面を用いて本発明の実施の形態を説明する。 Hereinafter, embodiments of the present invention will be described with reference to the drawings.
まず、波浪モデル無しの推定器を設計し、次に波浪モデル有りの推定器を設計する(第1実施形態)。そして、舵角オフセットモデルをさらに組み込んだ波浪モデル有りの推定器を設計する(第2実施形態)。 First, an estimator without a wave model is designed, and then an estimator with a wave model is designed (first embodiment). Then, an estimator with a wave model further incorporating a steering angle offset model is designed (second embodiment).
波浪モデル無しの推定器の設計においては、パラメータ不確かさに起因した推定誤差の特性を把握し、閉ループ安定性を低下させる誤差要因を求め、それを低減させるような設計を行い、波浪モデル有りの推定器および舵角オフセットモデルを組み込んだ波浪モデル有りの推定器では波浪モデル無しの推定器の結果と比較して波浪モデルの導入による推定誤差と外乱除去との特性を把握し、推定誤差を波浪モデル無しの推定器の場合と同一にし、外乱除去性を前者の場合より向上するような設計を行う。 In designing an estimator without a wave model, grasp the characteristics of the estimation error due to parameter uncertainty, determine the error factor that reduces the closed-loop stability, and design to reduce it. In the estimator with the wave model incorporating the estimator and the rudder angle offset model, the characteristics of the estimation error and disturbance rejection due to the introduction of the wave model are grasped compared with the result of the estimator without the wave model, and the estimation error is The design is made to be the same as that of the estimator without a model, and the disturbance eliminability is improved as compared with the former case.
本発明で対象とする第1実施形態による自動操舵装置10の制御系は、図1に示したように、設定針路と検出船首方位とに基づいて指令舵角δを出力する自動操舵装置の制御系において、閉ループを安定化するフィードバックループ15と、船首方位に含まれる波浪成分を除去する推定器20とから構成され、推定器20は、検出方位
と指令舵角δとを入力とし、船首方位の推定値である推定方位
と旋回角速度の推定値である推定角速度
とを出力する。
As shown in FIG. 1, the control system of the
And command rudder angle δ as input, estimated heading that is an estimated value of heading
And the estimated angular velocity, which is an estimate of the turning angular velocity
Is output.
推定器20の設計にあたり、操舵系と数値例を以下のように設定する。操舵系は、船体モデルとフィードバックループとからなる系に定めると、特性方程式は、
In designing the
船体パラメータの数値例は、船体モデルが安定船(ノミナル値)から不安定船(実際値)に変化した場合を想定し The numerical example of the hull parameters assumes that the hull model changes from a stable ship (nominal value) to an unstable ship (actual value).
以下、推定器の設計について、手順を追って説明する。 Hereinafter, the design of the estimator will be described step by step.
(第1実施形態)
1 波浪モデル無しの推定器
1.1 はじめに
波浪モデル無しの推定器(以下2次推定器と呼ぶ)は、ノミナル値の船体モデルから構成され、検出方位と指令舵角とを入力し推定方位と推定角速度とを出力する。それら出力は閉ループ安定化のためフィードバック制御に利用される。推定器は、ノミナル値のパラメータ不確かさにより推定誤差を生じるため安定性を劣化させる場合が生じる。よってパラメータ不確かさに起因する推定誤差を推定器の伝達関数を用いて調べ、その結果から2次推定器を設計することとする。
(First embodiment)
1 Estimator without wave model 1.1 Introduction An estimator without a wave model (hereinafter referred to as a secondary estimator) is composed of a nominal hull model, and inputs the detected direction and the command rudder angle. Outputs estimated angular velocity. These outputs are used for feedback control for closed-loop stabilization. Since the estimator generates an estimation error due to the parameter uncertainty of the nominal value, the stability may be deteriorated. Therefore, the estimation error caused by the parameter uncertainty is examined using the transfer function of the estimator, and a secondary estimator is designed from the result.
1.2 伝達関数の導出
2次推定器は、図2に示すように、ノミナル値の船体モデル(野本モデル)と、検出方位と推定方位との差
1.2 Derivation of transfer function As shown in Fig. 2, the secondary estimator is the difference between the nominal value hull model (Nomoto model) and the detected and estimated directions.
は、それぞれ方位と波浪とから推定方位までの伝達関数、
はそれぞれ方位と波浪とから推定角速度までの伝達関数で、
は2次推定器を意味し、
Is the transfer function from azimuth and wave to estimated azimuth,
Is the transfer function from azimuth and wave to the estimated angular velocity,
Means a second order estimator,
式(6)〜(9)から、2次推定器の伝達関数は、次の特性を持つことが分かる。
・パラメータ不確かさがなければ、推定値は真値と一致する。
・波浪による推定誤差はパラメータ不確かさに無関係である。
・パラメータ不確かさと波浪とによる推定誤差は特性多項式に関係する。
Gc3は舵感度時定数の関数を示し、操舵系固有周波数ωnでのゲインは、
From equations (6) to (9), it can be seen that the transfer function of the secondary estimator has the following characteristics.
• If there is no parameter uncertainty, the estimated value matches the true value.
• The estimation error due to waves is independent of parameter uncertainty.
• Estimation errors due to parameter uncertainty and waves are related to the characteristic polynomial.
G c3 represents a function of the rudder sensitivity time constant, and the gain at the steering system natural frequency ω n is
1.3 推定ゲインの設定
推定ゲインは特性方程式の根を極配置することにより求める。式(10)の特性方程式を2次標準系、
1.3 Estimated gain setting Estimated gain is obtained by placing the root of the characteristic equation in a pole. The characteristic equation of equation (10) is expressed as a secondary standard system,
1.4 伝達関数の周波数特性
伝達関数のパラメータ不確かさに起因する誤差を周波数特性で調べる。そのために、ゲイン
に対する誤差Δ1,Δ2の影響を求める。
1.4 Frequency characteristics of transfer function The error due to the parameter uncertainty of the transfer function is examined using the frequency characteristics. Therefore, gain
The influences of errors Δ 1 and Δ 2 on are obtained.
1.4.1 誤差Δ1の影響
式(6)から、Δ1による伝達関数
への影響は、
1.4.1 Effect of error Δ 1 From equation (6), transfer function with Δ 1
The impact on
次に、式(8)から、Δ1による伝達関数
への影響は、
Next, from equation (8), the transfer function by Δ 1
The impact on
1.4.2 誤差Δ2の影響
式(6)から、Δ2による伝達関数
への影響は、
1.4.2 Effect of error Δ 2 From equation (6), transfer function by Δ 2
The impact on
への影響は、
と同じになるため、詳細説明を省略する。
The impact on
Detailed description will be omitted.
1.4.3 周波数特性
以上の低周波数域と高周波数域とでの
のゲイン特性を表にまとめると、表1となる。表1は、誤差Δ1、Δ2のそれぞれに対するゲインへの影響を表している。位相は同領域ですべてゼロになる。操舵系と推定器との固有周波数の関係ωn<ωeから同表の低周波数域に着目すると、
のゲイン特性が、Δ1<0のとき1以下となることが分かる。このとき推定角速度による微分成分の制御量が減少するために閉ループ安定性が劣化する場合を生じる。つまり、Δ1による
の推定誤差が閉ループ安定性を低下させる最大要因になるため、かかる低下を防ぐように設計を行なう必要がある。
1.4.3 Frequency characteristics In the above low frequency range and high frequency range
Table 1 summarizes the gain characteristics. Table 1 shows the effect on the gain for each of the errors Δ 1 and Δ 2 . The phases are all zero in the same region. From the relationship between the natural frequency of the steering system and the estimator ω n <ω e , focusing on the low frequency range in the table,
It can be seen that the gain characteristic is 1 or less when Δ 1 <0. At this time, the control amount of the differential component due to the estimated angular velocity decreases, so that the closed loop stability may be deteriorated. That is, by Δ 1
Therefore, the design error must be designed to prevent such a decrease.
1.5 特性方程式の設計
上記の結果を用いて、設計パラメータωe,ζeを設計する。2次推定器は外乱除去性能より推定性能を重視するため、パラメータ不確かさによる推定誤差の低減を図るように、推定角速度の伝達関数すなわちΔ1による
の誤差を低減する設計を行う。Δ2による伝達誤差は設計パラメータで低減できないが低周波数域でほぼゼロになるため無視できる。
1.5 Design of characteristic equation Design parameters ω e and ζ e are designed using the above results. Since the second-order estimator places more emphasis on the estimation performance than the disturbance removal performance, the estimated angular velocity transfer function, ie, Δ 1 is used so as to reduce the estimation error due to parameter uncertainty.
Design to reduce the error. Transmission error due to delta 2 is negligible because it can not be reduced by the design parameters becomes substantially zero in the low frequency range.
1.5.1 固有周波数ωeの設計
式(8)の
のΔ1の係数(s+k1)/λe2は、式(15)、(16)により分子がωeの1次で分母がωeの2次である。よって、ωeを高くすると、
の伝達誤差は低減する。ωeは操舵系の固有周波数ωnと推定係数ρ>1とを用いて、
の仕様を満足する値に設定されるとよい。好ましくはρは3以上で、
の仕様を0.7程度にすると、ρは6程度の値とするとよい。
1.5.1 Design of natural frequency ω e Equation (8)
The coefficients of the Δ 1 (s + k 1) / λ e2, equation (15), a second order denominator primary molecule omega e is omega e by (16). Therefore, if ω e is increased,
The transmission error is reduced. ω e uses the natural frequency ω n of the steering system and the estimation coefficient ρ> 1,
It should be set to a value that satisfies the specifications. Preferably ρ is 3 or more,
Is about 0.7, ρ should be a value of about 6.
1.5.2 減衰係数ζeの設計
ζeはΔ1による
のパラメータ不確かさ感度を最小にする値を選ぶ。Δ1による
への影響は、前掲のように、
1.5.2 Design of damping coefficient ζ e ζ e depends on Δ 1
Choose a value that minimizes the parameter uncertainty sensitivity. According to Δ 1
As mentioned above,
図3はζe=0.5,0.707,1とした場合についての
のボード線図を示す。なお計算はρ=3,6で式(2)の数値を用いる。同図よりζeを小さくするに従い、ゲインのオフセット誤差は小さくなり位相のピーク誤差の周波数は高域に移ることが分かる。しかしζe=0.5の場合は、ゲインにピーク誤差を生じている。ζe=0.707の場合はゲインにピーク誤差を生じなく位相のピーク誤差はζe=0.5のものより小さい。
FIG. 3 shows the case where ζ e = 0.5, 0.707,1.
The Bode diagram of is shown. The calculation uses ρ = 3, 6 and the value of equation (2). From the figure, it can be seen that as ζ e is decreased, the offset error of the gain is reduced and the frequency of the phase peak error is shifted to a high frequency. However, when ζ e = 0.5, a peak error occurs in the gain. When ζ e = 0.707, no peak error occurs in the gain, and the phase peak error is smaller than that of ζ e = 0.5.
したがって、ζe=0.707は、周波数応答においてゲインにピーク誤差を生じさせない最小値、すなわち最適値になる。 Therefore, ζ e = 0.707 is a minimum value that does not cause a peak error in the gain in the frequency response, that is, an optimum value.
1.6 まとめ
以上のことから、波浪モデル無しの推定器においては、ωe=ρωn,ζe=1/√2と設定する。
1.6 Summary From the above, in an estimator without a wave model, ω e = ρω n and ζ e = 1 / √2 are set.
2. 波浪モデル有りの推定器
2.1 はじめに
次に、波浪モデル有りの推定器を考える。波浪モデル有りの推定器(以下4次推定器と呼ぶ)は、2次推定器に波浪モデルを組み込むことで、検出方位に含まれる波浪成分を推定波浪として分離抽出することができる。そのため推定方位と推定角速度とに含まれる波浪成分が除去され無駄舵が防止できる。しかし波浪モデルの導入が推定誤差を増加させる状況は避けなければならない。よって2次推定器の推定誤差を保持しつつ、かつ効果的な外乱除去性能を実現する4次推定器を設計する。なお記号は2次推定器のものと同一とする。
2. 2. Estimator with wave model 2.1 Introduction Next, an estimator with a wave model is considered. An estimator with a wave model (hereinafter referred to as a fourth-order estimator) can separate and extract the wave component included in the detected direction as an estimated wave by incorporating the wave model into the secondary estimator. Therefore, the wave component contained in the estimated azimuth and the estimated angular velocity is removed, and useless steering can be prevented. However, the situation where the introduction of the wave model increases the estimation error must be avoided. Therefore, a quaternary estimator is designed that retains the estimation error of the secondary estimator and realizes effective disturbance removal performance. Note that the symbols are the same as those of the secondary estimator.
2.2 伝達関数の導出
4次推定器は、図4に示すように、2次推定器にノミナル値の波浪モデルを加えたもので、
2.2 Derivation of transfer function As shown in Fig. 4, the fourth-order estimator is obtained by adding a nominal wave model to the second-order estimator.
になる。ここで、ki,i=1〜4は推定ゲインを、
は状態量を、
は推定波浪を、それぞれ示す。波浪モデルの固有周波数、減衰係数ωwn、ζwnは、図示しない波浪同定器によって、検出方位
から同定されるものである。波浪モデルの未知入力νは白色ノイズを仮定しているので平均値ゼロになる。したがってψwおよびψwに対応する
もまた平均値ゼロになるから、上式でνの入力の必要はない。上式と式(4)とを整理すると、4次推定器の伝達関数は、
become. Here, k i, i = 1 to 4 are estimated gains,
Is the state quantity,
Indicates estimated waves respectively. The natural frequency and attenuation coefficient ω wn and ζ wn of the wave model are detected by a wave identifier (not shown)
Are identified. Since the unknown input ν of the wave model assumes white noise, the average value becomes zero. Thus corresponding to ψ w and ψ w
Since the average value is also zero, it is not necessary to input ν in the above equation. Rearranging the above equation and equation (4), the transfer function of the fourth-order estimator is
はそれぞれ方位と波浪とから推定波浪までの伝達関数で、
は4次推定器を意味し、
Is the transfer function from direction and wave to estimated wave,
Means a fourth order estimator,
式(24)〜(29)から、4次推定器の伝達関数は、波浪モデルの組み込みによって、2次推定器の特性に加えて次の特定を持つことが分かる。
・波浪モデルが推定方位と推定角速度との伝達関数の分子に付加される。
・推定波浪はパラメータ不確かさにより推定誤差が生じる。
From equations (24) to (29), it can be seen that the transfer function of the fourth-order estimator has the following specification in addition to the characteristics of the second-order estimator by incorporating the wave model.
A wave model is added to the numerator of the transfer function between the estimated azimuth and the estimated angular velocity.
・ Estimated waves have estimation errors due to parameter uncertainty.
2.3 推定ゲインの設定
式(30)の特性方程式を2つの2次標準系を用いて
を付加する。
Is added.
2.4 特性方程式の設計
4次推定器の設計は、式(33)においてλeが2次推定器の設計より設定できるので、もう一方のλewのωew,ζewを決定することになる。4次推定器は波浪モデルを取り込むことによって、2次推定器より外乱除去性能の向上を図る。よって推定方位と推定角速度とに含まれる波浪成分を除去する設計を行う。波浪から推定方位と推定角速度とまでの伝達関数は式(25),(27)より波浪モデルをもつから、波浪除去に対応する伝達関数は、
2.4 Design of Characteristic Equation The design of the fourth-order estimator is to determine ω ew and ζ ew of the other λ ew since λ e can be set from the design of the second-order estimator in Equation (33). Become. The fourth-order estimator takes in the wave model to improve the disturbance removal performance than the second-order estimator. Therefore, a design is made to remove the wave component included in the estimated azimuth and the estimated angular velocity. Since the transfer function from the wave to the estimated azimuth and the estimated angular velocity has a wave model from Equations (25) and (27), the transfer function corresponding to wave removal is
2.4.1 固有周波数ωewの設計
上記伝達関数に波浪周波数ωwnでのノッチフィルタ特性を持たせるために、
ところで、推定誤差は、前述の2次推定器におけるΔ1に対する伝達関数への影響から類推されるように、ωe,ωewの内、より低い周波数でより大きくなる傾向をもつ。そのため波浪モデルの導入による推定誤差の増加を防ぐために、 By the way, the estimation error tends to become larger at lower frequencies of ω e and ω ew , as can be inferred from the influence on the transfer function for Δ 1 in the above-described secondary estimator. Therefore, in order to prevent an increase in estimation error due to the introduction of the wave model,
2.4.2 減衰係数ζewの設計
最悪条件になったときに(ωwn=ωew=ωe)にパラメータ不確かさ感度を最小にするために、λewをλeに一致させるよう減衰係数を
2.4.2 Design of attenuation coefficient ζ ew Attenuation to match λ ew to λ e to minimize parameter uncertainty sensitivity when worst case (ω wn = ω ew = ω e ) Coefficient
2.5 4次推定器の特性
4次推定器の推定誤差と波浪除去との特性を2次推定器の特性と比較する。推定誤差は2次推定器の設計よりパラメータ不確かさΔ1に対する推定角速度の伝達関数を調べる。一方、推定値に含まれる波浪成分はフィードバックゲインを乗じて舵角になる。微分ゲインが比例ゲインより大きいために、舵角の波浪成分は推定方位のものより推定角速度のものが主要になる。よって、波浪除去は波浪に対する推定角速度の伝達関数を調べることにする。
2.5 Characteristics of the fourth-order estimator The characteristics of the estimation error and wave elimination of the fourth-order estimator are compared with those of the second-order estimator. For the estimation error, the transfer function of the estimated angular velocity with respect to the parameter uncertainty Δ 1 is examined from the design of the secondary estimator. On the other hand, the wave component included in the estimated value is multiplied by a feedback gain to become a steering angle. Since the differential gain is larger than the proportional gain, the wave component of the rudder angle is mainly of the estimated angular velocity than that of the estimated azimuth. Therefore, wave removal will examine the transfer function of the estimated angular velocity for waves.
Δ1による伝達関数
への影響は、式(26)より、
From the equation (26),
に依存することがわかる。式(34)の推定ゲインに対し波浪除去条件(ωew=ωwn,ζew=ζe)を用いて近似すると、推定ゲインk1,k2はそれぞれ
It turns out that it depends on. When the estimated gain of Equation (34) is approximated using the wave removal conditions (ω ew = ω wn , ζ ew = ζ e ), the estimated gains k 1 and k 2 are respectively
のほぼ2倍から
に、k2は
より小さい値から
にそれぞれ漸近する。その様子を、式(2)の数値を用いて計算した結果として図5に示す。同図はk1,k2の近似式を用いず、ρ=3,ζwn=0.05,0.1,0.2,0.3を用いて、横軸にRe4を縦軸に推定ゲイン比
とをそれぞれ示している。図から最悪条件(Re4=1)の場合、推定ゲインk1は
の約2倍になるため、4次推定器のパラメータ不確かさに起因した推定誤差も2次推定器のそれの約2倍に増加することが分かる。
Almost twice as much
And k 2 is
From smaller value
Asymptotically. This is shown in FIG. 5 as a result of calculation using the numerical value of the equation (2). The figure without the approximation formula of k 1, k 2, ρ = 3, with the ζ wn = 0.05,0.1,0.2,0.3, estimated gain ratio on the vertical axis R e4 horizontal axis
Respectively. In the worst case (R e4 = 1), the estimated gain k 1 is
It can be seen that the estimation error due to the parameter uncertainty of the fourth order estimator also increases to about twice that of the second order estimator.
次に、波浪周波数に対する推定角速度のゲイン特性,すなわち波浪除去性能は式(9),(27)より
この結果、4次推定器の特性は2次推定器のそれに比べて、推定誤差が最悪条件で2倍程度に増加し、外乱除去性がζwn=0.1で0.14倍に減少することが分かる。 As a result, the characteristic of the fourth-order estimator is about twice as large as that of the second-order estimator under the worst condition, and the disturbance rejection is reduced to 0.14 times when ζ wn = 0.1. I understand that.
2.6 推定誤差の改善
前項で示されたように、波浪モデルを導入することにより、外乱除去性能は向上するが、推定性能は劣化することが分かった。しかしながら、実用的な推定器の設計としては、閉ループ安定性を優先するため、外乱除去性能の低下は許容しつつ、推定性能は波浪モデルなしの場合と同等になるように設計することが望まれる。以下、推定誤差の改善と、それに伴う外乱除去性能の低下について検討する。
2.6 Improvement of estimation error As shown in the previous section, it was found that the introduction of the wave model improves the disturbance removal performance but degrades the estimation performance. However, as a practical estimator design, closed-loop stability is prioritized, so it is desirable to design the estimation performance to be equivalent to that without the wave model while permitting a reduction in disturbance rejection performance. . In the following, the improvement of the estimation error and the accompanying decrease in disturbance removal performance will be examined.
推定誤差は式(41)でパラメータ不確かさΔ1の係数(以降、感度関数Sと呼ぶ)に依存する。4次推定器の感度関数Sを2次推定器のもの
と等しくなるように置くと、
The estimation error depends on the coefficient of parameter uncertainty Δ 1 (hereinafter referred to as sensitivity function S) in equation (41). The sensitivity function S of the fourth order estimator is that of the second order estimator.
Is set equal to
Re4に対する感度関数と外乱除去性能との関係を図6の4次推定器の特性を用いて説明する。同図は上段の横軸に周波数比
をその縦軸に感度関数の差
を、下段の横軸に周波数比
をその縦軸に波浪除去ゲイン[dB]をそれぞれ示し、
The relationship between the sensitivity function and disturbance rejection performance for R e4 will be described by using the characteristic of the fourth order estimator of FIG. The figure shows the frequency ratio on the horizontal axis at the top.
The difference in sensitivity function on the vertical axis
On the lower horizontal axis
Shows the wave removal gain [dB] on the vertical axis,
の位置を求め、下段からその位置をカットオフ周波数とする波浪除去性能を求める。波浪除去効果はカットオフ周波数において4次推定器の除去ゲイン−20[dB](ノッチフィルタ効果)と、2次推定器の除去ゲイン−40dB/dec(式(9)より)との差になる。
The wave removal performance with the cut-off frequency at the position is obtained from the lower stage. The wave removal effect is the difference between the removal gain of the fourth order estimator −20 [dB] (notch filter effect) and the removal gain of the second order estimator −40 dB / dec (from equation (9)) at the cutoff frequency. .
尚、上段において、図中の凡例中のRe4(0)の値は、
のときのRe4の値(初期値)を意味し、Re4=n(n=1,1.5,2,3)の線はそれぞれ
が大きくなる(横軸を右に進む)に従い、Re4の値自体は小さくなっていくが、1に達すると1に維持される。例えば、Re4(0)=1の線は図中1に維持され、Re4(0)=1.5の線は、
になるまではRe4の値が小さくなるが、それ以上ではRe4=1に維持されている。他の線も同様である。
In the upper row, the value of R e4 (0) in the legend in the figure is
Means the value (initial value) of R e4 when R e4 = n (n = 1, 1.5, 2, 3)
As the value increases (goes to the right on the horizontal axis), the value of Re4 itself decreases, but when it reaches 1, it is maintained at 1. For example, the line R e4 (0) = 1 is maintained at 1 in the figure, and the line R e4 (0) = 1.5 is
The value of R e4 becomes smaller until R e4 is reached, but R e4 = 1 is maintained beyond that. The same applies to the other lines.
Re4(0)=1(最悪条件)の場合、感度関数比は
2.6.1 ωeの解法
式(47)を満足する4次推定器の固有周波数ωeを求める。まず最悪条件になると仮定した場合のωeを求めるために、Re4=1として式(42)を式(47)に代入すると、
より大きい値となる。
2.6.1 Solving ω e Find the natural frequency ω e of the fourth-order estimator that satisfies Equation (47). First, in order to obtain ω e under the assumption of the worst condition, substituting equation (42) into equation (47) with R e4 = 1,
Greater value.
次に、最悪条件にならないと仮定した場合のωeを求めるためにRe4=ωwn/ωeとして同様にすると、
より大きい値となる。
Next, in order to obtain ω e under the assumption that the worst condition is not satisfied, R e4 = ω wn / ω e
Greater value.
ωwnとωxとの大小を比較することによって最悪条件であるか否かの判別をすることができる。ωwn≦ωxが成り立つときには、最悪条件のωe=ωxとすれば、2次推定器と同じ推定誤差を確保することができ、ωwn>ωxであれば最悪条件でなくωe=ωyとすれば、2次推定器と同じ推定誤差を確保することができる。まとめると By comparing the magnitudes of ω wn and ω x , it can be determined whether or not it is the worst condition. When ω wn ≦ ω x holds, if the worst condition ω e = ω x , the same estimation error as that of the secondary estimator can be secured, and if ω wn > ω x , ω e is not the worst condition. Assuming = ω y , the same estimation error as that of the secondary estimator can be secured. Summary
を、中段の縦軸に外乱除去の効果を、下段の縦軸に感度関数の誤差を、それぞれ示す。同図より感度関数の誤差は1%以下になり実用上問題にならない程度である。固有周波数の比率は波浪パラメータωwn,ζwnにより変化し、例えばζwn=0.1の場合Re4が2から3になると、
が−25%低減する。そのωeの減少はωeを一定値にした場合に比べて検出方位に含まれる高域ノイズにより生じる推定誤差を低減させる効果をもつ。外乱除去効果は最悪条件でζwn≧0.3ときあまり期待できないがζwn=0.1のとき−8[dB]または2.5倍向上できる。外乱除去性能は推定誤差に対する感度を2次推定器のものと同じくしたことによって、ζwn=0.1のとき−17[dB]から−8[dB]に低下する。なお2次と4次との推定器の外乱除去ゲインはそれぞれ
, The middle vertical axis shows the effect of disturbance removal, and the lower vertical axis shows the error of the sensitivity function. From the figure, the error of the sensitivity function is 1% or less, which is not a problem in practical use. The ratio of the natural frequency varies depending on the wave parameters ω wn and ζ wn . For example, when Re 4 is changed from 2 to 3 when ζ wn = 0.1,
Is reduced by -25%. Reduction of the omega e has the effect of reducing the estimation error caused by high-frequency noise contained in the detected direction as compared with the case where the omega e constant value. The disturbance removal effect is not expected so much when ζ wn ≧ 0.3 in the worst condition, but can be improved by −8 [dB] or 2.5 times when ζ wn = 0.1. The disturbance rejection performance is reduced from −17 [dB] to −8 [dB] when ζ wn = 0.1 because the sensitivity to the estimation error is the same as that of the secondary estimator. The disturbance elimination gains of the second-order and fourth-order estimators are respectively
2.7 まとめ
以上のことから、波浪モデル有りの推定器においては、設計パラメータを以下のように設定する。
2.7 Summary From the above, in the estimator with a wave model, the design parameters are set as follows.
ωwn≦ωxのとき、
ωe=ωx
ωwn *=ωe
ωew=ωwn *
ωwn>ωxのとき、
ωe=ωy
ωwn *=ωwn
ωew=ωwn *
When ω wn ≦ ω x ,
ω e = ω x
ω wn * = ω e
ω ew = ω wn *
When ω wn > ω x ,
ω e = ω y
ω wn * = ω wn
ω ew = ω wn *
(第2実施形態)
3.舵角オフセットモデルの追加
第1実施形態では、外乱モデルに波浪モデルを用いたが、舵角オフセットモデルも加えることができる。図8を用いて説明する。舵角オフセットモデルは方位軸まわりに作用する船体モーメントを舵角換算で表したもので、偏差にオフセット誤差を生じさせる。偏差誤差を除去するために、推定器に舵角オフセットモデルを追加して、推定舵角オフセットを求めフィードバックループで制御量に加える。
(Second Embodiment)
3. Addition of rudder angle offset model In the first embodiment, the wave model is used as the disturbance model, but a rudder angle offset model can also be added. This will be described with reference to FIG. The rudder angle offset model represents the hull moment acting around the azimuth axis in terms of rudder angle, and causes an offset error in the deviation. In order to remove the deviation error, a steering angle offset model is added to the estimator, and an estimated steering angle offset is obtained and added to the control amount in a feedback loop.
このとき船体モデルの入出力は
3.1 はじめに
舵角オフセットによる方位誤差を抑制するために、舵角オフセットモデルを4次推定器に組み込んだものを以下5次推定器と呼ぶ。推定舵角オフセットは推定状態量として推定器から出力し制御量に加えることによって、舵角オフセットを打ち消す。したがってこの目的は4次推定器の特性を保持しつつ、かつ舵角オフセットを推定する5次推定器を設計することである。なお記号は4次推定器のものと同一とする。
3.1 Introduction In order to suppress the heading error due to the steering angle offset, a model in which the steering angle offset model is incorporated in the fourth order estimator is hereinafter referred to as a fifth order estimator. The estimated steering angle offset is output from the estimator as an estimated state quantity and added to the control amount to cancel the steering angle offset. Therefore, the objective is to design a fifth order estimator that retains the characteristics of the fourth order estimator and estimates the steering angle offset. The symbol is the same as that of the fourth order estimator.
3.2 伝達関数の導出
5次推定器は、図9に示すように、4次推定器に舵角オフセットモデルを組み込んだもので、
になる。ここで、ki,i=1〜5は推定ゲインを、
は推定舵角オフセットを、それぞれ示す。上式と式(4)とを整理すると、5次推定器の伝達関数は、
become. Here, k i, i = 1 to 5 are estimated gains,
Indicates an estimated steering angle offset, respectively. Rearranging the above equation and equation (4), the transfer function of the fifth-order estimator is
は、それぞれ方位と波浪とから推定舵角オフセットまでの伝達関数で、
は5次推定器を意味し、
Is the transfer function from azimuth and wave to estimated rudder angle offset,
Means a fifth order estimator,
式(58)〜(65)から、5次推定器の伝達関数は、4次推定器の特性に加えて次の特性を持つことが分かる。
・sまたはk5の項が推定方位と推定角速度との伝達関数の分子に付加される。
・推定舵角オフセットはパラメータ不確かさにより推定誤差が生じる。
From equations (58) to (65), it can be seen that the transfer function of the fifth order estimator has the following characteristics in addition to the characteristics of the fourth order estimator.
A term of s or k 5 is added to the numerator of the transfer function between the estimated azimuth and the estimated angular velocity.
・ Estimated rudder angle offset has an estimation error due to parameter uncertainty.
3.3 推定ゲインの設定
式(66)の特性方程式を
3.3 Estimated gain setting The characteristic equation of equation (66)
を付加する。
Is added.
3.4 特性方程式の設計
5次推定器の設計についても、4次推定器の設定を行なったときと同様に、舵角オフセットモデルの導入により、4次推定器に比べパラメータ不確かさによる推定誤差を著しく増加させ外乱除去性能を著しく低下させる状況を回避するように設計を行なう必要がある。
3.4 Design of characteristic equation For the design of the fifth-order estimator, the estimation error due to the parameter uncertainty compared to the fourth-order estimator is introduced by introducing the steering angle offset model, as in the case of setting the fourth-order estimator. It is necessary to design so as to avoid a situation in which the noise is greatly increased and the disturbance elimination performance is significantly deteriorated.
3.4.1 推定舵角オフセットの固有周波数
推定舵角オフセットの固有周波数は、
3.4.1 Natural frequency of estimated rudder angle offset The natural frequency of estimated rudder angle offset is
3.4.2 5次推定器の特性
5次推定器の特性を調べる。5次推定器の特性方程式は推定舵角オフセットの周波数ωeoが他の周波数ωe, ωewに比べて十分に低い条件をもつから
3.4.2 Characteristics of fifth-order estimator Check the characteristics of the fifth-order estimator. The characteristic equation of the fifth order estimator is that the estimated steering angle offset frequency ω eo is sufficiently lower than other frequencies ω e and ω ew.
また式(75)の特性方程式に対応する推定ゲインは式(33)の4次特性方程式にsを乗じたものであるから、推定ゲインk1,k2,k3,k4は4次推定器のものとほぼ同一になる。よって5次推定器の推定方位、推定角速度と推定波浪との特性は式(73)の推定係数によって4次推定器のものとほぼ等価になり、各推定値の方位と波浪との入力に対するそれぞれの応答も4次推定器のものとほぼ同じになる。 Further, since the estimated gain corresponding to the characteristic equation of Expression (75) is obtained by multiplying the fourth-order characteristic equation of Expression (33) by s, the estimated gains k 1 , k 2 , k 3 , and k 4 are the fourth-order estimation. It becomes almost the same as that of the vessel. Therefore, the characteristics of the estimated azimuth, estimated angular velocity, and estimated wave of the fifth order estimator are almost equivalent to those of the fourth order estimator by the estimation coefficient of Equation (73). The response of is almost the same as that of the fourth-order estimator.
5次推定器の推定舵角オフセットの特性を調べる。推定舵角オフセットの伝達関数
にそれぞれ方位と波浪とのステップ入力を与えた場合の定常解は最終値の定理から
The characteristic of the estimated rudder angle offset of the fifth order estimator is examined. Estimated rudder angle offset transfer function
The steady-state solution is given from the final value theorem when step input of direction and wave is given to
3.4.3 推定誤差の改善
推定誤差を改善するために4次推定器で採用したパラメータ不確かさ感度を2次推定器のものと同じくする方法を5次推定器にも適用する。式(47)の感度式に5次推定ゲインk1を用いて解き、5次固有周波数ωeを求める。
3.4.3 Improvement of estimation error A method of applying the same parameter uncertainty sensitivity adopted in the fourth-order estimator to that of the second-order estimator to improve the estimation error is also applied to the fifth-order estimator. The sensitivity equation of equation (47) is solved using the fifth-order estimated gain k 1 to obtain the fifth-order natural frequency ω e .
まず、式(68)で表される推定ゲインk1に波浪除去条件ωew=ωwn,ζew=ζeを代入してωeo/ωwn≪1,1/Tsnの2乗以上の項を無視すると、近似した推定ゲインk1は、 First, the wave removal conditions ω ew = ω wn and ζ ew = ζ e are substituted into the estimated gain k 1 represented by the equation (68), and ω eo / ω wn << 1, 1 / T sn or more squares Ignoring the term, the approximate estimated gain k 1 is
をそれぞれ得る。ここでωxは最悪条件と仮定した固有周波数を、ωyは最悪条件でないと仮定した固有周波数をそれぞれ示し、上式の2次方程式の解の2根の内、大きい方を採用することで、その値を求めることができる。よって5次固有周波数は式(50)を用いて求まる。 Get each. Here, ω x represents the natural frequency assumed to be the worst condition, ω y represents the natural frequency assumed not to be the worst condition, and by adopting the larger one of the two roots of the solution of the above quadratic equation, The value can be obtained. Therefore, the fifth order natural frequency can be obtained using equation (50).
上述の5次推定器の性能を2次推定器と比較した結果を図10に示す。同図の構成は図7の4次推定器の性能と同様なので説明を省く。同図は4次推定器の場合と比べると顕著な差異はない。しかし固有周波数の比率は若干大きくなり、外乱除去性能は若干悪くなっている(ζwn=0.1のとき−8[dB]から−7[dB]に低下する)。なお5次推定器の外乱除去ゲインは、 FIG. 10 shows the result of comparing the performance of the above-described fifth order estimator with that of the second order estimator. Since the configuration of the figure is similar to the performance of the fourth-order estimator of FIG. 7, the description thereof is omitted. The figure is not significantly different from the case of the fourth-order estimator. However, the ratio of the natural frequency is slightly increased, and the disturbance removal performance is slightly deteriorated (decreases from −8 [dB] to −7 [dB] when ζ wn = 0.1). The disturbance elimination gain of the fifth order estimator is
この結果、舵角オフセットモデルを組み込んだ5次推定器は、該モデルを組み込んでいない4次推定器に比べて、式(73)の推定係数を用いた場合、固有周波数と外乱除去性能とはほぼ同じ性能をもつ。 As a result, the fifth-order estimator incorporating the rudder angle offset model has a higher natural frequency and disturbance rejection performance than the fourth-order estimator that does not incorporate the model. Has almost the same performance.
3.5 まとめ
以上のことから、波浪モデル及び舵角オフセットモデル有りの5次推定器においても、4次推定器と同様に、設計パラメータを以下のように設定する。
3.5 Summary From the above, in the fifth-order estimator with the wave model and the steering angle offset model, the design parameters are set as follows, similarly to the fourth-order estimator.
ωwn≦ωxのとき、
ωe=ωx
ωwn *=ωe
ωew=ωwn *
ωwn>ωxのとき、
ωe=ωy
ωwn *=ωwn
ωew=ωwn *
When ω wn ≦ ω x ,
ω e = ω x
ω wn * = ω e
ω ew = ω wn *
When ω wn > ω x ,
ω e = ω y
ω wn * = ω wn
ω ew = ω wn *
以上のように、本発明によれば、従来の推定器設計では、十分な考慮がなされなかったパラメータ不確かさと外乱モデルとに起因した推定誤差と外乱除去との特性を定量的に明らかにした上で設計を行っているために、以下の効果を奏することができる。
・推定誤差を外乱モデルのパラメータに依らず仕様どおりに設計できるようになり、極めて簡単に推定器が構成できるようになる。
・推定誤差特性が外乱モデルのないすなわち最も単純な制御対象のものと等価であるので、推定器を用いた閉ループ系設計を簡単化することができる。
・波浪モデルのパラメータに依らず推定器の固有周波数が常に最適値に設定されることから、不必要に固有周波数が高く設定されないので、高周波域の白色ノイズによる推定誤差の増加または外乱除去の低下を防止できる。
As described above, according to the present invention, in the conventional estimator design, the characteristics of the estimation error and disturbance removal due to the parameter uncertainty and disturbance model that have not been sufficiently considered are quantitatively clarified. Therefore, the following effects can be obtained.
・ Estimated errors can be designed according to specifications without depending on the parameters of the disturbance model, and an estimator can be configured very easily.
Since the estimation error characteristic is equivalent to that of the simplest control target without a disturbance model, the closed loop system design using the estimator can be simplified.
-Since the natural frequency of the estimator is always set to the optimum value regardless of the wave model parameters, the natural frequency is not set unnecessarily high, so the estimation error increases due to white noise in the high frequency range or the disturbance rejection decreases. Can be prevented.
10 自動操舵装置
15 フィードバックループ
20 推定器
10
Claims (11)
と指令舵角δとを入力とし、推定方位
と推定角速度
とを出力する推定器と、
設定針路と前記推定方位との偏差及び前記推定角速度に対してそれぞれフィードバックゲインを適用して前記指令舵角δを出力するフィードバックゲインループと、
前記フィードバックゲインループから出力された前記指令舵角δに応じて舵角を変化させる操舵機と、
を有する船舶用自動操舵装置において、
前記推定器の特性多項式として、
λe2は、波浪モデルが仮に無いとしたときの船体モデルの状態量を推定するための特性多項式であり、ζe、ωeがそれぞれ船体モデルの状態量を推定するための減衰係数、固有周波数であり、
ωeを操舵系固有周波数ωnのρ(>1)倍に設定し、ζeを1/√2に設定する、ことを特徴とする船舶用自動操舵装置。 Detection direction
And the command rudder angle δ
And estimated angular velocity
An estimator that outputs and
A feedback gain loop for applying the feedback gain to the deviation between the set course and the estimated azimuth and the estimated angular velocity to output the command steering angle δ,
A steering machine that changes the steering angle according to the command steering angle δ output from the feedback gain loop;
In the ship automatic steering device having
As a characteristic polynomial of the estimator,
λ e2 is a characteristic polynomial for estimating the state quantity of the hull model when there is no wave model, and ζ e and ω e are the attenuation coefficient and natural frequency for estimating the state quantity of the hull model, respectively. And
An automatic steering apparatus for a ship, wherein ω e is set to ρ (> 1) times the natural frequency ω n of the steering system, and ζ e is set to 1 / √2.
と指令舵角δとを入力とし、推定方位
と推定角速度
とを出力する推定器と、
設定針路と前記推定方位との偏差及び前記推定角速度に対してそれぞれフィードバックゲインを適用して前記指令舵角δを出力するフィードバックゲインループと、
前記フィードバックゲインループから出力された前記指令舵角δに応じて舵角を変化させる操舵機と、
を有する船舶用自動操舵装置において、
前記推定器の特性多項式として、
λe2は、波浪モデルが仮に無いとしたときの船体モデルの状態量を推定するための特性多項式であり、ζe、ωeがそれぞれ船体モデルの状態量を推定するための減衰係数、固有周波数であり、λewは、波浪モデルの状態量を推定するための特性多項式であり、
ζew、ωewがそれぞれ波浪モデルの状態量を推定するための減衰係数、固有周波数であり、
波浪モデルが無い(λew=1)としたときの推定器の船体パラメータに対する感度が、波浪モデルが有るときの推定器の船体パラメータに対する感度とほぼ等しくなるときの、ωe=ωwn(ωwn:波浪モデルの固有周波数である波浪周波数を表す)を満足するときのωeの値をωx、ωe=ωwnを満足しないときのωeの値をωyとしたときに、
波浪周波数ωwnがωxよりも大きいときには、固有周波数ωeをωyに設定し、固有周波数ωewを波浪周波数ωwnと等しく設定し、
波浪周波数ωwnがωx以下のときには、固有周波数ωeをωxに設定し、波浪周波数ωwnを修正の波浪周波数ωwn *=ωxに修正し、固有周波数ωewを修正の波浪周波数ωwn *と等しく設定する、ことを特徴とする船舶用自動操舵装置。 Detection direction
And the command rudder angle δ
And estimated angular velocity
An estimator that outputs and
A feedback gain loop for applying the feedback gain to the deviation between the set course and the estimated azimuth and the estimated angular velocity to output the command steering angle δ,
A steering machine that changes the steering angle according to the command steering angle δ output from the feedback gain loop;
In the ship automatic steering device having
As a characteristic polynomial of the estimator,
λ e2 is a characteristic polynomial for estimating the state quantity of the hull model when there is no wave model, and ζ e and ω e are the attenuation coefficient and natural frequency for estimating the state quantity of the hull model, respectively. Λ ew is a characteristic polynomial for estimating the state quantity of the wave model,
ζ ew and ω ew are the attenuation coefficient and natural frequency for estimating the state quantity of the wave model,
Ω e = ω wn (ω) when the sensitivity of the estimator to the hull parameter when there is no wave model (λ ew = 1) is almost equal to the sensitivity of the estimator to the hull parameter when there is a wave model wn: the value of omega e when satisfying represents the wave frequency) is the natural frequency omega x, the value of omega e when not satisfied ω e = ω wn when the omega y of wave model,
When the wave frequency ω wn is larger than ω x , the natural frequency ω e is set to ω y , the natural frequency ω ew is set equal to the wave frequency ω wn ,
When the wave frequency ω wn is less than or equal to ω x , the natural frequency ω e is set to ω x , the wave frequency ω wn is corrected to the corrected wave frequency ω wn * = ω x , and the natural frequency ω ew is corrected to the corrected wave frequency A marine vessel automatic steering apparatus characterized by being set equal to ω wn * .
と指令舵角δとを入力とし、推定方位
と推定角速度
と推定舵角オフセット
とを出力する推定器と、
設定針路と前記推定方位との偏差及び前記推定角速度に対してそれぞれフィードバックゲインを適用すると共に前記推定舵角オフセットを用いて前記指令舵角δを出力するフィードバックゲインループと、
前記フィードバックゲインループから出力された前記指令舵角δに応じて舵角を変化させる操舵機と、
を有する船舶用自動操舵装置において、
前記推定器の特性多項式として、
λe2は、波浪モデル及び舵角オフセットモデルが仮に無いとしたときの船体モデルの状態量を推定するための特性多項式であり、ζe、ωeがそれぞれ船体モデルの状態量を推定するための減衰係数、固有周波数であり、λewは、波浪モデルの状態量を推定するための特性多項式であり、ζew、ωewがそれぞれ波浪モデルの状態量を推定するための減衰係数、固有周波数であり、λeoは、舵角オフセットモデルの状態量を推定するための特性多項式であり、ωeoが舵角オフセットモデルの状態量を推定するための固有周波数であり、
固有周波数ωeoを操舵系固有周波数ωnのρo(<1)倍に設定し、
波浪モデル及び舵角オフセットモデルが無い(λewλeo=1)としたときの推定器の船体パラメータに対する感度が、波浪モデル及び舵角オフセットモデルが有るときの推定器の船体パラメータに対する感度とほぼ等しくなるときの、ωe=ωwnを満足するときのωeの値をωx(ωwn:波浪モデルの固有周波数である波浪周波数を表す)、ωe=ωwnを満足しないときのωeの値をωyとしたときに、
波浪周波数ωwnがωxよりも大きいときには、固有周波数ωeをωyに設定し、固有周波数ωewを波浪周波数ωwnと等しく設定し、
波浪周波数ωwnがωx以下のときには、固有周波数ωeをωxに設定し、波浪周波数ωwnを修正の波浪周波数ωwn *=ωxに修正し、固有周波数ωewを修正の波浪周波数ωwn *と等しく設定する、ことを特徴とする船舶用自動操舵装置。 Detection direction
And the command rudder angle δ
And estimated angular velocity
And estimated rudder angle offset
An estimator that outputs and
A feedback gain loop that applies a feedback gain to the deviation between the set course and the estimated azimuth and the estimated angular velocity and outputs the command steering angle δ using the estimated steering angle offset;
A steering machine that changes the steering angle according to the command steering angle δ output from the feedback gain loop;
In the ship automatic steering device having
As a characteristic polynomial of the estimator,
λ e2 is a characteristic polynomial for estimating the state quantity of the hull model when there is no wave model and rudder angle offset model, and ζ e and ω e are for estimating the state quantity of the hull model, respectively. Λ ew is a characteristic polynomial for estimating the state quantity of the wave model, and ζ ew and ω ew are the attenuation coefficient and natural frequency for estimating the state quantity of the wave model, respectively. Yes , λ eo is a characteristic polynomial for estimating the state quantity of the steering angle offset model, ω eo is a natural frequency for estimating the state quantity of the steering angle offset model,
The natural frequency ω eo is set to ρ o (<1) times the steering system natural frequency ω n ,
The sensitivity of the estimator to the hull parameters when there is no wave model and rudder angle offset model (λ ew λ eo = 1) is almost the same as the sensitivity of the estimator to the hull parameters when there is a wave model and a rudder angle offset model. The value of ω e when ω e = ω wn when equal is expressed as ω x (ω wn : represents the wave frequency that is the natural frequency of the wave model), and ω e when ω e = ω wn is not satisfied. When the value of e is ω y ,
When the wave frequency ω wn is larger than ω x , the natural frequency ω e is set to ω y , the natural frequency ω ew is set equal to the wave frequency ω wn ,
When the wave frequency ω wn is less than or equal to ω x , the natural frequency ω e is set to ω x , the wave frequency ω wn is corrected to the corrected wave frequency ω wn * = ω x , and the natural frequency ω ew is corrected to the corrected wave frequency A marine vessel automatic steering apparatus characterized by being set equal to ω wn * .
と指令舵角δとを入力とし、推定方位
と推定角速度
とを出力する推定器と、
設定針路と前記推定方位との偏差及び前記推定角速度に対してそれぞれフィードバックゲインを適用して前記指令舵角δを出力するフィードバックゲインループと、
前記フィードバックゲインループから出力された前記指令舵角δに応じて舵角を変化させる操舵機と、
を有する船舶用自動操舵装置の推定器の設計方法であって、
まず波浪モデル無しの推定器として船体モデルの状態量を推定するための固有周波数
と減衰係数ζeとを設計し、次に波浪モデル有りの推定器として船体パラメータによる推定誤差が波浪モデル無しの場合とほぼ同一になるような船体モデルの状態量を推定するための固有周波数
を設計し、波浪モデルの状態量を推定するための固有周波数ωewと減衰係数ζewとを設計する、ことを特徴とする船舶用自動操舵装置の推定器の設計方法。 Detection direction
And the command rudder angle δ
And estimated angular velocity
And the estimated Joki you output the door,
A feedback gain loop for applying the feedback gain to the deviation between the set course and the estimated azimuth and the estimated angular velocity to output the command steering angle δ,
A steering machine that changes the steering angle according to the command steering angle δ output from the feedback gain loop;
A estimator design method of marine autopilot to have a,
First, the natural frequency for estimating the state quantity of the hull model as an estimator without a wave model
And the damping coefficient ζ e, and then, as an estimator with a wave model, the natural frequency for estimating the state quantity of the hull model so that the estimation error due to the hull parameters is almost the same as the case without the wave model
And designing the natural frequency ω ew and the attenuation coefficient ζ ew for estimating the state quantity of the wave model, and a design method for the estimator of the marine automatic steering system.
と指令舵角δとを入力とし、推定方位
と推定角速度
と推定舵角オフセット
とを出力する推定器と、
設定針路と前記推定方位との偏差及び前記推定角速度に対してそれぞれフィードバックゲインを適用すると共に前記推定舵角オフセットを用いて前記指令舵角δを出力するフィードバックゲインループと、
前記フィードバックゲインループから出力された前記指令舵角δに応じて舵角を変化させる操舵機と、
を有する船舶用自動操舵装置の推定器の設計方法であって、
まず波浪モデル及び舵角オフセットモデル無しの推定器として船体モデルの状態量を推定するための固有周波数
と減衰係数ζeとを設計し、次に波浪モデル及び舵角オフセットモデル有りの推定器として船体パラメータによる推定誤差が波浪モデル無しの場合とほぼ同一になるような船体モデルの状態量を推定するための固有周波数ωeを設計し、波浪モデルの状態量を推定するための固有周波数ωewと減衰係数ζewとを設計し、舵角オフセットモデルの状態量を推定するための固有周波数ωeoを設計する、ことを特徴とする船舶用自動操舵装置の推定器の設計方法。 Detection direction
And the command rudder angle δ
And estimated angular velocity
And estimated rudder angle offset
And the estimated Joki you output the door,
A feedback gain loop that applies a feedback gain to the deviation between the set course and the estimated azimuth and the estimated angular velocity and outputs the command steering angle δ using the estimated steering angle offset;
A steering machine that changes the steering angle according to the command steering angle δ output from the feedback gain loop;
A estimator design method of marine autopilot to have a,
First, the natural frequency for estimating the state quantity of the hull model as an estimator without wave model and rudder angle offset model
And the damping coefficient ζ e, and then estimate the state quantity of the hull model so that the estimation error due to the hull parameters is almost the same as the case without the wave model as an estimator with the wave model and rudder angle offset model natural frequency omega e were designed, and a natural frequency omega ew and damping coefficient zeta ew for estimating a state quantity of wave models were designed natural frequency for estimating the state quantity of the steering angle offset model omega eo for The design method of the estimator of the automatic steering device for ships characterized by the above-mentioned.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004226670A JP4603832B2 (en) | 2004-08-03 | 2004-08-03 | Automatic steering device for ship and design method of estimator for automatic steering device for ship |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004226670A JP4603832B2 (en) | 2004-08-03 | 2004-08-03 | Automatic steering device for ship and design method of estimator for automatic steering device for ship |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2006044411A JP2006044411A (en) | 2006-02-16 |
JP4603832B2 true JP4603832B2 (en) | 2010-12-22 |
Family
ID=36023479
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004226670A Expired - Lifetime JP4603832B2 (en) | 2004-08-03 | 2004-08-03 | Automatic steering device for ship and design method of estimator for automatic steering device for ship |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4603832B2 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012210875A (en) * | 2011-03-31 | 2012-11-01 | Tokyo Keiki Inc | Automatic steering device for ships |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4669283B2 (en) * | 2004-12-28 | 2011-04-13 | 東京計器株式会社 | Ship automatic steering system |
JP6278745B2 (en) * | 2014-02-28 | 2018-02-14 | 東京計器株式会社 | Ship automatic steering system |
JP2023135995A (en) | 2022-03-16 | 2023-09-29 | 古野電気株式会社 | Automatic steering device, automatic steering system, automatic steering method, and automatic steering program |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59190093A (en) * | 1983-04-11 | 1984-10-27 | Tokyo Keiki Co Ltd | Automatic steering system |
JPS61207296A (en) * | 1985-03-12 | 1986-09-13 | Yokogawa Electric Corp | Auto-pilot for marine use |
JPH07101397A (en) * | 1993-10-04 | 1995-04-18 | Furuno Electric Co Ltd | Autopilot device |
JPH09207889A (en) * | 1995-11-27 | 1997-08-12 | Tokimec Inc | Automatically steering device for ship |
JPH09226689A (en) * | 1996-02-23 | 1997-09-02 | Tokimec Inc | Automatic steering device for ship |
JP2001018893A (en) * | 1999-07-01 | 2001-01-23 | Tokimec Inc | Automatic steering apparatus for ship |
JP2002145194A (en) * | 2000-11-16 | 2002-05-22 | National Maritime Research Institute | Marine automatic steering system |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2522485B2 (en) * | 1987-07-07 | 1996-08-07 | 株式会社トキメック | Automatic steering system for ships |
-
2004
- 2004-08-03 JP JP2004226670A patent/JP4603832B2/en not_active Expired - Lifetime
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59190093A (en) * | 1983-04-11 | 1984-10-27 | Tokyo Keiki Co Ltd | Automatic steering system |
JPS61207296A (en) * | 1985-03-12 | 1986-09-13 | Yokogawa Electric Corp | Auto-pilot for marine use |
JPH07101397A (en) * | 1993-10-04 | 1995-04-18 | Furuno Electric Co Ltd | Autopilot device |
JPH09207889A (en) * | 1995-11-27 | 1997-08-12 | Tokimec Inc | Automatically steering device for ship |
JPH09226689A (en) * | 1996-02-23 | 1997-09-02 | Tokimec Inc | Automatic steering device for ship |
JP2001018893A (en) * | 1999-07-01 | 2001-01-23 | Tokimec Inc | Automatic steering apparatus for ship |
JP2002145194A (en) * | 2000-11-16 | 2002-05-22 | National Maritime Research Institute | Marine automatic steering system |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012210875A (en) * | 2011-03-31 | 2012-11-01 | Tokyo Keiki Inc | Automatic steering device for ships |
Also Published As
Publication number | Publication date |
---|---|
JP2006044411A (en) | 2006-02-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5755795B2 (en) | Guidance system and method for minimizing missile heading changes | |
Blažič et al. | Adaptive law with a new leakage term | |
JP4603832B2 (en) | Automatic steering device for ship and design method of estimator for automatic steering device for ship | |
WO2013031082A1 (en) | Adaptive control device and adaptive control method, as well as control device and control method for injection molding machine | |
US9230535B2 (en) | Active vibration noise control apparatus | |
JP2013086745A (en) | Automatic steering gear for ship | |
JP4917272B2 (en) | Ship automatic steering system | |
JP5052165B2 (en) | Ship automatic steering system | |
JP5042905B2 (en) | Ship automatic steering system | |
EP4316754A1 (en) | Method and apparatus for compensating boom deflection, and method and apparatus for controlling boom | |
JP4820621B2 (en) | Ship automatic steering device and design method thereof | |
JP5682009B2 (en) | Ship automatic steering system | |
JP2003195950A (en) | Active vibration control method using adaptive control method | |
JP2007306753A (en) | Method for adjusting parameters for notch filter, program, and motor controller | |
JP6632497B2 (en) | Ship automatic steering system | |
CN109751232B (en) | Method for inhibiting fluctuation of rotating speed of air conditioner compressor | |
JP7150082B1 (en) | Vessel bearing control device and bearing control method | |
JP2023182949A (en) | Azimuth control device and azimuth control method for ship | |
Tzeng et al. | A sensitivity function approach to the design of rudder roll stabilization controller | |
JP4669283B2 (en) | Ship automatic steering system | |
CN109724325B (en) | Method for controlling rotation speed of air conditioner compressor | |
Tannuri et al. | Adaptive techniques applied to offshore dynamic positioning systems | |
JPH0834396A (en) | Automatic steering gear for ship | |
JP6228078B2 (en) | Ship automatic steering system | |
KR102435901B1 (en) | Gyroscopic actuator friction prevention/compensation method and device using mpc and disturbance observaer |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20070704 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20100305 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20100407 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100427 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100628 |
|
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: 20100914 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20101004 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131008 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4603832 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |