JP2008213681A - 船舶用自動操舵装置 - Google Patents
船舶用自動操舵装置 Download PDFInfo
- Publication number
- JP2008213681A JP2008213681A JP2007054599A JP2007054599A JP2008213681A JP 2008213681 A JP2008213681 A JP 2008213681A JP 2007054599 A JP2007054599 A JP 2007054599A JP 2007054599 A JP2007054599 A JP 2007054599A JP 2008213681 A JP2008213681 A JP 2008213681A
- Authority
- JP
- Japan
- Prior art keywords
- azimuth
- error
- hull
- control system
- model
- 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.)
- Granted
Links
Images
Landscapes
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
【解決手段】参照方位及び参照位置を出力する参照信号発生器12と、該参照信号発生器12からの参照方位及び参照位置と、センサで検出された方位及び位置から方位誤差及び位置誤差を演算する軌道航路誤差演算器14と、該方位誤差及び位置誤差から船体の方位と位置とを追跡させるべく指令舵角を出力するフィードバック制御器16とを備える。フィードバック制御器16は、舵角を制御して設定方位に船首方位を追従させる方位制御系であるとしたときの比例ゲインKψ、微分ゲインKrを用い、舵をとることによって生じる横滑り速度に依存して発生する位置誤差を加味した上で閉ループを安定にする航路ゲインKyを用いて、フィードバック制御を行う。
【選択図】図1
Description
フィードバック制御器は、横方向の位置誤差(ye)に対して航路ゲイン(Ky)を乗算し、方位誤差(ψe)に対して比例ゲイン(Kψ)と微分ゲイン(Kr)を乗算し、これらから
前記フィードバック制御器は、センサで検出された方位ψ及び位置(x、y)、及び指令舵角δFBから推定方位
と推定位置
とを出力する推定器を備えており、該推定器は、推定器の制御対象モデルの状態量を推定するための特性多項式として、
固有周波数ωeoを操舵系周波数ωnのρo(<1)倍に設定し、
波浪モデル及び舵角オフセットモデルが無い(λewλeo=1)としたときの推定器の船体パラメータに対する感度が、波浪モデル及び舵角オフセットモデルが有るときの推定器の船体パラメータに対する感度とほぼ等しくなるときの、ωe=ωwnを満足するときのωeの値をωx(ωwn:波浪モデルの固有周波数である波浪周波数を表す)、ωe=ωwnを満足しないときのωeの値をωzとしたときに、
波浪周波数ωwnがωxよりも大きいときには、固有周波数ωeをωzに設定し、固有周波数ωewを波浪周波数ωwnと等しく設定し、
波浪周波数ωwnがωx以下のときには、固有周波数ωeをωxに設定し、波浪周波数ωwnを修正の波浪周波数ωwn *=ωxに修正し、固有周波数ωewを修正の波浪周波数ωwn *と等しく設定する、ことを特徴とする。
図1は、船舶用自動操舵装置と制御対象の全体のブロック図である。既述のように、船舶用自動操舵装置10は、計画航路に船体位置を追跡させるために舵を制御する装置であり、参照信号発生器12、軌道航路誤差演算器14、フィードバック制御器16、加算器17及び各パラメータを同定する図示しない同定器を備えている。誘導システム22から計画航路及びセンサ類26のスピードログから船速Uが参照信号発生器12に入力され、参照信号発生器12からは参照方位ψR、参照位置xR、yR及び旋回時にはフィードフォワード舵角δFFが出力される。
1.1 座標系
航路制御系で用いる座標系は、図3に示すように、以下の座標系から構成する。
・対地系:緯度経度座標系で、GPSからの位置出力(x、y)に相当する。
・参照系:対地座標系で、誘導システム22により生成され指定された対地航路の位置と針路(即ち、計画航路)とからなる。
・船体系:運動座標系で、船体の重心を原点とし、船首方位をX軸とし、船体運動を定める。
尚、座標系の回転極性は右ネジ方向を正とし、Z軸方向は重力方向を正とする。座標系はX軸、Y軸の2次元を用いる。
前記制御対象である船体モデルを定めるために、船体の運動方程式を導出する。船体の運動方程式は、前進方向を除き、横方向と方位軸回りとの運動を扱うので、
(15)式を整理すると、
船体の位置は船体運動と潮流速度とからの対地速度を積分することで求めることができる。船体速度は対水速度を基に前進速度uと横流れ速度vとからなり、潮流速度は大きさと方向から定める。
制御対象は、非線形項αsを無視して線形化すると、図5に示すように、(24)式から得られる船体モデルと、外乱モデルとからなるものとする。外乱モデルはδo、ψw、uTx 、uTyで、δoは風等による方位軸回りのモーメントの舵角換算したオフセット成分を、ψwは白色ノイズνの入力によるフィルタ出力(中心周波数ωw、減衰係数ζw)で近似した波浪成分を、uTx,uTyは潮流によるそれぞれ北向き,東向きの対地速度を示す。
上記3次系の制御対象に対して、フィードバックゲイン器20を図7に示すように構成する。同図において、Kyは航路ゲイン、KrとKψとは方位制御系におけるそれぞれ微分ゲインと比例ゲインとすると、
1.Ky=0のとき、根は極(記号×)である方位制御系の共役根と原点根とになり、
2.Ky>0が大きくなると、共役根は実軸に向かいBreak-in point になった後左右方向に別れ、原点根は左方向に移動した後共役根から派生した右方向の根とBreakaway pointで重なり共役根になり、
3.さらにKy>0が大きくなると、方位制御系の共役根から派生した左方向の根はさらに左方に移動し、Breakaway point からの共役根は原点とゼロ点との回りを円弧状に移動した後、正の実軸でBreak-in point になり左右方向に別れる、
という特徴を持つ。
以上の航路ゲインKyの影響を踏まえて、航路ゲインKyを決定する。
閉ループの特性多項式λは前述の(31)式で表される。一方、設計仕様の特性多項式は
1.(36)式の4つの解の中から負の解と最大の正の解を除いた解を求める
2.残りの2つの解から小さい解を正解として選び、(37)式、(38)式を用いてそれぞれ実根aと航路ゲインKyとを求める
とする。
船速が変化した場合の航路ゲインKyの様子を検討する。船体運動の横方向速度は対水速度(船速)Uに比例するため、船速が変化したらKyはUと連動させて適切に更新させる必要がある。速度変化をU*とすると、船速変化に対する船体パラメータは、
外乱入力となる舵角オフセットδoと横滑り角オフセットβoについて考慮する。外乱入力に対しては、航路誤差の定常値を求め、その誤差を修正するようにする。平均値がゼロであるψwを省き、定常値に影響しないTs3,Tβ3をそれぞれゼロとする。フィードバック舵角に修正量αを追加すると
次に、推定器18の構成について説明する。まず、特許文献1で開示する方位制御系の5次推定器について説明し、次に、その5次推定器に基づき、航路制御系の推定器を構成することを考える。
方位制御系の5次推定器の構成例を図9の上段に示す。この推定器は、波浪モデルと舵角オフセットとを組み込んだものであり、
は推定状態量を、
は推定波浪を、
は推定舵角オフセットを、それぞれ示す。波浪モデルの固有周波数、減衰係数ωwn、ζwnは、図示しない波浪同定器によって、検出方位ψから同定されるものである。
特性多項式を
前記ωx及びωzは、
制御対象を方位制御系と航路誤差系とに分割したブロック行列で表現すると、
航路誤差系を含めた推定器18の固有値または特性多項式は7次になる。この7つの根を極配置するための推定ゲインを定める。未知数の7×2行列の推定ゲインは特性多項式の7つの係数方程式によって求めることになるが、方程式の数より未知数が多いので不定状態になる。そこで、図9に示したように、前述したブロック行列を用いて航路制御系の推定器を方位制御系の推定器相当部分と航路誤差系の推定器相当部分とに分離して、極配置する推定ゲインを設計する。航路制御系の7次の極配置において、既に特許文献1において方位制御系の5次相当部分は設計されているから、航路誤差系の2次の極配置を設計すればよいことになる。
即ち、推定係数ρは、ωeと操舵系の固有周波数ωnとの間で、
以上説明したように、本発明では、閉ループの安定性に影響する横滑り特性を含んだ実用的な制御対象を提案し、フィードバック制御の構成を示し、航路ゲインを決定した。
12 参照信号発生器
14 軌道航路誤差演算器
16 フィードバック制御器
18 推定器
Claims (6)
- 船体の参照方位及び参照位置を出力する参照信号発生器と、該参照信号発生器からの参照方位及び参照位置と、センサで検出された船体の方位及び位置から方位誤差及び位置誤差を演算する軌道航路誤差演算器と、該方位誤差及び位置誤差から指令舵角を出力するフィードバック制御器とを備え、該出力される指令舵角によって船体の方位と位置とを追跡させるべく操舵を行わせる船舶用自動操舵装置において、
フィードバック制御器は、横方向の位置誤差(ye)に対して航路ゲイン(Ky)を乗算し、方位誤差(ψe)に対して比例ゲイン(Kψ)と微分ゲイン(Kr)を乗算し、これらから
- 前記ωyは、(8)式の4つの解のうちの負の解と最大の正の解を除き、残りの2つの解のうちの小さい解であることを特徴とする請求項3記載の船舶用自動操舵装置。
- 船体の参照方位及び参照位置を出力する参照信号発生器と、該参照信号発生器からの参照方位及び参照位置と、センサで検出された船体の方位及び位置から方位誤差及び位置誤差を演算する軌道航路誤差演算器と、該方位誤差及び位置誤差から船体の方位と位置とを追跡させるべく指令舵角を出力するフィードバック制御器とを備えた船舶用自動操舵装置において、
前記フィードバック制御器は、センサで検出された方位ψ及び位置(x、y)、及び指令舵角δFBから推定方位
と推定位置
とを出力する推定器を備えており、該推定器は、推定器の制御対象モデルの状態量を推定するための特性多項式として、
- 前記λHCSは
固有周波数ωeoを操舵系周波数ωnのρo(<1)倍に設定し、
波浪モデル及び舵角オフセットモデルが無い(λewλeo=1)としたときの推定器の船体パラメータに対する感度が、波浪モデル及び舵角オフセットモデルが有るときの推定器の船体パラメータに対する感度とほぼ等しくなるときの、ωe=ωwnを満足するときのωeの値をωx(ωwn:波浪モデルの固有周波数である波浪周波数を表す)、ωe=ωwnを満足しないときのωeの値をωzとしたときに、
波浪周波数ωwnがωxよりも大きいときには、固有周波数ωeをωzに設定し、固有周波数ωewを波浪周波数ωwnと等しく設定し、
波浪周波数ωwnがωx以下のときには、固有周波数ωeをωxに設定し、波浪周波数ωwnを修正の波浪周波数ωwn *=ωxに修正し、固有周波数ωewを修正の波浪周波数ωwn *と等しく設定する、ことを特徴とする請求項5記載の船舶用自動操舵装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007054599A JP5052165B2 (ja) | 2007-03-05 | 2007-03-05 | 船舶用自動操舵装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007054599A JP5052165B2 (ja) | 2007-03-05 | 2007-03-05 | 船舶用自動操舵装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2008213681A true JP2008213681A (ja) | 2008-09-18 |
JP5052165B2 JP5052165B2 (ja) | 2012-10-17 |
Family
ID=39834235
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007054599A Active JP5052165B2 (ja) | 2007-03-05 | 2007-03-05 | 船舶用自動操舵装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5052165B2 (ja) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010105551A (ja) * | 2008-10-30 | 2010-05-13 | Mitsubishi Heavy Ind Ltd | 定点保持制御装置およびその方法並びにプログラム |
CN102680240A (zh) * | 2012-05-24 | 2012-09-19 | 北京理工大学 | 一种用于固体火箭发动机高过载试验装置的点火驱动系统 |
JP2015160606A (ja) * | 2014-02-28 | 2015-09-07 | 東京計器株式会社 | 船舶用自動操舵装置 |
JP2016008038A (ja) * | 2014-06-26 | 2016-01-18 | 東京計器株式会社 | 船舶用自動操舵装置 |
JP2016159695A (ja) * | 2015-02-27 | 2016-09-05 | 東京計器株式会社 | 船舶用自動操舵装置 |
CN106406095A (zh) * | 2016-10-26 | 2017-02-15 | 北京航空航天大学 | 输入输出非对称受限的全驱动水面舰船轨迹跟踪控制方法 |
CN113093734A (zh) * | 2021-03-17 | 2021-07-09 | 大连海事大学 | 一种输入受限的无人船航向共融控制方法、系统及结构 |
CN113741292A (zh) * | 2021-09-09 | 2021-12-03 | 中国船舶重工集团公司第七0七研究所九江分部 | 一种单手柄发送指令的车舵联合控制装置、系统及方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004042884A (ja) * | 2002-05-20 | 2004-02-12 | Kawasaki Heavy Ind Ltd | 移動体の操縦方法及び装置 |
-
2007
- 2007-03-05 JP JP2007054599A patent/JP5052165B2/ja active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004042884A (ja) * | 2002-05-20 | 2004-02-12 | Kawasaki Heavy Ind Ltd | 移動体の操縦方法及び装置 |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010105551A (ja) * | 2008-10-30 | 2010-05-13 | Mitsubishi Heavy Ind Ltd | 定点保持制御装置およびその方法並びにプログラム |
CN102680240A (zh) * | 2012-05-24 | 2012-09-19 | 北京理工大学 | 一种用于固体火箭发动机高过载试验装置的点火驱动系统 |
JP2015160606A (ja) * | 2014-02-28 | 2015-09-07 | 東京計器株式会社 | 船舶用自動操舵装置 |
JP2016008038A (ja) * | 2014-06-26 | 2016-01-18 | 東京計器株式会社 | 船舶用自動操舵装置 |
JP2016159695A (ja) * | 2015-02-27 | 2016-09-05 | 東京計器株式会社 | 船舶用自動操舵装置 |
CN106406095A (zh) * | 2016-10-26 | 2017-02-15 | 北京航空航天大学 | 输入输出非对称受限的全驱动水面舰船轨迹跟踪控制方法 |
CN113093734A (zh) * | 2021-03-17 | 2021-07-09 | 大连海事大学 | 一种输入受限的无人船航向共融控制方法、系统及结构 |
CN113093734B (zh) * | 2021-03-17 | 2023-11-03 | 大连海事大学 | 一种输入受限的无人船航向共融控制方法、系统及装置 |
CN113741292A (zh) * | 2021-09-09 | 2021-12-03 | 中国船舶重工集团公司第七0七研究所九江分部 | 一种单手柄发送指令的车舵联合控制装置、系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
JP5052165B2 (ja) | 2012-10-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5042906B2 (ja) | 船舶用自動操舵装置 | |
JP5052165B2 (ja) | 船舶用自動操舵装置 | |
JP5993125B2 (ja) | 船舶用自動操舵装置 | |
CN110308735B (zh) | 一种针对输入时滞的欠驱动uuv轨迹跟踪滑模控制方法 | |
Fossen et al. | Line-of-sight path following for dubins paths with adaptive sideslip compensation of drift forces | |
JP5042905B2 (ja) | 船舶用自動操舵装置 | |
CN111045432B (zh) | 一种欠驱动水面船非线性路径跟踪控制系统及方法 | |
JP4644522B2 (ja) | 小型無人ヘリコプタの自律飛行制御装置及び自律飛行制御方法 | |
CN110618611A (zh) | 一种基于回转率约束的无人艇轨迹跟踪安全控制方法 | |
Yang et al. | An improved stanley guidance law for large curvature path following of unmanned surface vehicle | |
Zwierzewicz | Robust and adaptive path-following control of an underactuated ship | |
CN109814583B (zh) | 基于自主水下机器人航向运动的动态状态反馈控制方法 | |
CN113110527B (zh) | 一种自主水下航行器有限时间路径跟踪的级联控制方法 | |
JP7170019B2 (ja) | 追尾制御装置 | |
JP2008213682A (ja) | 船舶用自動操舵装置 | |
CN116339314A (zh) | 一种基于自适应滑模的欠驱动无人艇航迹跟踪控制方法 | |
Kurowski et al. | Generic navigation and control methods for classes of unmanned surface vehicles | |
JP2008143398A (ja) | 飛翔体制御システムおよび飛翔体の飛行制御方法 | |
JP6373205B2 (ja) | 船舶用自動操舵装置 | |
JP6278849B2 (ja) | 船舶用自動操舵装置 | |
CN115657480A (zh) | 一种基于观测器补偿的最优滑模制导律构建方法 | |
CN115014355A (zh) | 一种双体无人船的定点返航调控方法及装置 | |
Daly et al. | A nonlinear path following controller for an underactuated unmanned surface vessel | |
JP5897391B2 (ja) | 船舶用自動操舵装置 | |
Wang et al. | Nonlinear path following of autonomous underwater vehicle considering uncertainty |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100212 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20110928 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120403 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120604 |
|
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: 20120710 |
|
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: 20120724 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5052165 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150803 Year of fee payment: 3 |
|
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 |