CN114967429A - Ship course control method, device and equipment - Google Patents

Ship course control method, device and equipment Download PDF

Info

Publication number
CN114967429A
CN114967429A CN202210913443.4A CN202210913443A CN114967429A CN 114967429 A CN114967429 A CN 114967429A CN 202210913443 A CN202210913443 A CN 202210913443A CN 114967429 A CN114967429 A CN 114967429A
Authority
CN
China
Prior art keywords
course
gain
ship
obtaining
control law
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202210913443.4A
Other languages
Chinese (zh)
Other versions
CN114967429B (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.)
Beijing Highlandr Digital Technology Co ltd
Original Assignee
Beijing Highlandr Digital Technology Co ltd
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 Beijing Highlandr Digital Technology Co ltd filed Critical Beijing Highlandr Digital Technology Co ltd
Priority to CN202210913443.4A priority Critical patent/CN114967429B/en
Publication of CN114967429A publication Critical patent/CN114967429A/en
Application granted granted Critical
Publication of CN114967429B publication Critical patent/CN114967429B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B11/00Automatic controllers
    • G05B11/01Automatic controllers electric
    • G05B11/36Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
    • G05B11/42Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses a method, a device and equipment for controlling ship course, wherein the method for controlling the ship course comprises the steps of obtaining the current steering gain and steering pressing gain of the ship course; obtaining a target anti-interference integral gain of the ship course according to the steering gain and the steering pressing gain; obtaining a course time domain control law according to the target anti-interference integral gain, the steering gain and the steering pressing gain; and controlling the ship course according to the course time domain control law. According to the scheme of the invention, the automatic adjustment of the control parameter of the ship course is carried out according to the target anti-interference integral gain, so that the course control of the ship can cope with various external interferences.

Description

Ship course control method, device and equipment
Technical Field
The invention relates to the technical field of ship navigation control, in particular to a ship course control method, a device and equipment.
Background
At present, in the practical application of ship course control, two methods mainly exist, namely a PID control method based on artificial experience adjustment parameters; the other is a self-adaptive control method based on model identification and an LQR control method.
In the PID control method, a crew who needs to follow tries to obtain 3 control parameters, namely proportion, integral and differential, in the ship sailing process according to the actual running condition and sea surface condition, and the difficulty and the workload of the crew are undoubtedly increased in the process of trying to obtain the control parameters. In the adaptive control method and the LQR control method based on model identification, identification is required to be carried out under a relatively calm 3-level sea condition, and the identification condition cannot be used for accurately processing the navigation change of a ship under a severe sea condition, so that the application of the method is limited; in addition, due to the limitation of identification conditions, the problem of inaccurate identification is also easy to occur, the interference of uncertain periodic variation of size and direction cannot be identified, and the model identification increases the calculation amount of system operation.
Disclosure of Invention
The invention aims to solve the technical problem of how to provide a method, a device and equipment for controlling the ship course, so that the course control of a ship can deal with various external interferences.
In order to solve the technical problems, the technical scheme of the invention is as follows:
a ship course control method comprises the following steps:
acquiring the current rudder striking gain and rudder pressing gain of the ship course;
obtaining a target anti-interference integral gain of the ship course according to the steering gain and the steering pressing gain;
obtaining a course time domain control law according to the target anti-interference integral gain, the steering gain and the steering pressing gain;
and controlling the ship course according to the course time domain control law.
Optionally, obtaining a target anti-interference integral gain of the ship course according to the steering gain and the steering pressing gain, including:
obtaining a course frequency domain control law with an anti-interference integral term;
obtaining a transfer function of course control according to the course frequency domain control law;
and obtaining the target anti-interference integral gain of the ship course according to the transfer function.
Optionally, obtaining a heading frequency domain control law with an interference rejection integral term includes:
obtaining a course frequency domain control law with an anti-interference integral term through the following formula:
Figure 760430DEST_PATH_IMAGE001
wherein, S is a frequency domain,
Figure 285083DEST_PATH_IMAGE002
is the course frequency domain control law when the frequency domain is S,
Figure 150271DEST_PATH_IMAGE003
in order to make the gain of the rudder,
Figure 351445DEST_PATH_IMAGE004
in order to obtain the gain of the rudder pressing,
Figure 246458DEST_PATH_IMAGE005
to meet a predetermined range of interference rejection integral gain,
Figure 824069DEST_PATH_IMAGE006
is the heading difference.
Optionally, obtaining a transfer function of the heading control according to the heading frequency domain control law includes:
obtaining a transfer function of the heading control through the following formula:
A=
Figure 356813DEST_PATH_IMAGE007
wherein A is a transfer function, T is a preset ship model inertia parameter, K is a preset ship model rudder effect parameter,
Figure 728889DEST_PATH_IMAGE008
the course when the frequency domain is S.
Optionally, obtaining a target anti-interference integral gain of the ship heading according to the transfer function includes:
obtaining the value range of the anti-interference integral gain according to the transfer function:
Figure 799613DEST_PATH_IMAGE009
wherein the content of the first and second substances,
Figure 164604DEST_PATH_IMAGE005
is that
Figure 66701DEST_PATH_IMAGE010
Equation (II)
Figure 360410DEST_PATH_IMAGE011
A value range in the case of a solid root;
and determining the target anti-interference integral gain in the value range of the anti-interference integral gain.
Optionally, obtaining a heading time domain control law according to the target anti-interference integral gain, the steering gain and the steering pressing gain, including:
obtaining the course time domain control law through the following formula:
Figure 980747DEST_PATH_IMAGE012
wherein the content of the first and second substances,
Figure 572266DEST_PATH_IMAGE013
is a course time domain control law, r is a steering rate,
Figure 583996DEST_PATH_IMAGE014
and the target anti-interference integral gain is obtained.
Optionally, controlling the ship heading according to the heading time domain control law, including:
when the course value does not exceed a preset threshold value, controlling the course of the ship according to the course time domain control law;
and when the course value exceeds a preset threshold value, reducing the target anti-interference integral gain to a preset multiple of the target anti-interference integral gain to obtain a course time domain control law, and controlling the course of the ship according to the obtained course time domain control law, wherein the preset multiple is less than 1.
The invention also provides a ship course control device, which comprises:
the acquisition module is used for acquiring the current rudder striking gain and rudder pressing gain of the ship course;
the processing module is used for obtaining a target anti-interference integral gain of the ship course according to the steering gain and the steering pressing gain; obtaining a course time domain control law according to the target anti-interference integral gain, the steering gain and the steering pressing gain; and controlling the ship course according to the course time domain control law.
The present invention also provides a computing device comprising: a processor, a memory storing a computer program which, when executed by the processor, performs the method.
The present invention also provides a computer-readable storage medium storing instructions that, when executed on a computer, cause the computer to perform the method.
The scheme of the invention at least comprises the following beneficial effects:
the control method of the ship course obtains the current helm opening gain and helm pressing gain of the ship course; obtaining a target anti-interference integral gain of the ship course according to the steering gain and the steering pressing gain; obtaining a course time domain control law according to the target anti-interference integral gain, the steering gain and the steering pressing gain; and controlling the ship course according to the course time domain control law, so that the ship course control can cope with various external interferences, the complexity of the ship course control method is reduced, and the calculated amount of the ship course control is also reduced.
Drawings
FIG. 1 is a flowchart of a method for controlling ship course according to an embodiment of the present invention;
fig. 2 is a schematic block diagram of a ship course control device according to an embodiment of the present invention.
Detailed Description
Exemplary embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings. While exemplary embodiments of the present disclosure are shown in the drawings, it should be understood that the present disclosure may be embodied in various forms and should not be limited to the embodiments set forth herein. Rather, these embodiments are provided so that this disclosure will be thorough and complete, and will fully convey the scope of the disclosure to those skilled in the art.
As shown in fig. 1, the present embodiment provides a method for controlling a ship heading, including:
s1, acquiring the current steering gain and steering pressing gain of the ship course;
s2, obtaining a target anti-interference integral gain of the ship course according to the steering gain and the steering pressing gain;
s3, obtaining a course time domain control law according to the target anti-interference integral gain, the steering gain and the steering pressing gain;
and S4, controlling the ship course according to the course time domain control law.
Wherein, the steering gain refers to the difference between the actual course and the target course, namely the control coefficient of the course difference; the steering gain refers to the ratio of the actual steering rate to the target steering rate, namely a control coefficient of the steering rate; the steering gain and the steering pressure gain can be calculated by an adaptive control method, a PID (proportional integral derivative) control method or an LQR (linear quadratic regulator) control method, or can be obtained by manual debugging.
According to the control method for the ship course, the control parameters are automatically adjusted through the target anti-interference integral gain, so that the ship course control can deal with various external interferences, meanwhile, a course time domain control law can be obtained only through simple calculation of the steering gain and the steering pressing gain, the ship course is controlled, and the calculated amount is small. Compared with a PID control method which needs to try and obtain 3 control parameters, the method greatly simplifies the complexity of the ship course control method and reduces the calculated amount of the ship course control. Compared with an adaptive control method based on model identification and an LQR control method which are limited by identification conditions, the method can be applied to various sea conditions and can perform anti-interference control.
As an optional implementation manner of this embodiment, in step S2, obtaining a target anti-interference integral gain of the ship heading according to the steering gain and the steering depression gain includes:
s21, obtaining a course frequency domain control law with an anti-interference integral term;
s22, obtaining a transfer function of course control according to the course frequency domain control law;
and S23, obtaining the target anti-interference integral gain of the ship course according to the transfer function.
The ship course control method can perform integral compensation by using the course difference, and obtain a course frequency domain control law executed in a time domain through the course frequency domain control law, and specifically comprises the following steps:
in step S21, obtaining a heading frequency domain control law with an anti-interference integral term includes:
obtaining a course frequency domain control law with an anti-interference integral term through the following formula:
Figure 563453DEST_PATH_IMAGE001
wherein, S is a frequency domain,
Figure 343190DEST_PATH_IMAGE002
is the course frequency domain control law when the frequency domain is S,
Figure 551449DEST_PATH_IMAGE003
in order to make the gain of the rudder,
Figure 428138DEST_PATH_IMAGE004
in order to obtain the gain of the rudder pressing,
Figure 562185DEST_PATH_IMAGE005
to meet a predetermined range of interference rejection integral gain,
Figure 829218DEST_PATH_IMAGE006
is the heading difference.
In step S22, obtaining a transfer function of the heading control according to the heading frequency domain control law, including:
obtaining a transfer function of the heading control through the following formula:
A=
Figure 90436DEST_PATH_IMAGE007
wherein A is a transfer function, T is a preset ship model inertia parameter, K is a preset ship model rudder effect parameter,
Figure 572364DEST_PATH_IMAGE008
the heading when the frequency domain is S.
In step S23, obtaining a target anti-interference integral gain of the ship heading according to the transfer function, including:
obtaining the value range of the anti-interference integral gain according to the transfer function:
Figure 628044DEST_PATH_IMAGE009
wherein the content of the first and second substances,
Figure 382374DEST_PATH_IMAGE005
is that
Figure 430970DEST_PATH_IMAGE010
In the equation
Figure 16672DEST_PATH_IMAGE011
A value range in the case of a solid root;
and determining the target anti-interference integral gain in the value range of the anti-interference integral gain.
It is to be noted that
Figure 259566DEST_PATH_IMAGE011
Is a quadratic equation of one element having a real root, i.e. satisfying
Figure 501191DEST_PATH_IMAGE015
A condition of more than or equal to 0 is obtained, so that the anti-interference integral gain is obtained
Figure 838632DEST_PATH_IMAGE005
The value range of (a). Integral gain while resisting interference
Figure 793687DEST_PATH_IMAGE005
When the value range is satisfied, the method can ensure that
Figure 128853DEST_PATH_IMAGE011
The zero point is provided, so that the transfer function of the closed loop has the zero point, and the anti-interference integral gain plays a role in adjusting.
The value range of the anti-interference integral gain is obtained through the method, and the target anti-interference integral gain is determined in the value range of the anti-interference integral gain, so that the phenomenon of frequent course crossing caused by large gain can be avoided, and the robustness is strong.
In step S3, obtaining a course time domain control law according to the target anti-interference integral gain, the steering gain, and the steering pressing gain, including:
obtaining the course time domain control law through the following formula:
Figure 920092DEST_PATH_IMAGE012
wherein the content of the first and second substances,
Figure 811956DEST_PATH_IMAGE013
is a course time domain control law, r is a steering rate,
Figure 372250DEST_PATH_IMAGE014
and the target anti-interference integral gain is obtained.
In step S4, controlling the ship heading according to the heading time domain control law, including:
when the course value does not exceed a preset threshold value, controlling the course of the ship according to the course time domain control law;
and when the course value exceeds a preset threshold value, reducing the target anti-interference integral gain to a preset multiple of the target anti-interference integral gain to obtain a course time domain control law, and controlling the course of the ship according to the obtained course time domain control law, wherein the preset multiple is less than 1, and preferably the preset multiple is 0.5.
The course value can be obtained by means of compass measurement and the like, when the ship turns, if the course value exceeds an artificially set or default threshold value, the phenomenon is an overshoot phenomenon, and the target anti-interference integral gain at the moment
Figure 449622DEST_PATH_IMAGE014
Mismatch, need to be adjusted in such a way that the current one is used
Figure 462577DEST_PATH_IMAGE014
Reduced by a predetermined factor
Figure 158132DEST_PATH_IMAGE014
E.g. 0.5 times
Figure 572933DEST_PATH_IMAGE016
And recalculating the course time domain control law.
It should be noted that the rudder angle is controlled by the course time domain control law, the rudder angle changes according to the course time domain control law, and the change of the rudder angle affects the course, so that the course of the ship is controlled according to the course time domain control law.
As an optional implementation manner of this embodiment, the steering gain and the rudder pressing gain may be obtained in real time, so as to obtain a real-time course time domain control law and control the course of the ship.
The ship course control method can automatically adjust the value range of the anti-interference integral gain, automatically adjust the target anti-interference integral gain, and realize the anti-interference control of the ship course by adopting the target anti-interference integral gain, and the whole control method does not depend on modes such as model identification and the like, and can realize the anti-interference control.
As an optional implementation manner of this embodiment, the ship course control method of this embodiment may be combined with a control method in the prior art.For example, the present embodiment is combined with a PID control method, in which 3 parameters required are proportional (K) P ) Integral (K) I ) Differential (K) D ) The target anti-interference integral gain obtained in the embodiment can be adopted
Figure 515481DEST_PATH_IMAGE016
As integral K in PID control methods I And further, the PID control method only needs to adjust 2 parameters, so that the complexity of simultaneously adjusting 3 parameters is reduced. For another example, the present embodiment is combined with an adaptive control method based on model recognition and an LQR control method to compensate for external interference.
As shown in fig. 2, the present embodiment further provides a ship heading control device 20, including:
the acquiring module 21 is used for acquiring the current rudder striking gain and rudder pressing gain of the ship course;
the processing module 22 is used for obtaining a target anti-interference integral gain of the ship course according to the steering gain and the steering pressing gain; obtaining a course time domain control law according to the target anti-interference integral gain, the steering gain and the steering pressing gain; and controlling the ship course according to the course time domain control law.
As an optional implementation manner of this embodiment, when the processing module 22 obtains the target anti-interference integral gain of the ship course according to the steering gain and the rudder pressing gain, the processing module is specifically configured to:
obtaining a course frequency domain control law with an anti-interference integral term;
obtaining a transfer function of course control according to the course frequency domain control law;
and obtaining the target anti-interference integral gain of the ship course according to the transfer function.
Optionally, the processing module 22 obtains a heading frequency domain control law with an anti-interference integral term, and is specifically configured to:
obtaining a course frequency domain control law with an anti-interference integral term through the following formula:
Figure 265000DEST_PATH_IMAGE001
wherein, S is a frequency domain,
Figure 747934DEST_PATH_IMAGE002
is the course frequency domain control law when the frequency domain is S,
Figure 33553DEST_PATH_IMAGE003
in order to make the gain of the rudder,
Figure 209319DEST_PATH_IMAGE004
in order to obtain the gain of the rudder pressing,
Figure 508452DEST_PATH_IMAGE005
to meet a predetermined range of interference rejection integral gain,
Figure 545809DEST_PATH_IMAGE006
is the heading difference.
Optionally, when the processing module 22 obtains the transfer function of the heading control according to the heading frequency domain control law, the processing module is specifically configured to:
obtaining a transfer function of the heading control through the following formula:
A=
Figure 669623DEST_PATH_IMAGE017
wherein A is a transfer function, T is a preset ship model inertia parameter, K is a preset ship model rudder effect parameter,
Figure 953973DEST_PATH_IMAGE008
the course when the frequency domain is S.
Optionally, when the processing module 22 obtains the target anti-interference integral gain of the ship heading according to the transfer function, the processing module is specifically configured to:
obtaining the value range of the anti-interference integral gain according to the transfer function:
Figure 740402DEST_PATH_IMAGE009
wherein the content of the first and second substances,
Figure 581450DEST_PATH_IMAGE005
is that
Figure 825349DEST_PATH_IMAGE010
Equation (II)
Figure 15022DEST_PATH_IMAGE011
A value range in the case of a solid root;
and determining the target anti-interference integral gain in the value range of the anti-interference integral gain.
Optionally, when the processing module 22 obtains a heading time-domain control law according to the target anti-interference integral gain, the steering gain, and the steering pressing gain, the processing module is specifically configured to:
obtaining the course time domain control law through the following formula:
Figure 232289DEST_PATH_IMAGE012
wherein the content of the first and second substances,
Figure 860716DEST_PATH_IMAGE013
is a course time domain control law, r is a steering rate,
Figure 975434DEST_PATH_IMAGE014
and the target anti-interference integral gain is obtained.
Optionally, when the processing module 22 controls the ship heading according to the heading time domain control law, the processing module is specifically configured to:
when the course value does not exceed a preset threshold value, controlling the course of the ship according to the course time domain control law;
and when the course value exceeds a preset threshold value, reducing the target anti-interference integral gain to a preset multiple of the target anti-interference integral gain to obtain a course time domain control law, and controlling the course of the ship according to the obtained course time domain control law, wherein the preset multiple is less than 1.
It should be noted that this embodiment is an apparatus embodiment corresponding to the above method embodiment, and all the implementations in the above method embodiment are applicable to this apparatus embodiment, and the same technical effects can be achieved.
The present embodiment also provides a computing device, including: a processor, a memory storing a computer program which, when executed by the processor, performs the method.
The present embodiments also provide a computer-readable storage medium storing instructions that, when executed on a computer, cause the computer to perform the method described.
The computing device may include: a processor (processor), a Communications Interface (Communications Interface), a memory (memory), and a Communications bus.
Wherein: the processor, the communication interface, and the memory communicate with each other via a communication bus. A communication interface for communicating with network elements of other devices, such as clients or other servers. The processor is used for executing the program, and specifically, the relevant steps in the above embodiments may be executed.
In particular, the program may include program code comprising computer operating instructions.
The processor may be a central processing unit CPU or an application Specific Integrated circuit asic or one or more Integrated circuits configured to implement embodiments of the present invention. The computing device includes one or more processors, which may be the same type of processor, such as one or more CPUs; or may be different types of processors such as one or more CPUs and one or more ASICs.
And the memory is used for storing programs. The memory may comprise high-speed RAM memory, and may also include non-volatile memory (non-volatile memory), such as at least one disk memory.
The program may in particular be adapted to cause a processor to perform the method in any of the above-described method embodiments. For specific implementation of each step in the program, reference may be made to corresponding steps and corresponding descriptions in units in the foregoing embodiments, which are not described herein again. It can be clearly understood by those skilled in the art that, for convenience and brevity of description, the specific working processes of the above-described devices and modules may refer to the corresponding process descriptions in the foregoing method embodiments, and are not described herein again.
The algorithms or displays presented herein are not inherently related to any particular computer, virtual system, or other apparatus. Various general purpose systems may also be used with the teachings herein. The required structure for constructing such a system will be apparent from the description above. In addition, embodiments of the present invention are not directed to any particular programming language. It is appreciated that a variety of programming languages may be used to implement the teachings of embodiments of the present invention as described herein, and any descriptions of specific languages are provided above to disclose the best modes of embodiments of the invention.
In the description provided herein, numerous specific details are set forth. It is understood, however, that embodiments of the invention may be practiced without these specific details. In some instances, well-known methods, structures and techniques have not been shown in detail in order not to obscure an understanding of this description.
Similarly, it should be appreciated that in the foregoing description of exemplary embodiments of the invention, various features of the embodiments of the invention are sometimes grouped together in a single embodiment, figure, or description thereof for the purpose of streamlining the disclosure and aiding in the understanding of one or more of the various inventive aspects. However, the disclosed method should not be interpreted as reflecting an intention that: that is, the claimed embodiments of the invention require more features than are expressly recited in each claim. Rather, as the following claims reflect, inventive aspects lie in less than all features of a single foregoing disclosed embodiment. Thus, the claims following the detailed description are hereby expressly incorporated into this detailed description, with each claim standing on its own as a separate embodiment of this invention.
Those skilled in the art will appreciate that the modules in the device in an embodiment may be adaptively changed and disposed in one or more devices different from the embodiment. The modules or units or components of the embodiments may be combined into one module or unit or component, and furthermore they may be divided into a plurality of sub-modules or sub-units or sub-components. All of the features disclosed in this specification (including any accompanying claims, abstract and drawings), and all of the processes or elements of any method or apparatus so disclosed, may be combined in any combination, except combinations where at least some of such features and/or processes or elements are mutually exclusive. Each feature disclosed in this specification (including any accompanying claims, abstract and drawings) may be replaced by alternative features serving the same, equivalent or similar purpose, unless expressly stated otherwise.
Furthermore, those skilled in the art will appreciate that while some embodiments herein include some features included in other embodiments, rather than other features, combinations of features of different embodiments are meant to be within the scope of the invention and form different embodiments. For example, in the following claims, any of the claimed embodiments may be used in any combination.
The various component embodiments of the invention may be implemented in hardware, or in software modules running on one or more processors, or in a combination thereof. Those skilled in the art will appreciate that a microprocessor or Digital Signal Processor (DSP) may be used in practice to implement some or all of the functionality of some or all of the components according to embodiments of the present invention. Embodiments of the present invention may also be embodied as device or system programs (e.g., computer programs and computer program products) for performing a portion or all of the methods described herein. Such programs implementing embodiments of the present invention may be stored on computer-readable media or may be in the form of one or more signals. Such a signal may be downloaded from an internet website or provided on a carrier signal or in any other form.
It should be noted that the above-mentioned embodiments illustrate rather than limit the invention, and that those skilled in the art will be able to design alternative embodiments without departing from the scope of the appended claims. In the claims, any reference signs placed between parentheses shall not be construed as limiting the claim. The word "comprising" does not exclude the presence of elements or steps not listed in a claim. The word "a" or "an" preceding an element does not exclude the presence of a plurality of such elements. Embodiments of the invention may be implemented by means of hardware comprising several distinct elements, and by means of a suitably programmed computer. In the unit claims enumerating several systems, several of these systems may be embodied by one and the same item of hardware. The usage of the words first, second and third, etcetera do not indicate any ordering. These words may be interpreted as names. The steps in the above embodiments should not be construed as limiting the order of execution unless specified otherwise.

Claims (10)

1. A ship course control method is characterized by comprising the following steps:
acquiring the current rudder striking gain and rudder pressing gain of the ship course;
obtaining a target anti-interference integral gain of the ship course according to the steering gain and the steering pressing gain;
obtaining a course time domain control law according to the target anti-interference integral gain, the steering gain and the steering pressing gain;
and controlling the ship course according to the course time domain control law.
2. The method for controlling the ship course according to claim 1, wherein obtaining the target anti-interference integral gain of the ship course according to the steering gain and the steering pressing gain comprises:
obtaining a course frequency domain control law with an anti-interference integral term;
obtaining a transfer function of course control according to the course frequency domain control law;
and obtaining the target anti-interference integral gain of the ship course according to the transfer function.
3. The method for controlling the heading of a ship according to claim 2, wherein obtaining a heading frequency domain control law with an anti-interference integral term comprises:
obtaining a course frequency domain control law with an anti-interference integral term through the following formula:
Figure DEST_PATH_IMAGE001
wherein, S is a frequency domain,
Figure 594654DEST_PATH_IMAGE002
is the course frequency domain control law when the frequency domain is S,
Figure 41947DEST_PATH_IMAGE003
in order to make the gain of the rudder,
Figure 670374DEST_PATH_IMAGE004
in order to obtain the gain of the rudder pressing,
Figure 289487DEST_PATH_IMAGE005
to meet a predetermined range of interference rejection integral gain,
Figure 915640DEST_PATH_IMAGE006
is the heading difference.
4. The method for controlling the heading of the ship as claimed in claim 3, wherein obtaining the transfer function of the heading control according to the heading frequency domain control law comprises:
obtaining a transfer function of the heading control through the following formula:
A=
Figure 99497DEST_PATH_IMAGE007
wherein A is a transfer function, T is a preset ship model inertia parameter, K is a preset ship model rudder effect parameter,
Figure 282347DEST_PATH_IMAGE008
the course when the frequency domain is S.
5. The method for controlling the heading of a ship according to claim 4, wherein obtaining the target anti-interference integral gain of the heading of the ship according to the transfer function comprises:
obtaining the value range of the anti-interference integral gain according to the transfer function:
Figure 500839DEST_PATH_IMAGE009
wherein, the first and the second end of the pipe are connected with each other,
Figure 609478DEST_PATH_IMAGE005
is that
Figure 280631DEST_PATH_IMAGE010
Equation (II)
Figure DEST_PATH_IMAGE011
A value range in the case of a solid root;
and determining the target anti-interference integral gain in the value range of the anti-interference integral gain.
6. The method for controlling the ship course according to claim 5, wherein obtaining a course time domain control law according to the target anti-interference integral gain, the steering gain and the steering pressing gain comprises:
obtaining the course time domain control law through the following formula:
Figure 375495DEST_PATH_IMAGE012
wherein the content of the first and second substances,
Figure 448493DEST_PATH_IMAGE013
is a course time domain control law, r is a steering rate,
Figure 229499DEST_PATH_IMAGE014
and the target anti-interference integral gain is obtained.
7. The method for controlling the heading of the ship as claimed in claim 6, wherein controlling the heading of the ship according to the heading time domain control law comprises:
when the course value does not exceed a preset threshold value, controlling the course of the ship according to the course time domain control law;
and when the course value exceeds the preset threshold value, reducing the target anti-interference integral gain to a preset multiple of the target anti-interference integral gain to obtain the course time domain control law, and controlling the course of the ship according to the obtained course time domain control law, wherein the preset multiple is less than 1.
8. A control device for the heading of a ship, comprising:
the acquisition module is used for acquiring the current rudder striking gain and rudder pressing gain of the ship course;
the processing module is used for obtaining a target anti-interference integral gain of the ship course according to the steering gain and the steering pressing gain; obtaining a course time domain control law according to the target anti-interference integral gain, the steering gain and the steering pressing gain; and controlling the ship course according to the course time domain control law.
9. A computing device, comprising: a processor, a memory storing a computer program which, when executed by the processor, performs the method of any of claims 1 to 7.
10. A computer-readable storage medium storing instructions that, when executed on a computer, cause the computer to perform the method of any one of claims 1 to 7.
CN202210913443.4A 2022-08-01 2022-08-01 Ship course control method, device and equipment Active CN114967429B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210913443.4A CN114967429B (en) 2022-08-01 2022-08-01 Ship course control method, device and equipment

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210913443.4A CN114967429B (en) 2022-08-01 2022-08-01 Ship course control method, device and equipment

Publications (2)

Publication Number Publication Date
CN114967429A true CN114967429A (en) 2022-08-30
CN114967429B CN114967429B (en) 2022-11-08

Family

ID=82969411

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210913443.4A Active CN114967429B (en) 2022-08-01 2022-08-01 Ship course control method, device and equipment

Country Status (1)

Country Link
CN (1) CN114967429B (en)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040193337A1 (en) * 2003-03-31 2004-09-30 Takesi Yamakawa Control system and method
CN103197542A (en) * 2013-02-07 2013-07-10 浙江工业大学 Time delay system PID controller stabilization method based on data drive
CN104391444A (en) * 2014-12-10 2015-03-04 福州大学 Improved single-neuron PID tuning method based on discrete system
JP2016008038A (en) * 2014-06-26 2016-01-18 東京計器株式会社 Automatic steering device for ship
CN109597299A (en) * 2019-02-21 2019-04-09 中国大唐集团科学技术研究院有限公司西北电力试验研究院 A kind of real-time automatic optimal control method and device of the online dynamic type of integral parameter
CN112578801A (en) * 2021-03-01 2021-03-30 北京海兰信数据科技股份有限公司 Ship course anti-interference control method
CN114019985A (en) * 2021-12-20 2022-02-08 中国海洋大学 Unmanned ship rudder direction control design method based on fractional order PID and particle swarm algorithm

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040193337A1 (en) * 2003-03-31 2004-09-30 Takesi Yamakawa Control system and method
CN103197542A (en) * 2013-02-07 2013-07-10 浙江工业大学 Time delay system PID controller stabilization method based on data drive
JP2016008038A (en) * 2014-06-26 2016-01-18 東京計器株式会社 Automatic steering device for ship
CN104391444A (en) * 2014-12-10 2015-03-04 福州大学 Improved single-neuron PID tuning method based on discrete system
CN109597299A (en) * 2019-02-21 2019-04-09 中国大唐集团科学技术研究院有限公司西北电力试验研究院 A kind of real-time automatic optimal control method and device of the online dynamic type of integral parameter
CN112578801A (en) * 2021-03-01 2021-03-30 北京海兰信数据科技股份有限公司 Ship course anti-interference control method
CN114019985A (en) * 2021-12-20 2022-02-08 中国海洋大学 Unmanned ship rudder direction control design method based on fractional order PID and particle swarm algorithm

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
张欣: "船舶自动操舵仪的实现及混合仿真测试", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *

Also Published As

Publication number Publication date
CN114967429B (en) 2022-11-08

Similar Documents

Publication Publication Date Title
CN109507885B (en) Model-free self-adaptive AUV control method based on active disturbance rejection
Du et al. Adaptive autopilot design of time-varying uncertain ships with completely unknown control coefficient
CN109917657B (en) Anti-interference control method and device for dynamic positioning ship and electronic equipment
CN103645736B (en) Based on non-linear H∞The ship course motion control method of inverse optimization output feedback controller
CN109799699B (en) Automatic driving system control parameter processing method, device, equipment and storage medium
CN110333658A (en) A kind of underactuated surface vessel course heading control method compensated with input constraint and drift angle
CN113954831B (en) Vehicle transverse control method and device and automatic driving vehicle
CN110244556A (en) Based on the modified underactuated surface vessel course heading control method of desired course
CN112578801B (en) Ship course anti-interference control method
CN111198502A (en) Unmanned ship track tracking control method based on interference observer and fuzzy system
CN114967429B (en) Ship course control method, device and equipment
CN111061262B (en) Course control method for reducing invalid steering
CN114924480A (en) Ship course tracking self-adaptive control method
Hassani et al. A multiple model adaptive wave filter for dynamic ship positioning
CN109582026A (en) Autonomous Underwater Vehicle path tracking control method based on Self-tuning System sight and drift angle compensation
Zhiping et al. Adaptive self-regulation PID tracking control for the ship course
JPS63192694A (en) Automatic steering gear for ship with weather adaptation type function
Tzeng et al. A sensitivity function approach to the design of rudder roll stabilization controller
CN113110519B (en) Non-incremental model-free adaptive heading control method for ships
CN115534930A (en) Vehicle transverse control method and device and electronic equipment
CN113885538B (en) Ship course control method and system
JP2014136509A (en) Automatic steering device
Renqiang et al. Neural network sliding mode control under new reaching law and application
CN106990788A (en) A kind of ship course composite control method and device
Popovich et al. Submarine Optimal Depth Control applying Parseval’s Theorem

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant