CN111665719B - Supply ship synchronous control algorithm with timeliness and stability - Google Patents

Supply ship synchronous control algorithm with timeliness and stability Download PDF

Info

Publication number
CN111665719B
CN111665719B CN202010530817.5A CN202010530817A CN111665719B CN 111665719 B CN111665719 B CN 111665719B CN 202010530817 A CN202010530817 A CN 202010530817A CN 111665719 B CN111665719 B CN 111665719B
Authority
CN
China
Prior art keywords
formula
control
vessel
ship
equation
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202010530817.5A
Other languages
Chinese (zh)
Other versions
CN111665719A (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.)
Dalian Maritime University
Original Assignee
Dalian Maritime 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 Dalian Maritime University filed Critical Dalian Maritime University
Priority to CN202010530817.5A priority Critical patent/CN111665719B/en
Publication of CN111665719A publication Critical patent/CN111665719A/en
Application granted granted Critical
Publication of CN111665719B publication Critical patent/CN111665719B/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
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

The invention provides a tender vessel synchronous control algorithm with timeliness and stability, which comprises a terminal cost function module, a tender vessel model prediction control module and a neural dynamic optimization module. The terminal cost function module ensures the closed loop stability of the supply ship control system by using the terminal cost function; the Model prediction Control module converts the synchronous Control problem of the supply ship into a tracking Control problem following a pilot, and designs a supply ship Control algorithm based on a Model Predictive Control (MPC) algorithm, so that the anti-interference capability of the supply ship during the execution of a supply task is improved, the speed of two ships can be synchronized during the supply task, and the supply efficiency is improved; the neural dynamic optimization module solves the problems of large calculation amount and low calculation speed in the traditional model predictive control algorithm by using a parallel calculation framework of a recurrent neural network, and can enable a tender boat to better cope with emergency situations during tender.

Description

Supply ship synchronous control algorithm with timeliness and stability
Technical Field
The invention relates to the technical field of automatic control, in particular to a synchronous control algorithm for a tender boat with timeliness and stability.
Background
Chinese patent CN 201610859143.7 discloses a generalized prediction adaptive supply ship course control method based on event driving, and the invention provides an event driving-based generalized prediction adaptive supply ship course control method.A discrete event trigger working in a discrete state is selected to design a trigger judgment function under a variable threshold value, and when the trigger time is reached, the event trigger judges whether the current state meets the trigger condition through the trigger judgment function; secondly, a controlled autoregressive integral sliding average model of a rudder angle-course is obtained through a supply ship low-frequency motion mathematical model and is used as a prediction model, and parameters of the prediction model are estimated on line by adopting a forgetting factor recursion least square method; thirdly, the state to be controlled is sent to the controller by combining with the event-driven trigger, and the controller outputs rudder angle control increment and control quantity after resolving through a GPC adaptive algorithm, so that the tender vessel can quickly finish the approaching stage and the parallel stage and keep course tracking of the tender stage. The invention mainly researches the course control problem of the supply ship, but in the course of sailing supply of the supply ship, only the course tracking effect in the supply stage is not enough, the speed synchronization problem of the supply ship and the supplied ship and the position relation between the two ships are considered, and the timeliness and the stability of the algorithm are increased, so that the supply ship can efficiently and safely complete the supply task.
Disclosure of Invention
According to the technical problems provided by the invention, a supply ship synchronous control algorithm with timeliness and stability is provided. The invention mainly utilizes a tender boat synchronous control algorithm with timeliness and stability, and is characterized by comprising the following steps: the system comprises a terminal cost function module, a supply ship model prediction control module and a neural dynamic optimization module.
For the tracking control problem of the supply ship, a three-degree-of-freedom ship motion model is adopted:
Figure BDA0002535343600000011
in the formula, eta = [ x, y, psi =] T X represents the lateral displacement of the vessel, y represents the longitudinal displacement of the vessel, ψ represents the yaw angle; upsilon = [ u, v, r] T U represents the advancing speed of the vessel, v represents the lateral speed of the vessel, and r represents the yaw rate of the vessel; j (ψ) represents a rotation matrix,
Figure BDA0002535343600000021
the tender vessel is typically operated at low speed, and therefore the dynamic model of vessel motion is summarized as:
Figure BDA0002535343600000022
in the formula,
Figure BDA0002535343600000023
a matrix of the inertia is represented and,
Figure BDA0002535343600000024
a damping matrix is represented which,
Figure BDA0002535343600000025
representing the Coriolis and central centripetal force matrix, τ T =[τ u τ v τ r ] T Indicating control force and moment, X (·) ,Y (·) ,N (·) Are hydrodynamic parameters.
The leader ship serves as a reference of a following ship, and a mathematical model of the leader ship is defined as:
Figure BDA0002535343600000026
coordinate conversion is performed on equations (1) and (3) by the following equation (4):
z 1 =xcosψ+ysinψ
z 2 =-xsinψ+ycosψ (4)
z 3 =ψ
offset (x) of displacement o ,y o ) In combination with equation (4) above, equation (4) can be converted to:
z 1r =(x r -x o )cosψ r +(y r -y o )sinψ r
z 2r =-(x r -x o )sinψ r +(y r -y o )cosψ r
z 3r =ψ r (5)
defining a synchronous control error system for supplying the dynamic positioning ship as follows:
z ie =z i -z ir i=1,2,3
u e =u-u r (6)
v e =v-v r
r e =r-r r
the formula (6) is differentiated and linearized to obtain:
Figure BDA0002535343600000031
in the formula, x t =y t =[z 1e z 2e z 3e u e v e r e ] T
Figure BDA0002535343600000032
Wherein,
Figure BDA0002535343600000033
d 11 =-X u ,d 22 =-Y v ,d 33 =-N r .
according to the actual requirement, selecting proper sampling time, the equation (8) can be converted into discrete form:
x(k+1)=Ax(k)+Bτ(k) (9)
wherein x, y ∈ R 6×1 ,A∈R 6×6 ,B∈R 6×3 K denotes sampling time points, and A and B are discrete system parameter matrixes.
In the invention, the stability of the control system is ensured by designing a secondary terminal cost function, and in the terminal cost function module, a linear state feedback law is firstly designed for the control system:
τ=Kx (10)
in the formula, K represents a vector for controlling the gain. The state matrix P of the terminal cost is obtained by solving the lyapunov equation (11)):
(A k +κI) T P+P(A k +κI)=-(Q lq +K T R lq K) (11)
in the formula, A k =A+BK,Q lq And R lq A weight matrix representing the outputs and inputs, κ is selected by equation (12):
κ<-λ max (A k ) (12)
thereby ensuring A k The real part of all eigenvalues of + kappa I is negative, where lambda is max (A k ) Is represented by A k Maximum eigenvalue of the real part.
Further, in order to improve the robustness and the anti-interference capability of the system, a tender vessel control algorithm is designed based on a model prediction control algorithm. Defining a prediction time domain as N in the supply ship model prediction control module p Control time domain of N c In the prediction calculation process, let τ (k + N) c )=τ(k+N c +1)=...=τ(k+N c +N p ) Then, the future state information of the system can be calculated sequentially by a certain prediction model (x (k + 1) = Ax (k) + B τ (k)):
Figure BDA0002535343600000041
wherein x (k + i | k) i =1,2 p Represents future state information x (k + i) i =1,2, N, predicted from the state information at the sampling time point k p
According to the above formula (13), the following definitions are made:
Figure BDA0002535343600000042
the above formula (13) is rewritten into a matrix form as shown in the formula (15):
X=Fx(k)+ΦΓ (15)
in the formula,
Figure BDA0002535343600000043
then, the synchronous multivariable control problem of the supply ship is converted into an optimal control problem with terminal cost:
Figure BDA0002535343600000044
the constraint conditions are as follows:
Γ min ≤Γ≤Γ max (17)
in the formula, Q mpc And R mpc Is an output weight matrix and an input weight matrix,
Figure BDA0002535343600000051
PX p is the terminal cost, X p Is the terminal state of X and P is the state matrix of the terminal cost function determined by equation (11).
Furthermore, in order to solve the problems of large calculation amount and low calculation speed in the traditional model predictive control algorithm, in the neural dynamic optimization system module, the parallel calculation architecture of the recurrent neural network is utilized to accelerate the calculation speed, so that the proposed algorithm has timeliness. In the neural dynamics optimization system module, substituting equation (15) into equation (16) yields:
Figure BDA0002535343600000052
by definition
Figure BDA0002535343600000053
Equation (18) is simplified to:
J=Γ T HΓ+WΓ+ξ (20)
the objective function (equation (20)) is solved iteratively by establishing a neural dynamic optimization system (equation (21)), so that the calculation speed is increased:
Figure BDA0002535343600000054
in the formula,
Figure BDA0002535343600000055
is the convergence speed, Ω (Γ) is taken as:, P Ω Is the projection operator, and the projection operator,
Figure BDA0002535343600000061
compared with the prior art, the invention has the following advantages:
(1) The method is based on a model prediction control algorithm, has robustness, and can excellently complete the replenishment task under the condition that the ship has external interference;
(2) The method solves the problems of large calculation amount and low calculation speed in the traditional model predictive control algorithm by utilizing the parallel calculation architecture of the recurrent neural network, can ensure that the proposed algorithm has timeliness, and ensures that the supply vessel adopting the method can better cope with changeable external environments;
(3) The invention ensures the closed loop stability of the control system by using the terminal cost function technology, so that the proposed algorithm has stability;
(4) The technology provided by the invention is used for controlling the supply ship, so that the supply ship can automatically follow the leader ship from different initial positions under the condition of interference and achieve the expected target of synchronous speed, the working strength of a rudder during supply can be effectively reduced, the supply ship can reach a supply state more quickly, the anti-interference capability of the supply ship is increased, the speed of the two ships can be ensured to be synchronous during supply, the influence of waves on supply is reduced, and the supply ship can finish the supply task efficiently.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings used in the embodiments or the description of the prior art will be briefly introduced below, and it is obvious that the drawings in the following description are some embodiments of the present invention, and for those skilled in the art, other drawings can be obtained according to these drawings without creative efforts.
FIG. 1 is a block diagram of an MPC design with timeliness and stability of the present invention.
FIG. 2 is a performance diagram of the synchronization control at different starting points according to the present invention.
FIG. 3 is a schematic diagram of the velocity synchronization process at different initial points according to the present invention.
FIG. 4 is a graphical representation of the response of the control input to various initiation points of the present invention.
Detailed Description
In order to make those skilled in the art better understand the technical solutions of the present invention, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
It should be noted that the terms "first," "second," and the like in the description and claims of the present invention and in the drawings described above are used for distinguishing between similar elements and not necessarily for describing a particular sequential or chronological order. It is to be understood that the data so used is interchangeable under appropriate circumstances such that the embodiments of the invention described herein are capable of operation in sequences other than those illustrated or described herein. Furthermore, the terms "comprises," "comprising," and "having," and any variations thereof, are intended to cover a non-exclusive inclusion, such that a process, method, system, article, or apparatus that comprises a list of steps or elements is not necessarily limited to those steps or elements expressly listed, but may include other steps or elements not expressly listed or inherent to such process, method, article, or apparatus.
As shown in fig. 1-4, the present invention provides a tender vessel synchronization control algorithm with timeliness and stability, which includes: the system comprises a terminal cost function module, a supply ship model prediction control module and a neural dynamic optimization module.
In the application, (1) in a terminal cost function module, the closed loop stability of a control system is guaranteed by designing a secondary terminal cost function; (2) In a model prediction control module of the supply ship, converting a synchronous control problem of the supply ship into a tracking control problem following a pilot, and solving the problem based on a model prediction control algorithm, so that the anti-interference capability of the supply ship is improved, the speed of two ships can be synchronized when a supply task is carried out, and the supply efficiency and the safety are improved; (3) In the neural dynamic optimization module, a parallel computing architecture of a recurrent neural network is used for quickly solving an objective function in the tender vessel model prediction control module, so that the ship can quickly react to a changeable external environment.
For the tracking control problem of the supply vessel, a three-degree-of-freedom vessel motion model is adopted:
Figure BDA0002535343600000071
in the formula, eta = [ x, y, psi =] T X represents the lateral displacement of the vessel, y represents the longitudinal displacement of the vessel, ψ represents the yaw angle; upsilon = [ u, v, r] T U represents the forward speed of the vessel, v represents the lateral speed of the vessel, and r represents the yaw rate of the vessel; j (ψ) represents a rotation matrix,
Figure BDA0002535343600000081
tender vessels are typically operated at low speeds, thus, the vessel is movedThe dynamic model of the ship motion is summarized as follows:
Figure BDA0002535343600000082
in the formula,
Figure BDA0002535343600000083
a matrix of the inertia is represented and,
Figure BDA0002535343600000084
a damping matrix is represented which is,
Figure BDA0002535343600000085
representing the Coriolis and central centripetal force matrix, τ T =[τ u τ v τ r ] T Indicating control force and moment, X (·) ,Y (·) ,N (·) Is a hydrodynamic parameter.
The leader ship serves as a reference of a following ship, and a mathematical model of the leader ship is defined as:
Figure BDA0002535343600000086
coordinate conversion is performed on equations (1) and (3) by the following equation (4):
Figure BDA0002535343600000087
offset (x) of displacement o ,y o ) In combination with equation (4) above, equation (4) can be converted to:
z 1r =(x r -x o )cosψ r +(y r -y o )sinψ r
z 2r =-(x r -x o )sinψ r +(y r -y o )cosψ r
z 3r =ψ r (5)
defining a synchronous control error system for the replenishment of a dynamically positioned vessel as:
z ie =z i -z ir i=1,2,3
u e =u-u r (6)
v e =v-v r
r e =r-r r
the differential and linearization processing of equation (6) yields:
Figure BDA0002535343600000091
in the formula, x t =y t =[z 1e z 2e z 3e u e v e r e ] T
Figure BDA0002535343600000092
Wherein
Figure BDA0002535343600000093
d 11 =-X u ,d 22 =-Y v ,d 33 =-N r
According to the actual requirement, selecting a proper sampling time, the equation (8) can be converted into a discrete form:
x(k+1)=Ax(k)+Bτ(k) (9)
wherein x, y ∈ R 6×1 ,A∈R 6×6 ,B∈R 6×3 K denotes sampling time points, and A and B are discrete system parameter matrixes.
In the invention, the stability of the control system is ensured by designing a secondary terminal cost function, and in the terminal cost function module, a linear state feedback law is firstly designed for the control system:
τ=Kx (10)
in the formula, K represents a vector for controlling the gain. The state matrix P of the terminal cost is obtained by solving the lyapunov equation (11)):
(A k +κI) T P+P(A k +κI)=-(Q lq +K T R lq K) (11)
in the formula, A k =A+BK,Q lq And R lq A weight matrix representing the output and input, κ being selected by equation (12):
κ<-λ max (A k ) (12)
thereby ensuring A k The real part of all eigenvalues of + kappa I are negative values, where lambda is max (A k ) Is represented by A k Maximum eigenvalue of the real part.
Further, in order to improve the robustness and the anti-interference capability of the system, a tender vessel control algorithm is designed based on a model prediction control algorithm. Defining a prediction time domain as N in the supply ship model prediction control module p Control time domain as N c In the prediction calculation process, let τ (k + N) c )=τ(k+N c +1)=...=τ(k+N c +N p ) Then, the future state information of the system can be calculated sequentially by a certain prediction model (x (k + 1) = Ax (k) + B τ (k)):
Figure BDA0002535343600000101
wherein x (k + i | k) i =1,2 p Represents future state information x (k + i) i =1,2, N, predicted from the state information at the sampling time point k p
According to the above formula (13), the following definitions are made:
Figure BDA0002535343600000102
rewriting the above formula (13) into a matrix form as shown in formula (15):
X=Fx(k)+ΦΓ (15)
in the formula,
Figure BDA0002535343600000103
then, the synchronous multivariable control problem of the supply ship is converted into an optimal control problem with terminal cost:
Figure BDA0002535343600000104
the constraint conditions are as follows:
Γ min ≤Γ≤Γ max (17)
in the formula, Q mpc And R mpc Is an output weight matrix and an input weight matrix,
Figure BDA0002535343600000111
PX p is the terminal cost, X p Represents the terminal state of X, and P is the state matrix of the terminal cost function determined by equation (11).
Furthermore, in order to solve the problems of large calculation amount and low calculation speed in the traditional model predictive control algorithm, in the neural dynamic optimization system module, the parallel calculation architecture of the recurrent neural network is utilized to accelerate the calculation speed, so that the proposed algorithm has timeliness. In the neural dynamic optimization system module, substituting equation (15) into equation (16) yields:
Figure BDA0002535343600000112
by definition
Figure BDA0002535343600000113
Equation (18) is simplified to:
J=Γ T HΓ+WΓ+ξ (20)
the objective function (equation (20)) is solved iteratively by establishing a neural dynamic optimization system (equation (21)), so that the calculation speed is accelerated:
Figure BDA0002535343600000114
in the formula,
Figure BDA0002535343600000115
is the convergence speed, taking Ω (Γ) as ^ J, P Ω Is the projection operator, and the projection operator,
Figure BDA0002535343600000121
example 1
The embodiment shows the synchronous control performance of the dynamically positioned ship when the novel replenishment ship synchronous control algorithm with timeliness and stability provided by the invention is adopted to finish the tracking replenishment task from different starting points. Fig. 2 shows the tracking performance of a dynamic positioning vessel when the replenishment task is performed from a different starting point, fig. 3 shows the synchronization process of the speed, and fig. 4 shows the response of the control input. In this embodiment, it can be seen from fig. 1 that although the starting point is at a different starting position, the following ship can still automatically follow the leader ship for replenishment, and it can be seen from fig. 2 that the synchronization of the speeds is automatically achieved in a steady state.
In addition, in the embodiment, the calculation time is compared, the comparison result is shown in the following table, and according to the data in the table, the novel supply ship synchronous control algorithm with timeliness and stability provided by the invention can be obtained, so that the calculation time of the traditional MPC algorithm can be effectively reduced, and the timeliness of the designed algorithm can be improved.
TABLE 1 calculated time comparison
Figure BDA0002535343600000122
The above-mentioned serial numbers of the embodiments of the present invention are merely for description and do not represent the merits of the embodiments.
In the above embodiments of the present invention, the descriptions of the respective embodiments have respective emphasis, and for parts that are not described in detail in a certain embodiment, reference may be made to related descriptions of other embodiments.
In the embodiments provided in the present application, it should be understood that the disclosed technology can be implemented in other ways. The above-described embodiments of the apparatus are merely illustrative, and for example, the division of the units may be a logical division, and in actual implementation, there may be another division, for example, multiple units or components may be combined or integrated into another system, or some features may be omitted, or not executed. In addition, the shown or discussed mutual coupling or direct coupling or communication connection may be an indirect coupling or communication connection through some interfaces, units or modules, and may be in an electrical or other form.
The units described as separate parts may or may not be physically separate, and parts displayed as units may or may not be physical units, may be located in one position, or may be distributed on a plurality of units. Some or all of the units can be selected according to actual needs to achieve the purpose of the solution of the embodiment.
Finally, it should be noted that: the above embodiments are only used to illustrate the technical solution of the present invention, and not to limit the same; while the invention has been described in detail and with reference to the foregoing embodiments, it will be understood by those skilled in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some or all of the technical features may be equivalently replaced; and these modifications or substitutions do not depart from the spirit of the corresponding technical solutions of the embodiments of the present invention.

Claims (3)

1. A tender ship synchronous control algorithm with timeliness and stability is characterized in that: the system comprises a terminal state matrix module, a model prediction control module and a neural dynamic optimization module;
for the tracking control problem of the supply ship, a three-degree-of-freedom ship motion model is adopted:
Figure FDA0003719118750000011
wherein eta = [ x, y, psi =] T X represents the transverse displacement of the vessel, y represents the longitudinal displacement of the vessel, ψ represents the yaw angle; upsilon = [ u, v, r] T U represents the forward speed of the vessel, v represents the lateral speed of the vessel, and r represents the yaw rate of the vessel; j (ψ) represents a rotation matrix,
Figure FDA0003719118750000012
the tender vessel is usually operated at low speed, and therefore the dynamic model of the vessel motion is summarized as:
Figure FDA0003719118750000013
in the formula,
Figure FDA0003719118750000014
a matrix of the inertia is represented and,
Figure FDA0003719118750000015
a damping matrix is represented which is,
Figure FDA0003719118750000016
representing the Coriolis and central centripetal force matrix, τ T =[τ u τ v τ r ] T Representing control force and moment; wherein X (·) ,Y (·) ,N (·) All represent hydrodynamic parameters;
the leader ship serves as a reference of a following ship, and a mathematical model of the leader ship is defined as:
Figure FDA0003719118750000017
Figure FDA0003719118750000018
the formula (1) is converted into by coordinate conversion of the formula (1) and the formula (3) by the following formula (4):
Figure FDA0003719118750000021
offset (x) of displacement o ,y o ) In combination with equation (4) above, equation (4) can be converted to:
z 1r =(x r -x o )cosψ r +(y r -y o )sinψ r
z 2r =-(x r -x o )sinψ r +(y r -y o )cosψ r
z 3r =ψ r ; (5)
defining a synchronous control error system for the replenishment of a dynamically positioned vessel as:
Figure FDA0003719118750000022
the formula (6) is obtained by differentiation and linearization:
Figure FDA0003719118750000023
in the formula, x t =y t =[z 1e z 2e z 3e u e v e r e ] T
Figure FDA0003719118750000024
Wherein,
Figure FDA0003719118750000025
d 11 =-X u ,d 22 =-Y v ,d 33 =-N r
by actually giving a suitable sampling time, said equation (8) is converted into a discrete form:
x(k+1)=Ax(k)+Bτ(k); (9)
wherein x, y ∈ R 6×1 ,A∈R 6×6 ,B∈R 6×3 K represents a sampling time point, A and B represent a dispersed system parameter matrix;
the closed loop stability of the control system is guaranteed through a secondary terminal cost function, in a terminal cost function module, a linear state feedback law is firstly designed for the control system:
τ=Kx; (10)
wherein K represents a vector of control gains; the state matrix P of the terminal cost function is obtained by solving the Lyapunov equation, namely the formula (11):
(A k +κI) T P+P(A k +κI)=-(Q lq +K T R lq K); (11)
in the formula, A k =A+BK,Q lq And R lq A weight matrix representing the output and input, κ being selected by equation (12):
κ<-λ max (A k ); (12)
A k the real part of all eigenvalues of + kappa I are negative values, where lambda is max (A k ) Is represented by A k Maximum eigenvalue of the real part.
2. The tender vessel synchronization control algorithm with timeliness and stability of claim 1, wherein:
in the prediction control module of the supply ship model, a prediction time domain is defined as N p Control time domain as N c In the prediction calculation process, it is assumed that:
τ(k+N c )=τ(k+N c +1)=...=τ(k+N c +N p );
the future state information of the system can be calculated sequentially by a certain prediction model x (k + 1) = Ax (k) + B τ (k):
Figure FDA0003719118750000031
wherein x (k + i | k) i =1,2 p Represents future state information x (k + i) i =1,2, N, predicted from the state information at the sampling time point k p
According to the above formula (13), the following definitions are made:
Figure FDA0003719118750000041
rewriting the above formula (13) into a matrix form as shown in formula (15):
X=Fx(k)+ΦΓ; (15)
in the formula,
Figure FDA0003719118750000042
then, the synchronous multivariable control problem of the supply ship is converted into an optimal control problem with terminal cost:
Figure FDA0003719118750000043
the constraint conditions are as follows:
Γ min ≤Γ≤Γ max ; (17)
in the formula, Q mpc And R mpc Is an output weight matrix and an input weight matrix,
Figure FDA0003719118750000044
is the terminal cost, X p Is the terminal state of X, P is the terminal generation determined by equation (11)A state matrix of the cost function.
3. The tender vessel synchronization control algorithm with timeliness and stability of claim 1, wherein:
in the neural dynamic optimization system module, the proposed algorithm has timeliness through a parallel computing architecture of a recurrent neural network; in the neural dynamic optimization system module, substituting equation (15) into equation (16) yields:
Figure FDA0003719118750000045
by definition
Figure FDA0003719118750000051
Equation (18) is simplified to:
J=Γ T HΓ+WΓ+ξ; (20)
the method comprises the following steps of (1) iteratively solving an objective function, namely the formula (20), by establishing a neural dynamic optimization system, namely the formula (21), so that the calculation speed is accelerated:
Figure FDA0003719118750000052
where, θ is the convergence speed,Ω(Γ)is taken as
Figure FDA0003719118750000053
P Ω Is a projection operator, which is a function of the projection operator,
Figure FDA0003719118750000054
CN202010530817.5A 2020-06-11 2020-06-11 Supply ship synchronous control algorithm with timeliness and stability Active CN111665719B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010530817.5A CN111665719B (en) 2020-06-11 2020-06-11 Supply ship synchronous control algorithm with timeliness and stability

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010530817.5A CN111665719B (en) 2020-06-11 2020-06-11 Supply ship synchronous control algorithm with timeliness and stability

Publications (2)

Publication Number Publication Date
CN111665719A CN111665719A (en) 2020-09-15
CN111665719B true CN111665719B (en) 2022-11-22

Family

ID=72386574

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010530817.5A Active CN111665719B (en) 2020-06-11 2020-06-11 Supply ship synchronous control algorithm with timeliness and stability

Country Status (1)

Country Link
CN (1) CN111665719B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112068440B (en) * 2020-09-18 2022-12-02 江苏科技大学 AUV recovery butt joint power positioning control method based on model prediction control

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107544500A (en) * 2017-09-18 2018-01-05 哈尔滨工程大学 A kind of unmanned boat berthing action trail planing method for considering constraint
CN108828955A (en) * 2018-08-16 2018-11-16 大连海事大学 Accurate Track In Track control method based on finite time extended state observer
CN109116731A (en) * 2018-07-27 2019-01-01 北京理工大学 A kind of data-driven method for optimally controlling switching linear system
CN109521797A (en) * 2018-12-28 2019-03-26 西北工业大学 The optimization mowing type formation control method of unmanned boat guidance submarine navigation device group
CN109656143A (en) * 2019-02-25 2019-04-19 曲阜师范大学 A kind of sea drives the adaptive tracking control method and system of ship entirely
CN110161853A (en) * 2019-05-09 2019-08-23 大连海事大学 A kind of novel ship craft integrated automated driving system with real-time
CN110879531A (en) * 2019-11-22 2020-03-13 北京理工大学重庆创新中心 Data-driven self-adaptive optimization control method and medium for random disturbance system

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107544500A (en) * 2017-09-18 2018-01-05 哈尔滨工程大学 A kind of unmanned boat berthing action trail planing method for considering constraint
CN109116731A (en) * 2018-07-27 2019-01-01 北京理工大学 A kind of data-driven method for optimally controlling switching linear system
CN108828955A (en) * 2018-08-16 2018-11-16 大连海事大学 Accurate Track In Track control method based on finite time extended state observer
CN109521797A (en) * 2018-12-28 2019-03-26 西北工业大学 The optimization mowing type formation control method of unmanned boat guidance submarine navigation device group
CN109656143A (en) * 2019-02-25 2019-04-19 曲阜师范大学 A kind of sea drives the adaptive tracking control method and system of ship entirely
CN110161853A (en) * 2019-05-09 2019-08-23 大连海事大学 A kind of novel ship craft integrated automated driving system with real-time
CN110879531A (en) * 2019-11-22 2020-03-13 北京理工大学重庆创新中心 Data-driven self-adaptive optimization control method and medium for random disturbance system

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
《船舶路径跟踪与减横摇综合控制研究》;刘程;《万方学位论文》;20170104;第1-167页 *

Also Published As

Publication number Publication date
CN111665719A (en) 2020-09-15

Similar Documents

Publication Publication Date Title
Witkowska et al. Adaptive dynamic control allocation for dynamic positioning of marine vessel based on backstepping method and sequential quadratic programming
Huang et al. Double-loop sliding mode controller with a novel switching term for the trajectory tracking of work-class ROVs
CN108319140B (en) Redefined output type model-free self-adaptive course control method and system
CN111007854B (en) Under-actuated ship trajectory tracking control system
CN110618686A (en) Unmanned ship track control method based on explicit model predictive control
Shen et al. Dynamic surface control for tracking of unmanned surface vessel with prescribed performance and asymmetric time-varying full state constraints
CN112034858B (en) Model-free adaptive heading control method fusing weak observation high-order output data
Yang et al. A recurrent neural network based fuzzy sliding mode control for 4-DOF ROV movements
Zhu et al. A bio-inspired neurodynamics-based backstepping path-following control of an AUV with ocean current
CN111665719B (en) Supply ship synchronous control algorithm with timeliness and stability
CN110161853A (en) A kind of novel ship craft integrated automated driving system with real-time
Meng et al. Distributed leaderless formation control for multiple autonomous underwater vehicles based on adaptive nonsingular terminal sliding mode
CN115113524B (en) ASV multiport event trigger path tracking control method based on intervention LVS guidance
CN111506080A (en) Comprehensive ship path tracking and rudder stabilization control method based on neural network optimization
Fu et al. Formation control for water-jet USV based on bio-inspired method
Zhu et al. Adaptive neural network fixed-time sliding mode control for trajectory tracking of underwater vehicle
Witkowska et al. Adaptive backstepping tracking control for an over–actuated DP marine vessel with inertia uncertainties
CN110109357B (en) Semi-global self-adaptive control method for non-standard type non-linear aircraft
CN117032209A (en) Robust self-adaptive neural network control method for under-actuated ship
Xiang et al. Coordinated 3D path following for autonomous underwater vehicles via classic PID controller
Rodriguez et al. Adaptive takeoff maneuver optimization of a sailing boat for America’s cup
CN116449829A (en) Ship formation system switching control method based on two-degree-of-freedom LQR
Sun et al. Distributed anti-windup NN-sliding mode formation control of multi-ships with minimum cost
Wang et al. Game-based distributed optimal formation tracking control of underactuated AUVs based on reinforcement learning
Xu et al. Model-free finite-time formation containment control of underactuated UUVs subject to input delays and unknown interaction information

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