JP6379388B2 - Maneuvering equipment - Google Patents
Maneuvering equipment Download PDFInfo
- Publication number
- JP6379388B2 JP6379388B2 JP2014216751A JP2014216751A JP6379388B2 JP 6379388 B2 JP6379388 B2 JP 6379388B2 JP 2014216751 A JP2014216751 A JP 2014216751A JP 2014216751 A JP2014216751 A JP 2014216751A JP 6379388 B2 JP6379388 B2 JP 6379388B2
- Authority
- JP
- Japan
- Prior art keywords
- ship
- control
- target
- turning
- band
- 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.)
- Active
Links
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
本発明は、操船装置に関する。 The present invention relates to a boat maneuvering apparatus.
従来、船体内部に配置された原動機(エンジン)から切換クラッチ、プロペラシャフトを介して船体外部に配置された前後進プロペラに動力を伝達する船舶(シャフト船)が知られている。また、接岸時等における操船性を向上させるために船舶を左右一側にむかって横移動させるためのサイドスラスタが設けられた船舶が知られている。サイドスラスタは、左右方向に推力が発生するように船首側の左右方向中央付近にプロペラを配置したものである。これにより船舶は、サイドスラスタによって横移動可能に構成され、接岸動作等のポジショニング制御(位置決め制御)を容易に行うことができる。 Conventionally, there is known a ship (shaft ship) that transmits power from a prime mover (engine) disposed inside a hull to a forward / rearward propeller disposed outside the hull via a switching clutch and a propeller shaft. Further, there is known a ship provided with a side thruster for laterally moving the ship toward the left and right sides in order to improve the maneuverability at the time of berthing or the like. In the side thruster, a propeller is arranged near the center in the left-right direction on the bow side so that thrust is generated in the left-right direction. Thereby, the ship is configured to be laterally movable by the side thruster, and positioning control (positioning control) such as a berthing operation can be easily performed.
このように構成される船舶において、船体の位置決めを行う場合、サイドスラスタや前後進プロペラの互いの影響を考慮して操作する必要があり操船操作が複雑であった。そこで、ジョイスティックレバーでサイドスラスタや前後進プロペラを連動して制御可能に構成することで操船操作を容易にした船舶が知られている。例えば、特許文献1に記載の如くである。
In the ship configured as described above, when positioning the hull, it is necessary to perform an operation in consideration of the mutual influences of the side thrusters and the forward and backward propellers, and the ship maneuvering operation is complicated. In view of this, there has been known a ship that facilitates a ship maneuvering operation by configuring a side thruster and a forward / reverse propeller to be controlled in conjunction with a joystick lever. For example, as described in
特許文献1に記載の船舶は、ジョイスティックレバーにより、各推進装置を容易に連動させながら操船することができる。つまり、この船舶は、操縦者が意識することなく船舶に位置を変更する移動制御と船舶の方位を変更する回頭制御とを同時に実施することができる。しかし、特許文献に記載の技術は、移動制御における回頭制御の影響が考慮されていない。従って、目標座標に目標方位で船舶の位置決めを行う場合、船舶の軌跡が回頭制御の影響により直線状にならず回頭方向に膨らむため、目標座標に目標方位で到達するように操縦者による補正が必要であった。
The ship described in
本発明は、このような問題を解決すべくなされたものであり、船舶の移動中に回頭を行っても船舶を直線状に移動させることができ、かつ目標座標に目標方位で留まることができる操船装置の提供を目的とする。 The present invention has been made to solve such a problem, and even if a turn is made during the movement of the ship, the ship can be moved linearly and can remain at the target coordinates in the target direction. The purpose is to provide a ship maneuvering device.
本発明の解決しようとする課題は以上の如くであり、次にこの課題を解決するための手段を説明する。 The problem to be solved by the present invention is as described above. Next, means for solving the problem will be described.
即ち、本発明においては、衛星測位システムの信号と方位センサの信号とに基づいて、船舶を目標座標に移動させる移動制御を行い、船舶を目標方位に回頭させる回頭制御を行う操船装置において、船舶を目標移動方向に移動させるとともに船舶を目標方位に回頭させる場合、現在座標と現在方位とから船舶を回頭させたときの単位時間後の現在方位と船舶を回頭させないときの単位時間後の現在方位とを算出し、単位時間後の回頭させたときの現在方位と単位時間後の回頭させないときの現在方位との差に基づいて船舶を移動させる目標移動方向を補正するものである。 That is, in the present invention, in the marine vessel maneuvering apparatus that performs the movement control for moving the ship to the target coordinates based on the signal of the satellite positioning system and the signal of the direction sensor and performs the turning control for turning the ship to the target direction, case of stem turning the ship target azimuth is moved to the target moving direction, the current after a unit time when not turning round the current orientation and the ship after the unit time obtained while stem turning the ship from the current coordinates and the current heading calculating a standing orientation, and corrects the target moving direction of moving the ship based on the difference between the current orientation when not turning round after current azimuth unit time obtained while turning round after unit time .
また、本発明においては、前記衛星測位システムの信号から算出した現在座標と前記目標座標との距離を基準として、目標位置を含む移動制御停止帯域と、移動制御停止帯域に隣接している緩衝帯域と、緩衝帯域に隣接している移動制御実施帯域と、が設定され、移動制御停止帯域において、移動制御のための船舶の推進装置による推力の発生を停止し、移動制御実施帯域において、移動制御のための船舶の推進装置による推力の発生を実施し、緩衝帯域において、移動制御実施帯域から緩衝帯域に移動してきた後に緩衝帯域内に留まっており、かつ目標位置から離間する方向に移動している場合にかぎり移動制御のため船舶の推進装置によって推力を発生させるものである。 Further, in the present invention, the movement control stop band including the target position and the buffer band adjacent to the movement control stop band on the basis of the distance between the current coordinates calculated from the signal of the satellite positioning system and the target coordinates. And a movement control execution band adjacent to the buffer band, the generation of thrust by the vessel propulsion device for movement control is stopped in the movement control stop band, and the movement control is performed in the movement control execution band. The thrust is generated by the marine vessel propulsion device, and after moving from the movement control band to the buffer band in the buffer band, it stays in the buffer band and moves away from the target position. The thrust is generated by the marine vessel propulsion device for movement control only when the vehicle is in motion.
また、本発明においては、前記方位センサの信号から算出した現在方位と前記目標方位との角度差を基準として、目標方位を含む回頭制御停止帯域と、回頭制御停止帯域に隣接している緩衝帯域と、緩衝帯域に隣接している回頭制御実施帯域と、が設定され、回頭制御停止帯域において、回頭制御のための船舶の推進装置による推力の発生を停止し、回頭制御実施帯域において、回頭制御のための船舶の推進装置による推力の発生を実施し、緩衝帯域において、回頭制御実施帯域から緩衝帯域に回頭してきた後に緩衝帯域内に留まっており、かつ目標方位から離間する方向に回頭している場合にかぎり回頭制御のため船舶の推進装置によって推力を発生させるものである。 Further, in the present invention, with reference to the angle difference between the current direction calculated from the signal from the direction sensor and the target direction, a turn control stop band including the target direction and a buffer band adjacent to the turn control stop band And the turn control execution band adjacent to the buffer band are set, the generation of thrust by the ship propulsion device for the turn control is stopped in the turn control stop band, and the turn control is performed in the turn control execution band. The thrust is generated by the ship's propulsion device, and in the buffer band, after turning from the turn control execution band to the buffer band, it stays in the buffer band and turns in a direction away from the target direction. The thrust is generated by the propulsion device of the ship for turning control only in the case of
本発明の効果として、以下に示すような効果を奏する。 As effects of the present invention, the following effects can be obtained.
本発明によれば、単位時間毎に船舶の回頭によってずれが生じる目標移動方向を補正した単位時間後の現在座標が算出される。これにより、船舶の移動中に回頭を行っても船舶を直線状に移動させることができる。 According to the present invention, the current coordinates after the unit time in which the target moving direction in which the deviation occurs due to the turn of the ship every unit time is calculated. Thereby, even if it turns around during movement of a ship, a ship can be moved linearly.
また、本発明によれば、移動制御と回頭制御とによる船舶の動きが目標座標および目標方位における停止精度に影響しない。これにより、船舶の移動中に回頭を行っても船舶を直線状に移動させることができ、かつ目標座標に目標方位で留まることができる。 Further, according to the present invention, the movement of the ship by the movement control and the turning control does not affect the stop accuracy at the target coordinates and the target direction. Thereby, even if it turns around during the movement of a ship, a ship can be moved linearly and it can remain at a target azimuth in a target coordinate.
まず、図1から図3を用いて本発明に係る一実施形態である船舶100の全体概要及び構成について説明する。なお、図1の船舶100は、いわゆる二軸推進方式の船舶(シャフト船)を示している。但し、推進軸の数や推進装置の形式はこれに限定されるものではなく、複数の軸を有するものやアウトドライブ方式のものでもよい。本実施形態において、船舶100の船首方向を前として前後左右方向を規定する。
First, an overall outline and configuration of a
図1と図2とに示すように、船舶100は、エンジン2の動力が、プロペラシャフト4aを介して前後進プロペラ4に伝達されるシャフト船である。船舶100は、船体1にエンジン2、切換クラッチ3、前後進プロペラ4、舵5、サイドスラスタ6およびECU16からなる推進装置、アクセルレバー8、操舵ハンドル9、ジョイスティックレバー10、サイドスラスタコントローラー11、モニタ12、GPS装置13、ヘディングセンサ(方位センサ)14および操船制御装置15からなる操船装置7、が具備される。なお、本実施形態において、船舶100は、左舷と右舷とに推進装置を有するシャフト船としたがこれに限定されるものではなく、スタンドライブ船等でもよい。
As shown in FIGS. 1 and 2, the
2つのエンジン2は、左舷と右舷との前後進プロペラ4をそれぞれ回転させるための動力を発生させる。エンジン2は、船体1の左舷後部側と右舷後部側とにそれぞれ配置されている。エンジン2の出力軸には、切換クラッチ3がそれぞれ接続されている。
The two
2つの切換クラッチ3は、エンジン2の出力軸から伝達された動力を正回転方向と逆回転方向とに切り換えて出力するものである。切換クラッチ3の入力側には、エンジン2の出力軸が接続されている。切換クラッチ3の出力側には、プロペラシャフト4aがそれぞれ接続されている。つまり、切換クラッチ3は、エンジン2からの動力をプロペラシャフト4aに伝達するように構成されている。
The two
2つの前後進プロペラ4は、前後方向の推力を発生させるものである。前後進プロペラ4は、船体1の左舷の船底と右舷の船底とを貫通して船外に至るように設けられている2本のプロペラシャフト4aにそれぞれ接続されている。前後進プロペラ4は、プロペラシャフト4aを介して伝達されたエンジン2の動力によって回転駆動され、その回転軸周りに配置された複数枚のブレードが周囲の水をかくことによって推力を発生させる。
The two forward and
2つの舵5は、前後進プロペラ4の回転駆動により発生した水流の方向を変更するものである。舵5は、船体1の左舷の船底後端(船尾側)と右舷の船底後端(船尾側)とであって前後進プロペラ4の後方にそれぞれ配置されている。舵5は、船体1にもうけられている回転軸を中心として左右方向に所定の角度範囲で回転可能に構成されている。舵5は、操舵ハンドル9と連動連結されている。これにより、舵5は、操舵ハンドル9の操作により、その後端部を船体1の右側に向けると水流により発生した推力によって船舶100の船尾が左側に推され、船首側が右側を向くように構成されている。同様に舵5は、操舵ハンドル9の操作により、その後端部を船舶100の左側に向けると水流により発生した推力によって船舶100の船尾が右側に推され、船首側が左側を向くように構成されている。
The two
サイドスラスタ6は、左右方向の推力を発生させるものである。サイドスラスタ6は、船体1の船首側であって左右方向中央に設けられている。サイドスラスタ6は、プロペラ6aとモータ6bとを具備している。モータ6bは、サイドスラスタコントローラー1111に接続され、任意の回転速度で回転可能に構成されている。サイドスラスタ6は、プロペラ6aによる推力発生方向が船体1の左右方向になるように構成されている。サイドスラスタ6は、サイドスラスタコントローラー11からの信号に基づいてモータ6bを駆動することによりプロペラ6aが回転され、左右方向に任意の大きさの推力を発生させる。
The
操船装置7を構成するアクセルレバー8は、左舷の前後進プロペラ4の回転速度、右舷の前後進プロペラ4の回転速度およびそれらの回転方向についての信号を生成するものである。アクセルレバー8は、左舷の前後進プロペラ4に対応したレバーと舷の前後進プロペラ4に対応したレバーとから構成されている。つまり、アクセルレバー8は、左舷の前後進プロペラ4と右舷の前後進プロペラ4とについての信号をそれぞれ独立して生成するように構成されている。アクセルレバー8は、船舶100の前後方向に任意の角度で傾斜するように構成されている。アクセルレバー8は、操作方向および操作量に応じて各エンジン2の回転速度と対応する切換クラッチ3の切り換え状態についての信号をそれぞれ独立して生成するように構成されている。アクセルエバー2は、前方に傾斜するように操作されると船舶100が前進する推力を発生させるように前後進プロペラ4の信号を生成し、後方に傾斜するように操作されると船舶100が後進する推力を発生させるように前後進プロペラ4の信号を生成する。
The
操船装置7を構成する操舵ハンドル9は、舵5の回転角度を変更するものである。操舵ハンドル9は、左舷と右舷との舵5にワイヤーリンク機構または油圧回路を介して連動連結されている。操舵ハンドル9は、右方向に回転操作されると舵5の後端部が右側に向かうように回転する。これにより、船舶100は、前後進プロペラ4により発生した水流が右側に向かうことで船尾が左側に推され、船首側が右側を向くように構成されている。同様にして、操舵ハンドル9は、左方向に回転操作されると舵5の後端部が左側に向かうように回転する。これにより、船舶100は、前後進プロペラ4により発生した水流が左側に向かうことで船尾が右側に推され、船首側が左側を向くように構成されている。
A steering handle 9 constituting the
図1と図3とに示すように、操船装置7を構成するジョイスティックレバー10は、船舶100を任意の方向に移動させるための信号を生成するものである。ジョイスティックレバー10は、任意の方向に任意の角度で傾斜できるように構成されている。また、ジョイスティックレバー10は、レバー軸周りに任意の角度に回転操作できるように構成されている。ジョイスティックレバー10は、操作態様および操作量に応じてエンジン2の回転速度と切換クラッチ3の切り換え状態についての信号、およびサイドスラスタ6の回転速度と回転方向についての信号を生成するように構成されている。具体的には、ジョイスティックレバー10は、任意の方向に傾斜するように操作されると操作量に応じた推力で船舶100を操作方向に移動させるための両舷の前後進プロペラ4とサイドスラスタ6との信号を生成する。また、ジョイスティックレバー10は、レバー軸周りに回転するように操作されると操作量に応じた推力で船舶100を任意の方向に回転させるための両舷の前後進プロペラ4とサイドスラスタ6との信号を生成する。
As shown in FIGS. 1 and 3, the
ジョイスティックレバー10には、後述のポジショニング制御のための目標座標を設定するポジショニングスイッチ10a、目標座標へ船舶100の移動を開始するための移動スイッチ10bおよび各種設定を変更する変更スイッチ10cを具備している。ポジショニングスイッチ10aは、ポジショニング制御開始信号を生成する。移動スイッチ10bは、ジョイスティックレバー10の操作により設定された目標座標へむけて船舶100の移動を開始する移動信号を生成する。変更スイッチ10cは、船舶100のポジショニングにおける制御条件を変更する信号を生成する。
The
操船装置7を構成するサイドスラスタコントローラー11は、サイドスラスタ6を駆動させるものである。サイドスラスタコントローラー11は、オン操作されるとサイドスラスタ6のプロペラ6aによって左右方向の推力が発生するようにサイドスラスタ6のモータ6bを任意の回転方向で回転させる。
The side thruster controller 11 constituting the
操船装置7を構成するGPS(GPS:Global Positioning System)装置13は、船舶100の位置座標を計測(算出)するものである。GPS装置13は、複数のGPS衛星からの信号を受信することで船舶100の位置座標を算出し、現在の位置を緯度La(n)と経度Lo(n)として出力する。つまり、GPS装置13は、船舶100の位置座標の絶対値を算出する。
A GPS (GPS: Global Positioning System)
操船装置7を構成する方位センサであるヘディングセンサ14は、船舶100の方向を計測(算出)するものである。ヘディングセンサ14は、地磁気から船舶100の船首の方位を算出する。つまり、ヘディングセンサ14は、船舶100の船首の絶対方位を算出する。
A heading
図1に示すように、ECU16は、エンジン2を制御するものである。ECU16には、エンジン2の制御を行うための種々のプログラムやデータが格納される。ECU16は、各エンジン2にそれぞれ設けられる。ECU16は、CPU、ROM、RAM、HDD等がバスで接続される構成であってもよく、あるいはワンチップのLSI等からなる構成であってもよい。
As shown in FIG. 1, the
ECU16は、エンジン2の図示しない燃料供給ポンプの燃料調量弁、燃料噴射弁および各種センサ等と接続され、燃料調量弁の供給量、燃料噴射弁の開閉を制御することができ、各種センサが検出する情報を取得することが可能である。
The
操船装置7を構成する操船制御装置15は、アクセルレバー8、操舵ハンドル9及びジョイスティックレバー10等からの検出信号に基づいてエンジン2、切換クラッチ3およびサイドスラスタ6を制御するものである。なお、操船制御装置15は、GPS装置13からの情報に基づいて自らの位置と設定された目的地とから航路を算出して自動で操船を行なう、いわゆる自動航法を可能に構成されてもよい。
A boat
操船制御装置15は、エンジン2、切換クラッチ3、サイドスラスタ6の制御を行うための種々のプログラムやデータが格納される。操船制御装置15は、CPU、ROM、RAM、HDD等がバスで接続される構成であってもよく、あるいはワンチップのLSI等からなる構成であってもよい。
The boat
操船制御装置15は、各切換クラッチ3および各エンジン2のECU16に接続され、各切換クラッチ3の状態、各エンジン2の起動状況及び各ECU16が各種センサから取得するエンジン回転速度Nや各種信号を取得することが可能である。
The marine vessel
操船制御装置15は、各切換クラッチ3にクラッチの状態を変更する(切り換える)信号を送信することが可能である。
The boat
操船制御装置15は、ECU16に燃料供給ポンプの燃料調量弁、燃料噴射弁その他エンジン2の各種機器を制御するための信号を送信することが可能である。
The boat
操船制御装置15は、アクセルレバー8およびジョイスティックレバー10と接続され、アクセルレバー8およびジョイスティックレバー10からの信号を取得することが可能である。
The boat
操船制御装置15は、サイドスラスタ6のサイドスラスタコントローラー11に接続され、サイドスラスタ6を制御するための信号を送信することが可能である。
The boat
操船制御装置15は、GPS装置13およびヘディングセンサ14に接続され、船舶100の絶対座標と絶対方位とを取得することが可能である。
The boat
操船制御装置15は、モニタ12に接続され、船舶100の現在位置やジョイスティックレバー10による操船状況を表示することが可能である。
The boat
以下では、図4と図5とを用いて、本発明に係る船舶の一実施形態である船舶100において、操船制御装置15によるポジショニング制御(位置制御)について説明する。ポジショニング制御とは、船舶100を所望の座標位置に船首が所望の方位に向くように移動させ、かつその位置を保持することをいう。
Hereinafter, with reference to FIGS. 4 and 5, positioning control (position control) by the boat
図4(a)に示すように、操船制御装置15は、ジョイスティックレバー10のポジショニングスイッチ10aが操作されるとポジショニング制御を開始する。操船制御装置15は、GPS装置13が算出した船舶100の現在の位置座標である緯度La(n)と経度Lo(n)とからなる現在座標P(n)を取得するとともにヘディングセンサ14が算出した船舶100の現在の船首の方位である現在方位Az(n)を取得する。そして、操船制御装置15は、ジョイスティックレバー10から取得した操作方向と操作量とに応じた信号に基づいて船舶100の目標とする位置座標である緯度Latと経度Lotとからなる目標座標Ptを算出し、船舶100の目標座標Ptにける船首の方位である目標方位Atを算出する。
As shown in FIG. 4A, the boat
図4(b)に示すように、操船制御装置15は、現在座標P(n)と目標座標Ptとの差を算出し、目標座標Ptを現在座標P(n)からの距離L(n)と移動方向θ(n)とで表す目標極座標Po(n)に変換する。さらに、操船制御装置15は、現在方位Az(n)と目標方位Atとの角度差である回頭角度R(n)を算出する。
As shown in FIG. 4B, the boat
図5に示すように、操船制御装置15は、現在方位Az(n)と単位時間前における現在方位Az(n−1)との差から船舶100の回頭速度である現在回頭速度ΔRv(n)を算出する。操船制御装置15は、単位時間前における現在座標P(n−1)と現在座標P(n)とから現在速度ΔV(n)と現在方向Δθv(n)とを算出する。
As shown in FIG. 5, the boat
以上の算出した値から、操船制御装置15は、PID制御に基づいて、回頭角度R(n)から船舶100の現在回頭速度ΔRv(n)を考慮した船舶100の目標回頭量Rt(n)を算出する。操船制御装置15は、PID制御に基づいて、距離L(n)から船舶100の現在速度ΔV(n)を考慮した船舶100の目標移動量Lt(n)を算出する。操船制御装置15は、PID制御に基づいて、移動方向θ(n)から船舶100の現在方向Δθv(n)を考慮して回頭によるずれを補正した船舶100の目標移動方向θt(n)を算出する。
From the above calculated values, the boat
操船制御装置15は、回頭制御として、算出した目標回頭量Rt(n)に基づいて、船舶100の前後進プロペラ4の推力、切換クラッチ3の切り換え状態および舵5、サイドスラスタ6の推力および回転方向について制御する。また、操船制御装置15は、移動制御として、算出した目標移動量Lt(n)および目標移動方向θt(n)に基づいて、船舶100の前後進プロペラ4の推力、切換クラッチ3の切り換え状態および舵5、サイドスラスタ6の推力および回転方向について制御する。
The boat
以下では、図6を用いて、本発明に係る船舶の一実施形態である船舶100において、操船制御装置15によるポジショニング制御(位置制御)について具体的に説明する。なお、本実施形態において、操船制御装置15は、ジョイスティックレバー10のポジショニングスイッチ10aが操作されてポジショニング制御開始信号を取得したものとする。
Hereinafter, with reference to FIG. 6, the positioning control (position control) by the boat
ステップS1において、操船制御装置15は、GPS装置13から船舶100の現在の位置座標である緯度La(n)と経度Lo(n)とからなる現在座標P(n)を取得するとともにヘディングセンサ14から船舶100の現在の船首の方位である現在方位Az(n)を取得し、ステップをステップS2に移行させる。
In step S <b> 1, the boat
ステップS2において、操船制御装置15は、ジョイスティックレバー10から傾斜方向と操作量とに応じた信号を取得し、ステップをステップS3に移行させる。
In step S2, the boat
ステップS3において、操船制御装置15は、取得したジョイスティックレバー10からの信号に基づいて船舶100の目標とする位置座標である緯度Latと経度Lotとからなる目標座標Ptを算出し、船舶100の目標とする船首の方位である目標方位Atを算出し、ステップをステップS4に移行させる。
In step S <b> 3, the boat
ステップS4において、操船制御装置15は、船舶100の現在座標P(n)と船舶100の目標座標Ptとの差を算出し、目標座標Ptを現在座標P(n)からの距離L(n)と移動方向θ(n)とで表す目標極座標Po(n)に変換する。
In step S4, the boat
ステップS5において、操船制御装置15は、現在方位Az(n)と目標方位Atとの差である回頭角度R(n)を算出し、現在方位Az(n)と単位時間前における現在方位Az(n−1)とから現在回頭速度ΔRv(n)を算出し、ステップをステップS6に移行する。
In step S5, the boat
ステップS6において、操船制御装置15は、単位時間前における現在座標P(n−1)と現在座標P(n)とから現在速度ΔV(n)と現在方向Δθv(n)とを算出し、ステップをステップS7に移行する。
In step S6, the boat
ステップS7において、操船制御装置15は、PID制御に基づいて、回頭角度R(n)から船舶100の現在回頭速度ΔRv(n)を考慮した船舶100の単位時間当たりの目標回頭量Rt(n)を算出し、距離L(n)から船舶100の現在速度ΔV(n)を考慮した船舶100の単位時間当たりの目標移動量Lt(n)を算出し、移動方向θ(n)から船舶100の現在方向Δθv(n)を考慮して回頭によるずれを補正した船舶100の単位時間当たりの目標移動方向θt(n)を算出し、ステップをステップS8に移行する。
In step S <b> 7, the boat
ステップS8において、操船制御装置15は、算出した目標回頭量Rt(n)に基づいて、船舶100の推進装置を制御する回頭制御を行い、算出した目標移動量Lt(n)および目標移動方向θt(n)に基づいて、船舶100の推進装置を制御する移動制御を行い、ステップをステップS1に移行する。
In step S8, the boat
このように、操船装置は、操船制御装置15によって船舶100の目標座標Pt(0)を目標極座標Po(n)に変換することで、目標回頭量Rt(n)、目標移動量Lt(n)および目標移動方向θt(n)をお互いに独立して算出することができるように構成されている。従って、操船装置は、船舶100の前後進プロペラ4の推力、切換クラッチ3の切り換え状態および舵5、サイドスラスタ6の推力および回転方向について容易に制御することができる。
In this way, the boat maneuvering device converts the target coordinate Pt (0) of the
以下では、図7から図9を用いて、本発明に係る操船装置において、ポジショニング制御における不感帯および不感帯制御の態様について説明する。 Hereinafter, the dead zone and the dead zone control in the positioning control in the boat maneuvering apparatus according to the present invention will be described with reference to FIGS.
ポジショニング制御における不感帯とは、所定の条件においてポジショニング制御を行わない帯域をいう。不感帯は、船舶100の慣性力による移動(いわゆる行き脚)や水流の影響を考慮した位置制御を行うために目標座標Pt(0)を中心とする所定の帯域に設定されている。算出操船制御装置15は、算出した距離L(n)と回頭角度R(n)とについて目標極座標Po(n)を中心とする不感帯を設定する。
The dead zone in positioning control refers to a zone in which positioning control is not performed under a predetermined condition. The dead zone is set to a predetermined zone centered on the target coordinate Pt (0) in order to perform position control in consideration of the movement of the
初めに、回頭制御における不感帯の設定および不感帯制御の態様について説明する。回頭制御とは、前後進プロペラ4の推力、切換クラッチ3の切り換え状態および舵5、サイドスラスタ6の推力および回転方向について制御し、船舶100の所定の点(例えば重心)を回転中心する回転移動によって船舶100の船首の向きを変更する制御を言う。
First, the setting of the dead zone in the turning control and the mode of the dead zone control will be described. The turning control controls the thrust of the forward /
図7に示すように、不感帯は、船舶100の目標とする船首の方位である目標方位Atを基準とする複数の帯域から構成されている。また、不感帯は、船舶100の回転中心を中心とする所定の角度範囲で設定されている。つまり、不感帯は、現在方位Az(n)と船舶100の目標方位Atとの差である回頭角度R(n)に対応する角度範囲によって表される。本実施形態において不感帯は、目標方位Atを基準として右方向を+、左方向を−として±180°の範囲で|角度θ1|未満の角度範囲を回頭制御停止帯域Ar、|角度θ1|以上|角度θ2|未満の角度範囲を緩衝帯域Br、|角度θ2|以上の角度範囲を回頭制御実施帯域Crとして構成されている。従って、不感帯は、目標方位Atを基準としてその両側に回頭制御停止帯域Arと回頭制御実施帯域Crとが緩衝帯域Brを介して設定されている。
As shown in FIG. 7, the dead zone is composed of a plurality of bands based on the target direction At that is the target heading of the
回頭制御実施帯域Crは、前後進プロペラ4やサイドスラスタ6等の推進装置によって船舶100を回頭させる回頭制御を行う角度範囲をいう。図8(a)に示すように、操船装置の操船制御装置15は、船舶100の回頭角度R(n)が回頭制御実施帯域Crに含まれている場合、PID制御に基づいて、船舶100の回頭角度R(n)が小さくなるように回頭制御を行う(図8(a)における白塗り矢印)。
The turning control execution band Cr refers to an angle range in which turning control is performed to turn the
緩衝帯域Brは、船舶100の回頭角度R(n)が緩衝帯域Br含まれる状態になった際の動作態様に応じて前後進プロペラ4やサイドスラスタ6等の推進装置によって船舶100を回頭させる回頭制御を行う場合と行わない場合とに切り換える角度範囲をいう。図8(b−1)に示すように、操船装置の操船制御装置15は、船舶100が回頭して回頭角度R(n)が回頭制御実施帯域Crに含まれている状態から緩衝帯域Brに含まれている状態に移行し(図8(b−1)における矢印参照)、かつ現在も緩衝帯域Brに含まれている場合、船舶100が回頭角度R(n)を小さくする方向に回頭しているときは回頭角度R(n)に関わらず回頭制御を行わない。一方、船舶100が回頭角度R(n)を大きくする方向に回頭しているとき(図8(b−2)矢印参照)は回頭角度R(n)を小さくするように回頭制御を行う(図8(b−2)白塗り矢印参照)。図8(c)に示すように、操船装置の操船制御装置15は、船舶100が回頭して回頭角度R(n)が緩衝帯域Brと回頭制御停止帯域Arとの間で回頭している場合、回頭方向、回頭角度R(n)に関わらず回頭制御を行わない。
The buffer band Br is a turn that causes the
回頭制御停止帯域Arは、前後進プロペラ4やサイドスラスタ6等の推進装置によって船舶100を移動させる移動制御を行わない距離範囲をいう。図8(c)に示すように、操船装置7の操船制御装置15は、船舶100が回頭して回頭角度R(n)が回頭制御停止帯域Arに含まれる場合、船舶100の回頭角度R(n)に関わらず回頭制御を行わない。
The turning control stop zone Ar refers to a distance range in which movement control for moving the
つまり、船舶100は、目標方位Atに近づく方向に回頭している場合であって船首が回頭制御停止帯域Arによって定まる領域と緩衝帯域Brによって定まる領域とにあるとき、および目標方位Atから離れる方向に回頭している場合であって船首が回頭制御停止帯域Arによって定まる領域にあるときと船首が回頭制御停止帯域Arによって定まる領域から緩衝帯域Brによって定まる領域に進入したときとは回頭制御を停止する。
That is, the
次に、本発明に係る操船装置7における回頭制御時の不感帯制御の態様について具体的に説明する。なお、本実施形態において、操船制御装置15は、ジョイスティックレバー10から取得した操作方向と操作量とに応じた信号に基づいて船舶100の目標とする船首の方位である目標方位Atを算出しているものとする。
Next, the aspect of dead zone control at the time of turning control in the
図9に示すように、ステップS110において、操船制御装置15は、ヘディングセンサ14から船舶100の船首の現在方位Az(n)を取得し、ステップをステップS120に移行させる。
As shown in FIG. 9, in step S110, the boat
ステップS120において、操船制御装置15は、事前に算出した目標方位Atと取得した現在方位Az(n)とから回頭角度R(n)を算出し、ステップをステップS130に移行させる。
In step S120, the boat
ステップS130において、操船制御装置15は、算出した回頭角度R(n)が|角度θ1|以上であるか否か判断する。その結果、算出した回頭角度R(n)が|角度θ1|以上であると判定した場合、すなわち、現在方位Az(n)が回頭制御停止帯域Arに含まれていないと判定した場合、操船制御装置15はステップをステップS140に移行させる。一方、算出した回頭角度R(n)が|角度θ1|以上でないと判定した場合、すなわち、現在方位Az(n)が回頭制御停止帯域Arに含まれていると判定した場合、操船制御装置15はステップをステップS270に移行させる。
In step S130, the boat
ステップS140において、操船制御装置15は、算出した回頭角度R(n)が|角度θ2|未満であるか否か判断する。その結果、算出した回頭角度R(n)が|角度θ2|未満であると判定した場合、すなわち、現在方位Az(n)が緩衝帯域Brに含まれていると判定した場合、操船制御装置15はステップをステップS150に移行させる。一方、算出した回頭角度R(n)が|角度θ2|未満でないと判定した場合、すなわち、現在方位Az(n)が緩衝帯域Brに含まれていないと判定した場合、操船制御装置15はステップをステップS170に移行させる。
In step S140, the boat
ステップS150において、操船制御装置15は、算出した回頭角度R(n)が単位時間前に算出した回頭角度R(n−1)よりも大きいか否か判断する。すなわち、操船制御装置15は、船舶100が目標方位Atから離間する方向に回頭しているか否か判断する。その結果、算出した回頭角度R(n)が単位時間前に算出した回頭角度R(n−1)よりも大きいと判断した場合、すなわち、船舶100が目標方位Atから離間する方向に回頭していると判断した場合、ステップをステップS160に移行させる。一方、算出した回頭角度R(n)が単位時間前に算出した回頭角度R(n−1)以下であると判断した場合、すなわち、船舶100が目標方位Atから離間する方向に回頭していないと判断した場合、ステップをステップS270に移行させる。
In step S150, the boat
ステップS160において、操船制御装置15は、算出した回頭角度R(n)が直前に回頭制御実施帯域Crに含まれていたか否か判断する。その結果、算出した回頭角度R(n)が直前に回頭制御実施帯域Crに含まれていたと判断した場合、ステップをステップS170に移行させる。一方、算出した回頭角度R(n)が直前に回頭制御実施帯域Crに含まれていないと判断した場合、ステップをステップS270に移行させる。
In step S160, the boat
ステップS170において、操船制御装置15は、回頭制御を実施し、ステップをステップS110に移行させる。
In step S170, the boat
ステップS270において、操船制御装置15は、回頭制御を停止し、ステップをステップS110に移行させる。
In step S270, the boat
次に、図10と図11とを用いて、移動制御における不感帯の設定および不感帯制御の態様について説明する。移動制御とは、前後進プロペラ4の推力、切換クラッチ3の切り換え状態および舵5、サイドスラスタ6の推力および回転方向について制御し、船舶100を目標座標Ptに移動させる制御を言う。
Next, with reference to FIG. 10 and FIG. 11, the setting of the dead zone in the movement control and the mode of the dead zone control will be described. The movement control refers to control for moving the
図10に示すように、不感帯は、船舶100の目標とする位置である目標座標Ptを基準とする複数の帯域から構成されている。また、不感帯は、船舶100の目標座標Ptを基準とする所定の距離範囲で設定されている。つまり、不感帯は、現在座標P(n)から目標座標Ptまでの距離L(n)に対応する距離範囲によって表される。本実施形態において不感帯は、目標座標Ptから距離L1未満の距離範囲からなる帯域を移動制御停止帯域Al、目標座標Ptから距離L1以上距離L2未満の距離範囲からなる帯域を緩衝帯域Bl、目標座標Ptから距離L2以上の距離範囲からなる帯域、すなわち移動制御停止帯域Alと緩衝帯域Blとを除いた帯域を移動制御実施帯域Clとして構成されている。従って、不感帯は、目標座標Ptを中心として移動制御停止帯域Alと移動制御実施帯域Clとが緩衝帯域Bl介して設定されている。
As shown in FIG. 10, the dead zone is composed of a plurality of bands based on target coordinates Pt that are target positions of the
移動制御実施帯域Clは、前後進プロペラ4やサイドスラスタ6等の推進装置によって船舶100を移動させる移動制御を行う距離範囲をいう。図11(a)に示すように、操船装置の操船制御装置15は、船舶100の距離L(n)が移動制御実施帯域Clに含まれている場合、PID制御に基づいて、船舶100の距離L(n)が小さくなるように移動制御を行う(図11(a)における白塗り矢印)。
The movement control execution band Cl is a distance range in which movement control for moving the
緩衝帯域Blは、船舶100の距離L(n)が緩衝帯域Bl含まれる状態になった際の動作態様に応じて前後進プロペラ4やサイドスラスタ6等の推進装置によって船舶100を移動させる移動制御を行う場合と行わない場合とに切り換える距離範囲をいう。図11(b−1)に示すように、操船装置の操船制御装置15は、船舶100が移動して距離L(n)が移動制御停止帯域Alに含まれている状態から緩衝帯域Blに含まれている状態に移行し(図11(b−1)における矢印参照)、かつ現在も緩衝帯域Blに含まれている場合、船舶100が距離L(n)を小さくする方向に回頭しているときは距離L(n)に関わらず移動制御を行わない。一方、船舶100が距離L(n)を大きくする方向に移動しているとき(図11(b−2)矢印参照)は距離L(n)を小さくするように移動制御を行う(図11(b−2)白塗り矢印参照)。図11(c)に示すように、操船装置の操船制御装置15は、船舶100が移動して距離L(n)が緩衝帯域Blと移動制御停止帯域Alとの間で移動している場合、移動方向、距離L(n)に関わらず移動制御を行わない。
The buffer band Bl is a movement control for moving the
移動制御停止帯域Alは、前後進プロペラ4やサイドスラスタ6等の推進装置によって船舶100を移動させる移動制御を行わない距離範囲をいう。操船装置の操船制御装置15は、船舶100の距離L(n)が移動制御停止帯域Alに含まれている場合、船舶100の回頭角度R(n)に関わらず回頭制御を行わない。
The movement control stop zone Al refers to a distance range in which movement control for moving the
つまり、船舶100は、目標座標Ptに近づく方向に移動している場合であって移動制御停止帯域Alによって定まる領域と緩衝帯域Blによって定まる領域とにあるとき、および目標座標Ptから離れる方向に移動している場合であって移動制御停止帯域Alによって定まる領域にあるときと移動制御停止帯域Alによって定まる領域から緩衝帯域Blによって定まる領域に進入したときとは移動制御を停止する。
That is, the
次に、本発明に係る操船装置7における移動制御時の不感帯制御の態様について具体的に説明する。なお、本実施形態において、操船制御装置15は、ジョイスティックレバー10から取得した操作方向と操作量とに応じた信号に基づいて船舶100の目標とする位置座標である緯度Latと経度Lotとからなる目標座標Ptを算出しているものとする。
Next, the aspect of dead zone control at the time of movement control in the
図12に示すように、ステップS310において、操船制御装置15は、GPS装置13から船舶100の現在座標P(n)を取得し、ステップをステップS320に移行させる。
As shown in FIG. 12, in step S310, the boat
ステップS320において、操船制御装置15は、事前に算出した目標座標Ptと取得した現在座標P(n)とから距離L(n)を算出し、ステップをステップS330に移行させる。
In step S320, the boat
ステップS330において、操船制御装置15は、算出した距離L(n)が距離L1以上であるか否か判断する。その結果、算出した距離L(n)が距離L1以上であると判定した場合、すなわち、現在座標P(n)が移動制御停止帯域Alに含まれていないと判定した場合、操船制御装置15はステップをステップS340に移行させる。一方、算出した距離L(n)が距離L1以上でないと判定した場合、すなわち、現在座標P(n)が移動制御停止帯域Alに含まれていると判定した場合、操船制御装置15はステップをステップS470に移行させる。
In step S330, the boat
ステップS340において、操船制御装置15は、算出した距離L(n)が距離L2未満であるか否か判断する。その結果、算出した距離L(n)が距離L2未満であると判定した場合、すなわち、現在座標P(n)が緩衝帯域Brに含まれていると判定した場合、操船制御装置15はステップをステップS350に移行させる。一方、算出した距離L(n)が距離L2未満でないと判定した場合、すなわち、現在座標P(n)が緩衝帯域Brに含まれていないと判定した場合、操船制御装置15はステップをステップS370に移行させる。
In step S340, the boat
ステップS350において、操船制御装置15は、算出した距離L(n)が単位時間前に算出した距離L(n−1)よりも大きいか否か判断する。すなわち、操船制御装置15は、船舶100が目標座標Ptから離間する方向に移動しているか否か判断する。その結果、算出した距離L(n)が単位時間前に算出した距離L(n−1)よりも大きいと判断した場合、すなわち、船舶100が目標座標Ptから離間する方向に移動していると判断した場合、ステップをステップS360に移行させる。一方、算出した距離L(n)が単位時間前に算出した距離L(n−1)以下であると判断した場合、すなわち、船舶100が目標座標Ptから離間する方向に移動していないと判断した場合、ステップをステップS470に移行させる。
In step S350, the boat
ステップS360において、操船制御装置15は、算出した距離L(n)が直前に移動制御実施帯域Clに含まれていたか否か判断する。その結果、算出した距離L(n)が直前に移動制御実施帯域Clに含まれていたと判断した場合、ステップをステップS370に移行させる。一方、算出した距離L(n)が直前に移動制御実施帯域Clに含まれていたと判断した場合、ステップをステップS470に移行させる。
In step S360, the boat
ステップS370において、操船制御装置15は、移動制御を実施し、ステップをステップS310に移行させる。
In step S370, the boat
ステップS470において、操船制御装置15は、移動制御を停止し、ステップをステップS310に移行させる。
In step S470, the boat
このように構成することで、帯域を設定することで船舶100の行き脚、水流や風などの外乱による影響の有無を考慮して制御態様が変更される。これにより、船舶の慣性力や外乱の影響に対応した位置決め制御が実施され、水流や風の影響によって船舶100が不感帯の境界で保持されることなく目標方位At、目標座標Ptの近傍に到達することができる。なお、本実施形態において、緩衝帯域Brの角度範囲、緩衝帯域Blの距離範囲、回頭制御時の推力、移動制御時の推力を船舶100の船体の形状や挙動に応じて変更してもよい。例えば、GPS装置13やヘディングセンサ14のデータから回頭制御停止帯域Arまたは移動制御停止帯域Alの近傍で停止する傾向がある船舶の場合、緩衝帯域が小さく設定されるように構成してもよい。
By configuring in this way, the control mode is changed in consideration of the influence of disturbance such as the landing leg, water flow, and wind of the
以下では、図13と図14とを用いて、本発明に係る操船装置において、ポジショニング制御における回頭による移動方向のずれの回頭補正制御の態様について説明する。ポジショニング制御における回頭による移動方向のずれとは、船舶100を移動制御と船舶100の回頭制御とを同時に行う場合、回頭制御により船舶100の移動制御の移動方向θ(n)にずれが生じることを言う。
Hereinafter, with reference to FIG. 13 and FIG. 14, an aspect of the turning correction control for the shift in the moving direction due to turning in the positioning control in the boat maneuvering apparatus according to the present invention will be described. The shift in the movement direction due to the turning in the positioning control means that when the movement control of the
初めに、図13を用いて、回頭による移動方向のずれの回頭補正制御が行われない場合の制御態様について説明する。本実施形態において、船舶100は、移動制御により移動方向θ(n)で現在座標P(n)から目標座標Ptまで移動されるとともに、回頭制御により船首を現在方位Az(n)から180度反転させた目標方位Atまで回頭される。
First, a control mode in the case where the turning correction control for the shift in the moving direction due to the turning is not performed will be described with reference to FIG. In the present embodiment, the
図13(a)に示すように、操船制御装置15は、現在座標P(n)を取得すると船舶100を移動制御により移動方向θ(n)として現在座標P(n)から現在座標P(n+1)に移動させるとともに、回頭制御により現在方位Az(n)から現在方位Az(n+1)まで回頭させる。この際、船舶100は、回頭制御の影響をうけて現在座標P(n)における移動方向θ(n)(図13(a)における黒塗り矢印参照)が目標座標Ptの方向からずれる(図13(a)における黒塗り破線矢印参照)。従って、船舶100は、移動制御により現在座標P(n)と目標座標Ptとを直線的につないだ方向からずれた方向に移動される。
As shown in FIG. 13A, when the boat
さらに、操船制御装置15は、現在座標P(n+1)を取得すると船舶100を移動制御によりずれを補正した移動方向θ(n+1)として現在座標P(n+1)から現在座標P(n+2)に移動させるとともに、回頭制御により現在方位Az(n+1)から現在方位Az(n+2)まで回頭させる。この際、船舶100は、回頭制御の影響をうけて現在座標P(n+1)における移動方向θ(n+1)(図13(a)における黒塗り矢印参照)が目標座標Ptの方向からずれる(図13(a)における黒塗り破線矢印参照)。
Further, when the boat
この結果、図13(b)に示すように、操船制御装置15は、回頭制御の影響による移動方向θ(n)のずれによって回頭している方向に膨らみ、船舶100が現在座標P(n)と目標座標Ptとをつなぐ直線状の軌跡を描くように制御できない。
As a result, as shown in FIG. 13B, the boat
次に、図14を用いて、回頭による移動方向のずれの回頭補正制御が行われる場合の制御態様について説明する。 Next, with reference to FIG. 14, a control mode in the case where the turning correction control for the shift in the moving direction due to the turning is performed will be described.
図14(a)に示すように、操船制御装置15は、現在座標P(n)を取得すると船舶100を移動制御により移動方向θ(n)として現在座標P(n)から現在座標P(n+1)に移動させるとともに、回頭制御により現在方位Az(n)から現在方位Az(n+1)まで回頭させる。この際、船舶100は、回頭制御の影響をうけて現在座標P(n)における移動方向θ(n)が目標座標Ptの方向からずれようとする(図13(a)における黒塗り破線矢印参照)。ここで、操船制御装置15は、回頭補正制御により船舶100が現在方位Az(n+1)に移動したときの現在方位Az(n+1)を考慮して船舶100を目標移動方向θt(n)に移動させる。
As shown in FIG. 14A, when the boat
この結果、図14(b)に示すように、操船制御装置15は、回頭制御による移動方向θ(n)のずれの影響を補正することで、船舶100が現在座標P(n)と目標座標Ptとをつなぐ略直線状の軌跡を描くように制御することができる。
As a result, as shown in FIG. 14B, the boat
このように構成することで、回頭補正制御を適用することにより移動制御における移動方向θ(n)を回頭制御による影響を考慮した目標移動方向θt(n)に補正することで船舶100が現在座標P(n)から目標座標Ptまで略直線状の軌跡を描くように移動される。これにより、移動制御と回頭制御を同時に行っても移動と回頭とのために必要な領域を小さくすることができる。また、操船制御装置15は、船舶が目標座標を中心とする所定範囲内、または目標方位を中心とする所定方位内(角度内)に到達すると前述の不感帯制御を実施する。これにより、船舶100は、回頭補正制御の終了後において、目標座標を中心とする所定の範囲内、および目標方位を中心とする所定方位内(角度内)に留まることができる。
By configuring in this way, by applying the turning correction control, the
以下では、図15と図16とを用いて、本発明に係る操船装置において、ポジショニング制御でのジョイスティックレバー10を用いた目標座標Ptおよび目標方位Atの設定の態様ついて説明する。
Hereinafter, with reference to FIG. 15 and FIG. 16, a description will be given of how the target coordinate Pt and the target direction At are set using the
図15に示すように、操船装置は、操船制御装置15におけるポジショニング制御において、目標座標Ptおよび目標方位Atの設定をジョイスティックレバー10とモニタ12に表示する船舶100を模した図形Dおよび図形Eよって行うように構成されている。操船制御装置15は、操船装置のモニタ12の中心部分に図形Dを船舶100の船首方向と一致するように表示し、船舶100の目標座標Ptおよび目標方位Atを図形Eで表示するように構成されている。
As shown in FIG. 15, the boat maneuvering device uses a figure D and a figure E imitating the
図15(a)に示すように、操船制御装置15は、ジョイスティックレバー10のポジショニングスイッチ10aからの信号を取得するとポジショニング制御を開始する。操船制御装置15は、ポジショニングスイッチ10aからの信号を取得すると、図形Dの位置と方位とを船舶100の現在座標P(n)と現在方位Az(n)として設定する。同時に、操船制御装置15は、図形Dと区別可能な図形E(本実施形態では、破線の船形図形)を図形Dと同じ位置に表示させる。
As illustrated in FIG. 15A, the boat
図15(b)に示すように、操船制御装置15は、ジョイスティックレバー10から取得した信号に基づいて目標座標Ptと目標方位Atとを算出する。操船制御装置15は、ジョイスティックレバー10の回転量から目標方位Atを算出し、ジョイスティックレバー10傾斜方向と傾斜量とから目標座標Ptを算出する。さらに、操船制御装置15は、目標座標Ptを現在座標P(n)からの距離L(n)と移動方向θ(n)とで表す目標極座標Po(n)として算出し、目標方位Atを現在方位Az(n)と現在方位Az(n)との差である回頭角度R(n)として算出する。そして、操船制御装置15は、目標極座標Po(n)と現在方位Az(n)を基準とする回頭角度Rとに基づいて図形Eを目標座標Ptに表示させる。
As illustrated in FIG. 15B, the boat
操船制御装置15は、ジョイスティックレバー10の移動スイッチ10bからの移動信号を取得すると前後進プロペラ4の推力、切換クラッチ3の切り換え状態および舵5、サイドスラスタ6の推力および回転方向について制御することで船舶100を目標座標Ptに向けて移動させ、目標方位Atに向けて回頭させる。この際、操船制御装置15は、前述の回頭による移動方向のずれの回頭補正制御を適用して船舶100を移動させる。また、操船制御装置15は、前述の不感帯制御を適用して船舶100が目標座標Ptおよび目標方位Atの所定の範囲内に収まるように移動制御と回頭制御とを実施する。合わせて、操船制御装置15は、不感帯制御を適用した船舶100が目標座標Ptおよび目標方位Atの所定の範囲内に留まるように制御する。
When the boat
図15(c)に示すように、操船制御装置15は、船舶100の移動が開始されると現在座標P(n)を基準として目標座標Ptまでの距離L(n)と移動方向θ(n)に基づいて図形Eを移動させる。同様に、操船制御装置15は、現在方位Az(n)を基準として目標方位Atまでの回頭角度R(n)に基づいて図形Eを回頭させる。つまり、操船制御装置15は、図形Dを基準として図形Eを船舶100の移動および回頭に連動するように表示させる。これにより、図形Eは、船舶100が目標座標Ptおよび目標方位Atに近づくにつれて図形Dに近づいていくように表示される。なお、本実施形態において、目標座標Ptと目標方位Atとを図形Eを用いて表示したが、距離L(n)や回頭角度R(n)をモニタ12に表示させてもよい。
As shown in FIG. 15C, when the movement of the
次に、本発明に係る操船装置7におけるジョイスティックレバー10を用いたポジショニング制御の態様について具体的に説明する。なお、本実施形態において、操船制御装置15は、適宜GPS装置13から現在座標P(n)を取得し、適宜ヘディングセンサ14から船舶100の船首の現在方位Az(n)を取得しているものとする。
Next, the aspect of the positioning control using the
図16に示すように、ステップS510において、操船制御装置15は、ジョイスティックレバー10のポジショニングスイッチ10aからポジショニング信号を取得すると、モニタ12の中央に船舶100の現在座標P(n)と現在方位Az(n)とを示す図形Dを表示し、図形Dに重複するようにして図形Dと区別できる態様の図形Eを表示し、ステップをステップS520に移行する。
As shown in FIG. 16, in step S510, when the boat
ステップS520において、操船制御装置15は、ジョイスティックレバー10から傾斜方向および傾斜量についての信号を取得すると、ステップをステップS530に移行する。
In step S520, when the marine vessel
ステップS530において、操船制御装置15は、船舶100の目標座標Ptと目標方位Atとを算出し、ステップをステップS540に移行する。
In step S530, the boat
ステップS540において、操船制御装置15は、現在座標P(n)を基準として目標座標Ptまでの距離L(n)と移動方向θ(n)とを算出し、現在方位Az(n)を基準として目標方位Atまでの角度である回頭角度R(n)を算出し、ステップをステップS550に移行させる。
In step S540, the boat
ステップS550において、操船制御装置15は、算出した距離L(n)と移動方向θ(n)と回頭角度R(n)とに基づいた位置に図形Eを表示し、ステップをステップS560に移行させる。
In step S550, the boat
ステップS560において、操船制御装置15は、ジョイスティックレバー10の移動スイッチ10bから移動信号を取得すると、不感帯制御と回頭補正制御とを適用して船舶100の回頭制御と移動制御とを開始し、ステップをステップS570に移動する。
In step S560, when the boat
ステップS570において、操船制御装置15は、モニタ12に表示している図形Dを基準として単位時間後の距離L(n)と移動方向θ(n)と回頭角度R(n)に基づいて図形Eを移動させ、ステップをステップS580に移行させる。
In step S570, the boat
ステップS580において、操船制御装置15は、船舶100の距離L(n)が不感帯制御を考慮した目標座標Ptの所定範囲内である距離L1未満であり、かつ船舶100の回頭角度R(n)が不感帯制御を考慮した目標方位Atの所定範囲内である|角度θ1|未満であるか否か判断する。その結果、船舶100の距離L(n)が不感帯制御を考慮した目標座標Ptの所定範囲内である距離L1未満であり、かつ船舶100の回頭角度R(n)が不感帯制御を考慮した目標方位Atの所定範囲内である|角度θ1|未満であると判断した場合、ステップをステップS590に移行させる。一方、船舶100の距離L(n)が不感帯制御を考慮した目標座標Ptの所定範囲内である距離L1未満でない、または船舶100の回頭角度R(n)が不感帯制御を考慮した目標方位Atの所定範囲内である|角度θ1|未満でないと判断した場合、ステップをステップS540に移行させる。
In step S580, the boat
ステップS590において、操船制御装置15は、現在座標P(n)と現在方位Az(n)とを維持し、ステップを終了させる。
In step S590, the boat
以上の如く構成することで、船舶100の現在座標P(n)と現在方位Az(n)とを基準として船舶100の目標座標Ptと目標方位Atとがジョイスティックレバー10の操作で直感的に設定される。これにより、操縦者に船舶100の現在位置と目標位置との位置関係が的確に認識されるので船舶100のポジショニング制御を容易に行うことができる。
By configuring as described above, the target coordinates Pt and the target direction At of the
7 操船装置
10 ジョイスティックレバー
13 GPS装置
14 方位センサ
Pt 目標座標
At 目標方位
P(n) 現在座標
Az(n) 現在方位
100 船舶
7
Claims (3)
船舶を目標移動方向に移動させるとともに船舶を目標方位に回頭させる場合、現在座標と現在方位とから船舶を回頭させたときの単位時間後の現在方位と船舶を回頭させないときの単位時間後の現在方位とを算出し、
単位時間後の回頭させたときの現在方位と単位時間後の回頭させないときの現在方位との差に基づいて船舶を移動させる目標移動方向を補正する
操船装置。 Based on the signals of the satellite positioning system and the signal of the direction sensor, in the ship maneuvering device that performs the movement control to move the ship to the target coordinates and performs the turning control to turn the ship to the target direction,
Case of stem turning the ship target direction moves the ship target moving direction, the current coordinate and the current orientation from the post unit time when not turning round the current orientation and the ship after the unit time obtained while stem turning the ship and it calculates the current orientation,
Steering device for correcting the target moving direction of moving the ship based on the difference between the current orientation when not turning round after current azimuth unit time obtained while turning round after unit time.
移動制御停止帯域において、移動制御のための船舶の推進装置による推力の発生を停止し、
移動制御実施帯域において、移動制御のための船舶の推進装置による推力の発生を実施し、
緩衝帯域において、移動制御実施帯域から緩衝帯域に移動してきた後に緩衝帯域内に留まっており、かつ目標位置から離間する方向に移動している場合にかぎり移動制御のため船舶の推進装置によって推力を発生させる
請求項1に記載の操船装置。 Based on the distance between the current coordinates calculated from the signals of the satellite positioning system and the target coordinates, the movement control stop band including the target position, the buffer band adjacent to the movement control stop band, and the buffer band are adjacent to each other. Is set, and
In the movement control stop zone, stop the generation of thrust by the ship propulsion device for movement control,
In the movement control implementation band, the thrust generation by the ship propulsion device for movement control is performed,
In the buffer band, the thrust is applied by the ship propulsion device for movement control only when it has moved from the movement control execution band to the buffer band and stayed in the buffer band and moved away from the target position. The marine vessel maneuvering device according to claim 1 to be generated.
回頭制御停止帯域において、回頭制御のための船舶の推進装置による推力の発生を停止し、
回頭制御実施帯域において、回頭制御のための船舶の推進装置による推力の発生を実施し、
緩衝帯域において、回頭制御実施帯域から緩衝帯域に回頭してきた後に緩衝帯域内に留まっており、かつ目標方位から離間する方向に回頭している場合にかぎり回頭制御のため船舶の推進装置によって推力を発生させる
請求項1または請求項2に記載の操船装置。 With reference to the angle difference between the current azimuth calculated from the signal from the azimuth sensor and the target azimuth, the turn control stop band including the target azimuth, the buffer band adjacent to the turn control stop band, and adjacent to the buffer band And the turning control execution band is set,
In the turning control stop band, stop the generation of thrust by the ship propulsion device for turning control,
In the turning control implementation band, the generation of thrust by the ship propulsion device for turning control is performed,
In the buffer band, the thrust is applied by the propulsion device of the ship for the turn control only when the head is turned into the buffer band from the turn control execution band and stays in the buffer band and is turned in the direction away from the target direction. The marine vessel maneuvering device according to claim 1 or 2.
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2014216751A JP6379388B2 (en) | 2014-10-23 | 2014-10-23 | Maneuvering equipment |
PCT/JP2015/073666 WO2016063610A1 (en) | 2014-10-23 | 2015-08-24 | Vessel steering apparatus |
US15/520,625 US10457371B2 (en) | 2014-10-23 | 2015-08-24 | Vessel steering apparatus |
EP15852263.1A EP3210878B1 (en) | 2014-10-23 | 2015-08-24 | Vessel steering apparatus |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2014216751A JP6379388B2 (en) | 2014-10-23 | 2014-10-23 | Maneuvering equipment |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2016083974A JP2016083974A (en) | 2016-05-19 |
JP6379388B2 true JP6379388B2 (en) | 2018-08-29 |
Family
ID=55971643
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2014216751A Active JP6379388B2 (en) | 2014-10-23 | 2014-10-23 | Maneuvering equipment |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6379388B2 (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6474067B2 (en) * | 2016-03-14 | 2019-02-27 | ヤンマー株式会社 | Maneuvering equipment |
US10429845B2 (en) * | 2017-11-20 | 2019-10-01 | Brunswick Corporation | System and method for controlling a position of a marine vessel near an object |
JP7199935B2 (en) * | 2018-11-27 | 2023-01-06 | ヤンマーパワーテクノロジー株式会社 | route generator |
JP7417538B2 (en) | 2018-11-27 | 2024-01-18 | ヤンマーパワーテクノロジー株式会社 | Control target generation device and ship maneuvering control device |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3300132B2 (en) * | 1993-10-04 | 2002-07-08 | 古野電気株式会社 | Autopilot device |
JP2926533B2 (en) * | 1994-02-15 | 1999-07-28 | 三井造船株式会社 | Automatic fixed point return control method for ships |
JPH1129095A (en) * | 1997-07-14 | 1999-02-02 | Maroole Kk | Thruster system |
JPH1134973A (en) * | 1997-07-22 | 1999-02-09 | Yamaha Motor Co Ltd | Observation ship |
JP2003112691A (en) * | 2001-10-05 | 2003-04-15 | Mitsubishi Heavy Ind Ltd | Underwater traveling body movement control method and its movement control device |
JP5147273B2 (en) * | 2007-03-29 | 2013-02-20 | 川崎重工業株式会社 | Method and apparatus for holding a fixed point position of a 1-axis 1-steer boat |
JP5226355B2 (en) * | 2008-03-31 | 2013-07-03 | 三井造船株式会社 | Fixed-point holding system and fixed-point holding method for 1-axis 1-rudder bow thruster ship |
-
2014
- 2014-10-23 JP JP2014216751A patent/JP6379388B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2016083974A (en) | 2016-05-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2016063610A1 (en) | Vessel steering apparatus | |
JP6596700B2 (en) | Maneuvering equipment | |
EP3170735B1 (en) | Boat maneuvering control method for boat and boat maneuvering control system for boat | |
US10048690B1 (en) | Method and system for controlling two or more propulsion devices on a marine vessel | |
JP6430988B2 (en) | Maneuvering equipment | |
EP2727819B1 (en) | Ship steering device and ship steering method | |
JP2014076758A (en) | Method and system for estimating movement center of ship | |
JP6379388B2 (en) | Maneuvering equipment | |
JP6421111B2 (en) | Maneuvering equipment | |
JP5809862B2 (en) | Ship handling equipment | |
JP6250520B2 (en) | Maneuvering equipment | |
JP2014076755A (en) | Watercraft control system, watercraft control method, and program | |
JP2017088111A (en) | Ship maneuvering control method and ship maneuvering control system | |
JP5764411B2 (en) | Ship handling equipment | |
JP6521527B2 (en) | Ship steering apparatus and ship equipped with the same | |
WO2018008589A1 (en) | Ship maneuvering system, ship, and ship maneuvering method | |
US11573087B1 (en) | Boat maneuvering control method for boat and boat maneuvering control system for boat | |
JP5944274B2 (en) | Ship drive system for out-drive device | |
JP6262633B2 (en) | Maneuvering equipment | |
US12013699B1 (en) | Boat maneuvering control method for boat and boat maneuvering control system for boat | |
WO2022191191A1 (en) | Ship maneuvering device and ship |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20170315 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20171205 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20180130 |
|
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: 20180703 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20180709 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6379388 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |