JP5957695B2 - MOBILE BODY CONTROL DEVICE, HULLE CONTROL DEVICE, SHIP, MOBILE BODY CONTROL METHOD, AND MOBILE BODY CONTROL PROGRAM - Google Patents

MOBILE BODY CONTROL DEVICE, HULLE CONTROL DEVICE, SHIP, MOBILE BODY CONTROL METHOD, AND MOBILE BODY CONTROL PROGRAM Download PDF

Info

Publication number
JP5957695B2
JP5957695B2 JP2012165348A JP2012165348A JP5957695B2 JP 5957695 B2 JP5957695 B2 JP 5957695B2 JP 2012165348 A JP2012165348 A JP 2012165348A JP 2012165348 A JP2012165348 A JP 2012165348A JP 5957695 B2 JP5957695 B2 JP 5957695B2
Authority
JP
Japan
Prior art keywords
moving body
fixed point
moving
hull
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.)
Expired - Fee Related
Application number
JP2012165348A
Other languages
Japanese (ja)
Other versions
JP2014024421A (en
Inventor
尚志 今坂
尚志 今坂
南 繁行
繁行 南
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Furuno Electric Co Ltd
Osaka City University
Original Assignee
Furuno Electric Co Ltd
Osaka City University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Furuno Electric Co Ltd, Osaka City University filed Critical Furuno Electric Co Ltd
Priority to JP2012165348A priority Critical patent/JP5957695B2/en
Publication of JP2014024421A publication Critical patent/JP2014024421A/en
Application granted granted Critical
Publication of JP5957695B2 publication Critical patent/JP5957695B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、船舶を定常的に同じ位置に留めるための船体制御方法および船体制御装置に関する。   The present invention relates to a hull control method and a hull control device for constantly keeping a ship in the same position.

一本釣り漁船等では、魚礁や瀬のような目的魚が多く生息する特定の位置に留まって漁を行う必要がある。言い換えれば、船舶を定点保持した状態で漁を行う必要がある。しかしながら、海上では、船体が風や潮流を受けて、目的とする特定の位置から流されてしまうことがある。   In a single fishing fishing boat, it is necessary to fish while staying at a specific position where a large number of target fish such as fish reefs and sets live. In other words, it is necessary to fish with the ship held at a fixed point. However, at sea, the hull may be swept away from a specific target position due to wind and tide.

このため、従来、風や潮流を受けても船舶を定点に留める船体制御方法が各種考案されている。たとえば、特許文献1に示す船舶では、サイドスラスターを備えている。サイドスラスターとは、船体を横方向、すなわち右舷左舷方向へ移動させるための機構である。また、従来の船舶には、このような横方向の移動を実現するために、水平方向に回動可能なプロペラを備えるものもある。   For this reason, conventionally, various hull control methods have been devised for keeping a ship at a fixed point even under wind and tidal currents. For example, the ship shown in Patent Document 1 includes a side thruster. The side thruster is a mechanism for moving the hull in the lateral direction, that is, in the starboard and port directions. In addition, some conventional ships include a propeller that can be rotated in the horizontal direction in order to realize such lateral movement.

特開2002−87389号公報JP 2002-87389 A

しかしながら、上述のようなサイドスラスターや、水平方向に回動可能なプロペラは、非常に大がかりなものであり、コストも高く、大型船舶への取り付けが一般的である。このため、プレジャーボートや小型漁船にサイドスラスターや水平方向に回動可能なプロペラを装備することは、あまり現実的ではない。また、経済性を重視する漁船の場合には、大幅なコスト高となるため、これらサイドスラスターや水平方向に回動可能なプロペラを、容易に装備することができない。   However, the above-mentioned side thrusters and propellers that can be rotated in the horizontal direction are very large, expensive, and generally attached to large ships. For this reason, it is not very realistic to equip a pleasure boat or small fishing boat with a side thruster or a propeller that can be rotated horizontally. Further, in the case of fishing boats that place importance on economic efficiency, the cost is greatly increased, and therefore it is not possible to easily equip these side thrusters and propellers that can be rotated in the horizontal direction.

この発明の目的は、これらサイドスラスターや水平方向に回動可能なプロペラ等の大がかりな追加装備を行うことなく、船体を定点保持できる船体制御方法や船体制御装置を提供することにある。   An object of the present invention is to provide a hull control method and a hull control device capable of holding a hull at a fixed point without performing large-scale additional equipment such as a side thruster and a propeller capable of rotating in a horizontal direction.

この発明は、特定の一方向にのみ移動体を推進させる推進力発生部と、該推進力により移動する方向を調整する移動方向調整部とを移動体に備え、移動体を定点に留める制御を行う移動体制御装置である。移動体制御装置は、定点位置設定部、移動方向検出部、および移動体方向制御部を備える。定点位置設定部は、定点の位置を設定する。移動方向検出部は、定点を起点として移動体が外乱要素によって流される方向を検出する。移動体方向制御部は、特定の一方向が流される方向と反対の向きになるように、推進力発生部および移動方向調整部を用いて移動体の姿勢を制御する。   The present invention includes a propulsive force generating unit that propels a moving body only in one specific direction, and a moving direction adjusting unit that adjusts the direction of movement by the propulsive force, and controls the moving body to a fixed point. It is the moving body control apparatus to perform. The moving body control device includes a fixed point position setting unit, a moving direction detection unit, and a moving body direction control unit. The fixed point position setting unit sets the position of the fixed point. The moving direction detection unit detects a direction in which the moving body is caused to flow by the disturbance element from a fixed point. The moving body direction control unit controls the attitude of the moving body using the propulsive force generation unit and the moving direction adjustment unit so as to be in the direction opposite to the direction in which a specific one direction flows.

この構成では、船舶等の水上の移動体が外乱要素(例えば、船体の場合、風や潮流)で定点から流されるような状況下において、特定方向にのみ推進力を発生する推進力発生部と、推進力を発生せず移動方向を調整するだけの移動方向調整部とだけで、移動体が流される方向と特定方向を一致させるように移動体の姿勢制御を行うことができる。これにより、移動体が外乱要素によって流されながらも、略定常的に定点に保持される。   In this configuration, a propulsive force generating unit that generates propulsive force only in a specific direction under a situation in which a moving body on the water such as a ship is swept away from a fixed point by a disturbance element (for example, wind or tidal current in the case of a hull) The posture of the moving body can be controlled so that the direction in which the moving body flows and the specific direction coincide with each other only with the moving direction adjusting unit that adjusts the moving direction without generating a propulsive force. Thereby, the moving body is held at a fixed point substantially constantly while being moved by the disturbance element.

また、この発明の移動体制御装置の移動方向検出部は、移動体の位置を検出する移動体位置検出部と、定点の位置と移動体の位置とに基づいて定点から移動体までの距離を算出する距離算出部と、を備える。移動方向検出部は、距離が所定閾値以上になると流される方向を検出する。   The moving direction detection unit of the moving body control device according to the present invention includes a moving body position detecting unit that detects the position of the moving body, and the distance from the fixed point to the moving body based on the position of the fixed point and the position of the moving body. A distance calculation unit for calculating. The movement direction detection unit detects a direction in which the distance flows when the distance is equal to or greater than a predetermined threshold.

この構成では、移動体が定点から所定距離以上離れた時点から上述の移動体姿勢制御が行われる。   In this configuration, the above-described moving body posture control is performed from the time when the moving body is separated from the fixed point by a predetermined distance or more.

また、この発明の移動体制御装置の移動方向検出部は、移動体の位置を検出する移動体位置検出部を備える。移動方向検出部は、異なる二つの時刻に検出された移動体の位置に基づいて、流される方向を検出する。   Moreover, the moving direction detection part of the moving body control apparatus of this invention is provided with the moving body position detection part which detects the position of a moving body. The moving direction detection unit detects the flowing direction based on the position of the moving body detected at two different times.

この構成では、所定の時間経過した後に、移動体の移動方向が検出されて、上述の移動体姿勢制御が行われる。   In this configuration, after a predetermined time has elapsed, the moving direction of the moving body is detected, and the above-described moving body posture control is performed.

また、この発明の移動体制御装置の移動体方向制御部は、定点の位置を基準位置として、該定点よりも流される方向の上流側の所定位置を目標位置に設定し、該目標位置に到達するように推進力発生部および移動方向調整部を制御する。   In addition, the moving body direction control unit of the moving body control device according to the present invention sets the predetermined position on the upstream side in the direction of flow from the fixed point as the reference position with the fixed point position as the reference position, and reaches the target position. The propulsive force generating unit and the moving direction adjusting unit are controlled as described above.

この構成では、特定方向と流され方向が徐々に一致していくように姿勢制御されながら、移動体が定点よりも上流側に設定された目標位置へ移動する。目標位置に移動後、移動体は外乱要素によって流されるので、結果的に移動体を定点へ移動させることができる。   In this configuration, the moving body moves to the target position set on the upstream side from the fixed point while the attitude is controlled so that the specific direction and the flowing direction gradually coincide with each other. After moving to the target position, the moving body is caused to flow by the disturbance element, and as a result, the moving body can be moved to a fixed point.

また、この発明は、上述のいずれかに記載の移動体制御装置を備えた船舶である。そして、移動体の本体は船体であり、推進力発生部は動力源と該動力源に接続し船首尾方向に推進力を発生するプロペラであり、移動方向調整手段は舵である。移動体方向制御部は、船首方向が流される方向とは反対の向きになるように船体の姿勢を制御する。   Moreover, this invention is the ship provided with the mobile body control apparatus in any one of the above-mentioned. The main body of the moving body is a hull, the propulsive force generating unit is a propeller that is connected to the power source and generates the propulsive force in the bow-stern direction, and the moving direction adjusting means is a rudder. The moving body direction control unit controls the attitude of the hull so that the direction of the bow is opposite to the direction in which the bow direction flows.

この構成では、移動体として、具体的に船首尾方向にのみ推進力が得られ、舵により移動方向が調整される船舶の場合を示している。   In this configuration, as a moving body, a case where a propulsive force is specifically obtained only in the bow-stern direction and the moving direction is adjusted by a rudder is shown.

また、この発明の船舶の推進力発生部はモータとエンジンとを備え、モータとエンジンはプロペラに切り替えて接続されている。   Further, the propulsive force generator of the ship according to the present invention includes a motor and an engine, and the motor and the engine are connected to each other by switching to a propeller.

この構成では、船舶がモータとエンジンとを切り替えて動力源として利用するハイブリッド船の場合を示している。   In this configuration, the case where the ship is a hybrid ship that switches between a motor and an engine and uses it as a power source is shown.

また、この発明の船舶の動力源は、エンジンである。   Moreover, the power source of the ship of this invention is an engine.

この構成では、船舶がエンジンを動力源とする船の場合を示している。   In this structure, the case where the ship is a ship which uses an engine as a power source is shown.

この発明によれば、大がかりな追加装備を行うことなく、船舶等の水上を移動する移動体の定点保持を容易に実現することができる。   According to this invention, the fixed point holding | maintenance of the moving body which moves on the water, such as a ship, can be easily implement | achieved, without performing a large additional equipment.

本発明の第1の実施形態に係る船舶10の主要構成を示すブロック図である。1 is a block diagram showing a main configuration of a ship 10 according to a first embodiment of the present invention. 本発明の第1の実施形態に係る定点保持の船体制御方法を示すフローチャートである。It is a flowchart which shows the hull control method of fixed point holding | maintenance based on the 1st Embodiment of this invention. 本発明の第1の実施形態に係る定点保持の制御概念を説明するための図である。It is a figure for demonstrating the control concept of fixed point holding | maintenance which concerns on the 1st Embodiment of this invention. 本発明の第2の実施形態に係る定点保持の船体制御方法を示すフローチャートである。It is a flowchart which shows the hull control method of the fixed point holding | maintenance which concerns on the 2nd Embodiment of this invention. 本発明の第2の実施形態に係る定点保持の制御概念を説明するための図である。It is a figure for demonstrating the control concept of fixed point holding | maintenance which concerns on the 2nd Embodiment of this invention.

本発明の第1の実施形態に係る船体制御装置を備える船舶、および船体制御方法について、図を参照して説明する。図1は本発明の実施形態に係る船舶10の主要構成を示すブロック図である。   A ship provided with a hull control device according to a first embodiment of the present invention and a hull control method will be described with reference to the drawings. FIG. 1 is a block diagram showing the main configuration of a ship 10 according to an embodiment of the present invention.

船舶10は、船体制御装置20、動力源30、プロペラ31、および舵40を備える。船体制御装置20は、アンテナ21、測位部22A、センサ22B、船体制御部23、動力制御部24、舵制御部25、および操作部26を備える。測位部22Aが、本発明の「移動体位置検出部」に相当する。船体制御部23が、本発明の「位置情報設定部」、「移動方向検出部」、「距離算出部」に相当する。また、船体方向制御部23、動力制御部24、および舵制御部25の組が「移動方向制御部」に相当する。また、動力源30およびプロペラ31の組が「推進力発生部」に相当する。また、舵40が「移動方向調整部」に相当する。   The ship 10 includes a hull control device 20, a power source 30, a propeller 31, and a rudder 40. The hull control device 20 includes an antenna 21, a positioning unit 22A, a sensor 22B, a hull control unit 23, a power control unit 24, a rudder control unit 25, and an operation unit 26. The positioning unit 22A corresponds to the “moving body position detecting unit” of the present invention. The hull control unit 23 corresponds to the “position information setting unit”, “movement direction detection unit”, and “distance calculation unit” of the present invention. Further, a set of the hull direction control unit 23, the power control unit 24, and the rudder control unit 25 corresponds to a “movement direction control unit”. Further, the set of the power source 30 and the propeller 31 corresponds to a “propulsion generation unit”. The rudder 40 corresponds to a “moving direction adjusting unit”.

アンテナ21は、GPS測位信号を受信し、測位部22Aへ出力する。測位部22Aは、GPS測位信号を用いて測位演算を実行し、船舶10の位置を算出する。この測位演算は、予め設定した測位タイミング毎に実行される。測位部22Aは、算出した船舶10の位置を、船体制御部23へ出力する。   The antenna 21 receives the GPS positioning signal and outputs it to the positioning unit 22A. The positioning unit 22A performs a positioning calculation using the GPS positioning signal and calculates the position of the ship 10. This positioning calculation is executed at every positioning timing set in advance. The positioning unit 22A outputs the calculated position of the ship 10 to the hull control unit 23.

センサ22Bは、例えば、船首方向を検出するヘディングセンサ、風向センサ、風速センサ、潮流計等のうち、必要なものから構成される。センサ22Bは、検出した船首方向、風向、風速、および潮流を、必要に応じて船体制御部23へ出力する。なお、センサ22Bは、必要に応じて取り付ければよく、取り付けない態様であってもよい。   The sensor 22B includes, for example, necessary ones among a heading sensor that detects a bow direction, a wind direction sensor, a wind speed sensor, a tide meter, and the like. The sensor 22B outputs the detected bow direction, wind direction, wind speed, and tidal current to the hull control unit 23 as necessary. In addition, what is necessary is just to attach the sensor 22B as needed, and the aspect which is not attached may be sufficient.

船体制御部23は、予め操作部26を介してユーザが設定した定点位置を記憶している。船体制御部23は、測位部22Aから出力された船舶10の位置と定点位置との距離を算出する。船体制御部23は、詳細は後述するが、定点位置と船舶10の位置に基づいて、船舶10を定点位置に留まらせるように制御する制御情報を設定する。制御情報は、例えば、動力量の情報と推進方向の情報とからなる。動力量の情報は、動力制御部24へ出力される。推進方向の情報は、舵制御部25へ出力される。   The hull control unit 23 stores a fixed point position set in advance by the user via the operation unit 26. The hull control unit 23 calculates the distance between the position of the ship 10 output from the positioning unit 22A and the fixed point position. Although details will be described later, the hull control unit 23 sets control information for controlling the ship 10 to remain at the fixed point position based on the fixed point position and the position of the ship 10. The control information includes, for example, power amount information and propulsion direction information. Information on the amount of power is output to the power control unit 24. Information on the propulsion direction is output to the rudder control unit 25.

動力制御部24は、動力量の情報に基づいて、動力源30の駆動制御を行う。舵制御部25は、推進方向の情報に基づいて、舵40の舵角制御を行う。   The power control unit 24 performs drive control of the power source 30 based on the power amount information. The rudder control unit 25 performs rudder angle control of the rudder 40 based on information on the propulsion direction.

操作部26は、所謂ユーザインターフェース機器であり、ユーザによる操作入力を、船体制御部23へ出力する。   The operation unit 26 is a so-called user interface device, and outputs an operation input by the user to the hull control unit 23.

動力源30は、ディーゼルエンジンやモータからなる。また、これらディーゼルエンジンとモータを備え、状況に応じて使い分けるハイブリッド動力機構であってもよい。動力源30は、発生した動力をプロペラ31に与える。   The power source 30 is composed of a diesel engine or a motor. Further, a hybrid power mechanism that includes these diesel engines and motors and that can be used depending on the situation may be used. The power source 30 gives the generated power to the propeller 31.

船舶10は、プロペラ31の推進力と、舵40の舵角によって、定点位置に留まるように、進行もしくは後退する。   The ship 10 advances or retreats so as to remain at the fixed position by the propulsion force of the propeller 31 and the rudder angle of the rudder 40.

なお、上述の説明では、測位部22Aで船舶10の位置を測位し、船体制御部23で距離を算出する例を示したが、測位部22Aで船舶10の相対速度を算出して船体制御部23へ出力し、船体制御部23で相対速度の時間積算値から距離を算出してもよい。   In the above description, the position of the ship 10 is measured by the positioning unit 22A, and the distance is calculated by the hull control unit 23. However, the relative speed of the ship 10 is calculated by the positioning unit 22A and the hull control unit is calculated. The distance may be calculated from the integrated value of the relative speed by the hull control unit 23.

次に、本実施形態の定点保持を行う船体制御について説明する。図2は、本実施形態に係る定点保持の船体制御方法を示すフローチャートである。図3は、本実施形態に係る定点保持の制御概念を説明するための図である。   Next, hull control for holding a fixed point according to the present embodiment will be described. FIG. 2 is a flowchart showing a fixed point holding hull control method according to the present embodiment. FIG. 3 is a diagram for explaining a fixed point holding control concept according to the present embodiment.

まず、ユーザが船舶10を航行し、目的の魚礁や瀬の上まで到達すると、操作部26を用いて定点設定の操作入力を行う。操作入力情報は、船体制御部23へ出力される。船体制御部23は、操作入力が行われたタイミングにおいて、測位部22Aから入力された船舶10の位置を、図3(A)に示すように定点位置Ppとして決定し、記憶する(S101)。ここで、定点位置Ppとは、経緯度であっても、予め設定した二次元座標系の座標であってもよい。定点位置Ppは、測位部22Aへ与えられる。   First, when the user navigates the ship 10 and reaches the top of the target fish reef or set, an operation input for fixed point setting is performed using the operation unit 26. The operation input information is output to the hull control unit 23. The hull control unit 23 determines and stores the position of the ship 10 input from the positioning unit 22A as the fixed point position Pp as shown in FIG. 3A at the timing when the operation input is performed (S101). Here, the fixed point position Pp may be longitude and latitude or may be coordinates in a preset two-dimensional coordinate system. The fixed point position Pp is given to the positioning unit 22A.

この状態で、推進力をオフにすると、すなわち動力源30をオフするかプロペラ31を動力源30から切り離すと、船舶10は、図3(B),(C)に示すように、風や潮流による流され方向Ddrに沿って、流され方向Ddrの上流側から下流側へ、破船太矢印901に示すように、流される。   In this state, when the propulsive force is turned off, that is, when the power source 30 is turned off or the propeller 31 is disconnected from the power source 30, the ship 10 is driven by wind and tidal currents as shown in FIGS. As shown by the broken ship thick arrow 901, it flows from the upstream side to the downstream side in the flowing direction Ddr.

この間、測位部22Aは、所定の測位タイミング間隔で、船舶10の位置を測位して、測位した位置と定点位置との距離を算出し、船体制御部23へ出力する(S102)。なお、距離算出は、一般的な二点間の二次元距離の算出方法を用いればよい。このような距離の算出処理は継続的に行われる。   During this time, the positioning unit 22A measures the position of the ship 10 at a predetermined positioning timing interval, calculates the distance between the measured position and the fixed point position, and outputs the distance to the hull control unit 23 (S102). In addition, what is necessary is just to use the calculation method of the general two-dimensional distance between two points for distance calculation. Such a distance calculation process is continuously performed.

船体制御部23は、算出距離が閾値R未満であれば(S103:No)、上述の推進力をオフにした状態での測位及び距離の算出を行い、算出距離と閾値Rとの比較を継続する。なお、閾値Rは、ユーザにより適宜設定すればよく、例えば15m〜30m程度に設定すればよい。   If the calculated distance is less than the threshold value R (S103: No), the hull control unit 23 performs the positioning and the distance calculation in a state where the above-described propulsive force is turned off, and continues the comparison between the calculated distance and the threshold value R. To do. Note that the threshold R may be set as appropriate by the user, and may be set to about 15 to 30 m, for example.

具体的な状態としては、図3(B)に示す状態であり、船舶10が定点位置Ppを中心とし閾値Rの距離からなる円内に存在する間は、上述の推進力をオフにした状態での測位及び距離の算出を行い、算出距離と閾値Rとの比較を継続する。   As a specific state, it is the state shown in FIG. 3 (B), and the above-mentioned propulsive force is turned off while the ship 10 exists in a circle having a distance of the threshold R around the fixed point position Pp. Positioning and calculation of the distance are performed, and the comparison between the calculated distance and the threshold value R is continued.

船体制御部23は、図3(C)に示すように、算出距離が閾値R以上になったことを検出すると(S103:Yes)、定点位置Ppに帰還するように、帰還制御を開始する(S104)。   As shown in FIG. 3C, when the hull control unit 23 detects that the calculated distance is equal to or greater than the threshold value R (S103: Yes), the hull control unit 23 starts feedback control so as to return to the fixed point position Pp ( S104).

具体的には、船体制御部23は、定点位置Ppを始点とし、算出距離が閾値R以上になったことを検出したタイミングでの船舶10の位置を終点とするベクトルの方向を、流され方向Ddr(定点からの移動方向)として検出する。   Specifically, the hull control unit 23 sets the vector direction starting from the fixed point position Pp and ending at the position of the ship 10 at the timing when the calculated distance is detected to be equal to or greater than the threshold R as the flow direction. It is detected as Ddr (moving direction from a fixed point).

次に、船体制御部23は、算出距離が閾値R以上になったことを検出したタイミングでの船舶10の位置を始点とし、定点位置Ppを終点とするように、船舶10を自動で航行させるための航路(図3(D)の太実線に対応)を設定する。この際、帰還用の自動航行の航路は直線的にすることができないので、船体制御部23は、流され方向Ddrに沿って船舶10が受ける影響を加味しながら、航路を設定する。また、船体制御部23は、船舶10が定点位置Ppに到達した時点で、船首尾方向と流され方向Ddrとが略一致し、船首が流され方向Ddrの上流側となるように、航路を設定する。   Next, the hull control unit 23 automatically navigates the ship 10 such that the position of the ship 10 at the timing when the calculated distance is detected to be equal to or greater than the threshold R is set as the start point and the fixed point position Pp is set as the end point. For this purpose (corresponding to the thick solid line in FIG. 3D). At this time, since the route of the automatic navigation for return cannot be made straight, the hull control unit 23 sets the route while taking into consideration the influence received by the ship 10 along the flow direction Ddr. Further, the hull control unit 23, when the ship 10 reaches the fixed point position Pp, the ship's tail direction and the flow direction Ddr substantially coincide with each other so that the bow is flown and is upstream of the direction Ddr. Set.

航路が設定されると、船体制御部23は、航路に応じて、動力量の情報と推進方向の情報とからなる制御情報を順次決定し、動力制御部24および舵制御部25へ与える。このような制御情報によって動力源30、プロペラ31、舵40が制御されることで、船舶10は、図3(D)の白抜き太矢印902に示すように、設定航路に沿って定点位置Ppへと自動航行する。   When the route is set, the hull control unit 23 sequentially determines control information including information on the amount of power and information on the propulsion direction according to the route, and supplies the control information to the power control unit 24 and the rudder control unit 25. By controlling the power source 30, the propeller 31, and the rudder 40 based on such control information, the ship 10 can move to the fixed point position Pp along the set route as indicated by a white thick arrow 902 in FIG. To sail automatically.

この際、船体制御部23は、測位部22Aから順次入力される位置と設定航路とを比較し、設定航路からのズレが生じていれば、制御情報を適宜更新し、設定航路に沿って船舶10が航行するように制御する。   At this time, the hull control unit 23 compares the position sequentially input from the positioning unit 22A with the set route, and if there is a deviation from the set route, the control information is appropriately updated, and the ship is moved along the set route. Control 10 to sail.

さらに、上述のヘディングセンサを備えていれば、設定航路に沿った自動航行に船首方向を利用することができ、有効である。また、定点位置Ppに帰還した時点で、船首尾方向と流され方向Ddrとが略一致し、船首方向が流され方向Ddrの上流側にあることを容易に検出することができ、有効である。   Furthermore, if the above-mentioned heading sensor is provided, the bow direction can be used for automatic navigation along the set route, which is effective. Further, when returning to the fixed point position Pp, it is possible to easily detect that the bow-stern direction and the flow direction Ddr substantially coincide with each other and the bow direction is flown and upstream of the direction Ddr. .

また、風速センサ、風向センサ、潮流センサが備えられていれば、これらのセンサ検出値から流され方向Ddrの変化等を検出でき、設定航路の最適化や適宜修正に有効である。   If a wind speed sensor, a wind direction sensor, and a tidal current sensor are provided, it is possible to detect a change in the direction Ddr from the detected values of these sensors, and it is effective for optimizing the set route and appropriately correcting it.

このような定点位置Ppへの自動航行は、船舶10が定点位置Ppに帰還したことを検出するまで継続的に実行される(S105:No→S104)。船舶10が定点位置Ppに帰還したかどうかは、測位した船舶10の位置と定点位置Ppとが一致するかどうか、もしくは算出した距離が略0であるかどうか等によって判断することができる。なお、船首尾方向と流され方向Ddrとが略一致し、船首方向が流され方向Ddrの上流側にあることは、ヘディングセンサがあると容易に検出できるが、ヘディングセンサがなくても、定点位置Ppに近づく過程での各タイミングでの測位位置の変化から、船首方向を概ね推定することはできる。   Such automatic navigation to the fixed point position Pp is continuously executed until it is detected that the ship 10 has returned to the fixed point position Pp (S105: No → S104). Whether or not the ship 10 has returned to the fixed point position Pp can be determined based on whether or not the position of the measured ship 10 matches the fixed point position Pp, whether the calculated distance is substantially zero, or the like. It should be noted that the fact that the bow direction and the flow direction Ddr are substantially coincident and the bow direction is flowed and is upstream of the direction Ddr can be easily detected with a heading sensor. From the change of the positioning position at each timing in the process of approaching the position Pp, the bow direction can be roughly estimated.

このような自動航行によって、図3(E)に示すように船舶10が定点位置Ppに帰還すると、船体制御部23はこれを検出する(S105:Yes)。そして、船体制御部23は、図3(F)、図3(G)に示すような前進および後進のみによる定点保持制御へ移行する(S106)。なお、図3(F)、図3(G)では、前進のみを用いた場合を示している。   When the ship 10 returns to the fixed point position Pp as shown in FIG. 3 (E) by such automatic navigation, the hull control unit 23 detects this (S105: Yes). Then, the hull control unit 23 shifts to the fixed point holding control only by the forward movement and the reverse movement as shown in FIGS. 3 (F) and 3 (G) (S106). Note that FIGS. 3F and 3G show a case where only forward movement is used.

具体的には、船体制御部23は、船舶10が定点位置Ppに帰還したことを検出すると、推進力をオフにして、舵を船首尾方向に平行に維持する制御を行う。このような制御を行うと、図3(F)の破船太矢印911に示すように、流され方向Ddrの上流側から下流側へ流される。この際、流され方向Ddrと船首尾方向とが略一致(平行)であるので、船舶10が後退することを同意になる。   Specifically, when detecting that the ship 10 has returned to the fixed point position Pp, the hull control unit 23 performs control to turn off the propulsive force and maintain the rudder parallel to the bow-stern direction. When such control is performed, as shown by a broken ship arrow 911 in FIG. 3F, the flow is caused to flow from the upstream side to the downstream side in the flowing direction Ddr. At this time, since the flowing direction Ddr and the fore-and-aft direction are substantially coincident (parallel), it is agreed that the ship 10 moves backward.

船体制御部23は、測位した船舶10の位置を継続的に取得しており、船舶10の位置が定点位置Ppから、所定距離離間すると、推進力をオンして前進するように制御する。なお、この際の推進力をオンするトリガとなる所定距離は、上述の閾値Rよりも小さい方がよく、例えば10m以下程度にすればよい。この所定距離もユーザによって適宜設定することができる。   The hull control unit 23 continuously acquires the position of the ship 10 that has been measured, and when the position of the ship 10 is separated from the fixed point position Pp by a predetermined distance, the hull control unit 23 controls the propulsion to turn on and move forward. In addition, the predetermined distance used as the trigger which turns on the driving force in this case should be smaller than the above-mentioned threshold value R, for example, should be about 10 m or less. This predetermined distance can also be set appropriately by the user.

ここで、船舶10は、元々の定点位置Ppへ復帰時点で、船首尾方向と流され方向Ddrとが略一致し、船首方向が流され方向Ddrの上流側である。したがって、推進力が再度オンになるタイミングでは、船首尾方向と流され方向Ddrとが略一致し、船首方向が流され方向Ddrの上流側となるので、プロペラ31と舵40による単なる前進制御のみで、図3(G)の白抜き太矢印912に示すように、直線的に定点位置Ppへ復帰することができる。そして、船舶10が定点位置Ppへ復帰すると、船体制御部23は、これを検出し、推進力をオフにして、舵を船首尾方向に平行に維持する制御を行う。   Here, when the ship 10 returns to the original fixed point position Pp, the bow direction is flushed with the direction Ddr, and the bow direction is flushed and is upstream of the direction Ddr. Therefore, at the timing when the propulsive force is turned on again, the bow-stern direction and the flow direction Ddr substantially coincide with each other, and the bow direction is flowed and becomes upstream of the direction Ddr. Therefore, only forward control by the propeller 31 and the rudder 40 is performed. Thus, as indicated by the thick thick arrow 912 in FIG. 3G, it is possible to return to the fixed point position Pp linearly. When the ship 10 returns to the fixed point position Pp, the hull control unit 23 detects this, turns off the propulsive force, and performs control to keep the rudder parallel to the bow-stern direction.

以降は、このようなプロペラ31と舵40による単なる前進制御による定点保持制御が継続的に実行される。   Thereafter, the fixed point holding control based on the simple forward control by the propeller 31 and the rudder 40 is continuously executed.

以上のような制御を実行することで、船舶10に元々備えられているプロペラ31と舵40の他に、サイドスラスター等の大がかりな追加装備を行うことなく、船舶10の自動的な定点保持制御を、容易に実現することができる。   By executing the control as described above, automatic fixed point holding control of the ship 10 without performing a large additional equipment such as a side thruster in addition to the propeller 31 and the rudder 40 originally provided in the ship 10. Can be easily realized.

次に、第2の実施形態に係る船体制御装置を備える船舶、および船体制御方法について、図を参照して説明する。なお、本実施形態の船体制御装置および船舶の構成は、船体制御部23の処理を除き、第1の実施形態と同じであるので、船体制御部23の処理以外についての説明は省略する。したがって、以下では、船体制御部23での定点保持を行う船体制御についてのみ説明する。図4は、本実施形態に係る定点保持の船体制御方法を示すフローチャートである。図5は、本実施形態に係る定点保持の制御概念を説明するための図である。   Next, a ship provided with a hull control device according to a second embodiment and a hull control method will be described with reference to the drawings. In addition, since the structure of the hull control apparatus and ship of this embodiment is the same as 1st Embodiment except the process of the hull control part 23, description other than the process of the hull control part 23 is abbreviate | omitted. Therefore, hereinafter, only hull control for holding a fixed point in the hull control unit 23 will be described. FIG. 4 is a flowchart illustrating the fixed point holding hull control method according to the present embodiment. FIG. 5 is a diagram for explaining the fixed point holding control concept according to the present embodiment.

まず、第1の実施形態と同様に、ユーザが船舶10を航行し、目的の魚礁や瀬の上まで到達すると、操作部26を用いて定点設定の操作入力を行う。操作入力情報は、船体制御部23へ出力される。船体制御部23は、操作入力が行われたタイミング(T=to)において、測位部22Aから入力された船舶10の位置を、図5(A)に示すように定点位置Ppとして決定し、記憶する(S201)。また、船体制御部23はタイマーを備えており、この定点位置Ppを決定したタイミングを基準タイミングT=toとして、計時を開始する。   First, similarly to the first embodiment, when the user navigates the ship 10 and reaches the target fish reef or the top of the target, an operation input for fixed point setting is performed using the operation unit 26. The operation input information is output to the hull control unit 23. The hull control unit 23 determines the position of the ship 10 input from the positioning unit 22A as the fixed point position Pp as shown in FIG. 5A at the timing (T = to) when the operation input is performed, and stores it. (S201). Further, the hull control unit 23 includes a timer, and starts timing with the timing at which the fixed point position Pp is determined as the reference timing T = to.

この状態で、推進力をオフにすると、船舶10は、図5(B)に示すように、風や潮流による流され方向Ddrに沿って、流され方向Ddrの上流側から下流側へ、破船太矢印901に示すように、流される。   When the propulsive force is turned off in this state, the ship 10 breaks the ship from the upstream side to the downstream side in the flowing direction Ddr along the flowing direction Ddr caused by wind or tidal current as shown in FIG. As shown by a thick arrow 901, the flow is performed.

船体制御部23は、基準タイミングから所定の時間後のタイミングT=to+Δtになったことを検出すると、このタイミングに測位部22Aで取得した測位位置を、定点位置Ppに基づく目標位置Ptへの自動航行開始の船体10の位置として採用する(S202)。   When the hull control unit 23 detects that the timing T = to + Δt after a predetermined time from the reference timing, the positioning position acquired by the positioning unit 22A at this timing is automatically set to the target position Pt based on the fixed point position Pp. This is adopted as the position of the hull 10 at the start of navigation (S202).

船体制御部23は、採用した船体10の位置と定点位置Ppとに基づいて、流され方向Ddr(定点からの移動方向)、すなわち、定点位置Ppを始点とし、採用した船体10の位置を終点とするベクトルの方向を算出する。船体制御部23は、図5(B)に示すように、流され方向Ddrに沿って定点位置Ppよりも上流側の所定位置を、目標位置Ptに設定する。   Based on the position of the adopted hull 10 and the fixed point position Pp, the hull control unit 23 starts the flow direction Ddr (moving direction from the fixed point), that is, the fixed point position Pp, and the adopted position of the hull 10 as the end point. The direction of the vector is calculated. As shown in FIG. 5B, the hull control unit 23 sets a predetermined position upstream of the fixed point position Pp along the flow direction Ddr as the target position Pt.

船体制御部23は、採用した船体10の位置を始点とし、目標位置Ptを終点として、船舶10を自動で航行させるための航路(図5(C)の太実線に対応)を設定する。この際、船体制御部23は、船舶10が目標位置Ptに到達した時点で、船首尾方向と流され方向Ddrとが略一致し、船首が流され方向Ddrの上流側となるように、言い換えれば船首方向と流され方向Ddrとが逆方向になるように、航路を設定する。   The hull control unit 23 sets a route (corresponding to the thick solid line in FIG. 5C) for automatically navigating the vessel 10 with the position of the adopted hull 10 as a start point and the target position Pt as an end point. At this time, the hull control unit 23 is paraphrased so that when the ship 10 reaches the target position Pt, the bow tail direction and the flow direction Ddr are substantially coincided with each other, and the bow is flown and is upstream of the direction Ddr. For example, the route is set so that the bow direction and the direction Ddr are reversed.

航路が設定されると、船体制御部23は、航路に応じて、動力量の情報と推進方向の情報とからなる制御情報を順次決定し、動力制御部24および舵制御部25へ与える。このような制御情報によって動力源30、プロペラ31、舵40が制御されることで、船舶10は、図5(C)の白抜き太矢印902Aに示すように、設定航路に沿って目標位置Ptへと自動航行する(S203)。   When the route is set, the hull control unit 23 sequentially determines control information including information on the amount of power and information on the propulsion direction according to the route, and supplies the control information to the power control unit 24 and the rudder control unit 25. By controlling the power source 30, the propeller 31, and the rudder 40 based on such control information, the ship 10 can move to the target position Pt along the set route as indicated by a white thick arrow 902A in FIG. (S203).

この際、船体制御部23は、測位部22Aから順次入力される位置と設定航路とを比較し、設定航路からのズレが生じていれば、制御情報を適宜更新し、設定航路に沿って船舶10が航行するように制御する。   At this time, the hull control unit 23 compares the position sequentially input from the positioning unit 22A with the set route, and if there is a deviation from the set route, the control information is appropriately updated, and the ship is moved along the set route. Control 10 to sail.

さらに、上述のように、ヘディングセンサを備えていれば、設定航路に沿った自動航行に船首方向を利用することができ、有効である。また、目標位置Ptに到着した時点で、船首尾方向と流され方向Ddrとが略一致し、船首方向が流され方向Ddrの上流側にあることを容易に検出することができ、有効である。また、上述のように、風速センサ、風向センサ、潮流センサが備えられていれば、これらのセンサ検出値から流され方向Ddrの変化等を検出でき、設定航路の最適化や適宜修正に有効である。   Further, as described above, if the heading sensor is provided, the bow direction can be used for automatic navigation along the set route, which is effective. Further, when the vehicle arrives at the target position Pt, the bow-stern direction and the flow direction Ddr substantially coincide with each other, and it can be easily detected that the bow direction is flown and is upstream of the direction Ddr. . In addition, as described above, if a wind speed sensor, a wind direction sensor, and a tidal current sensor are provided, it is possible to detect a change in the direction Ddr that is passed from these sensor detection values, which is effective for optimization of the set route and appropriate correction. is there.

このような目標位置Ptへの自動航行は、船舶10が目標位置Ptに到着したことを検出するまで継続的に実行される(S204:No→S203)。船舶10が目標位置Ptに到着したかどうかは、測位した船舶10の位置と設定した目標位置Ptの座標とが一致するかどうかによって判断することができる。なお、船首尾方向と流され方向Ddrとが略一致し、船首方向が流され方向Ddrの上流側にあることは、ヘディングセンサがあると容易に検出できるが、ヘディングセンサがなくても、目標位置Ptに近づく過程での各タイミングでの測位位置の変化から、船首方向を概ね推定することはできる。   Such automatic navigation to the target position Pt is continuously executed until it is detected that the ship 10 has arrived at the target position Pt (S204: No → S203). Whether or not the ship 10 has arrived at the target position Pt can be determined based on whether or not the position of the measured ship 10 and the coordinates of the set target position Pt match. It should be noted that the fact that the bow direction and the flow direction Ddr are substantially coincident and the bow direction is flowed and is upstream of the direction Ddr can be easily detected with a heading sensor. From the change of the positioning position at each timing in the process of approaching the position Pt, the bow direction can be roughly estimated.

このような自動航行によって、図5(C)の実線に示すように船舶10が目標位置Ptに到着すると、船体制御部23はこれを検出する(S204:Yes)。そして、船体制御部23は、図5(D)、図5(E)、図5(F)に示すような前進および後進のみによる定点保持制御へ移行する(S205)。   When the ship 10 arrives at the target position Pt as shown by the solid line in FIG. 5C by such automatic navigation, the hull control unit 23 detects this (S204: Yes). Then, the hull control unit 23 shifts to the fixed point holding control only by the forward movement and the reverse movement as shown in FIGS. 5D, 5E, and 5F (S205).

具体的には、船体制御部23は、船舶10が目標位置Ptに到着したことを検出すると、推進力をオフにして、舵を船首尾方向に平行に維持する制御を行う。このような制御を行うと、図5(D)の破船太矢印911に示すように、流され方向Ddrの上流側から下流側へ流される。この際、流され方向Ddrと船首尾方向とが略一致(平行)であるので、船舶10が後退することを同意になる。   Specifically, when detecting that the ship 10 has arrived at the target position Pt, the hull control unit 23 performs control to turn off the propulsive force and maintain the rudder parallel to the bow-stern direction. When such control is performed, as shown by a broken ship thick arrow 911 in FIG. 5D, the flow is caused to flow from the upstream side to the downstream side in the flowing direction Ddr. At this time, since the flowing direction Ddr and the fore-and-aft direction are substantially coincident (parallel), it is agreed that the ship 10 moves backward.

このように、定点位置Ppが目標位置Ptに対して流され方向Ddrの下流側にあるので、船体10が後退すると、図5(D)の実線に示すように、船体10の位置は、あるタイミングで定点位置Ppと一致する。さらに、このまま推進力をオフにし続けると、図5(E)の破船太矢印911に示すように、定点位置Ppから、流され方向Ddrに沿って、さらに下流側へ流される。   Thus, since the fixed point position Pp is flowed with respect to the target position Pt and is downstream in the direction Ddr, when the hull 10 moves backward, the position of the hull 10 is as shown by the solid line in FIG. It coincides with the fixed point position Pp at the timing. Further, if the propulsion force is kept off as it is, as shown by a broken ship thick arrow 911 in FIG. 5E, it flows from the fixed point position Pp further downstream along the flowing direction Ddr.

船体制御部23は、測位した船舶10の位置を継続的に取得しており、船舶10の位置が定点位置Ppから、流され方向Ddrの下流側に所定距離離間すると、推進力をオンして前進するように制御する。   The hull control unit 23 continuously acquires the position of the ship 10 that has been positioned, and when the position of the ship 10 is separated from the fixed point position Pp by a predetermined distance downstream in the flow direction Ddr, the hull control unit 23 turns on the propulsive force. Control to move forward.

ここで、船舶10は、元々の目標位置Ptへの到着時点および定点位置Ppの通過時点で、船首尾方向と流され方向Ddrとが略一致し、船首方向が流され方向Ddrの上流側(船首方向と流され方向とが逆方向)である。したがって、推進力が再度オンになるタイミングでも船首尾方向と流され方向Ddrとが略一致し、船首方向が流され方向Ddrの上流側となるので、プロペラ31と舵40による単なる前進制御のみで、図5(F)の白抜き太矢印912に示すように、直線的に定点位置Ppへ復帰することができる。そして、船舶10が定点位置Ppへ復帰すると、船体制御部23は、これを検出し、推進力をオフにして、舵を船首尾方向に平行に維持する制御を行う。   Here, when the ship 10 arrives at the original target position Pt and passes through the fixed point position Pp, the bow-stern direction and the flow direction Ddr substantially coincide with each other, the bow direction is flowed, and the upstream side of the direction Ddr ( The bow direction and the flow direction are opposite directions). Therefore, even when the propulsive force is turned on again, the bow direction and the flow direction Ddr are substantially coincident with each other, and the bow direction is flowed and becomes the upstream side of the direction Ddr. Therefore, only forward control by the propeller 31 and the rudder 40 is performed. As shown by the white thick arrow 912 in FIG. 5 (F), it is possible to return to the fixed point position Pp linearly. When the ship 10 returns to the fixed point position Pp, the hull control unit 23 detects this, turns off the propulsive force, and performs control to keep the rudder parallel to the bow-stern direction.

以降は、このようなプロペラ31と舵40による単なる前進制御による定点保持制御が継続的に実行される。   Thereafter, the fixed point holding control based on the simple forward control by the propeller 31 and the rudder 40 is continuously executed.

以上のような制御を実行しても、船舶10に元々備えられているプロペラ31と舵40の他に、サイドスラスター等の大がかりな追加装備を行うことなく、船舶10の自動的な定点保持制御を、容易に実現することができる。   Even if the above control is executed, automatic fixed point holding control of the ship 10 without performing a large additional equipment such as a side thruster in addition to the propeller 31 and the rudder 40 originally provided in the ship 10. Can be easily realized.

なお、本実施形態では、船体制御部23は、定点位置Ppの決定タイミング(T=to)から所定時間後の1回のタイミング(T=to+Δt)で船体10の流され方向Ddr(移動方向)を検出する例を示したが、予め設定した時間間隔(周期)で船体10の位置を順次取得し、この位置取得タイミング毎に流され方向Ddrを検出してもよい。この場合、例えば、船体制御部23は、検出した複数の流され方向Ddrを平均して、自動航行用の流され方向Ddrを決定してもよく、最新の流され方向Ddrを自動航行用の流され方向Ddrに設定してもよい。また、船体制御部23は、これら複数の流され方向Ddrの変位を計測し、流され方向Ddrの変位が継続して略0になった時点で、当該流され方向Ddrを自動航行用の流され方向Ddrに設定してもよい。   In the present embodiment, the hull control unit 23 causes the hull 10 to flow in a direction Ddr (moving direction) at one timing (T = to + Δt) after a predetermined time from the fixed point position Pp determination timing (T = to). However, it is also possible to sequentially acquire the position of the hull 10 at preset time intervals (cycles) and detect the direction Ddr that is flowed at each position acquisition timing. In this case, for example, the hull control unit 23 may determine the flow direction Ddr for automatic navigation by averaging a plurality of detected flow directions Ddr, and the latest flow direction Ddr for automatic navigation may be determined. The flow direction Ddr may be set. Further, the hull control unit 23 measures the displacement in the plurality of flowing directions Ddr, and when the displacement in the flowing direction Ddr continues to be substantially zero, the flowing direction Ddr is used for the flow for automatic navigation. The direction Ddr may be set.

また、本実施形態では、目標位置Ptを定点位置Ppの上流側に設定したが、下流側に設定することも可能である。ただし、下流側に設定した場合、目標位置Ptへ到達後に、さらに、前進制御を行う必要がある。また、下流側に目標位置Ptを設定した場合、流され方向Ddrを検出したタイミングの船体10の位置と、目標位置Ptとが近くなってしまうため、目標位置Ptに船体10が到達した時点で、船首尾方向と流され方向Ddrとを略一致させ、船首方向が流され方向Ddrの上流側とするように、自動航行しようとすると、一時的に定点位置Ppや目標位置Ptから大きく遠ざかる航路を設定しなければならない可能性がある。したがって、目標位置Ptは、定点位置Ppの上流側に設定することが望ましい。   In the present embodiment, the target position Pt is set on the upstream side of the fixed point position Pp, but can be set on the downstream side. However, when set to the downstream side, it is necessary to perform forward control further after reaching the target position Pt. In addition, when the target position Pt is set on the downstream side, the position of the hull 10 at the timing when the flow direction Ddr is detected and the target position Pt become close to each other, so when the hull 10 reaches the target position Pt. When the automatic navigation is performed so that the bow direction and the flow direction Ddr are substantially coincided with each other and the bow direction is flowed and is upstream of the direction Ddr, the route is temporarily moved far from the fixed point position Pp or the target position Pt. May have to be set. Therefore, it is desirable to set the target position Pt on the upstream side of the fixed point position Pp.

また、上述の第1の実施形態では距離を基準にし、第2の実施形態では時間を基準にして、流され方向Ddrの検出を行ったが、距離と時間の両方を組み合わせて、流され方向Ddrの検出を行ってもよい。例えば、船体制御部23は、距離の閾値と、流され方向Ddrの検出タイミング時間と、を予め設定しておく。船体制御部23は、当該検出タイミングまでに距離の閾値を超える船体10の移動がなければ、当該検出タイミングで流され方向Ddrを検出する。一方、船体制御部23は、検出タイミングよりも前に、船体10の移動量が距離の閾値を超えたことを検出すると、この移動量が距離の閾値を超えたタイミングで、流され方向Ddrを検出する。   In addition, in the first embodiment, the flow direction Ddr is detected based on the distance, and in the second embodiment, the time is used as a reference. However, the flow direction is determined by combining both the distance and the time. Ddr may be detected. For example, the hull control unit 23 presets a distance threshold and a detection timing time for the flow direction Ddr. If there is no movement of the hull 10 exceeding the distance threshold before the detection timing, the hull control unit 23 detects the direction Ddr that is flowed at the detection timing. On the other hand, when the hull control unit 23 detects that the amount of movement of the hull 10 exceeds the distance threshold before the detection timing, the hull control unit 23 changes the flow direction Ddr at the timing when the amount of movement exceeds the distance threshold. To detect.

また、上述各実施形態の流され方向Ddrの検出タイミングと、定点位置Ppへの帰還または目標位置Ptへの移動とを組合せを逆にしてもよい。すなわち、距離の閾値Rで流され方向Ddrを検出して目標位置Ptへ移動させても、所定時間後に流され方向Ddrを検出して定点位置Ppへ帰還させてもよい。   Further, the combination of the detection timing of the flowing direction Ddr and the return to the fixed point position Pp or the movement to the target position Pt in each of the above embodiments may be reversed. That is, the flow direction Ddr detected by the distance threshold R may be detected and moved to the target position Pt, or the flow direction Ddr may be detected after a predetermined time and returned to the fixed point position Pp.

なお、上述の説明では、機能部を個別に形成する例を示したが、測位部22A、船体制御部23、動力制御部24、および舵制御部25は、適宜組み合わせて、一体化することができる。この場合、上述の処理をプログラム化して記憶媒体に記憶しておき、演算器(コンピュータ等)で当該船体制御のプログラムを読み出して実行することで、上述の船体制御を実現することができる。   In addition, although the example which forms a function part separately was shown in the above-mentioned description, 22 A of positioning parts, the hull control part 23, the power control part 24, and the rudder control part 25 can be combined suitably and integrated. it can. In this case, the above-described hull control can be realized by programming the above-described processing and storing it in a storage medium, and reading and executing the hull-control program by a calculator (computer or the like).

また、上述の説明では、船舶10が定点位置Ppに到達した時点の測位位置を定点位置Ppに設定する例を示したが、海図等が備えられていれば、船舶10が定点位置Ppに到達する前に、定点位置Ppを設定することも可能である。ただし、この場合には、上述の用に船舶10の流される軌跡から流され方向Ddrを検出できないので、風向センサ、風速センサ、潮流計等の各種センサを用いて、流され方向Ddrを推定検出する必要がある。一方、上述のように、定点位置Ppに達した時点での測位位置で定点位置Ppを検出する場合は、実際に定点位置Ppとなる魚礁や瀬に一時的に停留できるので、この一時的な停留の期間での釣果等を参考に定点位置Ppを決定することができる。   In the above description, an example in which the positioning position when the ship 10 reaches the fixed point position Pp is set as the fixed point position Pp is shown. However, if a chart is provided, the ship 10 reaches the fixed point position Pp. It is also possible to set the fixed point position Pp before performing. However, in this case, since the direction Ddr is not detected from the trajectory of the ship 10 as described above, the direction Ddr is estimated and detected using various sensors such as a wind direction sensor, a wind speed sensor, and a tide meter. There is a need to. On the other hand, as described above, when the fixed point position Pp is detected at the positioning position at the time when the fixed point position Pp is reached, the temporary position can be temporarily stopped at the fish reef or the sea that is the fixed point position Pp. The fixed point position Pp can be determined with reference to the fishing results during the stopping period.

また、上述の説明では、移動体として船舶を例に示したが、特定方向への推進力のみを備える水上もしくは水中を移動する移動体(例えば、水陸両用車、水上バイク等)にも、上述の構成および処理を適用することができる。   In the above description, a ship is shown as an example of the moving body. The configuration and processing of can be applied.

10:船舶、20:船体制御装置、21:アンテナ、22A:測位部、22B:センサ、23:船体制御部、24:動力制御部、25:舵制御部、26:操作部、30:動力源、31:プロペラ、40:舵 10: ship, 20: hull control device, 21: antenna, 22A: positioning unit, 22B: sensor, 23: hull control unit, 24: power control unit, 25: rudder control unit, 26: operation unit, 30: power source , 31: propeller, 40: rudder

Claims (15)

水上もしくは水中を移動する移動体を特定の一方向にのみ推進させる推進力発生部と、該推進力により移動する方向を調整する移動方向調整部とを移動体に備え、前記移動体を定点に留める制御を行う移動体制御装置であって、
前記定点の位置を設定する定点位置設定部と、
前記定点を起点として前記移動体が外乱要素によって流される方向を検出する移動方向検出部と、
前記特定の一方向が前記流される方向と反対の向きになるように、前記推進力発生部および前記移動方向調整部を用いて前記移動体の姿勢を制御する移動体方向制御部と、
を備え
移動体方向制御部は、
前記定点の位置を基準位置として、該定点よりも前記流される方向の上流側の所定位置を目標位置に設定し、
該目標位置に到達するように、前記推進力発生部および前記移動方向調整部を制御する、
動体制御装置。
A thrust generating unit for viewing promotion of the specific one direction movable body that moves on water or underwater, and a moving direction adjustment unit for adjusting the direction of movement by the driving force provided to the moving body, the moving body A mobile control device that performs control to be fixed at a fixed point,
A fixed point position setting unit for setting the position of the fixed point;
A moving direction detection unit that detects a direction in which the moving body is caused to flow by a disturbance element from the fixed point;
A moving body direction control unit that controls the posture of the moving body using the propulsive force generation unit and the moving direction adjustment unit so that the specific one direction is opposite to the flowing direction;
Equipped with a,
The moving body direction control unit
Using the position of the fixed point as a reference position, a predetermined position on the upstream side in the flowing direction from the fixed point is set as a target position,
Controlling the propulsive force generating unit and the moving direction adjusting unit to reach the target position;
Moving body control device.
請求項1に記載の移動体制御装置であって、
前記移動方向検出部は、
前記移動体の位置を検出する移動体位置検出部と、
前記定点の位置と前記移動体の位置とに基づいて、前記定点から前記移動体までの距離を算出する距離算出部と、を備え、
前記距離が所定閾値以上になると前記流される方向を検出する、移動体制御装置。
The moving body control device according to claim 1,
The moving direction detector is
A moving body position detector for detecting the position of the moving body;
A distance calculation unit that calculates a distance from the fixed point to the moving body based on the position of the fixed point and the position of the moving body;
A moving body control device that detects the flowing direction when the distance is equal to or greater than a predetermined threshold.
請求項1に記載の移動体制御装置であって、
前記移動方向検出部は、
前記移動体の位置を検出する移動体位置検出部を備え、
異なる二つの時刻に検出された前記移動体の位置に基づいて、前記流される方向を検出する、移動体制御装置。
The moving body control device according to claim 1,
The moving direction detector is
A moving body position detecting unit for detecting the position of the moving body;
A moving body control device that detects the flowing direction based on the position of the moving body detected at two different times.
請求項1乃至請求項3のいずれかに記載の移動体制御装置であって、  It is a moving body control apparatus in any one of Claim 1 thru | or 3, Comprising:
前記移動体は、船舶である、  The mobile body is a ship.
移動体制御装置。  Mobile control device.
請求項4に記載の移動体制御装置であって、
前記移動体の本体は船体であり、
前記推進力発生部は、動力源と該動力源に接続し船首尾方向に推進力を発生するプロペラであり、
前記移動方向調整部は舵であり、
移動体方向制御部は、前記船首方向が前記流される方向とは反対の向きになるように船体の姿勢を制御する、移動体制御装置。
A mobile control equipment according to claim 4,
The main body of the mobile body is a hull,
The propulsive force generating unit is a propeller that is connected to the power source and generates a propulsive force in the stern direction.
The moving direction adjustment unit is a rudder,
The moving body direction control unit is a moving body control device that controls the attitude of the hull so that the bow direction is opposite to the flowing direction.
船体を特定の一方向にのみ推進させる推進力発生部と、該推進力により移動する方向を調整する移動方向調整部とを船舶に備え、前記船体を定点に留める制御を行う船体制御装置であって、  A hull control device that includes a propulsion force generation unit that propels a hull only in a specific direction and a movement direction adjustment unit that adjusts the direction of movement by the propulsion force, and that controls the hull to a fixed point. And
前記定点の位置を設定する定点位置設定部と、  A fixed point position setting unit for setting the position of the fixed point;
前記定点を起点として前記船体が外乱要素によって流される方向を検出する移動方向検出部と、  A moving direction detection unit for detecting a direction in which the hull is caused to flow by a disturbance element from the fixed point;
前記特定の一方向が前記流される方向と反対の向きになるように、前記推進力発生部および前記移動方向調整部を用いて前記船体の姿勢を制御する移動体方向制御部と、  A moving body direction control unit that controls the attitude of the hull using the propulsive force generation unit and the moving direction adjustment unit so that the specific direction is opposite to the flowing direction;
を備え、  With
移動体方向制御部は、  The moving body direction control unit
前記定点の位置を基準位置として、該定点よりも前記流される方向の上流側の所定位置を目標位置に設定し、  Using the position of the fixed point as a reference position, a predetermined position on the upstream side in the flowing direction from the fixed point is set as a target position,
該目標位置に到達するように、前記推進力発生部および前記移動方向調整部を制御する、  Controlling the propulsive force generating unit and the moving direction adjusting unit to reach the target position;
船体制御装置。Hull control device.
請求項6に記載の船体制御装置であって、  The hull control device according to claim 6,
前記推進力発生部は、動力源と該動力源に接続し船首尾方向に推進力を発生するプロペラであり、  The propulsive force generating unit is a propeller that is connected to the power source and generates a propulsive force in the stern direction.
前記移動方向調整部は舵であり、  The moving direction adjustment unit is a rudder,
移動体方向制御部は、前記船首方向が前記流される方向とは反対の向きになるように前記船体の姿勢を制御する、船体制御装置。  The moving body direction control unit controls the attitude of the hull so that the bow direction is opposite to the flowing direction.
請求項5に記載の移動体制御装置または請求項7に記載の船体制御装置を備えた船舶であって、
前記動力源は、モータとエンジンとを備え、
前記モータとエンジンは、前記プロペラに切り替えて接続される、船舶。
A ship equipped with the mobile control device according to claim 5 or the hull control device according to claim 7 ,
The power source includes a motor and an engine,
The motor and the engine are connected to the propeller by switching.
請求項5に記載の移動体制御装置または請求項7に記載の船体制御装置を備えた船舶であって、
前記動力源は、エンジンである、船舶。
A ship equipped with the mobile control device according to claim 5 or the hull control device according to claim 7 ,
The power source is an engine.
水上もしくは水中を移動する移動体を特定の一方向にのみ推進させながら、該推進力により移動する方向を調整することで、移動体を定点に留める制御を行う移動体制御方法であって、
前記定点の位置を設定する定点位置設定工程と、
前記定点を起点として前記移動体が外乱要素によって流される方向を検出する移動方向検出工程と、
前記特定の一方向が前記流される方向と反対の向きになるように、前記推進力および前記移動方向を調整して前記移動体の姿勢を制御する移動体方向制御工程と、
を有し、
移動体方向制御工程は、
前記定点の位置を基準位置として、該定点よりも前記流される方向の上流側の所定位置を目標位置に設定し、
該目標位置に到達するように、前記推進力および前記移動方向を制御する、
動体制御方法。
While viewing promotion of the specific one direction movable body that moves on water or underwater, by adjusting the direction of movement by the driving force, a mobile control method for controlling fasten mobile to fixed point ,
A fixed point position setting step for setting the position of the fixed point;
A moving direction detection step of detecting a direction in which the moving body is caused to flow by a disturbance element starting from the fixed point;
A moving body direction control step of controlling the posture of the moving body by adjusting the propulsive force and the moving direction so that the specific one direction is opposite to the flowing direction;
I have a,
The moving body direction control process
Using the position of the fixed point as a reference position, a predetermined position on the upstream side in the flowing direction from the fixed point is set as a target position,
Controlling the propulsive force and the moving direction to reach the target position;
Moving body control method.
請求項10に記載の移動体制御方法であって、
前記移動方向検出工程は、
前記移動体の位置を検出する移動体位置検出工程と、
前記定点の位置と前記移動体の位置とに基づいて、前記定点から前記移動体までの距離を算出する距離算出工程と、を有し、
前記距離が所定閾値以上になると前記流される方向を検出する、移動体制御方法。
It is a moving body control method of Claim 10 , Comprising:
The moving direction detection step includes
A moving body position detecting step for detecting the position of the moving body;
A distance calculating step of calculating a distance from the fixed point to the moving body based on the position of the fixed point and the position of the moving body;
A moving body control method for detecting the flowing direction when the distance is equal to or greater than a predetermined threshold.
請求項10に記載の移動体制御方法であって、
前記移動方向検出工程は、
前記移動体の位置を検出する移動体位置検出工程を有し、
異なる二つの時刻に検出された前記移動体の位置に基づいて、前記流される方向を検出する、移動体制御方法。
It is a moving body control method of Claim 10 , Comprising:
The moving direction detection step includes
A moving body position detecting step for detecting the position of the moving body;
A moving body control method for detecting the flowing direction based on the position of the moving body detected at two different times.
水上もしくは水中を移動する移動体を特定の一方向にのみ推進させながら、該推進力により移動する方向を調整することで、移動体を定点に留める制御をコンピュータに実行させる移動体制御プログラムであって、
前記コンピュータは、
前記定点の位置を設定する定点位置設定処理と、
前記定点を起点として前記移動体が外乱要素によって流される方向を検出する移動方向検出処理と、
前記特定の一方向が前記流される方向と反対の向きになるように、前記推進力および前記移動方向を調整して前記移動体の姿勢を制御する移動体方向制御処理と、
を実行し、
移動体方向制御処理として、
前記定点の位置を基準位置として、該定点よりも前記流される方向の上流側の所定位置を目標位置に設定し、
該目標位置に到達するように、前記推進力および前記移動方向を制御する、
動体制御プログラム。
While viewing promotion of the specific one direction movable body that moves on water or underwater, by adjusting the direction of movement by the driving force, the moving object control program for executing a control to keep the mobile on the fixed point on the computer Because
The computer
Fixed point position setting processing for setting the position of the fixed point;
A moving direction detection process for detecting a direction in which the moving body is caused to flow by a disturbance element starting from the fixed point;
A moving body direction control process for controlling the posture of the moving body by adjusting the propulsive force and the moving direction so that the specific one direction is opposite to the flowing direction;
Run
As a moving body direction control process,
Using the position of the fixed point as a reference position, a predetermined position on the upstream side in the flowing direction from the fixed point is set as a target position,
Controlling the propulsive force and the moving direction to reach the target position;
Moving body control program.
請求項13に記載の移動体制御プログラムであって、
前記コンピュータは、
前記移動方向検出処理として、
前記移動体の位置を検出する移動体位置検出処理と、
前記定点の位置と前記移動体の位置とに基づいて、前記定点から前記移動体までの距離を算出する距離算出処理と、を有し、
前記距離が所定閾値以上になると前記流される方向を検出する、移動体制御プログラム。
A moving body control program according to claim 13 ,
The computer
As the moving direction detection process,
A moving body position detection process for detecting the position of the moving body;
A distance calculation process for calculating a distance from the fixed point to the moving body based on the position of the fixed point and the position of the moving body;
A moving body control program for detecting the flowing direction when the distance is equal to or greater than a predetermined threshold.
請求項13に記載の移動体制御プログラムであって、
前記コンピュータは、
前記移動方向検出処理として、
前記移動体の位置を検出する移動体位置検出処理を有し、
異なる二つの時刻に検出された前記移動体の位置に基づいて、前記流される方向を検出する、移動体制御プログラム。
A moving body control program according to claim 13 ,
The computer
As the moving direction detection process,
A moving body position detection process for detecting the position of the moving body;
A moving body control program for detecting the flowing direction based on the position of the moving body detected at two different times.
JP2012165348A 2012-07-26 2012-07-26 MOBILE BODY CONTROL DEVICE, HULLE CONTROL DEVICE, SHIP, MOBILE BODY CONTROL METHOD, AND MOBILE BODY CONTROL PROGRAM Expired - Fee Related JP5957695B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2012165348A JP5957695B2 (en) 2012-07-26 2012-07-26 MOBILE BODY CONTROL DEVICE, HULLE CONTROL DEVICE, SHIP, MOBILE BODY CONTROL METHOD, AND MOBILE BODY CONTROL PROGRAM

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012165348A JP5957695B2 (en) 2012-07-26 2012-07-26 MOBILE BODY CONTROL DEVICE, HULLE CONTROL DEVICE, SHIP, MOBILE BODY CONTROL METHOD, AND MOBILE BODY CONTROL PROGRAM

Publications (2)

Publication Number Publication Date
JP2014024421A JP2014024421A (en) 2014-02-06
JP5957695B2 true JP5957695B2 (en) 2016-07-27

Family

ID=50198509

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012165348A Expired - Fee Related JP5957695B2 (en) 2012-07-26 2012-07-26 MOBILE BODY CONTROL DEVICE, HULLE CONTROL DEVICE, SHIP, MOBILE BODY CONTROL METHOD, AND MOBILE BODY CONTROL PROGRAM

Country Status (1)

Country Link
JP (1) JP5957695B2 (en)

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6370924B2 (en) * 2014-12-22 2018-08-08 古野電気株式会社 MOBILE BODY CONTROL DEVICE, MOBILE BODY CONTROL METHOD, AND MOBILE BODY CONTROL PROGRAM
US10183733B2 (en) 2014-12-22 2019-01-22 Furuno Electric Co., Ltd. Program, method and device for controlling movable body
JP6450595B2 (en) * 2015-01-05 2019-01-09 古野電気株式会社 MOBILE BODY CONTROL DEVICE, MOBILE BODY CONTROL METHOD, AND MOBILE BODY CONTROL PROGRAM
US11402838B1 (en) 2017-12-19 2022-08-02 Yamaha Hatsudoki Kabushiki Kaisha System for and method of controlling watercraft
KR102133368B1 (en) * 2018-06-21 2020-07-13 국방과학연구소 Unmanned dynamic buoy system for measuring precise marine location, Method thereof, and Computer readable storage medium
JP7263150B2 (en) 2019-06-27 2023-04-24 古野電気株式会社 Hull control device, hull control method, and hull control program
JP7261105B2 (en) 2019-06-28 2023-04-19 古野電気株式会社 Hull control device, hull control method, and hull control program
JP7263158B2 (en) 2019-07-05 2023-04-24 古野電気株式会社 Hull control device, hull control method, and hull control program
JP2021041872A (en) 2019-09-13 2021-03-18 古野電気株式会社 Hull controller, hull control method, and hull control program
JP2023049506A (en) * 2021-09-29 2023-04-10 日本発條株式会社 Ship, ship control device, ship control method and program
CN114217625A (en) * 2021-12-15 2022-03-22 浙江九段智能科技有限公司 Control method for specified point floating mode of autonomous underwater vehicle

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3662122B2 (en) * 1998-08-27 2005-06-22 ユニバーサル造船株式会社 Ship heading control equipment
JP2010173589A (en) * 2009-01-30 2010-08-12 Toyota Motor Corp Position holding control device for ship
JP2010195240A (en) * 2009-02-26 2010-09-09 Osaka City Univ Electric ship
JP5337722B2 (en) * 2010-01-07 2013-11-06 ヤマハ発動機株式会社 Ship propulsion control device and ship

Also Published As

Publication number Publication date
JP2014024421A (en) 2014-02-06

Similar Documents

Publication Publication Date Title
JP5957695B2 (en) MOBILE BODY CONTROL DEVICE, HULLE CONTROL DEVICE, SHIP, MOBILE BODY CONTROL METHOD, AND MOBILE BODY CONTROL PROGRAM
JP6821437B2 (en) Mobile control device, mobile control method, and mobile control program
JP6370924B2 (en) MOBILE BODY CONTROL DEVICE, MOBILE BODY CONTROL METHOD, AND MOBILE BODY CONTROL PROGRAM
JPWO2016104030A6 (en) MOBILE BODY CONTROL DEVICE, MOBILE BODY CONTROL METHOD, AND MOBILE BODY CONTROL PROGRAM
US10775808B2 (en) Boat maneuvering control method for boat and boat maneuvering control system for boat
US9771138B2 (en) Boat maneuvering control method for boat and boat maneuvering control system for boat
JP2017154734A (en) Improved marine vessel maneuvering methods and systems
JP6278567B2 (en) Hull control method and hull control device
JP5932362B2 (en) Hull Control Device, Hull Control Program, and Hull Control Method
US9950777B2 (en) Vehicle control device and method of controlling vehicle
JP2017088111A (en) Ship maneuvering control method and ship maneuvering control system
JP6596700B2 (en) Maneuvering equipment
JP2010173589A (en) Position holding control device for ship
JP6379388B2 (en) Maneuvering equipment
US11573087B1 (en) Boat maneuvering control method for boat and boat maneuvering control system for boat
Sliwka et al. Sailing without wind sensor and other hardware and software innovations
EP3423910B1 (en) Maritime drift control system
JP6450595B2 (en) MOBILE BODY CONTROL DEVICE, MOBILE BODY CONTROL METHOD, AND MOBILE BODY CONTROL PROGRAM
JP6262633B2 (en) Maneuvering equipment
JP6191984B2 (en) Ship steering method and ship automatic steering device
KR20170049893A (en) Propulsion control system for floating offshore plant
CN116395111A (en) Underwater hovering control submarine based on multiple propellers and control method thereof
KR20160051282A (en) Vessel Position Control System in Floating Offshore Plant
JP2010241182A (en) Ship azimuth control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20150223

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20150224

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20151210

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20151215

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20160215

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: 20160510

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20160523

R150 Certificate of patent or registration of utility model

Ref document number: 5957695

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313115

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313115

R371 Transfer withdrawn

Free format text: JAPANESE INTERMEDIATE CODE: R371

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: R313115

R360 Written notification for declining of transfer of rights

Free format text: JAPANESE INTERMEDIATE CODE: R360

R370 Written measure of declining of transfer procedure

Free format text: JAPANESE INTERMEDIATE CODE: R370

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees