CN111352341B - Ship navigation control online self-adaptive adjustment system and method - Google Patents
Ship navigation control online self-adaptive adjustment system and method Download PDFInfo
- Publication number
- CN111352341B CN111352341B CN202010192106.1A CN202010192106A CN111352341B CN 111352341 B CN111352341 B CN 111352341B CN 202010192106 A CN202010192106 A CN 202010192106A CN 111352341 B CN111352341 B CN 111352341B
- Authority
- CN
- China
- Prior art keywords
- ship
- course
- navigation
- route
- heading
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 31
- 238000001514 detection method Methods 0.000 claims description 19
- 230000003044 adaptive effect Effects 0.000 claims description 18
- 230000006870 function Effects 0.000 claims description 12
- 230000033001 locomotion Effects 0.000 claims description 9
- 230000008859 change Effects 0.000 claims description 7
- 238000005457 optimization Methods 0.000 claims description 7
- 238000005070 sampling Methods 0.000 claims description 6
- 238000002347 injection Methods 0.000 claims description 4
- 239000007924 injection Substances 0.000 claims description 4
- 230000010354 integration Effects 0.000 claims description 4
- 230000000694 effects Effects 0.000 description 12
- 230000009471 action Effects 0.000 description 10
- 238000010586 diagram Methods 0.000 description 9
- 239000000446 fuel Substances 0.000 description 5
- 230000007547 defect Effects 0.000 description 2
- 230000010355 oscillation Effects 0.000 description 2
- 239000000243 solution Substances 0.000 description 2
- 239000002699 waste material Substances 0.000 description 2
- 230000001154 acute effect Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000001141 propulsive effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012549 training Methods 0.000 description 1
- 201000009482 yaws Diseases 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/0205—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
- G05B13/024—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system in which a parameter or coefficient is automatically adjusted to optimise the performance
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention provides an online self-adaptive adjusting method for ship navigation control, which comprises the following steps: s1, setting an ideal route, if no wind wave flow interference force dominant direction exists, taking the ship heading as the ship navigation control direction, otherwise, entering S2; s2, measuring the magnitude and vector direction of the wind wave flow interference force in real time, setting the output value of the ship host and the included angle between the bow direction and the ideal route, and realizing that the vector direction of the resultant force of the propeller thrust and the wind wave flow interference force is the direction in which the current ship centroid points to the nearest reference point; s3, adjusting the included angle between the bow direction and the ideal route and/or the output value of the ship main engine to realize the intersection of the vector direction of the resultant force and the ideal route, wherein the included angle is smaller than a set threshold value; s4, self-adaptively controlling a ship steering engine according to the acquired course deviation value, maintaining the ship deviation course within an allowable range, and repeating the steps S3 and S4. The invention also provides an online self-adaptive adjusting system for ship navigation control.
Description
Technical Field
The invention relates to the technical field of navigation, in particular to an online self-adaptive adjusting system and method for ship navigation control.
Background
At present, the ocean navigation direction of the ship is realized by controlling the bow direction. In the prior art, the heading direction of a ship is required to be the sailing direction of the ship, so that the rudder is required to be frequently adjusted to overcome the interference of marine environmental force, the rudder blade is difficult to keep a middle position, and even if the rudder blade is difficult to keep a middle position, a driver is required to correct the heading direction at regular time to solve the problem of yaw, so that the track route of an ocean vessel is Z-shaped or S-shaped, and the additional resistance generated by the rudder effect influences the sailing speed.
The autopilot of the ocean vessel is a key device for keeping the course, takes the deviation of the heading direction of the vessel from the set course as a controlled quantity, takes the deflection angle of an execution rudder blade as a manipulated variable, and takes the external storm flow interference as a load. In the prior art, when the heading of a ship is taken as the heading, the automatic rudder passively overcomes the external interference, and the problems of frequent adjustment of a steering engine, reciprocating heading change, increased navigation resistance and more fuel consumption occur.
At present, the automatic rudder of a ship has the defects of single control parameter, always pursuing the heading of the ship to be aligned with the set navigation direction, not using the interference force of the stormy wave and current environment for assisting the navigation of the ship, but overcoming the interference of the stormy wave and current environment force to cause great loss of the power of the ship.
The existing ship navigation control method only using ship heading as course control specifically has the following problems:
(1) the ship navigation control target is single, so that frequent adjustment is caused, and extra loss is increased;
(2) the heading of the ship is a control target of the heading, and the interference force of wind waves and current is not used for assisting navigation and is overcome, so that additional oil consumption is caused;
(3) external interference is counteracted through deflection of the rudder blade, so that sailing resistance is increased, and fuel consumption of the ship is high.
Disclosure of Invention
The invention aims to provide an online self-adaptive adjusting system and method for ship navigation control, wherein the heading direction of a ship is no longer a single heading control target, the resultant force vector of the thrust of a ship propeller and the interference force of a storm flow environment is used as the actual navigation direction of the ship, and a ship navigation self-adaptive control module is used for self-adaptively controlling a ship steering engine through an optimized PID algorithm according to a heading deviation value. The navigation is assisted by utilizing the interference force of wind, waves and current, the problems of ship course oscillation, frequent regulation of a steering engine, increased navigation resistance and high fuel consumption are solved, and the online adaptive control of the ship steering engine is realized.
In order to achieve the above object, the present invention provides an online adaptive regulation system for ship navigation control, wherein a signal of the online adaptive regulation system is connected with a ship host and a ship steering engine, the ship host is connected with a propeller, and the thrust of the propeller is changed by changing the output value of the ship host to adjust the fuel injection quantity of the ship host, and the system comprises:
the route planning module is used for setting an ideal route comprising a plurality of reference points according to the position information of the starting port and the target port; the route planning module also sets a corresponding ship course given value for the reference point;
the ship position information acquisition module is used for acquiring ship position information in real time and determining the actual navigation movement direction according to the ship position information;
the wind wave flow interference force information acquisition module is used for acquiring the magnitude and the direction of the wind wave flow interference force;
the rudder angle detection module is in signal connection with a ship steering engine and is used for detecting the actual deflection value of a rudder blade;
the ship bow detection module is used for detecting the movement direction of the ship bow;
the ship navigation self-adaptive control module is in signal connection with the ship position information acquisition module, the route planning module, the storm flow interference force information acquisition module, the rudder angle detection module, the ship bow direction detection module, the ship host and the ship steering engine, and is used for setting an output value of the ship host and a deflection value of a rudder blade according to the magnitude and the direction of the storm flow interference force, an ideal route and ship position information when the storm flow interference force is dominant, so that the intersection of the vector direction of resultant force of propeller thrust and the storm flow interference force and the ideal route is realized, and the included angle between the vector direction of the resultant force and the ideal route is smaller than a set threshold value; the ship navigation self-adaptive control module also obtains a navigation deviation value according to the ship course given value and the actual navigation moving direction, and self-adaptively controls a ship steering engine according to the course deviation value to maintain the deviation of the ship from an ideal route within an allowable range.
The ship navigation control online self-adaptive adjusting system also comprises a ship heading navigation control module which is in signal connection with the storm flow interference force information acquisition module, a ship steering engine, a ship host, a course planning module, a ship position information acquisition module and a ship heading detection module and is used for controlling a ship to navigate along an ideal course by taking the ship heading as the course.
The invention also provides an online adaptive adjusting method for ship navigation control, which is realized by adopting the online adaptive adjusting system for ship navigation control, and comprises the following steps:
s1, setting an ideal route by taking the starting port as a route starting point and the destination port as a route terminal point; setting a plurality of reference points on the ideal route;
s2, if there is no dominant direction of the interference force of the wind, wave and flow, controlling the ship to sail along the ideal course through a ship heading sailing control module; otherwise, go to S3;
s3, measuring the magnitude and the vector direction of the wind wave flow disturbance force in real time; the output value of a ship host and the included angle between the ship heading and an ideal air route are set through a ship navigation self-adaptive control module, so that the vector direction of the resultant force of the propeller thrust and the wind wave flow interference force is the direction in which the current ship centroid points to the nearest reference point;
s4, adjusting an included angle between the heading of the ship and an ideal route and/or an output value of a main engine of the ship through the ship navigation self-adaptive control module to realize the intersection of the vector direction of the resultant force and the ideal route, wherein the included angle gamma between the vector direction of the resultant force and the ideal route is smaller than a set threshold value, and the ship takes the vector direction of the resultant force as the heading;
s5, the ship navigation self-adaptive control module is used for self-adaptively controlling a ship steering engine according to the acquired course deviation value and maintaining the ship deviation course within an allowable range; steps S2 to S5 are repeated.
Preferably, step S2 further includes: acquiring ship position information in real time, and detecting whether a ship deviating from a route is within an allowable range; and if the allowable range is exceeded, operating the ship to return to the ideal route through the ship heading navigation control module.
Preferably, step S2 further includes controlling the ship to navigate along the desired route by the ship heading and navigation control module when the ship enters or exits the port, passes through a narrow channel, avoids collision, is in a complex sea area, and is in a bad sea condition.
Preferably, in steps S3 and S4, the output value of the marine main engine is set to 75% to 85% of the full load of the marine main engine.
Step S5 specifically includes:
s51, calculating the heading deviation e (k) y d (k) -y (k); k is a sampling sequence number; y is d (k) Generating a ship course given value for a route planning module according to a reference point on an ideal route, and y (k) being an output value of the actual navigation direction of the ship acquired by a ship position information acquisition module; when heading deviation | e (k) | ≧ Δ | 1 L, go to S52; otherwise, keeping the current course unchanged; wherein Δ 1 A dead zone/insensitive zone of the ship course;
s52, calculating a proportional output u p (k)＝K p (k) e (k); wherein K p (k) Is a proportionality coefficient;
s53, calculating integral output
T I (k) Is an integration time constant;
is a trapezoidal integral term; f [ e (k)]In order to perform the integration at a variable speed,
|Δ 1 |≤B≤1.5|e(k)|,A≥2|e(k)|；
s54, calculating differential output u D (k) Wherein
Where ξ is the low-pass filter coefficient, T D (k) Is differential time, T s (k) Is the sampling time;
s55, constructing an error square sum performance value function J and optimizing K p (k)、T I (k)、T D (k) The method comprises the following steps Wherein,
s56, p u p (k)+u I (k)+u D (k) After amplitude limiting, the steering angle OP (k) is used as a steering angle OP (k) to be input into a ship steering engine, and the steering blade deflects according to the steering angle OP (k); if steering angle OP (k) does not exceed the full steering limit and steering angle | OP (k) | ≧ Δ | 2 L, go to S51; otherwise, keeping the current course; wherein Δ 2 Is a dead zone of the rudder angle.
Preferably, the allowable range specifically refers to a sea area where the distance between an actual route and an ideal route is smaller than the ship length.
Compared with the prior art, the invention has the beneficial effects that:
(1) when the dominant direction of the wind wave flow interference force exists, the vector direction of the resultant force of the propeller thrust and the wind wave flow interference force is used as the ship navigation direction, the wind wave flow interference force is not an obstacle which needs to be overcome any more, the ship navigation is assisted by the wind wave flow interference force, and the ship navigation control can be realized only by finely adjusting the propeller thrust and the rudder blade deflection angle;
(2) the steering effect of the steering engine and the propulsion of the ship host are adjusted in an online self-adaptive manner along with the interference force of wind, wave and current, the transverse drift can be counteracted without using a GPS, and the navigation resistance is reduced to the maximum extent;
(3) by using the method, the load of the ship steering engine, the steering engine adjusting amplitude and the steering engine adjusting frequency are greatly reduced, the navigation resistance and the energy loss are greatly reduced, and the method has good popularization value.
Drawings
In order to more clearly illustrate the technical solution of the present invention, the drawings used in the description will be briefly introduced, and it is obvious that the drawings in the following description are an embodiment of the present invention, and other drawings can be obtained by those skilled in the art without creative efforts according to the drawings:
FIG. 1 is a schematic diagram of a ship course control in the prior art;
FIG. 1A is a schematic view of a ship sailing back under the disturbance of wind, wave and current with the heading of the ship as the heading in the prior art;
FIG. 2 is a schematic illustration of various tracks generated by a prior art vessel voyage control method;
FIG. 3 is a schematic diagram of an online adaptive control method for ship navigation control according to the present invention;
FIG. 4 is a schematic diagram of an online adaptive control system for ship navigation control according to the present invention;
FIG. 5 is a schematic diagram of a self-adaptive control steering engine of the ship navigation self-adaptive control module according to the present invention;
FIG. 6 is a schematic diagram of a track generated by a ship through the ship navigation control online adaptive adjustment method of the invention;
FIG. 7A and FIG. 7B are schematic diagrams respectively illustrating the propeller thrust, the ship heading and the ideal course included angle when the wind wave flow disturbance force direction is unchanged and only changes in magnitude, and the wind wave flow disturbance force is unchanged and only changes in direction;
fig. 8A to 8C are schematic diagrams of propeller thrust and an angle between a ship bow direction and an ideal course when the ship moves downwind, upwind and transversely, respectively.
In the figure: 1. a route planning module; 2. a ship position information acquisition module; 3. the wind wave flow interference force information acquisition module; 4. a rudder angle detection module; 5. a ship heading detection module; 6. a ship navigation self-adaptive control module; 7. a marine main engine; 8. a ship steering engine; 9. and the ship heading navigation control module.
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.
FIG. 1 is a schematic diagram of a ship course control in the prior art, which includes the following steps: the driver sets up the module through the course of the vesselDetermining the ship navigation direction SP of a certain range, namely setting the ship heading; under the disturbance of sea environment, wind, wave and flow, the ship heading PV deviates from the set ship heading SP, e 1 Not equal to 0 and e 1 If the steering engine is larger than delta (delta is a dead zone and an insensitive zone), the steering engine acts to adjust the deflection of the rudder blade in a follow-up manner, additional ship turning moment is generated, and the ship heading is returned to the set ship heading. The course deviation e is obtained by the electric compass through detecting the actual ship heading value PV 1 SP-PV; the course control operation module and the control rudder angle generation module generate a control angle according to the equation e 1 Calculating an operation rudder angle OP; OP is used as an input value of the steering engine; the rudder blade deflection module realizes rudder blade deflection according to OP, and the rudder angle detection module 4 obtains the actual deflection value theta of the rudder blade to obtain the rudder angle deviation e 2 OP- θ. The hydraulic steering engine installed at the stern part of the ocean vessel has the function of automatically controlling the position of a rudder blade, and eliminates the rudder angle deviation e according to OP and theta 2 The hydraulic system adjusts the rudder blade deflection until the OP value. The problems of adjustment lag, overshoot, oscillation and the like are inevitably caused by the inherent characteristics of the current ship course control system. As shown in fig. 1A, the ship needs to continuously return to a preset route, which causes a large energy consumption of the ship main engine 7 and a waste of energy.
Fig. 2 is a schematic diagram of various tracks generated by the ship navigation control method in the prior art, and the defects of the ocean vessel course control in the prior art can be seen according to the tracks in fig. 2. Track (a) and track (b) in fig. 2 show that the ship sways on both sides of a given course, and although the average course still can surround the forward direction, the ship direction adjustment time is long. The track (a) is convergent, which indicates that the ship navigation control method is feasible; track (b) is divergent and its corresponding vessel control method cannot be used. The track (c) shows that the ship sways unevenly left and right in the yaw dead zone, the average course deviates from the forward direction, and the track (c) is also divergent after a long time. And the track (d) is the condition that the ship returns to the positive course after the PID course retaining controller corrects the large deviation of the average course, and the power energy waste of the ship is large under the condition. Although the existing ocean vessel autopilot can correct the deviation to enable the vessel to return to the positive course, the existing ocean vessel autopilot cannot provide the force for the lateral drift of the vessel, and the course control is realized by means of a GPS positioning system.
The invention provides an online self-adaptive adjusting system for ship navigation control, as shown in fig. 4, the system is connected with a ship host 7 and a ship steering engine 8 through signals, the ship host 7 is connected with a propeller, and the thrust of the propeller is changed by changing the output value of the ship host to adjust the fuel injection quantity of the ship host, and the system comprises:
the route planning module 1 is used for setting an ideal route according to the position information of an originating port and a target port; preferably, the route planning module 1 contains an electronic map. And a plurality of discontinuous reference points are arranged on the ideal route. The route planning module 1 also sets a corresponding ship course given value for a reference point on an ideal route. Generally, the reference points are compared every two hours of sailing of the ship, the actual sailing deviation condition of the ship is checked and corrected, and if the yaw is larger than a set threshold value, the course is adjusted according to the next reference point to enable the sailing deviation to be 0, so that a new set course is generated. If the yaw does not exceed the set threshold, no adjustment is required.
The ship position information acquisition module 2 is used for acquiring ship position information in real time and generating a ship mass center motion direction according to the ship position information; preferably, the ship position information acquisition module 2 is a GPS module;
the wind wave flow interference force information acquisition module 3 is used for acquiring the magnitude and the direction of the wind wave flow interference force;
the rudder angle detection module 4 is in signal connection with a ship steering engine 8 and is used for detecting the actual deflection value of a rudder blade; the bow direction detection module 5 is used for detecting the movement direction of the bow; preferably, the bow detection module 5 is an electric compass;
the ship navigation self-adaptive control module 6 is in signal connection with the ship position information acquisition module 2, the route planning module 1, the storm flow interference force information acquisition module 3, the rudder angle detection module 4, the ship bow direction detection module 5, the ship host 7 and the ship steering engine 8, and is used for setting an output value and a rudder blade deflection value of the ship host according to the magnitude and the direction of the storm flow interference force, an ideal route and the ship position information when the storm flow interference force is dominant, so that the intersection of the vector direction of the resultant force of the propeller thrust and the storm flow interference force and the ideal route is realized, and the included angle between the vector direction of the resultant force and the ideal route is smaller than a set threshold value; the ship navigation self-adaptive control module 6 also obtains a course deviation value according to the ship course set value and the actual navigation moving direction, and self-adaptively controls a ship steering engine 8 according to the course deviation value to maintain the deviation of the ship from an ideal route within an allowable range;
and the ship heading navigation control module 9 is in signal connection with the storm flow interference force information acquisition module 3, the ship steering engine 8, the ship host 7, the route planning module 1, the ship position information acquisition module 2 and the ship heading detection module 5 and is used for controlling the ship to navigate along an ideal route by taking the ship heading as a heading.
The invention also comprises an online adaptive adjusting method for ship navigation control, which is realized by the online adaptive adjusting system for ship navigation control, and as shown in figure 3, the online adaptive adjusting method comprises the following steps:
s1, setting an ideal route by taking the starting port as a route starting point and the destination port as a route terminal point; setting a plurality of reference points on the ideal route;
s2, if there is no wave and current interference force dominant direction, or if the ship deviates from the route and exceeds the allowable range, or the ship is in the port, passes through the narrow channel, avoids collision, is in the complex sea area and bad sea, entering into the ship heading control mode, and controlling the ship to sail along the ideal route through the ship heading control module 9 (this is the prior art); otherwise, entering an online self-adaptive mode of ship navigation control, controlling the ship to navigate through the ship navigation self-adaptive control module 6, and entering S3; the allowable range specifically means a sea area in which the distance between an actual route and an ideal route is smaller than the ship length, with the ideal route as a center, as shown in fig. 6;
s3, measuring the magnitude and the vector direction of the wind wave flow disturbance force in real time; the ship navigation self-adaptive control module 6 generates the output value of a ship host and the included angle alpha between the ship heading and the ideal route, so as to realize the propeller thrust F p The vector direction of resultant force of interference force with wind wave flow is the current ship mass centerDirection to the nearest reference point; preferably, the output value of the marine main engine 7 is set to 75% to 85% of the full load of the marine main engine 7, and at this output value, the main engine efficiency is the highest and is at the optimum load.
The adjustment of the included angle alpha between the bow direction of the ship and the ideal air line is realized by adjusting the deflection angle of the rudder blade of the ship steering engine 8, and the middle position is restored after the adjustment of the rudder blade is finished, so that F is ensured p The direction is stable, and the additional resistance generated by the rudder effect is eliminated. F p Is controlled by the output value of the ship main engine 7, when the output value of the ship main engine is large, the oil injection amount of the ship main engine 7 is high, and the propeller thrust F p And also increases.
The key of the ship navigation control is to detect the magnitude and the acting direction of the wind wave flow disturbance force, and the wind wave flow disturbance force in fig. 8A to 8C is respectively a forward force, an inverse force and a transverse force to the ship navigation. The sailing direction of the ship is the direction indicated by the resultant force F, and the thrust of the propeller is F p The disturbance force of wind, wave and flow is F D If the angle between the ship bow direction (propeller thrust direction) and the ideal course is alpha and the angle between the resultant force vector F and the course is gamma, the angle is
In practice a must be an acute angle, and
then the
Firstly, when the ship moves downwind or transversely,
secondly, when the ship is against the wind,
the current ocean vessel course keeping principle is that alpha 0 is controlled to be a target, so that the heading of the ocean vessel sails around a given route in a Z-shaped or S-shaped track.
Fig. 7A and 7B show two special cases, namely, the direction of the disturbance acting force of the wind wave flow is not changed but is changed in magnitude, and the direction is not changed but is changed in magnitude, so that the effect of adjusting alpha is the best. In practice, the magnitude and direction of the interference force are randomly changed, so that the main engine is adjusted to work at the optimal load rate state and the included angle alpha is adjusted to adapt to the change of the interference force on the premise of not exceeding the load of the main engine of the ship by 85 percent (preferably 75 to 85 percent, and the efficiency of the ship is highest at the moment).
As shown in FIG. 7A, when the direction of the disturbance acting force of the wind wave flow is not changed but is changed in magnitude, the initial disturbance force is
Thrust of the propeller is
Resultant force vector
On a predetermined course. Reduce the disturbance force of
Increase the disturbance force of
And the disturbance force direction remains unchanged. If the propeller thrust is not changed, the propeller thrust is still
The resultant force vector after the disturbance force is reduced is
Deviation from predetermined course O 1 O 2 (ii) a The resultant force vector after the increase of the disturbance force is
Deviation from predetermined course O 1 O 2 (ii) a Therefore, the thrust of the propeller needs to be adjusted, and the resultant force vector after the disturbance force is reduced is
Keeping the vessel on a predetermined course O 1 O 2 The above step (1); the resultant force vector after the increase of the disturbance force is
Keeping the vessel on a predetermined course O 1 O 2 In fig. 7A, the adjustment effect is shown to be significant when the thrust acting direction α of the propeller is changed.
Fig. 7B shows a case where the magnitude of the disturbance force of the wind wave flow is not changed but the direction is changed: initial disturbance force of
Thrust of the propeller is
Resultant force vector
On a predetermined course.
The included angle between the interference force and the direction of the air route is reduced,
and the included angle between the interference force and the air route direction is increased, and the magnitude of the interference force is kept unchanged. If the propeller thrust is not changed, the propeller thrust is still
The resultant force vector after the included angle is reduced is
Deviation from predetermined course O 1 O 2 (ii) a The resultant force vector after the increase of the included angle is
Deviation from predetermined course O 1 O 2 (ii) a Therefore, the thrust of the propeller needs to be adjusted, and the resultant force vector after the included angle is reduced is
The vessel remaining on the predetermined course O 1 O 2 The above step (1); the resultant force vector after the increase of the included angle is
The vessel remaining on the predetermined course O 1 O 2 In the above, the figure shows that the adjustment effect is obvious when the thrust action direction of the propeller is changed.
S4, adjusting an included angle between the heading of the ship and an ideal route and/or an output value of a main engine of the ship through the ship navigation self-adaptive control module 6 to realize the intersection of the vector direction of the resultant force and the ideal route, wherein the included angle gamma between the vector direction of the resultant force and the ideal route is smaller than a set threshold value, and the ship takes the vector direction of the resultant force as the heading; preferably, the output value of the marine main engine is set to be 75-85% of the full load of the marine main engine.
S5, the ship navigation self-adaptive control module 6 controls a ship steering engine 8 in a self-adaptive mode according to the acquired course deviation value, and the deviation course of the ship is maintained within an allowable range; in the invention, when the included angle gamma is larger than a set threshold value, self-adaptive control can be carried out; and when the distance of the ship deviating from the air route is larger than an allowable range, the self-adaptive control can be carried out. Steps S2 to S5 are repeated.
As shown in fig. 5, the adaptive control of the marine steering engine in step S5 specifically includes:
s51, calculating heading deviation e (k) y d (k) -y (k); k is a sampling sequence number; y is d (k) The course given value of the ship generated by the route planning module 1 and y (k) is the output value of the actual navigation direction of the ship acquired by the ship position information acquisition module 2; when heading deviation | e (k) | ≧ | Δ |) 1 L, go to S52; otherwise, keeping the current course unchanged; wherein Δ 1 The ship course dead zone/insensitive zone; delta of 1 Not a fixed value, preferably Δ 1 The steady state value is approximately (3-5)%; delta under severe sea conditions 1 Increase stability and increase the lower delta of calm 1 The accuracy is reduced and improved;
s52, calculating a ratio output u p (k)＝K p (k) e (k); wherein K p (k) Is a proportionality coefficient;
s53, calculating integral output
T I (k) Is an integration time constant;
is a trapezoidal integral term; f [ e (k)]In order to integrate the speed change,
|Δ 1 |≤B≤1.5|e(k)|,A≥2|e(k)|；
s54, calculating differential output u D (k) In which
Where ξ is the low-pass filter coefficient, T D (k) Is differential time, T s (k) Is the sampling time;
s55, constructing an error square sum performance value function J and optimizing K p (k)、T I (k)、T D (k)；K p (k)、T I (k)、T D (k) The effect of (a) is to eliminate the error e (k), the magnitude of which affects the control system stability and e (k) convergence speed. PID control parameter initial value K p (0)、T I (0)、T D (0) The best value of real ship debugging of equipment manufacturers is taken as a default value, and after the system is powered on, K is enabled to be firstly p (0)、T I (0)、T D (0) And restoring the factory setting.
Wherein,
the ship output y (k) has a monotonic response characteristic to the action of the control input u (k), i.e.
From the sum of squared errors and the performance function
The iterative optimization algorithm is
The PID control parameter iterative optimization method comprises the following steps:
s56, p u p (k)+u I (k)+u D (k) After amplitude limiting (the amplitude limiting is to prevent the rudder blade from deflecting beyond a feasible range to cause the steering engine to be out of control) is carried out, the amplitude limiting is used as a steering angle OP (k) to be input into a ship steering engine 8, the steering engine arranged at the stern part of the ship has the function of automatically controlling the position of the rudder blade, and the rudder blade deflects according to the steering angle OP (k); if the steering angle OP (k) does not exceed the full steering limit and the steering angle OP (k) is greater than or equal to Delta 2 Proceeding to S51; otherwise, keeping the current course; wherein Δ 2 Is a dead zone of the rudder angle.
The steering angle OP (k) of the invention does not exceed the full steering limit, namely OP (k) is not less than theta min And OP (k) is not more than theta max ，θ min The left full rudder is set to be- (30-35 degrees),θ max the angle is 30-35 degrees.
As shown in FIG. 6, the invention ensures that the included angle gamma between the course direction and the ship centroid motion direction is minimum and the directions are consistent and convergent, and reduces the action frequency of the steering engine and the amplitude of deviation from the course.
The ship sails to O 1 Resultant force vector O at position 1 c 1 Propeller thrust O 1 b 1 + interference force O 1 a 1 Resultant force vector O 1 c 1 The rudder blade is positioned at the middle position consistent with the flight path, so that the thrust of the propeller is kept unchanged 1 b 1 . But the interference force at sea has uncertain change, and the magnitude and the direction of the interference force are changed into O 1 a 2 When the resultant force vector becomes O 1 d 2 The ship movement and inertia influence deviate from the preset route at O 2 At the location.
The ship sails to O 2 When the ship is in the position, under the condition that the ship main engine 7 and the steering engine are adjusted together, the thrust of the propeller is adjusted by O 1 b 1 Is changed into O 2 b 2 After the adjustment is finished, the rudder blade no longer has the rudder effect in the middle return position, and the main engine is kept on a new accelerator, so that the resultant force vector O 2 c 2 Propeller thrust O 2 b 2 + interference force O 2 a 2 Resultant force vector O 2 c 2 The adjustment process is gradual, with a small angle to the flight path, which ensures stability.
Resultant force vector O 2 c 2 Sailing to O under the action of ship 3 At the position, the disturbing force is changed to O 3 a 3 But the propeller thrust is adjusted to O 3 b 3 New resultant force vector O 3 c 3 Propeller thrust O 3 b 3 + interference force O 3 a 3 Resultant force vector O 3 c 3 And back to line with the flight path.
Resultant force vector O 3 c 3 Sailing to O under the action of ship 4 At the position, the disturbance force becomes O 4 a 4 The direction of the propeller changes almost 180 degrees, which is an extreme case, and the thrust direction of the propeller also needs to change greatly, so that the flight path is clamped in the dry stateDisturbance O 4 a 4 And a propulsive force O 4 b 4 Only then can the resultant force vector O be ensured 4 c 4 Approaching the course, the resultant force vector O 4 c 4 Propeller thrust O 4 b 4 + interference force O 4 a 4 Resultant force vector O 4 c 4 Intersecting or tangent to the course, further approaching the course.
Resultant force vector O 4 c 4 Sailing to O under the action of ship 5 Resultant force vector O at position 5 d 5 Propeller thrust O 5 b 5 + interference force O 5 a 5 The rudder blade deflects to generate an additional ship-turning moment, and on one hand, the interference force O is overcome 5 a 5 Influence, on the other hand, of the heading of the ship approaching the course, the resultant force vector O 5 d 5 Not equal to propeller thrust O 5 b 5 + interference force O 5 a 5 。O 5 b 5 Although the ship heading keeping method is approximately parallel to the ship course and has the same direction, the difference between the ship heading keeping method and the existing ship heading keeping method is that at least one intersection point exists between the ship heading and the ship course, the included angle between the ship heading and the ship course is required to be minimum, and the ship heading keeping method is considered to be approximately coincident when more than two intersection points are included.
The ship has large inertia, the motion change of the ship cannot be too fast, and the ship yaws to O under the action of inertia, propeller thrust and rudder effect 6 At position, resultant force vector O 6 d 6 Not equal to propeller thrust O 6 b 6 + interference force O 6 a 6 And the ship bow direction approaches to the air route under the continuous action of the rudder effect.
The ship moves to the position O under the action of propeller thrust and rudder effect 7 When the air course enters between the thrust and the interference of the propeller, the position is automatically converted into a ship course control mode, the rudder blade returns to the middle position to cancel the action of the rudder effect, and the resultant force vector O 7 c 7 Propeller thrust O 7 b 7 + interference force O 7 a 7 Resultant force vector O 7 c 7 And routeApproximately coincident, this achieves optimal control and navigation results.
According to the invention, the steering engine deflection angle can be automatically and rapidly adjusted to a set deflection value through the error square and the performance value function, and by combining the combined force of the wind wave flow interference force and the propeller thrust as the ship navigation direction, the automatic ship navigation control is realized, and the problems of large ship energy efficiency and frequent course adjustment are effectively solved.
In the prior art, ship navigation control is mainly developed around a course control algorithm, the emphasis is on algorithm optimization, no research is carried out on application of disturbance power in marine environment, and no precedent for assisting ship navigation by disturbance is provided.
While the invention has been described with reference to specific embodiments, the invention is not limited thereto, and various equivalent modifications and substitutions can be easily made by those skilled in the art within the technical scope of the invention. Therefore, the protection scope of the present invention shall be subject to the protection scope of the claims.
Claims (7)
1. An online adaptive adjusting method for ship navigation control is characterized by comprising the following steps:
s1, setting an ideal route by taking the starting port as a route starting point and the destination port as a route terminal point; setting a plurality of reference points on the ideal route;
s2, if there is no dominant direction of the interference force of the wind wave flow, controlling the ship to sail along the ideal route through a ship heading sailing control module; otherwise, go to S3;
s3, measuring the magnitude and the vector direction of the wind wave flow disturbance force in real time; the output value of a ship host and the included angle between the ship heading and an ideal air route are set through a ship navigation self-adaptive control module, so that the vector direction of the resultant force of the propeller thrust and the wind wave flow interference force is the direction in which the current ship centroid points to the nearest reference point;
s4, adjusting an included angle between the heading of the ship and an ideal route and/or an output value of a main engine of the ship through the ship navigation self-adaptive control module to realize the intersection of the vector direction of the resultant force and the ideal route, wherein the included angle gamma between the vector direction of the resultant force and the ideal route is smaller than a set threshold value, and the ship takes the vector direction of the resultant force as the heading;
s5, the ship navigation self-adaptive control module self-adaptively controls a ship steering engine according to the acquired course deviation value and maintains the ship deviation course within an allowable range; repeating steps S2 to S5;
step S5 specifically includes:
s51, calculating heading deviation e (k) y d (k) -y (k); k is a sampling sequence number; y is d (k) Generating a ship course set value for a course planning module according to a reference point on an ideal course, and y (k) being an output value of the actual navigation direction of the ship acquired by a ship position information acquisition module; when heading deviation | e (k) | ≧ Δ | 1 L, go to S52; otherwise, keeping the current course unchanged; wherein Δ 1 The ship course dead zone/insensitive zone;
s52, calculating a proportional output u p (k)＝K p (k) e (k); wherein K is p (k) Is a proportionality coefficient;
s53, calculating integral output
T I (k) Is an integration time constant;
is a trapezoidal integral term; f [ e (k)]In order to integrate the speed change,
|Δ 1 |≤B≤1.5|e(k)|,A≥2|e(k)|；
s54, calculating differential output u D (k) Wherein
Xi is the coefficient of the low-pass filter, T D (k) Is differential time, T s (k) Is the sampling time;
s55, constructing an error square sum performance value function J and optimizing K p (k)、T I (k)、T D (k) The method comprises the following steps Wherein,
s56, p u p (k)+u I (k)+u D (k) After amplitude limiting, the amplitude is used as a steering angle OP (k) to be input into a steering engine of a ship, and a rudder blade deflects according to the steering angle OP (k); if steering angle OP (k) does not exceed the full steering limit and steering angle | OP (k) | ≧ Δ | 2 L, go to S51; otherwise, keeping the current course; wherein Δ 2 Is a dead zone of the rudder angle.
2. The online adaptive control method for ship voyage control according to claim 1, wherein step S2 further comprises: acquiring ship position information in real time, and detecting whether a ship deviating from a course is within an allowable range; and if the allowable range is exceeded, operating the ship to return to the ideal route through the bow navigation control module.
3. The online adaptive control method for ship navigation control according to claim 1, wherein step S2 further comprises controlling the ship to navigate along the desired route through the heading navigation control module when the ship enters or exits a port, passes through a narrow channel, avoids collision, is in a complex sea area, and is in a bad sea condition.
4. The online adaptive control method for ship voyage control according to claim 1, wherein in steps S3 and S4, the output value of the ship 'S main engine is set to 75% to 85% of the full load of the ship' S main engine.
5. The online adaptive control method for ship navigation control according to claim 1, wherein the allowable range specifically refers to a course width, and a sea area where a distance between an actual course and an ideal course is smaller than a ship length.
6. An online self-adaptive adjusting system for ship navigation, which is used for realizing the adjusting method according to any one of claims 1 to 5, wherein the adjusting system is in signal connection with a ship host and a ship steering engine, the ship host is connected with a propeller, and the thrust of the propeller is changed by changing the output value of the ship host to adjust the oil injection quantity of the ship host, and the online self-adaptive adjusting system is characterized by comprising:
the route planning module is used for setting an ideal route comprising a plurality of reference points according to the position information of the starting port and the target port; the route planning module also sets a corresponding ship course given value for the reference point;
the ship position information acquisition module is used for acquiring ship position information in real time and determining the actual navigation movement direction according to the ship position information;
the wind wave flow interference force information acquisition module is used for acquiring the magnitude and the direction of the wind wave flow interference force;
the rudder angle detection module is in signal connection with a ship steering engine and is used for detecting the actual deflection value of a rudder blade;
the ship heading detection module is used for detecting the movement direction of a ship bow;
the ship navigation self-adaptive control module is in signal connection with the ship position information acquisition module, the route planning module, the storm flow interference force information acquisition module, the rudder angle detection module, the ship bow direction detection module, the ship host and the ship steering engine, and is used for setting an output value of the ship host and a deflection value of a rudder blade according to the magnitude and the direction of the storm flow interference force, an ideal route and ship position information when the storm flow interference force is dominant, so that the intersection of the vector direction of resultant force of propeller thrust and the storm flow interference force and the ideal route is realized, and the included angle between the vector direction of the resultant force and the ideal route is smaller than a set threshold value; the ship navigation self-adaptive control module also obtains a navigation deviation value according to the ship course given value and the actual navigation moving direction, and self-adaptively controls a ship steering engine according to the course deviation value to maintain the deviation of the ship from an ideal route within an allowable range.
7. The online adaptive control system for ship navigation according to claim 6, further comprising a ship heading navigation control module, wherein the ship heading navigation control module is in signal connection with the storm current interference force information acquisition module, the ship steering engine, the ship host, the route planning module, the ship position information acquisition module and the ship heading detection module, and is used for controlling the ship to navigate along an ideal route with the ship heading as the heading.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010192106.1A CN111352341B (en) | 2020-03-18 | 2020-03-18 | Ship navigation control online self-adaptive adjustment system and method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010192106.1A CN111352341B (en) | 2020-03-18 | 2020-03-18 | Ship navigation control online self-adaptive adjustment system and method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111352341A CN111352341A (en) | 2020-06-30 |
| CN111352341B true CN111352341B (en) | 2022-09-30 |
Family
ID=71197490
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010192106.1A Active CN111352341B (en) | 2020-03-18 | 2020-03-18 | Ship navigation control online self-adaptive adjustment system and method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN111352341B (en) |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113031614B (en) * | 2021-03-11 | 2022-09-30 | 上海海事大学 | Ocean vessel course control composite optimization oil-saving method |
| CN113665776B (en) * | 2021-08-03 | 2022-10-11 | 珠海云洲智能科技股份有限公司 | Rudder angle control method, rudder angle control device and rudder angle control box |
| CN114044104B (en) * | 2021-11-03 | 2023-03-21 | 上海外高桥造船有限公司 | Method for measuring minimum speed of ship for keeping course |
| CN116639229B (en) * | 2023-07-26 | 2023-10-03 | 江苏道达风电设备科技有限公司 | Marine fan foundation submerged-running switching ship-running control method and related device |
Family Cites Families (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6450112B1 (en) * | 1999-04-02 | 2002-09-17 | Nautronix, Inc. | Vessel control force allocation optimization |
| CN1132757C (en) * | 1999-07-17 | 2003-12-31 | 周德群 | Ship driven by wave energy and stable building floating on water surface |
| CN100494898C (en) * | 2004-12-30 | 2009-06-03 | 中国科学院自动化研究所 | Track autopilot control system and method thereof |
| CN101893849A (en) * | 2010-07-12 | 2010-11-24 | 绍兴县精功机电研究所有限公司 | Control method of PID controller |
| CN103558854B (en) * | 2013-11-05 | 2016-08-31 | 武汉理工大学 | A kind of sail-assisted propulsion boats and ships course heading control method and system |
| CN103693183B (en) * | 2014-01-09 | 2018-02-02 | 孙小鸣 | A kind of new towboat using high altitude wind energy |
| JP6888217B2 (en) * | 2017-07-04 | 2021-06-16 | 三井Ｅ＆Ｓ造船株式会社 | Ships and maneuvering methods |
| CN108490946A (en) * | 2018-04-13 | 2018-09-04 | 武汉理工大学 | A kind of marine power positioning control method |
| CN109634289A (en) * | 2019-01-24 | 2019-04-16 | 大连海事大学 | A kind of unmanned boat autonomous navigation system and its working method |
-
2020
- 2020-03-18 CN CN202010192106.1A patent/CN111352341B/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| CN111352341A (en) | 2020-06-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111352341B (en) | Ship navigation control online self-adaptive adjustment system and method | |
| CN110673598B (en) | Intelligent path tracking control method for unmanned surface vehicle | |
| CN109976349B (en) | Design method of path tracking guidance and control structure of constraint-containing unmanned ship | |
| CN111487966B (en) | Self-adaptive path tracking control method for unmanned surface vehicle based on waypoints | |
| CN111413981B (en) | Ship autopilot composite neural network PID control method | |
| WO2021230356A1 (en) | Method for autonomously guiding vessel, program for autonomously guiding vessel, system for autonomously guiding vessel, and vessel | |
| CN102385316A (en) | Deepening controlling method of underactuated automatic underwater vehicle based on neural network back stepping method | |
| CN112083654A (en) | Anti-interference track tracking control method for beacon vessel | |
| CN103558854A (en) | Course control method and system for sail navigation aid ship | |
| CN108829102B (en) | Course control method of wave glider with self-adaptive heading information fusion | |
| Alessandri et al. | System control design of autopilot and speed pilot for a patrol vessel by using LMIs | |
| CN114089749A (en) | Unmanned ship motion control anti-interference controller and method | |
| CN114967702A (en) | Unmanned ship control system and path tracking method | |
| CN112987771B (en) | Mechanical sailing boat path tracking control method based on multiport output error trigger mechanism | |
| CN110515387A (en) | A kind of above water craft drift angle compensating non-linear course heading control method | |
| CN116520834B (en) | Low-energy-consumption unmanned ship cruising method | |
| Rodriguez et al. | Adaptive takeoff maneuver optimization of a sailing boat for America’s cup | |
| CN116610122A (en) | Unmanned ship path tracking method capable of stabilizing navigational speed and unmanned ship | |
| Xuefei et al. | Heading control method of unmanned sailing boats based on fuzzy PID | |
| CN116048090A (en) | Sail navigation aid ship path tracking control method with energy consumption optimization effect | |
| CN115145282A (en) | Automatic berthing robust self-adaptive control method for under-actuated ship | |
| CN107187575A (en) | A kind of ship vector rudder control method, apparatus and system | |
| Cheng et al. | A new fuzzy autopilot for way-point tracking control of ships | |
| CN114047743A (en) | Unmanned ship target tracking control method and system with prediction function | |
| dos Santos et al. | Performance evaluation of propulsion control techniques for autonomous sailboat |
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 | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20230807 Address after: Room 368, 302, 211 Fute North Road, pilot Free Trade Zone, Pudong New Area, Shanghai 200131 Patentee after: Power system with tin (Shanghai) Co.,Ltd. Reddy ship Address before: 201306 1550 Harbour Road, Lingang New Town, Pudong New Area, Shanghai Patentee before: Shanghai Maritime University |
|
| TR01 | Transfer of patent right |