CN112666832B - Non-periodic communication underwater glider cooperative controller system and design method - Google Patents
Non-periodic communication underwater glider cooperative controller system and design method Download PDFInfo
- Publication number
- CN112666832B CN112666832B CN202011555801.6A CN202011555801A CN112666832B CN 112666832 B CN112666832 B CN 112666832B CN 202011555801 A CN202011555801 A CN 202011555801A CN 112666832 B CN112666832 B CN 112666832B
- Authority
- CN
- China
- Prior art keywords
- underwater glider
- module
- path
- underwater
- glider
- 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
- 238000004891 communication Methods 0.000 title claims abstract description 50
- 238000013461 design Methods 0.000 title claims abstract description 25
- 238000000034 method Methods 0.000 title claims abstract description 14
- 230000000737 periodic effect Effects 0.000 claims abstract description 17
- 239000011159 matrix material Substances 0.000 claims description 14
- 239000013598 vector Substances 0.000 claims description 12
- 230000007246 mechanism Effects 0.000 claims description 11
- 230000006870 function Effects 0.000 claims description 6
- 238000013016 damping Methods 0.000 claims description 4
- 230000005284 excitation Effects 0.000 claims description 4
- 230000000694 effects Effects 0.000 claims description 3
- 235000006629 Prosopis spicigera Nutrition 0.000 claims description 2
- 240000000037 Prosopis spicigera Species 0.000 claims description 2
- 230000008878 coupling Effects 0.000 claims description 2
- 238000010168 coupling process Methods 0.000 claims description 2
- 238000005859 coupling reaction Methods 0.000 claims description 2
- 239000012530 fluid Substances 0.000 claims description 2
- 238000005070 sampling Methods 0.000 claims description 2
- 230000017105 transposition Effects 0.000 claims description 2
- 238000005265 energy consumption Methods 0.000 abstract description 3
- 230000003993 interaction Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 5
- 230000001960 triggered effect Effects 0.000 description 4
- 230000010355 oscillation Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 241000282414 Homo sapiens Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 229910052500 inorganic mineral Inorganic materials 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 239000011707 mineral Substances 0.000 description 1
- 230000006855 networking Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
Classifications
-
- 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
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
The invention discloses an underwater glider cooperative controller structure and a design method thereof. According to the invention, a non-periodic communication mode is designed by constructing the preset trigger event function based on the self path parameter and the neighbor path parameter, and information interaction between underwater gliders is carried out only when the preset trigger condition is met, so that the communication burden can be obviously reduced, the energy consumption is reduced, and the actual requirement of long-time ocean observation is met. Aiming at the underwater glider cluster system under the condition of incomplete state information, uncertain model parameters and complex marine environment disturbance, the invention realizes that the dependence of controller design on multiple sensors can be effectively reduced under the conditions of less equipped sensors and low precision of the underwater glider, the cooperative tracking under the planned path is realized, and the actual requirement of marine observation is met.
Description
Technical Field
The invention relates to the field of control of underwater gliders, in particular to an underwater glider cooperative controller system with non-periodic communication and a design method.
Background
The ocean occupies 71 percent of the surface area of the earth, surrounds all lands on the earth, and occupies a part of four war spaces of air, sky, land and sea developed by human beings, wherein abundant mineral resources and biological resources are stored, and extremely abundant polymetallic nodules are deposited at the bottom of the ocean, so that the development of underwater robots and other related fields becomes a necessary trend. As a novel autonomous ocean observation platform, the underwater glider realizes gliding movement by means of buoyancy change and attitude adjustment, and has the advantages of low energy consumption, strong cruising ability, extremely low noise, suitability for repeated use, large amount of throwing and the like. Because the observation or detection function of a single underwater glider is relatively single, the operation range of unit time is very limited, and the underwater glider cooperatively operates in a cluster mode to become the inevitable development trend of the underwater glider.
In the last two decades, the world oceanic force nations have conducted a great deal of research and application testing work around the networking of underwater gliders in a coordinated manner, and have had many feasible solutions. However, the prior art still faces the following problems:
firstly, the underwater glider has the problems of unknown speed, unknown external interference, uncertain model and the like, so that the underwater glider cannot be well controlled in practical application;
secondly, the existing underwater glider control comprises an output feedback control method based on an observer, but high-frequency oscillation can be brought while the estimation of the fuzzy observer is carried out, so that the control precision is influenced;
third, the existing method for controlling the coordinated path tracking of the underwater glider requires continuous or periodic communication between the underwater gliders, which is difficult to realize in a practical network environment. Therefore, a communication mode of the aperiodic communication mechanism needs to be further considered, so as to save communication resources.
Disclosure of Invention
In order to solve the defects in the prior art, the invention aims to solve the problem of non-periodic communication cooperative path tracking of the cluster underwater gliders under the condition of limited communication, and provides a non-periodic communication cooperative controller system of the underwater gliders and a design method thereof, so that the underwater gliders do not need continuous communication any more and only communicate when a trigger condition is met, and the communication frequency required by the cluster underwater glider cooperation is effectively reduced.
In order to achieve the purpose, the technical scheme of the invention is as follows: an underwater glider cooperative controller system comprises a communication network and a plurality of controller units, wherein the communication network is based on a non-periodic communication mechanism and is respectively connected with the controller units after passing through the non-periodic communication mechanism;
the controller unit comprises a cooperation module, a path tracking guidance module, a dynamics module, a fuzzy observer, a fuzzy controller based on low-frequency learning and a preset trigger event module; two input ends of the cooperation module are respectively connected with the output end of the path tracking guidance module and the output end of the communication network, and three output ends of the cooperation module are respectively connected with the input end of the path tracking guidance module, the input end of the communication network and the input end of the preset trigger event module; the path tracking guidance module has four input ends, wherein three input ends are respectively connected with the output end of the underwater glider, the output end of the fuzzy observer and the output end of the cooperation module, and the fourth input end is given path parameters; the other output end of the path tracking guidance module is respectively connected with the input end of the dynamics module and the input end of the fuzzy controller based on low-frequency learning; the other input end of the dynamics module is connected with the output end of the fuzzy controller based on low-frequency learning, and the two output ends of the dynamics module are respectively connected with the two input ends of the underwater glider and the two input ends of the low-frequency learning + controller; the other input end of the fuzzy controller based on low-frequency learning is connected with the output end of the fuzzy observer, and the output end of the fuzzy controller based on low-frequency learning is connected with the input end of the dynamics module; three input ends of the preset trigger event module are respectively connected with an output end before the cooperative module is not triggered, an output end after the cooperative module is triggered and an output end of the neighbor preset trigger event module, and the output end of the preset trigger event module is connected with the trigger switch;
the underwater glider comprises six degrees of freedom when moving underwater, and the motion equation of the underwater glider is a complex multivariable system which is nonlinear, under-actuated and strongly coupled. Therefore, in practical studies, the spatial motion of the underwater glider is decomposed into horizontal plane motion and vertical plane motion, and the coupling between the horizontal plane motion and the vertical plane motion is ignored, and the kinematic and dynamic model of the underwater glider in the vertical plane is represented by the following formula:
wherein:
in the formula, subscript i is the number of the underwater glider,pose information, x, for an underwater glider i 、y i And theta i Respectively longitudinal position information, vertical position information and longitudinal rocking angle information of the underwater glider, wherein T represents the transposition of a matrix or a vector;the velocity vectors of the underwater glider are respectively longitudinal velocity, vertical velocity and longitudinal rocking angular velocity;unknown control gains of the underwater glider in the longitudinal direction, the vertical direction and the pitching direction are respectively related to the quality of the underwater glider, and diag {. cndot } represents a diagonal matrix;respectively representing the control input of the underwater glider in the longitudinal direction, the vertical direction and the pitching direction;is the uncertainty disturbance to the underwater glider, where f i (t,η i ,υ i )=-C i (υ i )υ i -D i (υ i )υ i -g i (υ i ,η i )+τ id (t),f iu (·)、f iw (·)、f iq (. is) i.e. f iu (t,u i ,w i ,θ i ,q i )、f iw (t,u i ,w i ,θ i ,q i )、f iq (t,u i ,w i ,θ i ,q i ) Representing the non-linear equations relating hydrodynamic damping effects in the longitudinal, vertical and pitch directions, respectively, C i Is a hydrodynamic and centripetal matrix of fluids, D i As a damping matrix, g i For unmodeled dynamics, τ id (t)=[d iu ,d iw ,d iq ] T Respectively representing the external environment disturbance of the underwater glider in the longitudinal direction, the vertical direction and the pitching direction; m i =diag{m iu m iw m iq The inertia matrixes of the underwater glider in the longitudinal direction, the vertical direction and the pitching direction are respectively.
A design method of an underwater glider cooperative controller system with non-periodic communication comprises the following steps:
A. design of collaboration modules
The input signal of the cooperation module is the path parameter information of the neighbor of the ith underwater gliderAnd the longitudinal position error x of the ith underwater glider output by the path tracking guidance module ie Output signal ω of said synergy module i 、χ i (t) is designed as follows:
in the formula: mu.s i Is a normal number; chi shape i Is a path parameter; upsilon is s Is the path parameter χ i The path update speed of (2); omega i Is based on path parameters of an aperiodic communication mechanism;is based on path parameter cooperation error of non-periodic communication mechanism, wherein a ij In order to gain in the consistency of the data,is the trigger time, and satisfiesFor the next time of the trigger, the trigger time,based on the self-estimated path parameters for the underwater glider i,estimating a path parameter for the underwater glider j based on the neighboring underwater glider i; and isWherein x' id (χ i )、z′ id (χ i ) Are each x id (χ i )、z id (χ i ) Partial derivatives of (d);
B. design of path tracking guidance module
The input signal to the path tracking guidance module is a given path signal p id (χ i ) Pose information eta of underwater glider i =[x i ,z i ,θ i ] T And an estimated state of velocity vector vWherein p is id (χ i )=(x id (χ i ),z id (χ i ) Is X) E -Z E Given path signals under a coordinate system, the output signal is the longitudinal position error x of the underwater glider ie Desired forward speed u iu Desired pitching speed q iq And a desired pitch angle theta iθ ;
Wherein x is ie ,z ie ,θ ie Respectively a longitudinal position error, a vertical position error and a longitudinal angle error of the underwater glider;respectively estimating errors of the speed in the longitudinal direction, the vertical direction and the pitching direction;are each u i ,w i An estimated value of (d);is a normal number; to control the gain; alpha (alpha) ("alpha") i Is an angle of attack; phi is a i =sinθ ie cos(θ iθ -θ id -α i )+(cosθ ie -1)sin(θ iθ +θ id -α i );ε i Is a normal number;and | l iε |≤ε i ;
C. Design of fuzzy observer
The input of the fuzzy observer is the pose information eta of the underwater glider i =[x i ,z i ,θ i ] T (ii) a The output is estimated speed information of the underwater glider
The velocity estimation equation is as follows:
wherein,are respectively x i ,z i ,θ i ,u i ,w i ,q i An estimated value of (d);are respectively f iu (·)、f iw (·)、f iq An estimate of (·); and ist d Is the sampling period, beta i (ζ i )=[β iu (ζ iu ),β iw (ζ iw ),β iq (ζ iq )] T :For the known function of continuous excitation, the excitation is,namely the vector of the N-dimension,i.e., a 3-dimensional vector;for the purpose of the estimated weight factors,i.e., an N × 3 dimensional matrix;is M i The inverse matrix of (d);is a control gain matrix;to estimate the error;
D. design of fuzzy controller based on low frequency learning
The input signal of the fuzzy controller based on low-frequency learning is the expected value u of the underwater glider iu ,q iq ,θ iθ Estimated state of velocity vector vAnd the output signal tau of the dynamics module iu ,τ iq (ii) a The output signal being an uncertainty observationError of estimated velocity from actual velocity
The designed fuzzy controller based on low-frequency learning is as follows:
wherein:
T i =diag{R T (θ i ),I 3 }
S T =diag{S T ,0 3 }
wherein, is E i Is an error, satisfiesIs a normal number;ι i is a positive constant;is composed ofThe estimated weight after passing through a low-pass filter;an estimation error that is a weight;
E. design of kinetic modules
The input signal to the dynamics module is the desired state u of the underwater glider iu ,q iq ,θ iθ Error of estimated speed and actual speedAnd uncertainty observed valueThe output signal is a control input signal tau of an underwater glider iu ,τ iq (ii) a Output signal tau of a kinetic module iu ,τ iq The design of (2) is as follows:
wherein:
k iu ,k iq is a constant that is positive and constant,are all normal numbers, and function as treatment b iu 0 and b iq A singularity condition occurs when 0;
F. design of preset trigger event module
Presetting the input signal of a trigger event module as the current path parameter x of the ith underwater glider i (t) previous trigger timePath parameter of last trigger timeAnd the derivative of the path parameter at the time of the last triggerPath parameter of last triggering moment of neighbor underwater glider jAnd the derivative of the path parameter at the time of the last trigger
The parameter cooperation error based on the aperiodic communication mechanism is as follows:
wherein:
the path parameter collaborative error is based on the information of the neighbor underwater glider; the output signal of the trigger event module is preset to be ET, and when the preset ET condition is met, the information packet is sentThe trigger condition ET is designed as follows:
Compared with the prior art, the invention has the following beneficial effects:
firstly, compared with the existing underwater glider cluster cooperative controller adopting periodic communication, the invention designs an aperiodic communication mode by constructing a preset trigger event function based on own path parameters and neighbor path parameters, and carries out information interaction between the underwater gliders when preset trigger conditions are met, thereby remarkably lightening the communication burden, reducing the energy consumption and meeting the actual requirements of long-time marine observation.
Secondly, compared with the existing underwater glider cluster cooperative controller of which the state information needs to be known, the invention designs an output feedback cooperative path tracking control method without speed measurement by adopting the pose information of the underwater glider, and aiming at an underwater glider cluster system under the conditions of incomplete state information, uncertain model parameters and complex ocean environment disturbance, the dependence of the design of the controller on multiple sensors can be effectively reduced under the conditions of less sensors and low precision of the underwater glider, the cooperative tracking under the planned path is realized, and the actual requirements of ocean observation are met.
Thirdly, compared with the existing output feedback control based on the observer, the method of adding the low-frequency filter into the fuzzy observer is adopted, the fuzzy observer combined with the low-frequency learning method is designed to avoid the generated high-frequency oscillation, the estimated speed information of the underwater glider can be obtained, and the high-frequency oscillation signal which causes the reduction of the control precision can be filtered out, so that the unified estimation of the unmeasured speed, the internal modeling uncertainty and the external disturbance is realized.
Drawings
FIG. 1 is a schematic diagram of an underwater glider cooperative controller system with non-periodic communication.
Fig. 2 is a schematic diagram of a 3 underwater glider communication network system.
Fig. 3 is a schematic diagram of coordinate conversion of an underwater glider.
Fig. 4 is a schematic diagram of the coordinated motion trajectory of 3 underwater gliders.
FIG. 5 is a graph of the lateral position error of 3 underwater gliders.
FIG. 6 is a graph of the longitudinal position error of 3 underwater gliders.
Fig. 7 is a diagram of the effect of non-periodic communication of 3 underwater gliders.
FIG. 8 is a graph of the estimated performance of lateral disturbances for 3 underwater gliders.
FIG. 9 is a graph of the estimated performance of the longitudinal disturbances of 3 underwater gliders.
Detailed Description
The present invention will be further described with reference to the accompanying drawings in which a particular three underwater gliders are cooperatively controlled. The invention discloses an aperiodic communication underwater glider cooperative controller system which is shown in figure 1, a communication network structure for cooperative control of three underwater gliders is shown in figure 2, path parameter information of the No. 1 underwater glider is transmitted to the No. 2 underwater glider, path parameter information of the No. 2 underwater glider is transmitted to the No. 3 underwater glider, and meanwhile, parameter information of the No. 3 underwater glider is transmitted back to the No. 2 underwater glider, namely, the No. 2 underwater glider is adjusted in real time through the No. 1 and the No. 3 neighbors.
The control objective for this embodiment is that three underwater gliders can track a parameterized path (x) id (χ i ),y id (χ i ) And maintain coordinated path tracking while reducing communication frequency and reducing power consumption.
The specific parameters of the model designed by the invention are as follows:
the initial states of the three underwater gliders are:
(x 1 ,y 1 ,z 1 ,θ 1 )=(0,0,0,0)
(x 2 ,y 2 ,z 2 ,θ 2 )=(10,-16,-5,0)
(x 3 ,y 3 ,z 3 ,θ 3 )=(20,16,-10,0)
the three parameterized paths respectively tracked by the underwater glider are designed as follows:
the control parameters were chosen as follows:
K i1 =diag{90,90,90},K i2 ={2700,2700,2700},Γ i =diag{9000,9000,9000},
the simulation results are shown in fig. 4-9. Fig. 4 shows the cooperative motion trajectories of 3 underwater gliders on the vertical plane based on the output feedback control method, the solid line in the graph is the expected path, the dotted line is the motion trajectory of 3 underwater gliders, and it is obvious from the graph that even if the underwater gliders are disturbed by external disturbance, the underwater gliders can still well track the three expected paths. The tracking error x is given in fig. 5 and 6, respectively ie And z ie It can be seen that the tracking errors eventually converge to zero. Figure 7 shows the events triggered during three periods of motion of the underwater glider, the numbers 1 and 0 on the ordinate represent the communication strategy based on aperiodic communication and the communication strategy based on time triggering, respectively, it can be seen that the communication strategy based on aperiodic communication is aperiodic and that the events triggered will be more frequent when necessary communication is required and vice versa, and therefore when necessary communication is requiredThe communication frequency is relatively high at the beginning of the coordinated movement. Fig. 8 and 9 show the capability of estimating uncertainty in the longitudinal direction and the pitch direction, respectively, and it can be seen that the fuzzy observer can effectively estimate the model uncertainty and the dynamics of the external disturbance system.
The present invention is not limited to the embodiment, and any equivalent idea or change within the technical scope of the present invention is to be regarded as the protection scope of the present invention.
Claims (2)
1. An underwater glider cooperative controller system, characterized in that: the communication network is based on a non-periodic communication mechanism and is respectively connected with the plurality of controller units after passing through the non-periodic communication mechanism;
the controller unit comprises a coordination module, a path tracking guidance module, a dynamics module, a fuzzy observer, a fuzzy controller based on low-frequency learning and a preset trigger event module; two input ends of the cooperation module are respectively connected with the output end of the path tracking guidance module and the output end of the communication network, and three output ends of the cooperation module are respectively connected with the input end of the path tracking guidance module, the input end of the communication network and the input end of the preset trigger event module; the path tracking guidance module has four input ends, wherein three input ends are respectively connected with the output end of the underwater glider, the output end of the fuzzy observer and the output end of the cooperation module, and the fourth input end is given path parameters; the other output end of the path tracking guidance module is respectively connected with the input end of the dynamics module and the input end of the fuzzy controller based on low-frequency learning; the other input end of the dynamics module is connected with the output end of the fuzzy controller based on low-frequency learning, and the two output ends of the dynamics module are respectively connected with the two input ends of the underwater glider and the two input ends of the low-frequency learning + controller; the other input end of the fuzzy controller based on low-frequency learning is connected with the output end of the fuzzy observer, and the output end of the fuzzy controller based on low-frequency learning is connected with the input end of the dynamics module; three input ends of the preset trigger event module are respectively connected with the output end of the synergy module before triggering, the output end of the synergy module after triggering and the output end of the neighbor preset trigger event module, and the output end of the preset trigger event module is connected with the trigger switch;
the underwater glider comprises six degrees of freedom when moving underwater, and the motion equation of the underwater glider is a complex multivariable system which is nonlinear, under-actuated and strongly coupled; in practical studies, the spatial motion of the underwater glider is decomposed into horizontal plane motion and vertical plane motion, and the coupling between the horizontal plane motion and the vertical plane motion is ignored, and the kinematic and dynamic model of the underwater glider in the vertical plane is represented by the following formula:
wherein:
in the formula, subscript i is the number of the underwater glider,pose information, x, for an underwater glider i 、y i And theta i Respectively longitudinal position information, vertical position information and longitudinal rocking angle information of the underwater glider, wherein T represents the transposition of a matrix or a vector;the velocity vectors of the underwater glider are respectively longitudinal velocity, vertical velocity and longitudinal rocking angular velocity;unknown control gains of the underwater glider in the longitudinal direction, the vertical direction and the pitching direction are respectively related to the quality of the underwater glider, and diag {. cndot } represents a diagonal matrix;respectively representing the control input of the underwater glider in the longitudinal direction, the vertical direction and the pitching direction;is the uncertainty disturbance to the underwater glider, where f i (t,η i ,υ i )=-C i (υ i )υ i -D i (υ i )υ i -g i (υ i ,η i )+τ id (t),f iu (·)、f iw (·)、f iq (. is) i.e. f iu (t,u i ,w i ,θ i ,q i )、f iw (t,u i ,w i ,θ i ,q i )、f iq (t,u i ,w i ,θ i ,q i ) Representing the non-linear equations relating hydrodynamic damping effects in the longitudinal, vertical and pitch directions, respectively, C i Is a hydrodynamic and centripetal matrix of fluids, D i As a damping matrix, g i For unmodeled dynamics, τ id (t)=[d iu ,d iw ,d iq ] T Respectively representing the external environment disturbance of the underwater glider in the longitudinal direction, the vertical direction and the pitching direction; m i =diag{m iu m iw m iq The inertia matrixes of the underwater glider in the longitudinal direction, the vertical direction and the pitching direction are respectively.
2. A design method of an underwater glider cooperative controller system with non-periodic communication is characterized in that: the method comprises the following steps:
A. design of collaboration modules
The input signal of the cooperative module is the path of the neighbor of the ith underwater gliderDiameter parameter informationAnd the longitudinal position error x of the ith underwater glider output by the path tracking guidance module ie Output signal ω of said synergy module i 、χ i (t) is designed as follows:
in the formula: mu.s i Is a normal number; chi shape i Is a path parameter; upsilon is s Is the path parameter χ i The path update speed of (1); omega i Is based on the path parameter of the non-periodic communication mechanism;is based on the path parameter cooperation error of the non-periodic communication mechanism, wherein a ij In order to gain in the consistency of the data,is the trigger time and satisfies k ∈ Z ≥0 ,For the next time of the trigger, the trigger time,based on the self-estimated path parameters for the underwater glider i,estimating a path parameter for the underwater glider j based on the neighboring underwater glider i; and isWherein x' id (χ i )、z′ id (χ i ) Are respectively x id (χ i )、z id (χ i ) Partial derivatives of (d);
B. design of path tracking guidance module
The input signal to the path tracking guidance module is a given path signal p id (χ i ) Pose information eta of underwater glider i =[x i ,z i ,θ i ] T And an estimated state of velocity vector vWherein p is id (χ i )=(x id (χ i ),z id (χ i ) Is X) E -Z E Given path signals under a coordinate system, the output signal is the longitudinal position error x of the underwater glider ie Desired forward speed u iu Desired pitch velocity q iq And a desired pitch angle theta iθ ;
Wherein x is ie ,z ie ,θ ie Respectively a longitudinal position error, a vertical position error and a longitudinal angle error of the underwater glider; respectively estimating errors of the longitudinal direction, the vertical direction and the pitching direction;are each u i ,w i An estimated value of (d);is a normal number; to control the gain; alpha (alpha) ("alpha") i Is an angle of attack; phi is a i =sinθ ie cos(θ iθ -θ id -α i )+(cosθ ie -1)sin(θ iθ +θ id -α i );ε i Is a normal number;and | l iε |≤ε i ;
C. Design of fuzzy observer
The input of the fuzzy observer is the pose information eta of the underwater glider i =[x i ,z i ,θ i ] T (ii) a The output is the estimated speed information of the underwater glider
The velocity estimation equation is as follows:
wherein, are respectively x i ,z i ,θ i ,u i ,w i ,q i An estimated value of (d);are respectively f iu (·)、f iw (·)、f iq An estimate of (·); and ist d Is the period of the sampling, and,for the known function of continuous excitation, the excitation is,namely the vector of the N-dimension,i.e., a 3-dimensional vector;for the purpose of the estimated weight factors,i.e., an N × 3 dimensional matrix;is M i The inverse matrix of (d);is a control gain matrix;to estimate the error;
D. design of fuzzy controller based on low frequency learning
The input signal of the fuzzy controller based on low-frequency learning is the expected value u of the underwater glider iu ,q iq ,θ iθ Estimated state of velocity vector vAnd the output signal tau of the dynamics module iu ,τ iq (ii) a The output signal being an uncertainty observationError of estimated speed from actual speed
The designed fuzzy controller based on low-frequency learning is as follows:
wherein:
T i =diag{R T (θ i ),I 3 }
S T =diag{S T ,0 3 }
wherein is e i Is an error, satisfies Is a normal number;ι i is a positive constant;is composed ofThe estimated weight after passing through a low-pass filter;an estimation error that is a weight;
E. design of kinetic modules
The input signal to the dynamics module is the desired state u of the underwater glider iu ,q iq ,θ iθ Error of estimated speed and actual speedAnd uncertainty observationThe output signal is a control input signal tau of an underwater glider iu ,τ iq (ii) a Output signal tau of a dynamics module iu ,τ iq The design of (2) is as follows:
wherein:
k iu ,k iq is a constant that is positive for a given value,are all normal numbers, and function as treatment b iu 0 and b iq A singularity case when 0;
F. design of preset trigger event module
Presetting the input signal of a trigger event module as the current path parameter chi of the ith underwater glider i (t), last trigger timePath parameter of last trigger timeAnd the derivative of the path parameter at the time of the last triggerPath parameter of last triggering moment of neighbor underwater glider jAnd the derivative of the path parameter at the time of the last trigger
The parameter cooperation error based on the aperiodic communication mechanism is as follows:
wherein:
the path parameter collaborative error is based on the information of the neighbor underwater glider; the output signal of the trigger event module is preset to be ET, and when the preset ET condition is met, the information packet is sentThe trigger condition ET is designed as follows:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011555801.6A CN112666832B (en) | 2020-12-23 | 2020-12-23 | Non-periodic communication underwater glider cooperative controller system and design method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011555801.6A CN112666832B (en) | 2020-12-23 | 2020-12-23 | Non-periodic communication underwater glider cooperative controller system and design method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112666832A CN112666832A (en) | 2021-04-16 |
CN112666832B true CN112666832B (en) | 2022-08-30 |
Family
ID=75408545
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011555801.6A Active CN112666832B (en) | 2020-12-23 | 2020-12-23 | Non-periodic communication underwater glider cooperative controller system and design method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112666832B (en) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113342010B (en) * | 2021-06-03 | 2023-05-23 | 大连海事大学 | Self-triggering communication underwater glider cooperative control system |
CN113342016B (en) * | 2021-06-23 | 2022-05-24 | 湖南大学 | Autonomous underwater robot cooperative control method and system based on dynamic event triggering |
CN114035592B (en) * | 2021-11-22 | 2023-05-16 | 大连海事大学 | Three-dimensional collaborative path tracking control system of underwater glider |
CN113970887B (en) * | 2021-11-22 | 2023-11-14 | 大连海事大学 | Multi-underwater glider path planning system based on optimal energy consumption |
CN114460948B (en) * | 2022-02-06 | 2024-02-02 | 西北工业大学 | Underwater glider pitch angle robust self-adaptive control method based on event triggering strategy |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107085427A (en) * | 2017-05-11 | 2017-08-22 | 华南理工大学 | A kind of unmanned water surface ship formation control method for following structure based on leader |
CN107255923A (en) * | 2017-06-14 | 2017-10-17 | 哈尔滨工程大学 | Drive lacking unmanned boat Track In Track control method based on the RBF ICA CMAC neutral nets recognized |
CN108227502A (en) * | 2018-01-22 | 2018-06-29 | 哈尔滨工程大学 | One kind is overdrived AUV executing agencies method for handover control |
CN108594845A (en) * | 2018-03-23 | 2018-09-28 | 哈尔滨工程大学 | More AUV formation methods based on PREDICTIVE CONTROL under a kind of communication limitation |
CN109765892A (en) * | 2019-01-16 | 2019-05-17 | 大连海事大学 | A kind of collision of unmanned boat cluster is from evading formation control device structure and design method |
CN109799818A (en) * | 2019-01-15 | 2019-05-24 | 大连海事大学 | The unmanned boat collaboration handling controller and its design method of multi-parameter route guidance |
CN110362095A (en) * | 2019-08-09 | 2019-10-22 | 大连海事大学 | A kind of design method of finite time convergence control unmanned boat collaborative controller |
CN111273671A (en) * | 2020-03-03 | 2020-06-12 | 大连海事大学 | Non-periodic communication remote observer of intelligent ship |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010101749A1 (en) * | 2009-03-05 | 2010-09-10 | Massachusetts Institute Of Technology | Predictive semi-autonomous vehicle navigation system |
WO2017019595A1 (en) * | 2015-07-27 | 2017-02-02 | Genghiscomm Holdings, LLC | Airborne relays in cooperative-mimo systems |
-
2020
- 2020-12-23 CN CN202011555801.6A patent/CN112666832B/en active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107085427A (en) * | 2017-05-11 | 2017-08-22 | 华南理工大学 | A kind of unmanned water surface ship formation control method for following structure based on leader |
CN107255923A (en) * | 2017-06-14 | 2017-10-17 | 哈尔滨工程大学 | Drive lacking unmanned boat Track In Track control method based on the RBF ICA CMAC neutral nets recognized |
CN108227502A (en) * | 2018-01-22 | 2018-06-29 | 哈尔滨工程大学 | One kind is overdrived AUV executing agencies method for handover control |
CN108594845A (en) * | 2018-03-23 | 2018-09-28 | 哈尔滨工程大学 | More AUV formation methods based on PREDICTIVE CONTROL under a kind of communication limitation |
CN109799818A (en) * | 2019-01-15 | 2019-05-24 | 大连海事大学 | The unmanned boat collaboration handling controller and its design method of multi-parameter route guidance |
CN109765892A (en) * | 2019-01-16 | 2019-05-17 | 大连海事大学 | A kind of collision of unmanned boat cluster is from evading formation control device structure and design method |
CN110362095A (en) * | 2019-08-09 | 2019-10-22 | 大连海事大学 | A kind of design method of finite time convergence control unmanned boat collaborative controller |
CN111273671A (en) * | 2020-03-03 | 2020-06-12 | 大连海事大学 | Non-periodic communication remote observer of intelligent ship |
Non-Patent Citations (3)
Title |
---|
《Adaptive Cooperative Diving of Saucer-Type Underwater Gliders Subject to Model Uncertainties and Input Constraints》;HAOLIANG WANG.etc;《IEEE Access》;20170507;第7卷;第60042-60054页 * |
《Output-Feedback Control for Cooperative Diving of Saucer-Type Underwater Gliders Based on a Fuzzy Observer and Event-Triggered Communication》;HAOLIANG WANG.etc;《IEEE Access》;20190415;第50453-50465页 * |
《多自主船协同路径跟踪的自适应动态面控制》;王昊等;《控制理论与应用》;20130531;第30卷(第5期);第637-643页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112666832A (en) | 2021-04-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112666832B (en) | Non-periodic communication underwater glider cooperative controller system and design method | |
CN108445892B (en) | Under-actuated unmanned ship formation controller structure and design method | |
Li et al. | Robust time-varying formation control for underactuated autonomous underwater vehicles with disturbances under input saturation | |
CN113189979B (en) | Finite time control method for distributed queue of unmanned ship | |
Wang et al. | Neuroadaptive sliding mode formation control of autonomous underwater vehicles with uncertain dynamics | |
CN107168312B (en) | Space trajectory tracking control method for compensating UUV kinematic and dynamic interference | |
CN112965371B (en) | Water surface unmanned ship track rapid tracking control method based on fixed time observer | |
CN109799818B (en) | Design method of unmanned ship cooperative operation controller guided by multi-parametric path | |
CN108710373B (en) | Networked under-actuated unmanned ship distributed formation controller and design method thereof | |
CN110609556A (en) | Multi-unmanned-boat cooperative control method based on LOS navigation method | |
CN114779645B (en) | Pectoral fin flapping robot fish formation control method under directional fixed communication topology | |
CN114115262B (en) | Multi-AUV actuator saturation cooperative formation control system and method based on azimuth information | |
CN114442640B (en) | Track tracking control method for unmanned surface vehicle | |
CN113342010B (en) | Self-triggering communication underwater glider cooperative control system | |
Er et al. | Intelligent trajectory tracking and formation control of underactuated autonomous underwater vehicles: A critical review | |
Pandian et al. | A neuro-fuzzy controller for underwater robot manipulators | |
Jing et al. | Self-tuning adaptive active disturbance rejection pitch control of a manta-ray-like underwater glider | |
Dong et al. | An improved dynamic surface sliding mode method for autonomous cooperative formation control of underactuated USVs with complex marine environment disturbances | |
Wang et al. | Distributed finite-time velocity-free robust formation control of multiple underactuated AUVs under switching directed topologies | |
CN113147438A (en) | Wireless charging system of underwater vehicle and control method | |
Pang et al. | Multi-AUV formation reconfiguration obstacle avoidance algorithm based on affine transformation and improved artificial potential field under ocean currents disturbance | |
CN115903820A (en) | Multi-unmanned-boat pursuit and escape game control method | |
Ihle | Coordinated control of marine craft | |
Ghommam et al. | Coordinated path following for multiple underactuated AUVs | |
Marais et al. | Go with the flow: energy minimising periodic trajectories for UVMS |
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 |