CN112256026A - Ship course model predictive control algorithm design method under multi-constraint condition - Google Patents
Ship course model predictive control algorithm design method under multi-constraint condition Download PDFInfo
- Publication number
- CN112256026A CN112256026A CN202011098643.6A CN202011098643A CN112256026A CN 112256026 A CN112256026 A CN 112256026A CN 202011098643 A CN202011098643 A CN 202011098643A CN 112256026 A CN112256026 A CN 112256026A
- Authority
- CN
- China
- Prior art keywords
- ship
- equation
- follows
- constraint
- model
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 42
- 230000008569 process Effects 0.000 claims abstract description 21
- 238000005457 optimization Methods 0.000 claims abstract description 17
- 238000004088 simulation Methods 0.000 claims abstract description 16
- 239000011159 matrix material Substances 0.000 claims description 45
- 238000005070 sampling Methods 0.000 claims description 7
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 238000005096 rolling process Methods 0.000 claims description 6
- 238000006073 displacement reaction Methods 0.000 claims description 5
- 239000006185 dispersion Substances 0.000 claims description 3
- 230000004044 response Effects 0.000 claims description 3
- 229920006395 saturated elastomer Polymers 0.000 claims 1
- 230000002040 relaxant effect Effects 0.000 abstract description 2
- 101150080778 INPP5D gene Proteins 0.000 description 54
- 230000009471 action Effects 0.000 description 4
- 230000008859 change Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 101150036841 minJ gene Proteins 0.000 description 2
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses a design method of a ship course model predictive control algorithm under a multi-constraint condition, which comprises the following steps: establishing a ship low-noise motion control simulation model; designing a course model prediction controller of the ship according to the ship motion control simulation model and establishing a control objective function for the model prediction controller; determining hard constraint conditions such as rudder angle and rudder speed of a rudder according to a control objective function and actual operation requirements of a ship, and processing the hard constraint conditions; properly relaxing the course deviation aiming at the control objective function to form a soft constraint condition, and processing the soft constraint condition; and according to the control objective function, the hard constraint condition and the soft constraint condition, performing online optimization to obtain the optimal controller output. The invention effectively solves the problem of noise of the steering device caused by frequent steering of the ship in the maneuvering process, and ensures stable and low-noise navigation of the ship.
Description
Technical Field
The invention relates to the technical field of ship motion control, in particular to a ship course model predictive control algorithm design method under a multi-constraint condition.
Background
For a ship control system, a rudder angle and a rudder speed are important parameters for representing the operation state of a steering engine, and the maneuvering capacity, stability and control quality of a ship are restrained by the maximum rudder angle and the maximum rudder speed; in order to meet the ship steering requirement, the steering angle and the steering speed are determined by the heading speed and the like in the maneuvering process and are directly related to hydrodynamic noise. Under the working condition of low noise, low-frequency manual steering is usually adopted, namely, the steering is carried out at the lowest possible frequency by widening the course during navigation and adopting a smaller steering angle; however, under the low-noise working condition, due to the low navigational speed and poor rudder effect of the ship, the change of the motion state of the ship is difficult to predict effectively for a long time when a crew operates the ship in a follow-up manner.
Therefore, how to realize real-time control of the maneuvering process of the ship under the low-noise sailing condition is a problem to be solved urgently by the technical personnel in the field.
Disclosure of Invention
In view of the above, the invention provides a design method of a ship course model predictive control algorithm under multiple constraint conditions, which can effectively predict the ship motion state change, output control and realize real-time control of the maneuvering process of a ship under a low-noise sailing condition.
In order to achieve the purpose, the invention adopts the following technical scheme:
a ship course model predictive control algorithm design method under multiple constraint conditions comprises the following steps:
step 1: establishing a ship low-noise motion control simulation model;
step 2: establishing a control objective function for the course model prediction controller according to the motion control simulation model;
and step 3: determining a hard constraint condition according to the control objective function and the actual operation requirement of the ship;
and 4, step 4: forming a soft constraint condition according to the control objective function and the allowable course deviation condition; the allowable course deviation condition is that the allowable course control command has a deviation of +/-2 degrees in the target course direction;
and 5: and according to the control objective function, the hard constraint condition and the soft constraint condition, performing online optimization to obtain the output of the optimal course model prediction controller.
Preferably, the motion control simulation model in the step 1 comprises a ship nonlinear motion model and a steering engine model;
the establishment process of the ship nonlinear motion model is as follows:
the ship nonlinear motion model is mainly a ship nonlinear equation, wherein the ship underwater state motion equation comprises an axial force equation, a lateral force equation, a rolling moment equation, a yawing moment equation and an auxiliary equation, which are respectively expressed as follows:
axial force equation:
lateral force equation:
roll moment equation:
yaw moment equation:
auxiliary equation:
wherein m is the ship mass; i isx、IzThe rotational inertia of the ship rotating around the x axis and the z axis respectively; u, v, p and r are respectively the longitudinal speed, the transverse inclination speed and the yaw speed under a ship body coordinate system; phi, phi,Xi and eta are respectively transverse inclination, heading, longitudinal displacement and transverse displacement under a fixed coordinate system; deltarIs the rudder angle of the rudder; the other parameters are standard hydrodynamic derivatives of the international pool conference;
the steering engine model is established as follows:
the ship steering engine servo system has the nonlinear characteristics of dead zones, saturation and the like, and the functional relation between the input and the output of the steering engine is expressed as follows:
wherein deltadThe command input angle of the steering engine is, delta is the actual output angle of the steering engine, and sigma is deltad-δ;σ1、σ2The maximum steering engine speed, the upper limit of the response dead zone and the lower limit of the saturation zone are respectively.
Preferably, the control objective function of the heading model predictive controller of the ship is established as follows:
step 21: linearizing the motion process of the ship to obtain a motion state space model as follows:
step 22: expressing the motion state space model of the ship as follows:
y=Cx;
Step 23: discretizing the motion state space model of the continuous time domain and introducing an increment control form of input quantity to obtain:
and simplifying the above formula to obtain a discrete simplified state space model:
Step 24: predicting the prediction step length of the discrete simplified state space model obtained after the dispersion and simplification, wherein the prediction step length is nyThe control step is set to nuWherein n isu<nyAnd at a time sampling step k>nuAnd meanwhile, considering that the increment of the control input quantity is 0, keeping the input quantity unchanged, and obtaining a state quantity prediction equation:
the output quantity prediction equation is as follows:
and summarizing the state quantity prediction equation and the output quantity prediction equation to obtain:
step 25: introducing an error d (k) between the single-step predicted output quantity and the actual output measured value at the current moment, and obtaining a state quantity prediction equation and an output quantity prediction equation which are respectively as follows:
the simplified form is:
step 26: obtaining an objective function according to the state quantity prediction equation and the output quantity prediction equation in the step 25 as follows:
whereinFor a preset reference track, Q is a weight matrix of an output error, R is a weight matrix of an input quantity, and the specific forms are respectively as follows:
Q=diag(q1,…qny)
R=diag(r1,…rnc);
step 27: substituting the output quantity prediction equation into the objective function to obtain the control objective function:
preferably, the hard constraints include rudder angle, rudder speed, and the like, and the hard constraints are established and processed as follows:
step 31: the hard constraints, which are mainly the rudder speed Δ u and rudder angle u of the steering engine, can be mathematically expressed as:
umin<u<umax
Δumin<Δu<Δumaxwherein u ismin,umaxRespectively representing the minimum value and the maximum value of the rudder angle u; Δ umin,ΔumaxRespectively represent the minimum value and the maximum value of the rudder speed Deltau;
step 32: because the input quantity of the rudder angle is in the whole control step lengthAre limited by the magnitude of the rudder speed, the upper and lower bounds defining the rudder speed being denoted by Δ, respectivelyuAndthe constraint relation of rudder speed amplitude limiting in the prediction process is as follows:
the conversion into a matrix is in the form:
step 33: because the rudder angle input quantity is limited by the rudder angle amplitude in the whole control step length, the upper limit and the lower limit for defining the rudder angle are respectively expressed asuAndthe constraint relation of rudder angle amplitude limiting in the prediction process is as follows:
the above equation is expressed in the form of the constraint of rudder speed, and the result is:
Further conversion into matrix form:
preferably, the soft constraint condition includes an output variable constraint, an intermediate state variable constraint, and the like, and the soft constraint condition is established and processed as follows:
introducing a reference track constraint method to make the reference trackIs rewritten intoThe matrix M is used for changing a reference track into a vector which is the same as the prediction step length, alpha is the reference track to be solved, and the matrix M meets the following soft constraint processing conditions:
kxis the lower limit of the state variable constraint interval,is the upper limit of the state variable constraint interval;
kyis the lower limit of the output variable constraint interval,the upper limit of the interval is constrained for the output variables.
Preferably, the specific steps of obtaining the output of the controller are as follows:
step 51: processing the reference track in the soft constraint processing conditionSubstituting into the objective function to obtain:
wherein Q is the weight matrix of the output error, and k is a time sampling step length; ignoring constant terms in the control objective function, and sorting to obtain a final objective function form as follows:
J=cTSc+2fTc
wherein:
step 52: combining the hard constraint condition and the soft constraint condition, combining a matrix expression form of the rudder angle constraint condition, a matrix expression form of the rudder speed constraint condition and a constraint expression form of the soft constraint condition into a matrix to obtain expression forms of all the constraint conditions:
wherein:
Io=[I(n×nu)×(n×nu) 0(n×nu)×(m×ny+m×ny)](n×nu)×(n×nu+m×ny+m×ny)
Mo=[0(m×ny)×(n×nu) I(m×ny)×(m×ny) 0(m×ny)×(m×ny)](m×ny)×(n×nu+m×ny+m×ny)
Co=[CI/Δ(n×nu)×(n×nu) 0(n×nu)×(m×ny+m×ny)](n×nu)×(n×nu+m×ny+m×ny)
Aeq=[I(n×nu)×(n×nu) 0(n×nu)×(m×ny+m×ny)](n×nu)×(n×nu+m×ny+m×ny)
n is the dimension of the output variable, m is the dimension of the input variable;
step 53: generalizing said final objective function form and said all constraint forms:
minJ=cTSc+2fTc
s.t.CCx≤dmax
wherein S is a symmetric positive definite matrix, c is an optimization variable, the objective function optimization problem forms a standard quadratic programming problem, the final objective function is optimized and solved by applying a quadprog quadratic programming solving function to obtain the optimal control input sequence at the current moment,
step 54: and (4) performing predictive control output on the rolling optimization ship course model, only taking the first row of the optimal control input sequence at the current moment as the output value of the controller at the current moment, returning to the step 53 at the next moment, and repeating optimization.
Compared with the prior art, the invention discloses a ship course model predictive control algorithm design method under the multi-constraint condition, which comprises the following steps: establishing a ship low-noise motion control simulation model; designing a course model prediction controller of the ship according to the ship motion control simulation model and establishing a control objective function for the model prediction controller; determining hard constraint conditions such as rudder angle and rudder speed of a rudder according to a control objective function and actual operation requirements of a ship, and processing the hard constraint conditions; properly relaxing the course deviation aiming at the control objective function to form a soft constraint condition, and processing the soft constraint condition; and according to the control objective function, the hard constraint condition and the soft constraint condition, performing online optimization to obtain the optimal controller output. The invention effectively solves the problem of noise of the steering device caused by frequent steering of the ship in the maneuvering process, and ensures stable and low-noise navigation of the ship.
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 description of the embodiments or the prior art will be briefly described below, it is obvious that the drawings in the following description are only embodiments of the present invention, and for those skilled in the art, other drawings can be obtained according to the provided drawings without creative efforts.
FIG. 1 is a flow chart of a design of a ship course model predictive control algorithm provided by the invention;
FIG. 2 is a block diagram of a steering engine model according to the present invention;
FIG. 3 is a graph of course curves under the action of a course model predictive controller under an automatic direction change condition according to the present invention;
FIG. 4 is a plot of rudder angle of a rudder under the action of a heading model predictive controller under an automatic turning condition, provided by the invention;
FIG. 5 is a graph showing a course curve under the action of a PID controller under an automatic turning condition according to the invention;
FIG. 6 is a rudder angle curve diagram of a rudder under the action of a PID controller under the automatic turning condition provided by the invention.
Detailed Description
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.
The embodiment of the invention discloses a design method of a ship course model predictive control algorithm under a multi-constraint condition, which comprises the following steps:
s1: establishing a ship low-noise motion control simulation model; the motion control simulation model comprises a ship nonlinear motion model and a steering engine model;
s11: the establishment process of the ship nonlinear motion model is as follows:
the ship nonlinear motion model is mainly a ship nonlinear equation, wherein the ship underwater state motion equation comprises an axial force equation, a lateral force equation, a rolling moment equation, a yawing moment equation and an auxiliary equation, which are respectively expressed as follows:
axial force equation:
lateral force equation:
roll moment equation:
yaw moment equation:
auxiliary equation:
wherein m is the ship mass; i isx、IzThe rotational inertia of the ship rotating around the x axis and the z axis respectively; u, v, p and r are respectively the longitudinal speed, the transverse inclination speed and the yaw speed under a ship body coordinate system; phi, phi,Xi and eta are respectively transverse inclination, heading and longitudinal displacement under a fixed coordinate systemAnd transversely displacing; deltarIs the rudder angle of the rudder; the other parameters are standard hydrodynamic derivatives of the international pool conference;
s12: the steering engine model is established as follows:
the ship steering engine servo system has the nonlinear characteristics of dead zones, saturation and the like, and a structural block diagram for establishing a steering engine model is shown in FIG. 2:
the functional relationship between the steering engine input and output is expressed as follows:
wherein deltadThe command input angle of the steering engine is, delta is the actual output angle of the steering engine, and sigma is deltad-δ;σ1、σ2The maximum steering engine speed, the upper limit of the response dead zone and the lower limit of the saturation zone are respectively;
s2: constructing a course model prediction controller of the ship according to the motion control simulation model, and establishing a control objective function for the course model prediction controller; the control objective function establishment process is as follows:
s21: linearizing the motion process of the ship to obtain a motion state space model as follows:
s22: the motion state space model of the ship is expressed as follows:
y=Cx;
S23: discretizing the motion state space model of the continuous time domain and introducing an increment control form of input quantity to obtain:
and simplifying the above formula to obtain a discrete simplified state space model:
S24: predicting the prediction step length of the discrete simplified state space model obtained after the dispersion and simplification, wherein the prediction step length is nyThe control step is set to nuWherein n isu<nyAnd at a time sampling step k>nuAnd meanwhile, considering that the increment of the control input quantity is 0, keeping the input quantity unchanged, and obtaining a state quantity prediction equation:
the output quantity prediction equation is as follows:
and (3) summarizing the state quantity prediction equation and the output quantity prediction equation to obtain:
s25: introducing an error d (k) between the single-step predicted output quantity and the actual output measured value at the current moment to obtain a state quantity prediction equation and an output quantity prediction equation which are respectively as follows:
the simplified form is:
s26: the objective function is obtained from the state quantity prediction equation and the output quantity prediction equation in S25 as follows:
whereinFor a preset reference track, Q is a weight matrix of an output error, R is a weight matrix of an input quantity, and the specific forms are respectively as follows:
Q=diag(q1,…qny)
R=diag(r1,…rnc);
s27: substituting the output quantity prediction equation into the objective function to obtain a control objective function:
s3: determining a hard constraint condition according to the control objective function and the actual operation requirement of the ship, and processing the hard constraint condition; the hard constraint conditions comprise a rudder angle, a rudder speed and the like of a rudder, and the hard constraint conditions are established and processed as follows:
s31: the rudder speed Δ u and rudder angle u of the steering engine as main hard constraints can be mathematically expressed as:
umin<u<umax
Δumin<Δu<Δumaxwherein u ismin,umaxRespectively representing the minimum value and the maximum value of the rudder angle u; Δ umin,ΔumaxRespectively represent the minimum value and the maximum value of the rudder speed Deltau;
s32: because the rudder angle input quantity is limited by the rudder speed amplitude in the whole control step length, the upper bound and the lower bound of the rudder speed are defined and respectively expressed as deltauAndthe constraint relation of rudder speed amplitude limiting in the prediction process is as follows:
the conversion into a matrix is in the form:
s33: because the rudder angle input quantity is limited by the rudder angle amplitude in the whole control step length, the upper limit and the lower limit for defining the rudder angle are respectively expressed asuAndthe constraint relation of rudder angle amplitude limiting in the prediction process is as follows:
the above equation is expressed in the form of the constraint of rudder speed, and the result is:
Further conversion into matrix form:
s4: forming a soft constraint condition according to the control objective function and the allowable course deviation condition, and processing the soft constraint condition; the allowable course deviation condition is that the allowable course control command has a deviation of +/-2 degrees in the target course direction; the soft constraint conditions comprise output variable constraints, intermediate state variable constraints and the like, and the establishment and processing processes of the soft constraint conditions are as follows:
introducing a reference track constraint method to make the reference trackIs rewritten intoThe matrix M is used for changing the reference track into a vector which is the same as the prediction step length, alpha is the reference track to be solved, and the matrix M meets the following soft constraint processing conditions:
kxis the lower limit of the state variable constraint interval,is the upper limit of the state variable constraint interval;
kyis the lower limit of the output variable constraint interval,an upper limit of the output variable constraint interval;
s5: according to the target function, the hard constraint condition and the soft constraint condition, performing online optimization to obtain the output of an optimal course model prediction controller;
s51: processing reference track in soft constraint conditionSubstituting into the objective function yields:
wherein Q is a weight matrix of the output error, and k is a time sampling step length; neglecting constant terms in the control objective function, and obtaining a final objective function form by sorting:
J=cTSc+2fTc
wherein:
s52: combining the hard constraint condition and the soft constraint condition, combining the matrix expression form of the rudder angle constraint condition, the matrix expression form of the rudder speed constraint condition and the constraint expression form of the soft constraint condition into a matrix to obtain the expression forms of all the constraint conditions:
wherein:
Io=[I(n×nu)×(n×nu) 0(n×nu)×(m×ny+m×ny)](n×nu)×(n×nu+m×ny+m×ny)
Mo=[0(m×ny)×(n×nu) I(m×ny)×(m×ny) 0(m×ny)×(m×ny)](m×ny)×(n×nu+m×ny+m×ny)
Co=[CI/Δ(n×nu)×(n×nu) 0(n×nu)×(m×ny+m×ny)](n×nu)×(n×nu+m×ny+m×ny)
Aeq=[I(n×nu)×(n×nu) 0(n×nu)×(m×ny+m×ny)](n×nu)×(n×nu+m×ny+m×ny)
n is the dimension of the output variable, m is the dimension of the input variable;
s53: generalizing the final objective function form and all constraint forms:
minJ=cTSc+2fTc
s.t.CCx≤dmax
the optimization method comprises the following steps that S is a symmetric positive definite matrix, c is an optimization variable, an objective function optimization problem forms a standard quadratic programming problem, and optimization solving can be carried out by applying a quadprog quadratic programming solving function to obtain an optimal control input sequence at the current moment;
s54: according to the idea of a rolling optimization ship course model predictive control algorithm, only the first row of an optimal control input sequence is used as the output value of a controller at the current time, and the process is repeated at the next time.
Examples
Taking a certain ship motion control system as an example, the heading model prediction controller parameter values are as follows: n isy=35,nu=15,Q=0.2Iny×ny,R=20Inu×nuThe amplitude of the rudder angle of the rudder is set to 10 degrees, the amplitude of the rudder speed is limited to 1.5 degrees/s under the condition of adding state quantity constraint, the initial course is 30 degrees, the target course is 60 degrees, the initial speed is set to 8kn, the simulation sampling time is set to 0.1s, the course deviation is widened by 2 degrees, the simulation result is shown in figures 3 and 4, the control effect under the PID control algorithm under the same simulation condition is shown in figures 5 and 6, the horizontal coordinate represents time, and the vertical coordinate represents the change angle.
The embodiments in the present description are described in a progressive manner, each embodiment focuses on differences from other embodiments, and the same and similar parts among the embodiments are referred to each other. The device disclosed by the embodiment corresponds to the method disclosed by the embodiment, so that the description is simple, and the relevant points can be referred to the method part for description.
The previous description of the disclosed embodiments is provided to enable any person skilled in the art to make or use the present invention. Various modifications to these embodiments will be readily apparent to those skilled in the art, and the generic principles defined herein may be applied to other embodiments without departing from the spirit or scope of the invention. Thus, the present invention is not intended to be limited to the embodiments shown herein but is to be accorded the widest scope consistent with the principles and novel features disclosed herein.
Claims (6)
1. A ship course model predictive control algorithm design method under multiple constraint conditions is characterized by comprising the following steps:
step 1: establishing a ship low-noise motion control simulation model;
step 2: establishing a control objective function for the course model prediction controller according to the motion control simulation model;
and step 3: determining a hard constraint condition according to the control objective function and the actual operation requirement of the ship;
and 4, step 4: forming a soft constraint condition according to the control objective function and the allowable course deviation condition;
and 5: and according to the control objective function, the hard constraint condition and the soft constraint condition, performing online optimization to obtain the output of the optimal course model prediction controller.
2. The design method of the ship heading model predictive control algorithm under the multi-constraint condition as claimed in claim 1, wherein the motion control simulation model in the step 1 comprises a ship nonlinear motion model and a steering engine model;
step 11: the establishment process of the ship nonlinear motion model is as follows:
the ship nonlinear motion model is a ship nonlinear equation, wherein the ship underwater state motion equation comprises an axial force equation, a lateral force equation, a rolling moment equation, a yawing moment equation and an auxiliary equation, which are respectively expressed as follows:
axial force equation:
lateral force equation:
roll moment equation:
yaw moment equation:
auxiliary equation:
wherein m is the ship mass; i isx、IzThe rotational inertia of the ship rotating around the x axis and the z axis respectively; u, v, p and r are respectively the longitudinal speed, the transverse inclination speed and the yaw speed under a ship body coordinate system; phi, phi,Xi and eta are respectively transverse inclination, heading, longitudinal displacement and transverse displacement under a fixed coordinate system; deltarIs the rudder angle of the rudder; the other parameter is the standard hydrodynamic derivative of the international pool conference.
Step 12: the steering engine model is established as follows:
the ship steering engine servo system has dead zone and saturated nonlinear characteristics, and the functional relation between the input and the output of the steering engine is expressed as follows:
3. The method for designing the ship heading model predictive control algorithm under the multi-constraint condition as recited in claim 2, wherein the control objective function establishing process of the heading model predictive controller of the ship in the step 2 is as follows:
step 21: linearizing the motion process of the ship to obtain a motion state space model as follows:
step 22: expressing the motion state space model of the ship as follows:
y=Cx;
Step 23: discretizing the motion state space model of the continuous time domain and introducing an increment control form of input quantity to obtain:
and simplifying to obtain a discrete simplified state space model:
Step 24: predicting the prediction step length of the discrete simplified state space model obtained after the dispersion and simplification, wherein the prediction step length is nyThe control step is set to nuWherein n isu<nyAnd at a time sampling step k>nuAnd meanwhile, considering that the increment of the control input quantity is 0, keeping the input quantity unchanged, and obtaining a state quantity prediction equation:
the output quantity prediction equation is as follows:
and summarizing the state quantity prediction equation and the output quantity prediction equation to obtain:
step 25: introducing an error d (k) between the single-step predicted output quantity and the actual output measured value at the current moment, and obtaining a state quantity prediction equation and an output quantity prediction equation which are respectively as follows:
the method is simplified as follows:
step 26: obtaining an objective function according to the state quantity prediction equation and the output quantity prediction equation in the step 25 as follows:
whereinFor a preset reference track, Q is a weight matrix of an output error, R is a weight matrix of an input quantity, and the specific forms are respectively as follows:
step 27: substituting the output quantity prediction equation into the objective function to obtain the control objective function:
4. the design method of the ship heading model predictive control algorithm under the multi-constraint condition as claimed in claim 3, wherein the hard constraint condition comprises a rudder angle and a rudder speed, and the hard constraint condition is established and processed as follows:
step 31: taking the rudder speed delta u and the rudder angle u of the steering engine as the hard constraint conditions, the rudder speed delta u and the rudder angle u are expressed as follows:
umin<u<umax
Δumin<Δu<Δumaxwherein u ismin,umaxRespectively representing the minimum value and the maximum value of the rudder angle u; Δ umin,ΔumaxRespectively represent the minimum value and the maximum value of the rudder speed Deltau;
step 32: the upper and lower bounds for the set rudder speed are denoted by Δ, respectivelyuAndthe constraint relation of rudder speed amplitude limiting in the prediction process is as follows:
the conversion into a matrix is in the form:
step 33: the upper and lower limits of the rudder angle are respectively indicated asuAndthe constraint relation of rudder angle amplitude limiting in the prediction process is as follows:
the above equation is expressed in the form of the constraint of rudder speed, and the result is:
The conversion into a matrix is in the form:
5. the method for designing the ship heading model predictive control algorithm under the multi-constraint condition as claimed in claim 4, wherein the allowable heading deviation condition is a deviation of the allowable heading control command in a target heading direction by ± 2 °, the soft constraint condition comprises an output variable constraint and an intermediate state variable constraint, and the soft constraint condition is established and processed as follows:
introducing a reference track constraint method to make the reference trackIs rewritten intoThe matrix M is used for changing a reference track into a vector which is the same as the prediction step length, alpha is the reference track to be solved, and the matrix M meets the following soft constraint processing conditions:
kxis the lower limit of the state variable constraint interval,is the upper limit of the state variable constraint interval;
6. The design method of the ship heading model predictive control algorithm under the multi-constraint condition as claimed in claim 5, wherein the concrete steps of obtaining the controller output are as follows:
step 51: processing the reference track in the soft constraint processing conditionSubstituting into the objective function to obtain:
wherein Q is the weight matrix of the output error, and k is a time sampling step length; ignoring constant terms in the control objective function, and sorting to obtain a final objective function form as follows:
J=cTSc+2fTc
wherein:
step 52: combining the hard constraint conditions and the soft constraint conditions to obtain expression forms of all constraint conditions:
wherein:
Io=[I(n×nu)×(n×nu) 0(n×nu)×(m×ny+m×ny)](n×nu)×(n×nu+m×ny+m×ny)
Mo=[0(m×ny)×(n×nu) I(m×ny)×(m×ny) 0(m×ny)×(m×ny)](m×ny)×(n×nu+m×ny+m×ny)
Co=[CI/Δ(n×nu)×(n×nu) 0(n×nu)×(m×ny+m×ny)](n×nu)×(n×nu+m×ny+m×ny)
Aeq=[I(n×nu)×(n×nu) 0(n×nu)×(m×ny+m×ny)](n×nu)×(n×nu+m×ny+m×ny)
n is the dimension of the output variable, m is the dimension of the input variable;
step 53: generalizing said final objective function form and said all constraint forms:
min J=cTSc+2fTc
s.t.CCx≤dmax
wherein S is a symmetric positive definite matrix, c is an optimization variable, the final objective function is optimized by applying a quadprog quadratic programming solving function, the optimal control input sequence at the current moment is obtained by solving,
step 54: and (4) performing predictive control output on the rolling optimization ship course model, only taking the first row of the optimal control input sequence at the current moment as the output value of the controller at the current moment, returning to the step 53 at the next moment, and repeating optimization.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011098643.6A CN112256026B (en) | 2020-10-14 | 2020-10-14 | Ship course model predictive control algorithm design method under multi-constraint condition |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011098643.6A CN112256026B (en) | 2020-10-14 | 2020-10-14 | Ship course model predictive control algorithm design method under multi-constraint condition |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112256026A true CN112256026A (en) | 2021-01-22 |
CN112256026B CN112256026B (en) | 2022-11-29 |
Family
ID=74243437
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011098643.6A Active CN112256026B (en) | 2020-10-14 | 2020-10-14 | Ship course model predictive control algorithm design method under multi-constraint condition |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112256026B (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113110468A (en) * | 2021-04-22 | 2021-07-13 | 中国船舶重工集团公司第七0七研究所九江分部 | Control method applied to autonomous berthing of under-actuated double-paddle double-rudder ship |
CN113359446A (en) * | 2021-06-02 | 2021-09-07 | 武汉理工大学 | Nonlinear ship course control model and control system |
CN118092199A (en) * | 2024-04-28 | 2024-05-28 | 陕西明泰电子科技发展有限公司 | Prediction method for dynamic response time of steering engine |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150286220A1 (en) * | 2014-04-04 | 2015-10-08 | Sikorsky Aircraft Corporation | Rotorcraft control laws for sea-based operations |
CN105068422A (en) * | 2015-07-17 | 2015-11-18 | 燕山大学 | MPC method based on triangular interval constraints |
CN106444370A (en) * | 2016-06-22 | 2017-02-22 | 上海振华重工集团(南通)传动机械有限公司 | Prediction control algorithm based on motion linear model and area performance index |
CN108445762A (en) * | 2018-03-21 | 2018-08-24 | 青岛科技大学 | Power positioning control method based on UKF filtering and Constrained Model Predictive Control |
CN109766569A (en) * | 2018-11-23 | 2019-05-17 | 中国船舶重工集团公司第七一九研究所 | Submarine movement Model Simplification Method and device |
CN110162039A (en) * | 2019-05-09 | 2019-08-23 | 大连海事大学 | A kind of novel integrated ship path trace and rollstabilization optimal control method |
CN110827616A (en) * | 2019-11-21 | 2020-02-21 | 中国人民解放军海军工程大学 | Submarine steering and balance control simulation test platform and method |
CN110990504A (en) * | 2019-11-14 | 2020-04-10 | 中国船舶重工集团公司第七0七研究所 | Ship track compression method based on course and speed change rate |
CN111427356A (en) * | 2020-04-13 | 2020-07-17 | 华中科技大学 | Ship course interval control method and system |
-
2020
- 2020-10-14 CN CN202011098643.6A patent/CN112256026B/en active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150286220A1 (en) * | 2014-04-04 | 2015-10-08 | Sikorsky Aircraft Corporation | Rotorcraft control laws for sea-based operations |
CN105068422A (en) * | 2015-07-17 | 2015-11-18 | 燕山大学 | MPC method based on triangular interval constraints |
CN106444370A (en) * | 2016-06-22 | 2017-02-22 | 上海振华重工集团(南通)传动机械有限公司 | Prediction control algorithm based on motion linear model and area performance index |
CN108445762A (en) * | 2018-03-21 | 2018-08-24 | 青岛科技大学 | Power positioning control method based on UKF filtering and Constrained Model Predictive Control |
CN109766569A (en) * | 2018-11-23 | 2019-05-17 | 中国船舶重工集团公司第七一九研究所 | Submarine movement Model Simplification Method and device |
CN110162039A (en) * | 2019-05-09 | 2019-08-23 | 大连海事大学 | A kind of novel integrated ship path trace and rollstabilization optimal control method |
CN110990504A (en) * | 2019-11-14 | 2020-04-10 | 中国船舶重工集团公司第七0七研究所 | Ship track compression method based on course and speed change rate |
CN110827616A (en) * | 2019-11-21 | 2020-02-21 | 中国人民解放军海军工程大学 | Submarine steering and balance control simulation test platform and method |
CN111427356A (en) * | 2020-04-13 | 2020-07-17 | 华中科技大学 | Ship course interval control method and system |
Non-Patent Citations (7)
Title |
---|
YONGDINGZHANG等: "MPC-based 3-D trajectory tracking for an autonomous underwater vehicle with constraints in complex ocean environments", 《OCEAN ENGINEERING》 * |
刘菊等: "基于EKF的船舶模型预测动力定位导引控制器设计", 《造船技术》 * |
张子昌,等: "基于模型预测控制的潜艇水平面航迹控制算法", 《中国舰船研究》 * |
张扬等: "船舶柴油机SCR***尿素喷射控制仿真", 《船舶工程》 * |
张焕清等: "一种AUV发射体发射操纵模型的简化方法", 《武汉理工大学学报(交通科学与工程版)》 * |
柳晨光: "基于预测控制的无人船运动控制方法研究", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 * |
牟鹏程: "水面无人船轨迹跟踪控制方法研究", 《中国优秀硕士论文全文数据库 工程科技Ⅱ辑》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113110468A (en) * | 2021-04-22 | 2021-07-13 | 中国船舶重工集团公司第七0七研究所九江分部 | Control method applied to autonomous berthing of under-actuated double-paddle double-rudder ship |
CN113110468B (en) * | 2021-04-22 | 2022-07-26 | 中国船舶重工集团公司第七0七研究所九江分部 | Control method applied to autonomous berthing of under-actuated double-paddle double-rudder ship |
CN113359446A (en) * | 2021-06-02 | 2021-09-07 | 武汉理工大学 | Nonlinear ship course control model and control system |
CN113359446B (en) * | 2021-06-02 | 2022-06-17 | 武汉理工大学 | Nonlinear ship course control method and system |
CN118092199A (en) * | 2024-04-28 | 2024-05-28 | 陕西明泰电子科技发展有限公司 | Prediction method for dynamic response time of steering engine |
CN118092199B (en) * | 2024-04-28 | 2024-07-19 | 陕西明泰电子科技发展有限公司 | Prediction method for dynamic response time of steering engine |
Also Published As
Publication number | Publication date |
---|---|
CN112256026B (en) | 2022-11-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112256026B (en) | Ship course model predictive control algorithm design method under multi-constraint condition | |
Elmokadem et al. | Terminal sliding mode control for the trajectory tracking of underactuated Autonomous Underwater Vehicles | |
Zhang et al. | Robust model predictive control for path-following of underactuated surface vessels with roll constraints | |
Cui et al. | Adaptive sliding-mode attitude control for autonomous underwater vehicles with input nonlinearities | |
Falcone et al. | Linear time‐varying model predictive control and its application to active steering systems: Stability analysis and experimental validation | |
Qian et al. | Switching logic-based nonlinear feedback control of offshore ship-mounted tower cranes: A disturbance observer-based approach | |
Min et al. | Concise robust fuzzy nonlinear feedback track keeping control for ships using multi-technique improved LOS guidance | |
CN110618686B (en) | Unmanned ship track control method based on explicit model predictive control | |
CN105867139B (en) | A kind of aircraft robust control method of model reference adaptive | |
CN114815626B (en) | Prediction active disturbance rejection and stabilization reduction control method of rudder fin system | |
CN113428218B (en) | Vehicle steering control method, device, equipment and storage medium | |
CN112445234A (en) | Attitude control method and device for spacecraft | |
CN109669345A (en) | Underwater robot fuzzy motion control method based on ESO | |
CN111427356A (en) | Ship course interval control method and system | |
Du et al. | A novel adaptive backstepping sliding mode control for a lightweight autonomous underwater vehicle with input saturation | |
Do | Global path-following control of underactuated ships under deterministic and stochastic sea loads | |
Koshkouei et al. | Stabilisation of ship roll motion via switched controllers | |
Tang et al. | Robust fixed-time trajectory tracking control of the dynamic positioning ship with actuator saturation | |
CN109828586B (en) | Unmanned ship robust H-infinity course control method based on nonlinear uncertainty | |
Bak et al. | Robust tool point control for offshore knuckle boom crane | |
CN115407656A (en) | Intelligent agricultural machinery autonomous operation control method and system based on dynamic self-adaptive LQR | |
Qian et al. | Model predictive controller using laguerre functions for dynamic positioning system | |
CN114488786A (en) | A3C and event trigger-based networked servo system control method | |
Lu et al. | Nonlinear adaptive heading control for an underactuated surface vessel with constrained input and sideslip angle compensation | |
Ma et al. | Multi-model predictive control strategy for path-following of unmanned surface vehicles in wide-range speed variations |
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 |