MARINE VESSEL, HEADING CONTROL METHOD, HEADING CONTROL DEVICE, AND PROGRAM
20230303233 · 2023-09-28
Inventors
Cpc classification
B63H25/04
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
A marine vessel includes: an actuator having a rudder; a heading detection unit; and a heading control device including a target heading acquisition unit, a heading deviation calculation unit, a PID control unit, and a gain setting unit, the heading deviation calculation unit calculates a heading deviation, which is the difference between a target heading and a actual heading, the PID control unit calculates an instruction value for the actuator through PID control from the heading deviation calculated by the heading deviation calculation unit, the gain setting unit sets at least a derivative gain, and in a case in which the heading deviation calculated by the heading deviation calculation unit is equal to or greater than a first threshold value, the gain setting unit adds a derivative gain addition correction quantity to the current value of the derivative gain.
Claims
1. A marine vessel comprising: an actuator having a rudder; a heading detection unit configured to detect an actual heading, which is an actual azimuth of a bow of the marine vessel; and a heading control device including a target heading acquisition unit, a heading deviation calculation unit, a PID control unit, and a gain setting unit, wherein the heading deviation calculation unit calculates a heading deviation, which is a difference between a target heading acquired by the target heading acquisition unit and the actual heading detected by the heading detection unit, the PID control unit calculates an instruction value for the actuator through PID control from the heading deviation calculated by the heading deviation calculation unit, the gain setting unit sets, out of a proportional gain, an integral gain, and a derivative gain used in the PID control, at least the derivative gain, and in a case in which the heading deviation calculated by the heading deviation calculation unit is equal to or greater than a first threshold value, the gain setting unit adds a derivative gain addition correction quantity to a current value of the derivative gain.
2. A marine vessel comprising: an actuator having a rudder; a heading detection unit configured to detect an actual heading, which is an actual azimuth of a bow of the marine vessel; and a heading control device including a target heading acquisition unit, a heading deviation calculation unit, a PID control unit, and a gain setting unit, wherein the heading deviation calculation unit calculates a heading deviation, which is a difference between a target heading acquired by the target heading acquisition unit and the actual heading detected by the heading detection unit, the PID control unit calculates an instruction value for the actuator through PID control from the heading deviation calculated by the heading deviation calculation unit, the gain setting unit sets, out of a proportional gain, an integral gain, and a derivative gain used for the PID control, at least the derivative gain, and in a case in which an evaluation value of a change quantity in the instruction value calculated by the PID control unit is equal to or greater than a second threshold value, the gain setting unit subtracts a derivative gain reduction correction quantity from a current value of the derivative gain.
3. The marine vessel according to claim 2, wherein the PID control unit calculates the instruction value for the actuator at a predetermined time interval, the change quantity in the instruction value calculated by the PID control unit is a difference between an instruction value calculated at that time by the PID control unit and an instruction value previously calculated by the PID control unit, and the evaluation value of the change quantity in the instruction value calculated by the PID control unit is a value corresponding to a value obtained by accumulating the change quantity in the instruction value calculated by the PID control unit from a current time back to a preset time.
4. A heading control method for a marine vessel including an actuator having a rudder, comprising: a heading detection step of detecting an actual heading, which is an actual azimuth of a bow of the marine vessel; a target heading acquisition step of acquiring a target heading; a heading deviation calculation step of calculating a heading deviation, which is a difference between the target heading acquired in the target heading acquisition step and the actual heading detected in the heading detection step; a PID control step of calculating an instruction value for the actuator through PID control from the heading deviation calculated in the heading deviation calculation step; and a gain setting step of setting, out of a proportional gain, an integral gain, and a derivative gain used in the PID control step, at least the derivative gain, wherein, in a case in which the heading deviation calculated in the heading deviation calculation step is equal to or greater than a first threshold value, a derivative gain addition correction quantity is added to a current value of the derivative gain in the gain setting step.
5. A heading control method for a marine vessel including an actuator having a rudder, comprising: a heading detection step of detecting an actual heading, which is an actual azimuth of a bow of the marine vessel; a target heading acquisition step of acquiring a target heading; a heading deviation calculation step of calculating a heading deviation, which is a difference between the target heading acquired in the target heading acquisition step and the actual heading detected in the heading detection step; a PID control step of calculating an instruction value for the actuator through PID control from the heading deviation calculated in the heading deviation calculation step; and a gain setting step of setting, out of a proportional gain, an integral gain, and a derivative gain used in the PID control step, at least the derivative gain, wherein, in a case in which an evaluation value of a change quantity in the instruction value calculated in the PID control step is equal to or greater than a second threshold value, a derivative gain reduction correction quantity is subtracted from a current value of the derivative gain in the gain setting step.
6. A heading control device for a marine vessel including an actuator having a rudder, comprising: a target heading acquisition unit; a heading deviation calculation unit configured to calculate a heading deviation, which is a difference between a target heading acquired by the target heading acquisition unit and an actual heading; a PID control unit configured to calculate an instruction value for the actuator through PID control from the heading deviation calculated by the heading deviation calculation unit; and a gain setting unit configured to set, out of a proportional gain, an integral gain, and a derivative gain used for the PID control, at least the derivative gain, wherein, in a case in which the heading deviation calculated by the heading deviation calculation unit is equal to or greater than a first threshold value, the gain setting unit adds a derivative gain addition correction quantity to a current value of the derivative gain.
7. A heading control device for a marine vessel including an actuator having a rudder, comprising: a target heading acquisition unit; a heading deviation calculation unit configured to calculate a heading deviation, which is a difference between a target heading acquired by the target heading acquisition unit and an actual heading; a PID control unit configured to calculate an instruction value for the actuator through PID control from the heading deviation calculated by the heading deviation calculation unit; and a gain setting unit configured to set, out of a proportional gain, an integral gain, and a derivative gain used for the PID control, at least the derivative gain, wherein, in a case in which an evaluation value of a change quantity in the instruction value calculated by the PID control unit is equal to or greater than a second threshold value, the gain setting unit subtracts a derivative gain reduction correction quantity from a current value of the derivative gain.
8. A non-transitory storage medium storing a program for causing a computer mounted in a marine vessel including an actuator having a rudder to execute: a heading detection step of detecting an actual heading, which is an actual azimuth of a bow of the marine vessel; a target heading acquisition step of acquiring a target heading; a heading deviation calculation step of calculating a heading deviation, which is a difference between the target heading acquired in the target heading acquisition step and the actual heading detected in the heading detection step; a PID control step of calculating an instruction value for the actuator through PID control from the heading deviation calculated in the heading deviation calculation step; and a gain setting step of setting, out of a proportional gain, an integral gain, and a derivative gain used in the PID control step, at least the derivative gain, wherein, in a case in which the heading deviation calculated in the heading deviation calculation step is equal to or greater than a first threshold value, a derivative gain addition correction quantity is added to a current value of the derivative gain in the gain setting step.
9. A non-transitory storage medium storing a program for causing a computer mounted in a marine vessel including an actuator having a rudder to execute: a heading detection step of detecting an actual heading, which is an actual azimuth of a bow of the marine vessel; a target heading acquisition step of acquiring a target heading; a heading deviation calculation step of calculating a heading deviation, which is a difference between the target heading acquired in the target heading acquisition step and the actual heading detected in the heading detection step; a PID control step of calculating an instruction value for the actuator through PID control from the heading deviation calculated in the heading deviation calculation step; and a gain setting step of setting, out of a proportional gain, an integral gain, and a derivative gain used in the PID control step, at least the derivative gain, wherein, in a case in which an evaluation value of a change quantity in the instruction value calculated in the PID control step is equal to or greater than a second threshold value, a derivative gain reduction correction quantity is subtracted from a current value of the derivative gain in the gain setting step.
Description
BRIEF DESCRIPTION OF DRAWINGS
[0037]
[0038]
[0039]
[0040]
[0041]
[0042]
DESCRIPTION OF EMBODIMENTS
First Embodiment
[0043] First embodiments of a marine vessel, a heading control method, a heading control device, and a program according to the present invention will be described below.
[0044]
[0045] In the example shown in
[0046] The operation unit 11 includes, for example, a steering unit 11A, a throttle operation unit 11B, and a target heading setting unit 11C. The steering unit 11A receives an input operation of a vessel operator who operates a rudder 12A, which will be described later. The throttle operation unit 11B receives an input operation of the vessel operator who operates a thrust generation unit 12B, which will be described later. The target heading setting unit 11C sets a target heading, which is an azimuth of a target of a bow 1A of the marine vessel 1 (see
[0047] The actuator 12 includes the rudder 12A and the thrust generation unit 12B. The rudder 12A has a function of generating a turning moment in the marine vessel 1. The thrust generation unit 12B has a function of generating a propulsive force of the marine vessel 1.
[0048] The heading detection unit 13 detects an actual heading, which is an actual azimuth of the bow 1A of the marine vessel 1. The heading detection unit 13 includes, for example, an azimuth sensor. The azimuth sensor calculates the actual heading of the marine vessel 1 by utilizing geomagnetism, for example.
[0049] In another example, the azimuth sensor may be a device (gyrocompass) that always indicates north by adding a north pointing device and a damping device to a gyroscope rotating at high speed.
[0050] In still another example, the azimuth sensor may be a Global Positioning System (GPS) compass that includes a plurality of GPS antennas and calculates a heading from relative positional relationships between the plurality of GPS antennas.
[0051] In the example shown in
[0052] For example, as shown in
[0053] In another example, the target heading acquisition unit 14A may acquire, as the target heading, a heading angle or the like numerically input by the vessel operator, for example.
[0054] In the example shown in
[0055] The heading deviation calculation unit 14C calculates a heading deviation, which is the difference between the target heading acquired by the target heading acquisition unit 14A and the actual heading detected by the heading detection unit 13 (specifically, the actual heading acquired by the actual heading acquisition unit 14B).
[0056] The PID control unit 14D calculates an instruction value STR for the actuator 12 through PID control from the heading deviation calculated by the heading deviation calculation unit 14C. Specifically, the PID control unit 14D calculates the instruction value STR at a predetermined time interval. Specifically, the PID control unit 14D calculates the instruction value STR on the basis of, for example, the following formula. In the following formula, Kp indicates a proportional gain, Ki indicates an integral gain, and Kd indicates a derivative gain.
STR=Kp×heading deviation+Ki×integral value of heading deviation+Kd×derivative value of heading deviation
[0057] In the example shown in
[0058] In another example, the gain setting unit 14E may only set the derivative gain Kd, and the proportional gain Kp and the integral gain Ki may be set, for example, by the vessel operator, or may be set to fixed values.
[0059] In the example shown in
[0060] The change quantity calculation unit 14E1 calculates, for example, a change quantity |STR.sub.t−STR.sub.t−1| of the instruction value STR, which is the difference an instruction value STR.sub.t calculated by the PID control unit 14D at a time t and an instruction value STR.sub.t−1 calculated by the PID control unit 14D at a time a predetermined time before the time t (that is, a time (t−1)). That is, the change quantity |STR.sub.t−STR.sub.t−1| of the instruction value STR calculated by the change quantity calculation unit 14E1 of the PID control unit 14D is the difference between the instruction value STR.sub.t calculated at that time by the PID control unit 14D and the instruction value STR.sub.t−1 previously calculated by the PID control unit 14D.
[0061] The evaluation value calculation unit 14E2 calculates an evaluation value Et of the change quantity |STR.sub.t−STR.sub.t−1| of the instruction value STR calculated by the change quantity calculation unit 14E1. Specifically, the evaluation value calculation unit 14E2 calculates the evaluation value Et of the change quantity of the instruction value STR on the basis of the following formula.
[0062] That is, the evaluation value Et of the change quantity of the instruction value STR represented by the above formula is a value corresponding to a value obtained by accumulating the change quantity |STR.sub.t−k−STR.sub.t−k−1| of the instruction value STR calculated by the PID control unit 14D from a current time (k=0) back to a preset time (k=n).
[0063]
[0064] In the example shown in
[0065] Before the time t11, that is, in the case in which the control similar to automatic steering by the above-described known automatic steering device is performed (in a case in which the derivative gain Kd is fixed at zero, for example), the heading deviation (see
[0066] After the time t11, control by the heading control device 14 of the marine vessel 1 of the first embodiment is performed.
[0067] Specifically, during the period from the time t11 to a time t12, the heading deviation calculated by the heading deviation calculation unit 14C (see
[0068] Next, during the period from the time t12 to a time t13, the heading deviation calculated by the heading deviation calculation unit 14C (see
[0069] Thus, in the control by the heading control device 14 of the marine vessel 1 of the first embodiment, the gain setting unit 14E performs a process of adding the derivative gain addition correction quantity to the current value of the derivative gain Kd at a predetermined time interval, for example. As a result, the value of the derivative gain Kd increases from “3” to “8.”
[0070] Accordingly, in the control by the heading control device 14 of the marine vessel 1 of the first embodiment, during the period after the time t13, the heading deviation calculated by the heading deviation calculation unit 14C (see
[0071] Specifically, during the period after the time t13, the heading deviation calculated by the heading deviation calculation unit 14C (see
[0072] The present inventors and the like have been able to confirm through their research that, as shown in
[0073] That is, the present inventors and the like have found that, in the case in which the heading deviation (see
[0074]
[0075] In the example shown in
[0076] The present inventors and the like have confirmed through their intensive research that the instruction value STR (see
[0077] Further, the present inventors and the like have found through their intensive research that, by executing the process of subtracting the derivative gain reduction correction quantity (for example, “0.1”) from the current value of the derivative gain Kd (see
[0078] Thus, in the control by the heading control device 14 of the marine vessel 1 of the first embodiment, in a case in which the evaluation value Et of the change quantity in the instruction value STR (see
[0079] In the example shown in
[0080] As a result, in the example shown in
[0081] The present inventors and the like have confirmed through their research that, as shown in
[0082] That is, present the inventors and the like have found that, by performing the process of subtracting the derivative gain reduction correction quantity from the current value of the derivative gain Kd (see
[0083]
[0084] In the example shown in
[0085] Also, in step S12, the heading detection unit 13 detects the actual heading of the marine vessel 1 at the timing when the target heading is set in step S11.
[0086] Next, in step S13, the target heading acquisition unit 14A acquires the actual heading detected in step S12 as the target heading of the marine vessel 1.
[0087] Also, in step S14, the heading detection unit 13 detects the actual heading of the marine vessel 1.
[0088] Next, in step S15, the actual heading acquisition unit 14B acquires the actual heading of the marine vessel 1 detected in step S14 as the actual heading of the marine vessel 1 used for the control by the heading control device 14.
[0089] Next, in step S16, the heading deviation calculation unit 14C calculates the heading deviation, which is the difference between the target heading acquired in step S13 and the actual heading detected in step S14 (specifically, the actual heading acquired in step S15). Next, in step S17, the PID control unit 14D executes the PID control. Specifically, the PID control unit 14D calculates the instruction value STR for the actuator 12 from the heading deviation calculated in step S16.
[0090] Also, in step S18, the gain setting unit 14E sets the proportional gain Kp, the integral gain Ki, and the derivative gain Kd used for the PID control on the basis of the heading deviation calculated in step S16 and the instruction value STR calculated in step S17.
[0091]
[0092] In the example shown in
[0093] In step S18B, the gain setting unit 14E adds the derivative gain increase correction quantity to the current value of the derivative gain Kd, and the process proceeds to step S18C.
[0094] In step S18C, the evaluation value calculation unit 14E2 calculates the evaluation value Et of the change quantity in the instruction value STR calculated in step S17. Also, in step S18C, the gain setting unit 14E determines whether or not the evaluation value Et of the change quantity of the instruction value STR is equal to or greater than the threshold value TH2. If the evaluation value Et of the change quantity in the instruction value STR is equal to or greater than the threshold value TH2, the process proceeds to step S18D, and if the evaluation value Et of the change quantity in the instruction value STR is less than the threshold value TH2, the process proceeds to step S18E.
[0095] In step S18D, the gain setting unit 14E subtracts the derivative gain reduction correction quantity from the current value of the derivative gain Kd, and the process proceeds to step S18E.
[0096] In step S18E, the gain setting unit 14E determines whether or not to end the routine shown in
Second Embodiment
[0097] A second embodiment of the marine vessel, the heading control method, the heading control device, and the program according to the present invention will be described below.
[0098] The marine vessel 1 of the second embodiment is configured in the same manner as the marine vessel 1 of the first embodiment described above, except for the points described later. Accordingly, according to the marine vessel 1 of the second embodiment, the same effects as those of the marine vessel 1 of the first embodiment described above can be provided except for the points described later.
[0099] As described above, the marine vessel 1 of the first embodiment is a marine vessel such as a PWC.
[0100] On the other hand, the marine vessel 1 of the second embodiment is a marine vessel other than PWC. Specifically, in a first example of the marine vessel 1 of the second embodiment, the marine vessel 1 of the second embodiment is a small marine vessel such as the small marine vessel described in Japanese Patent No. 3118475, for example.
[0101] In a second example of the marine vessel 1 of the second embodiment, the marine vessel 1 of the second embodiment is, for example, a marine vessel equipped with an outboard motor, such as a marine vessel equipped with an outboard motor described in Japanese Patent No. 6198192, or Japanese Unexamined Patent Application, First Publication No. 2007-22284, or the like.
[0102] In a third example of the marine vessel 1 of the second embodiment, the marine vessel of the second embodiment is a marine vessel equipped with an inboard or outboard motor or an inboard engine.
[0103] In a fourth example of the marine vessel 1 of the second embodiment, the marine vessel of the second embodiment is a large marine vessel equipped with a side thruster.
[0104] As described above, the aspects for carrying out the present invention have been described using the embodiments, but the present invention is not limited to such embodiments at all, and various modifications and substitutions can be made without departing from the gist of the present invention. The configurations described in each embodiment and each example described above may be combined together.
[0105] All or some of the functions of each unit provided in the marine vessel 1 according to the above-described embodiments may be realized by recording a program for realizing these functions on a computer-readable recording medium and causing a computer system to read and execute the program recorded on this recording medium. Also, the term “computer system” mentioned here includes an OS and hardware such as peripheral devices.
[0106] In addition, the term “computer-readable recording medium” indicates a storage unit including a portable medium such as a flexible disk, a magneto-optical disk, ROM, and CD-ROM, and a hard disk built into a computer system. Further, the term “computer-readable recording medium” may also include a medium that dynamically retains a program for a short period of time such as a communication line for transmitting the program via a network such as the Internet or a communication line such as a telephone line, and in that case, a medium that holds the program for a certain period of time such as a volatile memory inside the computer system serving as a server and client. Moreover, the program may be one for realizing some of the above-described functions or may be one capable of realizing the above-described functions in combination with programs already recorded in the computer system.
REFERENCE SIGNS LIST
[0107] 1 Marine vessel [0108] 1A Bow [0109] 11 Operation unit [0110] 11A Steering unit [0111] 11B Throttle operation unit [0112] 11C Target heading setting unit [0113] 12 Actuator [0114] 12A Rudder [0115] 12B Thrust generation unit [0116] 13 Heading detection unit [0117] 14 Heading control device [0118] 14A Target heading acquisition unit [0119] 14B Actual heading acquisition unit [0120] 14C Heading deviation calculation unit [0121] 14D PID Control unit [0122] 14E Gain setting unit [0123] 14E1 Change quantity calculation unit [0124] 14E2 Evaluation value calculation unit [0125] Kp Proportional gain [0126] Ki Integral gain [0127] Kd Derivative gain [0128] STR Instruction value