JP2013140449A - 制御装置及び水中航走体 - Google Patents
制御装置及び水中航走体 Download PDFInfo
- Publication number
- JP2013140449A JP2013140449A JP2011290130A JP2011290130A JP2013140449A JP 2013140449 A JP2013140449 A JP 2013140449A JP 2011290130 A JP2011290130 A JP 2011290130A JP 2011290130 A JP2011290130 A JP 2011290130A JP 2013140449 A JP2013140449 A JP 2013140449A
- Authority
- JP
- Japan
- Prior art keywords
- control
- gain
- change rate
- limit value
- unit
- 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
- 230000008859 change Effects 0.000 claims abstract description 86
- 230000004044 response Effects 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 7
- 238000009499 grossing Methods 0.000 description 7
- 238000000034 method Methods 0.000 description 6
- 238000012935 Averaging Methods 0.000 description 5
- 238000005265 energy consumption Methods 0.000 description 5
- 230000008569 process Effects 0.000 description 5
- 230000004043 responsiveness Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000000630 rising effect Effects 0.000 description 2
- 230000010365 information processing Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Images
Landscapes
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
【解決手段】制御対象の出力である船体の旋回角度を目標指令に一致させるような制御指令を生成するフィードバック制御部11と、船体速度に応じて、フィードバック制御部11で用いられる制御ゲインを調整するゲインスケジュール部12とを備える。ゲインスケジュール部12は、ゲインテーブルを記憶する記憶部21と、船体速度に応じた制御ゲインをゲインテーブルから取得するゲイン取得部22と、ゲイン取得部22によって取得された制御ゲインの変化率が所定の変化率制限値以下となるように制限する変化率制限部23とを備えている。
【選択図】図2
Description
例えば、特許文献1には、現在の船速及び翼深度に基づいて制御ゲインを決定するゲインスケジューリング装置が開示されている。
特に、水中を航走する水中航走体では、エネルギー補充のために浮上する必要があり、不安定な制御による消費エネルギーの増大は深刻な問題となる。
本発明は、制御対象の出力を目標指令に一致させるような制御指令を生成するフィードバック制御手段と、所定の参照信号に応じて、前記フィードバック制御手段で用いられる制御ゲインを調整するゲインスケジュール手段とを備える制御装置であって、前記ゲインスケジュール手段は、前記制御ゲインの変化率が所定の変化率制限値以下となるように制限する変化率制限手段を具備する制御装置を提供する。
本発明によれば、フィードバック制御手段で用いられる制御ゲインの変化率を所定の変化率制限値以下に制限するので、フィードバック制御手段に出力される制御ゲインの変動を抑制することができる。これにより、制御対象の出力の振動を抑制することができ、安定した制御の実現に寄与する。この結果、消費エネルギーの増大を抑制することができる。
また、制御の不安定を解消する対策として、一般的に、制御ゲインを通常よりも小さく設定することが挙げられるが、この場合、外乱に対するロバスト性が劣化するおそれがある。本発明によれば、変化率が変化率制限値を超える場合に限って制御ゲインを小さめに設定するので、制御系の外乱に対するロバスト性の低下を回避することが可能となる。
上記変化率制限手段の実現手法としては、レートリミッタ、平滑化手段等が挙げられる。平滑化手段としては、ローパスフィルタや、平均化処理等が挙げられる。
以下に、本発明の第1実施形態に係る制御装置及び水中航走体について、図面を参照して説明する。図1(a)は、本実施形態に係る水中航走体の概略平面図を示した図、図1(b)は、本実施形態に係る水中航走体の概略右側面図である。
図1に示すように、本実施形態に係る水中航走体1は、船体2と、主推進器3と、水平推進器4と、垂直推進器5とを備えている。
図2は、制御装置10が備える各種機能のうち、旋回制御に関する機能を抽出して概略的に示した機能ブロック図である。
図2に示すように、制御装置10は、フィードバック制御部11と、ゲインスケジューリング部12とを備えている。
記憶部21は、例えば、船体速度(参照信号)と制御ゲインKp,Ki,Kdとがそれぞれ関連付けられたゲインテーブルを有している。
ゲイン取得部22は、現在の船体速度に対応する制御ゲインKp,Ki,Kdをゲインテーブルから取得する。
このように、変化率制限部23を有しているので、フィードバック制御部11に出力される制御ゲインが所定量以上変動することを抑制することができる。
ローパスフィルタは、制御ゲインを平滑化する効果を持つので、制御ゲインの急激な変化を効果的に抑制することができる。この場合、ローパスフィルタの次数は特に制限されない。
また、平均化処理は、今回の制御ゲインと過去N(Nは1以上の整数)回分の制御ゲインの平均を算出し、平均制御ゲインを出力する移動平均等が挙げられる。このような平均化処理では、制御ゲインが急激に変化しても、その変化分が過去の制御ゲインによって平滑化されるため、制御ゲインの変動を抑制することができる。
そして、上述の処理が繰り返し行われることにより、現在の船体2の旋回角度を目標旋回角度に徐々に近づけることができる。
また、制御ゲインの変化率が変化率制限値を超える場合に限って制御ゲインが小さい方向に調整されるので、制御系の外乱に対するロバスト性の低下を抑制することができる。
次に、本発明の第2実施形態に係る水中航走体及び制御装置について説明する。
図3は、本実施形態に係る水中航走体の制御装置10aの機能ブロック図である。なお、図3は、上述した第1実施形態と同様に、旋回制御に関する機能のみを抽出して示したものである。
図3に示すように、本実施形態に係る制御装置10aのスケジューリング部15は、図2に示した第1実施形態に係るスケジューリング部12の構成に加えて、変化率制限値設定部24を備えている。
変化率制限値設定部24は、船体2の旋回角度(制御対象の出力)と目標旋回角度(目標指令)との関係に応じて、変化率制限部23で用いられる変化率制限値を変更するものである。
次に、本発明の第3実施形態に係る水中航走体及び制御装置について説明する。
上述した第1実施形態では、ゲイン取得部22によって取得された制御ゲインに対して変化率の制限をかけていたが、本実施形態では、ゲイン取得部22に入力される参照信号、すなわち、船体速度の変動を抑制することとしている。船体速度の変動を抑制することにより、ゲイン取得部22によって取得される制御ゲインの変動を間接的に抑制することが可能となる。
図5に示すように、本実施形態に係るゲインスケジューリング部17は、参照信号である船体速度の変化率を制限する変化率制限部27を有している。
変化率制限部27としては、上述した第1実施形態と同様に、レートリミッタや平滑化手段等を採用することができる。
また、フィードバック制御部11は、比例積分微分制御を行うことで制御指令を生成することとしたが、これに代えて、比例積分制御を行うこととしてもよいし、積分制御を行うこととしてもよい。そして、フィードバック制御部11の構成に対応した制御ゲインがゲインスケジューリング部12によって調整される。
2 船体
3 主推進器
3a 右側推進プロペラ
3b 左側推進プロペラ
4 水平推進器
4a 前方水平推進器
4b 後方水平推進器
5 垂直推進器
5a 前方垂直推進器
5b 後方垂直推進器
7a 前方水平プロペラ
7b 後方水平プロペラ
9a 前方垂直プロペラ
9b 後方垂直プロペラ
10、10a,10b 制御装置
11 フィードバック制御部
12、15、17 ゲインスケジューリング部
21 記憶部
22 ゲイン取得部
23、27 変化率制限部
24 変化率制限値設定部
Claims (4)
- 制御対象の出力を目標指令に一致させるような制御指令を生成するフィードバック制御手段と、所定の参照信号に応じて、前記フィードバック制御手段で用いられる制御ゲインを調整するゲインスケジュール手段とを備える制御装置であって、
前記ゲインスケジュール手段は、前記制御ゲインの変化率が所定の変化率制限値以下となるように制限する変化率制限手段を具備する制御装置。 - 前記変化率制限値を前記制御対象の出力と前記目標指令との関係に応じて変更する変化率制限値設定手段を具備する請求項1に記載の制御装置。
- 前記変化率制限手段は、前記所定の参照信号の変化率が変化率制限値以下となるように制限することにより、前記ゲインの変化率を前記変化率制限値以下とする請求項1または請求項2に記載の制御装置。
- 請求項1から請求項3に記載の制御装置を備える水中航走体。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011290130A JP5822722B2 (ja) | 2011-12-28 | 2011-12-28 | 制御装置及び水中航走体 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011290130A JP5822722B2 (ja) | 2011-12-28 | 2011-12-28 | 制御装置及び水中航走体 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2013140449A true JP2013140449A (ja) | 2013-07-18 |
JP5822722B2 JP5822722B2 (ja) | 2015-11-24 |
Family
ID=49037841
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2011290130A Active JP5822722B2 (ja) | 2011-12-28 | 2011-12-28 | 制御装置及び水中航走体 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5822722B2 (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015153232A (ja) * | 2014-02-17 | 2015-08-24 | 三菱重工業株式会社 | 制御装置 |
JP2015219792A (ja) * | 2014-05-20 | 2015-12-07 | 株式会社日立製作所 | プラント制御装置の制御ゲイン最適化システム |
JP2017109528A (ja) * | 2015-12-14 | 2017-06-22 | 学校法人立命館 | 風力発電機を備えた係留気球及びその制御方法 |
KR20180022447A (ko) * | 2016-08-24 | 2018-03-06 | 현대중공업 주식회사 | 엔진의 운전 최적화 시스템 및 방법 |
JP2022088859A (ja) * | 2020-12-03 | 2022-06-15 | いすゞ自動車株式会社 | パラメータ調整装置 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61169392A (ja) * | 1985-01-18 | 1986-07-31 | スペリー コーポレイシヨン | 適合自動操舵方法および装置 |
JPH1091211A (ja) * | 1996-09-13 | 1998-04-10 | Toshiba Corp | 制御定数調整装置 |
JPH1111394A (ja) * | 1997-06-23 | 1999-01-19 | Nec Corp | 水中航走体の制御装置 |
-
2011
- 2011-12-28 JP JP2011290130A patent/JP5822722B2/ja active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61169392A (ja) * | 1985-01-18 | 1986-07-31 | スペリー コーポレイシヨン | 適合自動操舵方法および装置 |
JPH1091211A (ja) * | 1996-09-13 | 1998-04-10 | Toshiba Corp | 制御定数調整装置 |
JPH1111394A (ja) * | 1997-06-23 | 1999-01-19 | Nec Corp | 水中航走体の制御装置 |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015153232A (ja) * | 2014-02-17 | 2015-08-24 | 三菱重工業株式会社 | 制御装置 |
JP2015219792A (ja) * | 2014-05-20 | 2015-12-07 | 株式会社日立製作所 | プラント制御装置の制御ゲイン最適化システム |
JP2017109528A (ja) * | 2015-12-14 | 2017-06-22 | 学校法人立命館 | 風力発電機を備えた係留気球及びその制御方法 |
KR20180022447A (ko) * | 2016-08-24 | 2018-03-06 | 현대중공업 주식회사 | 엔진의 운전 최적화 시스템 및 방법 |
KR102257970B1 (ko) * | 2016-08-24 | 2021-05-28 | 한국조선해양 주식회사 | 엔진의 운전 최적화 시스템 및 방법 |
JP2022088859A (ja) * | 2020-12-03 | 2022-06-15 | いすゞ自動車株式会社 | パラメータ調整装置 |
Also Published As
Publication number | Publication date |
---|---|
JP5822722B2 (ja) | 2015-11-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5822722B2 (ja) | 制御装置及び水中航走体 | |
JP4798181B2 (ja) | 移動体、走行装置、移動体の制御方法 | |
JP5790677B2 (ja) | 移動制御装置、移動体制御方法、及び制御プログラム | |
US20110060513A1 (en) | Moving body, method of controlling the same, and program | |
US20150375777A1 (en) | Steering control device, and steering control method | |
JP5761347B2 (ja) | 倒立型移動体制御装置、その制御方法及びプログラム | |
JP5273117B2 (ja) | モータ制御装置 | |
JP2014193706A (ja) | 自動操舵装置、自動操舵方法及び自動操舵プログラム | |
JP2014086074A (ja) | モータの制御装置及びモータの制御方法 | |
KR101266024B1 (ko) | 선박의 엔진 제어 장치 및 방법 | |
JP5812859B2 (ja) | 水中航走体及びその制御装置 | |
JP6004877B2 (ja) | 制御装置 | |
CN111158392A (zh) | 无人机转弯的规划控制方法、装置、电子设备及存储介质 | |
JP2011189884A (ja) | 自動操舵装置、自動操舵方法及び自動操舵プログラム | |
JP5272570B2 (ja) | 舵角制御装置及び舵角制御方法 | |
JP2010105551A (ja) | 定点保持制御装置およびその方法並びにプログラム | |
JP2009179263A (ja) | 自動操舵装置 | |
JP2004291773A (ja) | 船体の減揺システム | |
JP2010188883A (ja) | 車両用操舵制御装置及び車両用操舵制御方法 | |
JP6316905B1 (ja) | サーボモータ制御装置 | |
JP5251028B2 (ja) | 車両用操舵制御装置 | |
JP4747720B2 (ja) | 車両用操舵装置 | |
JP5201644B1 (ja) | 電気推進船の揺れ抑制装置 | |
JP6464726B2 (ja) | 車両用電動シートシステムの制御装置 | |
JP6354447B2 (ja) | 訓練システム、訓練方法及び訓練プログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20140811 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20150529 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20150602 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20150803 |
|
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: 20150908 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20151006 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 5822722 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313111 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313113 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |