Asynchronous collaborative search task-oriented air-sea collaborative system autonomous navigation control method
By constructing the nonlinear system model of ship-drone and designing adaptive control law, the problem of low path tracking accuracy in asynchronous collaborative tasks is solved, and high-precision ship-drone collaborative control is achieved, reducing equipment Manipulation and communication burden.
Patent Information
- Application Number
- CN202411136724.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-19
- Publication Date
- 2024-11-26
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
In the existing ship-drone path tracking control, traditional algorithms cause path tracking control accuracy to be reduced in asynchronous coordinated tasks, and the event triggering mechanism causes frequent manipulation of driver devices and frequent occupation of communication, affecting accuracy and equipment life.
Build a nonlinear system model of ship-drone, design a parallel control law for aircraft and ships, use radial basis function neural network and minimum learning parameter algorithm to process nonlinear terms, and design an adaptive control law for combined event triggering mechanism to reduce communication burden and energy loss.
It improves the accuracy of ship-drone path tracking control, reduces the manipulation frequency and communication burden of the drive equipment, and enhances the automation and manipulation of the system.
Smart Images

Figure CN119024698A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of ship and unmanned aerial vehicle motion control, and in particular to an autonomous navigation control method of an air-sea collaborative system for asynchronous collaborative search tasks. Background Art
[0002] In the field of navigation, the path tracking control system consists of three subsystems: guidance, control, and navigation. The guidance system can automatically construct a reference signal based on the positional relationship between the current attitude of the ship-UAV system and the desired path; the control system can achieve effective convergence by stabilizing the error between the current attitude and the reference signal; the navigation system can transmit the position and attitude information of the controlled object to the guidance system and the control system through sensors. Guidance and control are two important subsystems in path tracking control. In existing research results, the guidance system mostly relies on time to divide the path into straight segments and turning segments for separate calculations. In the control system, there is no complete control theory for the heterogeneous cooperative control of ships and UAVs. Although the 3D mapping guidance algorithm constructs the guidance framework of the UAV-ship cooperative system, due to the limitation of the consistency of the ship and the aircraft, that is, the trajectory of the UAV and the ship is consistent, the algorithm is not suitable for air-sea collaborative asynchronous search tasks.
[0003] Based on the above analysis, the ship-UAV path tracking control algorithm based on 3D mapping guidance has the following two main defects in the collaborative control task between the two:
[0004] 1) The traditional LVS guidance algorithm needs to calculate the time of the straight segment and the turning segment first, and then parse the guidance reference signal. In navigation practice, this guidance strategy will produce cumulative errors in position and attitude at the switching point (straight segment-turning segment). For navigation situations with many waypoints (such as narrow waterways and island and reef waters), it will affect the accuracy of its path tracking control.
[0005] 2) Since the command signal generated by the control system needs to be transmitted to the drive device in real time to drive the ship-UAV stabilization error. Continuous control signals may lead to frequent manipulation of the drive device, further causing unnecessary wear of the drive device and frequent occupation of the communication channel. To solve this problem, the event trigger mechanism is a common method, but it is easy to lead to a significant reduction in control accuracy. Summary of the invention
[0006] The present invention provides an autonomous navigation control method for an air-sea collaborative system for asynchronous collaborative search tasks, so as to overcome the technical problem that in ship-UAV path tracking control, the traditional algorithm and event trigger mechanism are used for tracking control, resulting in reduced path tracking control accuracy.
[0007] In order to achieve the above object, the technical solution of the present invention is:
[0008] The autonomous navigation control method of the air-sea collaborative system for asynchronous collaborative search tasks includes:
[0009] S1: Construct a ship-UAV nonlinear system model as the controlled object of the control law designed in the subsequent steps;
[0010] S2: Constructing a parallel control law for the ship and the aircraft, obtaining a ship-UAV asynchronous collaborative search and navigation waypoint path according to the parallel control law for the ship and the aircraft, and then obtaining a virtual reference path for the ship and the UAV, and obtaining an expected angle and an expected speed for the ship and the UAV according to the reference path;
[0011] S3: According to the expected angle and the expected speed, the position error and attitude error of the ship-UAV are obtained, and virtual control laws of the position error and attitude error are respectively constructed to eliminate the position error and attitude error of the ship-UAV;
[0012] S4: using a radial basis function neural network and a minimum learning parameter algorithm to approximate the nonlinear terms of the ship-UAV nonlinear system model, and obtaining adaptive parameters and robust damping terms of the virtual control law of the position error and attitude error respectively;
[0013] S5: constructing an event-triggered control law based on the event-triggered mechanism, and designing a control law and an adaptive law of the ship-UAV according to the event-triggered control law, the adaptive parameters, the robust damping term and the disturbance compensation mechanism;
[0014] S6: Based on the ship-UAV control law and adaptive law, adaptive control of the ship-UAV collaborative system is realized.
[0015] Furthermore, S1 constructs a ship-UAV nonlinear system model, as shown in formulas (1) and (2):
[0016]
[0017] in,
[0018]
[0019] Where, formula (1) is the nonlinear system model of the UAV, formula (2) is the nonlinear system model of the ship, [x jj ,y jj ,z a ,φ a ,θ a ,ψ jj ] T, jj=s, a represents the forward, drift, heave displacement and roll, pitch and pitch angle of the ship-UAV cooperative system, represents the forward, drift and pitch speed of the ship, ν a =[u ax ,u ay ,u az ,p a ,q a ,r a ] T It represents the speed and angular velocity of the drone along the ox, oy, oz axes, i.e. the forward, drift, heave speed of the drone and the angular velocity of the roll, pitch and yaw of the drone; m u ,m v ,m r It represents the additional mass of the ship in the forward, drifting and bow rolling directions, d ii1 ,d ii2 ,d ii3 ,ii=u,v,r represents the nonlinear damping term of the model; m a represents the mass of the drone, g represents the acceleration of gravity, d represents the diagonal diameter of the drone, and I xx ,I yy ,I zz represents the rotational inertia of the drone along the ox, oy, oz axis, k dx ,k dy ,k dz It represents the rotational drag coefficient of the drone along the ox, oy, oz axis, d ll ,ll=u s ,v s ,r s ,u ax ,u ay ,u az ,p a ,q a ,r a It indicates the external interference force / torque on the ship in the forward, drifting, and pitching directions and on the UAV in the forward, drifting, heave, roll, pitch, and pitching directions; τ f represents the rotor force of the UAV, τ φ ,τ θ ,τ ψ represents the roll, pitch and pitch moment of the UAV, τ u ,τ r It represents the forward thrust and turning moment of the ship. It represents the nonlinear term of the speed and angular velocity of the drone along the ox, oy, oz axes. They represent the nonlinear terms of the ship's forward, sideways and bow rolling speeds respectively.
[0020] Furthermore, a parallel control law for a motor-ship is constructed, and a ship-UAV asynchronous collaborative search and navigation waypoint path is obtained according to the parallel control law for the motor-ship, and then a virtual reference path for the ship-UAV is obtained, and an expected angle and an expected speed of the ship-UAV are obtained according to the reference path, including:
[0021] S21. Constructing the parallel control law of the motor ship:
[0022] Define the ship parallel search width L w , turn to search width L s , UAV cycle width W sl and the drone cycle length L sl , where W sl ≤2W sc , W sc Indicates the search radius of the drone;
[0023] In the parallel search width L of the ship w In the distance of the segment, the UAV makes a circular motion around the ship, searching for the width L according to the steering s and the drone cycle width W sl , obtain the number of complete cycles n of the UAV and the distance m from the ship after the cycle ends, that is, the parallel control law of the UAV and the ship, as shown in formula (3),
[0024]
[0025] When m≤W sl When the drone flies to the other side of the ship, it tracks the waypoints for the next section of the path;
[0026] When m>W sl When the drone continues to cycle to L w End, and then track the waypoints of the next path;
[0027] S22, connecting all waypoints to form a waypoint path;
[0028] S23, using L1 ship-L1 drone to obtain a virtual reference path of ship-drone, wherein the L1 ship and L1 drone are virtual ships and drones set to obtain a straight line or arc navigation path:
[0029] S231: Determine the reference path of the ship through L1 real-time ship planning, as shown in formula (4),
[0030]
[0031] In the formula, x sd ,y sd ,ψ sd l1 represents the ship's forward and drift distance and heading angle, usd ,r sd l1 represents the forward speed and yaw angular velocity of the ship, u sd According to the actual situation, set sd As shown in formula (5),
[0032]
[0033] Where, L 1s is the distance from L1 ship to the turning reference point, η s =ψ sd -ψ L1s , ψ L1s is the azimuth of the L1 ship to the reference point, η s Indicates the heading difference angle of L1 ship;
[0034] The azimuth angle ψ from the actual ship to the L1 ship r As shown in formula (6),
[0035]
[0036] In the formula, x se =x sd -x s ,y se =y sd -y s is the ship's forward and horizontal drift distance error; x s and s Indicates the actual forward and sideways displacement of the ship;
[0037] S232: Determine the reference path of the drone through L1 drone real-time planning, as shown in formula (7),
[0038]
[0039] Among them, x ad ,y ad ,ψ ad Indicates the forward and drift distances and heading angles of the L1 UAV, u ad ,r ad represents the forward speed and yaw rate of the L1 UAV, L ls ,L la are the total distances of L1 ship and L1 UAV, and the heave distance z of L1 UAV ad The expected flight altitude of the UAV is set according to the search mission requirements;
[0040] Obtain the expected angle and expected speed, that is, the forward and drift distances, heading angles, forward speeds, bow angular velocity and heave distance of the L1 ship and L1 UAV.
[0041] Further, S3 obtains the position error and attitude error of the ship-UAV according to the expected angle and the expected speed, and constructs virtual control laws of the position error and attitude error respectively to eliminate the position error and attitude error of the ship-UAV, including:
[0042] S31. According to the expected angle and expected speed, define the ship position error and the UAV forward, drift, and heave distance errors, that is, the UAV position error, as shown in formula (8):
[0043]
[0044] In the formula, z se represents the ship position error, x se Represents the ship's forward distance error, y se Indicates the ship's drift distance error, x ae Indicates the UAV forward distance error, y ae Indicates the UAV drift distance error, z ae Indicates the heave distance error of the UAV, x ad Indicates the distance traveled by the L1 drone, y ad Indicates the horizontal drift distance of the L1 drone, z ad Indicates the rise and fall distance of the L1 drone, x a Indicates the actual distance the drone moves forward, y a Indicates the actual drift distance of the drone, z a Indicates the actual UAV heave distance;
[0045] The ship position error and the drone position error are derived, as shown in formula (9):
[0046]
[0047] In the formula, ψ se =ψ r -ψ s is the ship's pitch angle error; ψ s Indicates the actual ship's pitch angle;
[0048] Design the virtual control law of position error, as shown in formula (10):
[0049]
[0050] In the formula, They represent the virtual control laws for the ship position error and the UAV forward, drift, and heave distance errors, respectively. They represent the virtual control law Positive design parameters;
[0051] S32. According to the expected angle and expected speed, define the ship attitude error, the UAV roll, pitch, and bow angle errors, that is, the UAV attitude error, as shown in formula (11),
[0052]
[0053] In the formula, ψ se ,φ ae ,θ ae ,ψ ae Respectively represent the ship's bow angle, UAV's roll, UAV's pitch and UAV's bow angle error; φ ad represents the roll angle of the L1 drone, θ ad represents the reference pitch angle of the L1 UAV, φ a represents the roll angle of the actual drone, θ a represents the actual pitch angle of the UAV, ψ a represents the actual pitch angle of the UAV; ψ ad Indicates the heading angle of the L1 UAV;
[0054] The ship attitude error and the UAV attitude error are derived, as shown in formula (12):
[0055]
[0056] Design the virtual control law of attitude error, as shown in formula (13):
[0057]
[0058] In the formula, is a virtual control law greater than zero Control parameters.
[0059] Furthermore, S4 uses a radial basis function neural network and a minimum learning parameter algorithm to approximate the nonlinear terms of the ship-UAV nonlinear system model, and obtains adaptive parameters and robust damping terms of the virtual control law of position error and attitude error, respectively, including:
[0060] S41. Introduce dynamic surface technology to reduce the order of the derivative of the virtual control law of the position error, as shown in formula (14):
[0061]
[0062] In the formula, ∈ iis a time constant greater than zero, and the dynamic surface error y i =α i -β i β i Dynamic surface signal representing position error, α i represents the virtual control law of position error;
[0063] Define the speed error i e =β i -i, and take the derivative, as shown in formula (15),
[0064]
[0065] In the formula, f i ,i=u s ,u ax ,u ay ,u az It represents the nonlinear terms of the ship's forward movement, the UAV's forward movement, drift, and heave speed in the ship-UAV nonlinear system model; They represent the derivatives of the ship's forward speed, the UAV's forward speed, the drift speed, and the heave speed error respectively; d wi It represents the external interference force on the ship's forward movement and the UAV's forward movement, drift, and heave directions in the ship-UAV nonlinear system model;
[0066] S42, using radial basis function neural network to i Perform online approximation and introduce the adaptive parameters in the minimum learning parameter algorithm to simplify it, as shown in formula (16):
[0067]
[0068] In the formula, A i represents f i Neural network weight update law, S i represents the Gaussian function, ε i represents the approximation error, λ i Adaptive parameters introduced by the minimum learning parameter algorithm, Represents λ i The robust damping term, γ i1 and γ i2 is a positive constant;
[0069] S43, introduce the dynamic surface technology to reduce the order of the derivative of the virtual control law of the attitude error, as shown in formula (17),
[0070]
[0071] In the formula, ∈ j is a time constant greater than zero, and the dynamic surface error yj =α j -β j , β j Dynamic surface signal representing attitude error, α j represents the virtual control law of attitude error;
[0072] Define the angular velocity error j e =β j -j,j=r s ,r a ,p a ,q a , and take the derivative, as shown in formula (18),
[0073]
[0074] In the formula, f j ,j=r s ,p a ,q a ,r a represents the nonlinear terms of the ship's bow angular velocity, the UAV's roll, pitch and bow angular velocity in the ship-UAV nonlinear system model; d wj It represents the ship's bow angle in the ship-UAV nonlinear system model, and the external interference forces on the UAV in the roll, pitch and bow directions;
[0075] S44, using radial basis function neural network to j Perform online approximation and introduce the adaptive parameters in the minimum learning parameter algorithm to simplify, as shown in formula (19):
[0076]
[0077] In the formula, A j represents f j Neural network weight update law, S j represents the Gaussian function, ε j represents the approximation error, λ j Adaptive parameters introduced by the minimum learning parameter algorithm, Represents λ j The robust damping term, γ j1 and γ j2 is a positive constant.
[0078] Furthermore, S5 constructs an event-triggered control law based on the event-triggered mechanism, including:
[0079] S51. Construct an event-triggered control law for position error based on the event-triggered mechanism:
[0080] S511: Define the intermediate variables of the ship-UAV nonlinear system to simplify the control design. The intermediate variables are shown in formula (20):
[0081]
[0082] In the formula, The actuator intermediate control law representing the ship's forward direction, the UAV's forward direction, the drift direction, and the heave direction, that is, the position error actuator intermediate control law;
[0083] S512: Introduce an input-based event trigger mechanism into the intermediate control law of the position error actuator to construct an event trigger rule, as shown in formulas (21) and (22),
[0084]
[0085] In the formula, ζ i In order to introduce the event-triggered control law of the position error actuator, express The last trigger time of Represents τ ι The last trigger time of g i ,h i is a constant parameter, satisfying 0 <g i <1,h i >0, where i=u s ,u ax ,u ay ,u az ;
[0086] S513: Obtain a control signal of the position error actuator according to the event triggering mechanism, as shown in formula (23):
[0087]
[0088] In the formula, ξ i1 ,ξ i2 is a constant whose absolute value is less than 1;
[0089] S52. Construct an event-triggered control law for attitude error based on the event-triggered mechanism:
[0090] S521: Define the intermediate variables of the ship-UAV nonlinear system to simplify the control design. The intermediate variables are shown in formula (24):
[0091]
[0092] In the formula, The actuator intermediate control law representing the ship's pitch direction, the UAV's roll, pitch and pitch direction, that is, the attitude error actuator intermediate control law;
[0093] S522: Introduce an input-based event trigger mechanism into the intermediate control law of the attitude error actuator to construct an event trigger rule, as shown in formulas (25) and (26),
[0094]
[0095]
[0096] In the formula, ζ ρ In order to introduce the event-triggered control law of the attitude error actuator, express The last trigger time, g j ,h j is a constant parameter, satisfying 0 <g j <1,h j >0;
[0097] S523: Obtain a control signal of the attitude error actuator according to the event triggering mechanism, as shown in formula (27):
[0098]
[0099] In the formula, ξ j1 ,ξ j2 is a constant whose absolute value is less than 1.
[0100] Further, S5 designs the control law and adaptive law of the ship-UAV according to the event triggering control law, the adaptive parameters, the robust damping term and the interference compensation mechanism, including:
[0101] S53, Introduction As λ i The estimated value of As ω i The estimated value of is used to design the position control law and the adaptive law according to the control signal of the ship-UAV position error actuator, the adaptive parameters of the position error virtual control law, the robust damping term and the disturbance compensation mechanism, as shown in formulas (28) and (29),
[0102]
[0103] In the formula, k i ,Γ i , δ i ,μ i is a design parameter greater than zero; irepresents the adaptive parameter of the virtual control law of position error, ω i Represents the external interference force d wi The maximum value of
[0104] S54, Introduction and As λ j and ω j According to the estimated value of the attitude error actuator control signal, the adaptive parameters of the attitude error virtual control law, the robust damping term and the disturbance compensation mechanism, the ship-UAV attitude controller and the adaptive law are designed, as shown in formulas (30) and (31).
[0105]
[0106]
[0107] In the formula, I ρ =I xx ,I yy ,I zz , k j ,Γ j , δ j ,μ j is a design parameter greater than zero, λ j represents the adaptive parameter of the virtual control law of attitude error, ω j Represents the external interference force d wj The maximum value of .
[0108] Furthermore, the nonlinear decoupling technology is used to solve formula (28) to obtain the reference roll angle and pitch angle φ of the UAV: ad ,θ ad , as shown in formula (32),
[0109]
[0110] Beneficial effects: The present invention provides an autonomous navigation control method for an air-sea collaborative system for asynchronous collaborative search tasks, establishes a nonlinear system model of a ship-UAV system, and constructs a parallel control law for a ship and a machine, autonomously plans the search path of the ship-UAV according to the target search water range and the UAV search performance, and ensures the collaborative task of the ship-UAV. By introducing a radial basis function neural network and a minimum parameter learning algorithm, the nonlinear terms in the ship-UAV collaborative system model are processed, and a controller is designed for the ship-UAV system to reduce the adaptive parameters in the controller, which is beneficial to the maneuverability of the heterogeneous system. Finally, event-triggered control and interference compensation mechanism are combined to construct control laws and adaptive laws, which reduces the communication burden from the controller to the actuator, improves transmission efficiency, avoids unnecessary energy loss, and improves the overall path tracking control accuracy. BRIEF DESCRIPTION OF THE DRAWINGS
[0111] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the following briefly introduces the drawings required for use in the embodiments or the description of the prior art. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.
[0112] Figure 1 A method flow chart of the autonomous navigation control method of the air-sea collaborative system for asynchronous collaborative search tasks of the present invention;
[0113] Figure 2 A schematic diagram of a waypoint path is generated for the asynchronous collaborative search and guidance of the present invention;
[0114] Figure 3 The framework diagram of the present invention using L1 ship-L1 UAV to generate guidance reference signal;
[0115] Figure 4 A three-dimensional trajectory diagram of a ship-UAV collaborative search path tracking in an embodiment of the present invention;
[0116] Figure 5 A planar trajectory diagram of a ship-UAV collaborative search path tracking in an embodiment of the present invention;
[0117] Figure 6 It is a diagram of the ship control input and the rotor force of the drone in one embodiment of the present invention;
[0118] Figure 7 This is a diagram of the ship position error and the ship-UAV collaborative system attitude error in one embodiment of the present invention. DETAILED DESCRIPTION
[0119] In order to make the purpose, technical solution and advantages of the embodiments of the present invention clearer, the technical solution in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0120] This embodiment provides an autonomous navigation control method for an air-sea collaborative system for asynchronous collaborative search tasks. Figure 1 As shown, including:
[0121] S1: Construct a ship-UAV nonlinear system model as the controlled object of the control law designed in the subsequent steps;
[0122] S2: Constructing a parallel control law for the ship and the aircraft, obtaining a ship-UAV asynchronous collaborative search and navigation waypoint path according to the parallel control law for the ship and the aircraft, and then obtaining a virtual reference path for the ship and the UAV, and obtaining an expected angle and an expected speed for the ship and the UAV according to the reference path;
[0123] S3: According to the expected angle and the expected speed, the position error and attitude error of the ship-UAV are obtained, and virtual control laws of the position error and attitude error are respectively constructed to eliminate the position error and attitude error of the ship-UAV;
[0124] S4: using a radial basis function neural network and a minimum learning parameter algorithm to approximate the nonlinear terms of the ship-UAV nonlinear system model, and obtaining adaptive parameters and robust damping terms of the virtual control law of the position error and attitude error respectively;
[0125] S5: constructing an event-triggered control law based on the event-triggered mechanism, and designing a control law and an adaptive law of the ship-UAV according to the event-triggered control law, the adaptive parameters, the robust damping term and the disturbance compensation mechanism;
[0126] S6: Based on the ship-UAV control law and adaptive law, adaptive control of the ship-UAV collaborative system is realized.
[0127] Specifically, firstly, a ship-UAV nonlinear system model is constructed as the controlled object of the control law designed in the subsequent steps, and at the same time, nonlinear terms are obtained to approximate the nonlinear terms in the subsequent steps, and then prepare for designing virtual control laws; secondly, a ship-machine parallel control law is constructed to obtain the ship-UAV asynchronous collaborative search navigation waypoint path, and then obtain the ship-UAV virtual reference path, and obtain the expected angle and expected speed of the ship-UAV according to the reference path. The search path of the ship-UAV can be autonomously planned according to the target search water range and the UAV search performance, and the speed of the ship and the UAV is related, which can ensure the collaborative task of the ship-UAV; according to the expected angle and expected speed, the position error and attitude error of the ship-UAV are obtained, and virtual control laws of the position error and attitude error are respectively constructed to eliminate the position error and attitude error of the ship-UAV, the position error and attitude error of the ship are obtained, and a virtual control law is designed to eliminate the error, which can achieve accurate tracking of the ship-UAV, and more The navigation requirements are met and the guidance accuracy is higher; the nonlinear terms of the ship-UAV nonlinear system model are approximated by using a radial basis function neural network and a minimum learning parameter algorithm, and the adaptive parameters and robust damping terms of the virtual control laws of the position error and attitude error are obtained respectively; the nonlinear terms in the ship-UAV collaborative system are processed by a radial basis function neural network system and a minimum learning parameter algorithm; at the same time, a controller is designed for the ship-UAV system to reduce the adaptive parameters in the controller, which is beneficial to the maneuverability of the heterogeneous system and improves the automation of the ship-UAV in the air-sea collaborative search mission; an event-triggered control law is constructed based on an event-triggered mechanism, and the control law and adaptive law of the ship-UAV are designed according to the event-triggered control law, the adaptive parameters, the robust damping terms and the interference compensation mechanism, and the event-triggered control and the interference compensation mechanism are combined to achieve the dynamic compromise requirements of the transmission load and the control accuracy; finally, the adaptive control of the ship-UAV collaborative system is realized based on the control law and the adaptive law of the ship-UAV.
[0128] In a specific embodiment, the scheme for constructing a ship-UAV nonlinear system model is:
[0129] The ship-UAV nonlinear system model is shown in formulas (33) and (34),
[0130]
[0131]
[0132] in,
[0133]
[0134] Where, formula (33) is the nonlinear system model of the UAV, formula (34) is the nonlinear system model of the ship, [x jj ,y jj ,z a ,φ a ,θ a ,ψ jj ] T , jj=s, a represents the forward, drift, heave displacement and roll, pitch and pitch angle of the ship-UAV cooperative system, and v represents the forward, drift and pitch speed of the ship, a =[u ax ,u ay ,u az ,p a ,q a ,r a ] T It represents the speed and angular velocity of the drone along the ox, oy, oz axes, i.e. the forward, drift, heave speed of the drone and the angular velocity of the roll, pitch and yaw of the drone; m u ,m v ,m r It represents the additional mass of the ship in the forward, drifting and bow rolling directions, d ii1 ,d ii2 ,d ii3 ,ii=y,v,r represents the nonlinear damping term of the model; m a represents the mass of the drone, g represents the acceleration of gravity, d represents the diagonal diameter of the drone, and I xx ,I yy ,I zz represents the rotational inertia of the drone along the ox, oy, oz axis, k dx ,k dy ,k dz It represents the rotational drag coefficient of the drone along the ox, oy, oz axis. ll ,ll=u s ,v s ,r s ,u ax ,u ay ,u az ,p a ,q a ,r a It indicates the external interference force / torque on the ship in the forward, drifting, and pitching directions and on the UAV in the forward, drifting, heave, roll, pitch, and pitching directions; τ f represents the rotor force of the UAV, τ φ ,τ θ ,τ ψ represents the roll, pitch and pitch moment of the UAV, τ u ,τ rIt represents the forward thrust and turning moment of the ship. It represents the nonlinear term of the speed and angular velocity of the drone along the ox, oy, oz axes. They represent the nonlinear terms of the ship's forward, sideways and bow rolling speeds respectively.
[0135] In this scheme, a ship-UAV nonlinear system model is constructed as the controlled object of the control law designed in the subsequent steps. At the same time, the nonlinear terms are obtained to prepare for the approximation of the nonlinear terms in the subsequent steps and then the design of the virtual control law.
[0136] In a specific embodiment, a parallel control law for a motor-ship is constructed, and a ship-UAV asynchronous collaborative search and navigation waypoint path is obtained according to the parallel control law for the motor-ship, and then a virtual reference path for the ship-UAV is obtained. The scheme for obtaining the expected angle and expected speed of the ship-UAV according to the reference path is:
[0137] S21. Constructing the parallel control law of the motor ship:
[0138] like Figure 2 As shown in Figure (a), the asynchronous collaborative search guidance generates a waypoint path. The user needs to set the parallel search width L according to the target water search range and the UAV search performance. w , turn to search width L s , UAV cycle width W sl , UAV cycle length L sl To generate the required path, when setting parameters, in order to meet the search effect, W sl The setting needs to ensure W sl ≤2W sc , while L s and L sl The time should be set according to the speed and sea surface scanning capability of the drone and the communication distance between the drone and the ship. If it is set too long, the drone speed may not be able to meet the requirements or the drone may exceed the communication range of the ship.
[0139] In the parallel search width L of the ship w In the distance of the segment, the UAV will perform a circular motion around the ship. The number of complete cycles of the UAV n and the length of the remaining distance m after the cycle are completed are calculated according to the parallel control law of the UAV and the ship, as shown in formula (35):
[0140]
[0141] like Figure 2 As shown in (b) and (c), when m≤W sl When the drone flies directly to the other side of the ship, it will start tracking the waypoints for the next section of the path;
[0142] When m>Wsl When the drone needs to continue to cycle to L w End, then track the waypoints for the next segment of the path;
[0143] S22, connecting all waypoints to form a waypoint path;
[0144] The waypoint path obtained by this method is not smooth at the corners and cannot be used directly as a guidance signal. It needs to be processed by L1 ship-L1 UAV to generate a virtual and smooth reference path. The value obtained by L1 ship-L1 UAV is the expected value of the actual ship and UAV. The path is as follows Figure 3 As shown;
[0145] S23, using L1 ship-L1 drone to obtain a virtual reference path of ship-drone, wherein the L1 ship and L1 drone are virtual ships and drones set to obtain a straight line or arc navigation path:
[0146] S231: Determine the reference path of the ship through L1 ship real-time planning, as shown in formula (36),
[0147]
[0148] In the formula, x sd ,y sd ,ψ sd Indicates the forward and drift distance and heading angle of L1 ship, u sd ,r sd represents the forward speed and yaw angular velocity of L1 ship, u sd It is set by the user according to the actual situation. sd As shown in formula (37),
[0149]
[0150] Where, L 1s is the distance from L1 ship to the reference point, η s =ψ sd -ψ L1s , ψ L1s is the bearing from L1 ship to the reference point;
[0151] The azimuth angle ψ from the actual ship to the L1 ship r As shown in formula (38),
[0152]
[0153] In the formula, x se =x sd -x s ,y se =ysd -y s is the ship's forward and horizontal drift distance error; x s and s Indicates the actual forward and sideways displacement of the ship;
[0154] S232: Determine the reference path of the UAV through L1 UAV real-time planning, as shown in formula (39),
[0155]
[0156] Among them, x ad ,y ad ,ψ ad Indicates the forward and drift distance and heading angle of L1 ship, u ad ,r ad represents the forward speed and yaw angular velocity of the L1 ship, L ls ,L la are the total distances of L1 ship and L1 UAV, and the heave distance z of L1 UAV ad The expected flight altitude of the drone is set according to the search mission requirements, and the specific value is set by the user;
[0157] Obtain the expected angle and expected speed, that is, the forward and drift distances, heading angles, forward speeds, bow angular velocity and heave distance of the L1 ship and L1 UAV.
[0158] In this scheme, a parallel control law for the ship and the aircraft is constructed to obtain the navigation waypoint path of the ship-UAV asynchronous collaborative search system, and then obtain the virtual reference path of the ship-UAV. The ship-UAV search path can be autonomously planned according to the target search water range and the UAV search performance. The speeds of the ship and the UAV are related, which can ensure the collaborative mission of the ship-UAV.
[0159] In a specific embodiment, according to the expected angle and the expected speed, the position error and attitude error of the ship-UAV are obtained, and virtual control laws of the position error and attitude error are respectively constructed to eliminate the position error and attitude error of the ship-UAV:
[0160] S31. According to the expected angle and expected speed, define the ship position error and the UAV forward, drift, and heave distance errors, that is, the UAV position error, as shown in formula (40):
[0161]
[0162] In the formula, z se represents the ship position error, x seRepresents the ship's forward distance error, y se Indicates the ship's drift distance error, x ae Indicates the UAV forward distance error, y ae Indicates the UAV drift distance error, z ae Indicates the heave distance error of the UAV, x ad Indicates the distance traveled by the L1 drone, y ad Indicates the horizontal drift distance of the L1 drone, z ad Indicates the rise and fall distance of the L1 drone, x a Indicates the actual distance the drone moves forward, y a Indicates the actual drift distance of the drone, z a Indicates the actual UAV heave distance;
[0163] The ship position error and the drone position error are derived, as shown in formula (41),
[0164]
[0165] In the formula, ψ se =ψ r -ψ s is the ship's pitch angle error; ψ s Indicates the actual ship's pitch angle;
[0166] Design the position error virtual control law as shown in formula (42):
[0167]
[0168] In the formula, They represent the virtual control laws for the ship position error and the UAV forward, drift, and heave distance errors, respectively. They represent the virtual control law Positive design parameters;
[0169] S32: In order to control the current attitude of the ship-UAV to converge to the reference attitude, that is, the desired attitude, the ship attitude error, the UAV roll, pitch, and bow angle errors, that is, the UAV attitude error, are defined as shown in formula (43):
[0170]
[0171] In the formula, ψ se ,φ ae ,θ ae ,ψ ae Respectively represent the ship's bow angle, UAV's roll, UAV's pitch and UAV's bow angle error; φ ad represents the roll angle of the L1 drone, θ adrepresents the reference pitch angle of the L1 UAV, φ a represents the roll angle of the actual drone, θ a represents the actual pitch angle of the UAV, ψ a represents the actual pitch angle of the UAV; ψ ad Indicates the heading angle of the L1 UAV;
[0172] The ship attitude error and the UAV attitude error are derived, as shown in formula (44),
[0173]
[0174] Design the virtual control law of attitude error, as shown in formula (45),
[0175]
[0176] In the formula, is a virtual control law greater than zero Control parameters;
[0177] In this scheme, the position error and attitude error of the ship are obtained, and a virtual control law is designed to eliminate the error, which can achieve accurate tracking of the ship-UAV, better meet navigation requirements, and have higher guidance accuracy.
[0178] In a specific embodiment, the nonlinear terms of the ship-UAV nonlinear system model are approximated using a radial basis function neural network and a minimum learning parameter algorithm, and the scheme for obtaining the adaptive parameters and robust damping terms of the virtual control law of the position error and attitude error respectively is:
[0179] S41, the virtual controller will cause a large computational load problem in the subsequent derivation, so the dynamic surface technology is introduced to reduce the order of the derivative of the virtual control law of the position error, as shown in formula (46),
[0180]
[0181] In the formula, ∈ i is a time constant greater than zero, and the dynamic surface error y i =α i -β i β i Dynamic surface signal representing position error, α i represents the virtual control law of position error;
[0182] Define the speed error i e =β i -i, and take the derivative, as shown in formula (47),
[0183]
[0184] In the formula, f i ,i=u s ,u ax ,u ay ,u az It represents the nonlinear terms of the ship's forward movement, the UAV's forward movement, drift, and heave speed in the ship-UAV nonlinear system model; They represent the derivatives of the ship's forward speed, the UAV's forward speed, the drift speed, and the heave speed error respectively; d wi It represents the external interference force on the ship's forward movement and the UAV's forward movement, drift, and heave directions in the ship-UAV nonlinear system model;
[0185] S42, using radial basis function neural network to i Perform online approximation and introduce the adaptive parameters in the minimum learning parameter algorithm to simplify it, as shown in formula (48):
[0186]
[0187] In the formula, A i represents f i Neural network weight update law, S i represents the Gaussian function, ε i represents the approximation error, λ i Adaptive parameters introduced by the minimum learning parameter algorithm, Represents λ i The robust damping term, γ i1 and γ i2 is a positive constant;
[0188] S43, introduce the dynamic surface technology to reduce the order of the derivative of the virtual control law of the attitude error, as shown in formula (49),
[0189]
[0190] In the formula, ∈ j is a time constant greater than zero, and the dynamic surface error y j =α j -β j , β j Dynamic surface signal representing attitude error, α j represents the virtual control law of attitude error;
[0191] Define the angular velocity error j e =β j -j,j=r s ,r a ,p a ,q a , and take the derivative, as shown in formula (50),
[0192]
[0193] In the formula, f j ,j=r s ,p a ,q a ,r a represents the nonlinear terms of the ship's bow angular velocity, the UAV's roll, pitch and bow angular velocity in the ship-UAV nonlinear system model; d wj It represents the ship's bow angle in the ship-UAV nonlinear system model, and the external interference forces on the UAV in the roll, pitch and bow directions;
[0194] S44, using radial basis function neural network to j Perform online approximation and introduce the adaptive parameters in the minimum learning parameter algorithm to simplify it, as shown in formula (51):
[0195]
[0196] In the formula, A j represents f j Neural network weight update law, S j represents the Gaussian function, ε j represents the approximation error, λ j Adaptive parameters introduced for the minimum learning parameter technique, γ j1 and γ j2 is a positive constant.
[0197] In this scheme, a radial basis function neural network system and a minimum learning parameter algorithm are used to process the nonlinear terms in the ship-UAV collaborative system. At the same time, a controller is designed for the ship-UAV system to reduce the adaptive parameters in the controller, which is beneficial to the maneuverability of the heterogeneous system and improves the automation of the ship-UAV collaborative search mission in the air and sea.
[0198] In a specific embodiment, an event-triggered control law is constructed based on an event-triggered mechanism, and a scheme for designing a control law and an adaptive law of a ship-UAV according to the event-triggered control law, the adaptive parameters, the robust damping term and the interference compensation mechanism is:
[0199] S51. Construct an event-triggered control law for position error based on the event-triggered mechanism:
[0200] S511: Define the intermediate variables of the ship-UAV nonlinear system to simplify the control design. The intermediate variables are shown in formula (52):
[0201]
[0202] In the formula, The actuator intermediate control law representing the ship's forward direction, the UAV's forward direction, the drift direction, and the heave direction, that is, the position error actuator intermediate control law;
[0203] S512: Introduce an event trigger mechanism based on the input end into the intermediate control law of the position error actuator to construct an event trigger rule, as shown in formulas (53) and (54),
[0204]
[0205] In the formula, ζ i In order to introduce the event-triggered control law of the position error actuator, express The last trigger time of Represents τ ι The last trigger time of g i ,h i is a constant parameter, satisfying 0 <g i <1,h i >0, where i=u s ,u ax ,u ay ,u az ;
[0206] S513: Obtain a control signal of the position error actuator according to the event triggering mechanism, as shown in formula (55),
[0207]
[0208] In the formula, ξ i1 ,ξ i2 is a constant whose absolute value is less than 1;
[0209] S52. Construct an event-triggered control law for attitude error based on the event-triggered mechanism:
[0210] S521: Define the intermediate variables of the ship-UAV nonlinear system to simplify the control design. The intermediate variables are shown in formula (56):
[0211]
[0212] In the formula, The actuator intermediate control law representing the ship's pitch direction, the UAV's roll, pitch and pitch direction, that is, the attitude error actuator intermediate control law;
[0213] S522: Introduce an event trigger mechanism based on the input end into the intermediate control law of the attitude error actuator to construct an event trigger rule, as shown in formulas (57) and (58),
[0214]
[0215] In the formula, ζ ρ In order to introduce the event-triggered control law of the attitude error actuator, express The last trigger time, g j ,h j is a constant parameter, satisfying 0 <g j <1,h j >0;
[0216] S523: Obtain a control signal of the attitude error actuator according to the event triggering mechanism, as shown in formula (59),
[0217]
[0218] In the formula, ξ j1 ,ξ j2 is a constant whose absolute value is less than 1;
[0219] S53, Introduction As λ i The estimated value of As ω i The estimated value of is used to design the position control law and the adaptive law according to the control signal of the ship-UAV position error actuator, the adaptive parameters of the position error virtual control law, the robust damping term and the disturbance compensation mechanism, as shown in formulas (60) and (61),
[0220]
[0221] In the formula, k i ,Γ i , δ i ,μ i is a design parameter greater than zero; i represents the adaptive parameter of the virtual control law of position error, ω i Represents the external interference force d wi The maximum value of
[0222] The nonlinear decoupling technology is used to solve formula (60) to obtain the reference roll angle and pitch angle φ of the UAV: ad ,θ ad , as shown in formula (62),
[0223]
[0224] 54. Introduction and As λ j and ωj The estimated value of is used to design the ship-UAV attitude controller and the adaptive law according to the control signal of the attitude error actuator, the adaptive parameters of the attitude error virtual control law, the robust damping term and the disturbance compensation mechanism, as shown in formulas (63) and (64).
[0225]
[0226] In the formula, I ρ =I xx ,I yy ,I zz , k j ,Γ j , δ j ,u j is a design parameter greater than zero, λ j represents the adaptive parameter of the virtual control law of attitude error, ω j Represents the external interference force d wj The maximum value of .
[0227] In this scheme, an input-based event trigger mechanism is introduced to reduce the uncertainty of the ship-UAV system and the frequent jitter of the closed-loop system caused by external interference, reduce the communication burden and the update frequency of the controller from the controller to the actuator; event-triggered control and interference compensation mechanism are combined to achieve the dynamic compromise requirements of transmission load and control accuracy.
[0228] In order to perform the air-sea coordinated sea surface large-scale target search mission, this embodiment sets the path parameter L of the asynchronous coordinated search guidance. w =3750m,L s =1000m,W sl =1000m,L sl =2000m, UAV search radius W sc =500m, the coordinates of the search mission starting point are [1000m, 0m], and the first four ship waypoints are selected to form the waypoint path. The initial state of the controlled object is
[0229]
[0230] Figure 4-Figure 6 They respectively show the simulation results of ship-UAV collaborative search under level 4 sea conditions simulated on the MATLAB simulation platform. Figure 4 Represents the ship-UAV collaborative search path tracking trajectory curve, from Figure 4 and Figure 5It can be seen that the reference path of the ship-UAV is obtained according to the asynchronous collaborative search guidance planning, which can achieve full coverage of the target search waters. In addition, compared with the single automatic system of the ship or the UAV, the collaborative control algorithm proposed in the present invention can achieve the collaborative tracking of the ship-UAV to the reference signal at the desired speed. Figure 6 It represents the control input of the ship-UAV collaborative system. The enlarged local details in the figure show the superiority of the proposed algorithm. The blue dotted line represents the input signal without event-triggered control, and the red solid line represents the actual final input. It can be clearly seen that the frequency of change of the input command is reduced, indicating that the control algorithm proposed in the present invention is effective in reducing the communication burden and actuator wear. Figure 7 is the position error and attitude error of the ship-UAV collaborative system. Figure 7 It can be found that although the UAV overshoots at the waypoint with a large turning angle, it finally achieves effective tracking of the reference path.
[0231] Combining the prior art, controller design and simulation test, the present invention has the following two beneficial effects in the field of air-sea collaborative search:
[0232] 1) The present invention solves the problem of the non-autonomy of the existing sea-air collaborative search. The proposed asynchronous collaborative search guidance strategy will be able to autonomously plan the ship-UAV search path according to the target search waters and the UAV search performance, and the speed of the ship and the UAV are related, which can ensure the ship-UAV collaborative task. Compared with the prior art, the present invention can combine the neural network system and the minimum learning parameter strategy to deal with the structural uncertainties in the ship-UAV collaborative system, and at the same time design a controller for the ship-UAV system to reduce the adaptive parameters in the controller, which is beneficial to the maneuverability of the heterogeneous system. The present invention can improve the automation of ship-UAV in sea-air collaborative search tasks.
[0233] 2) The control law designed by the present invention combines event-triggered control and interference compensation mechanism to achieve the dynamic compromise between transmission load and control accuracy. The simulation experiment of ship-UAV air-sea collaborative search was carried out in a simulated ocean environment to verify the effectiveness of the guidance strategy and control algorithm proposed in the present invention. The simulation results show that the algorithm has a high-precision control effect. Due to the advantages of the event-triggered mechanism, the communication burden from the controller to the actuator is reduced. The algorithm has obvious advantages in improving transmission efficiency and avoiding unnecessary energy loss.
[0234] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present invention.
Claims
1. An autonomous navigation control method for an air-sea collaborative system for asynchronous collaborative search tasks, characterized in that: include: S1: Construct a ship-UAV nonlinear system model as the controlled object of the control law designed in the subsequent steps; S2: Constructing a parallel control law for the ship and the aircraft, obtaining a ship-UAV asynchronous collaborative search and navigation waypoint path according to the parallel control law for the ship and the aircraft, and then obtaining a virtual reference path for the ship and the UAV, and obtaining an expected angle and an expected speed for the ship and the UAV according to the reference path; S3: According to the expected angle and the expected speed, the position error and attitude error of the ship-UAV are obtained, and virtual control laws of the position error and attitude error are respectively constructed to eliminate the position error and attitude error of the ship-UAV; S4: using a radial basis function neural network and a minimum learning parameter algorithm to approximate the nonlinear terms of the ship-UAV nonlinear system model, and obtaining adaptive parameters and robust damping terms of the virtual control law of the position error and attitude error respectively; S5: constructing an event-triggered control law based on the event-triggered mechanism, and designing a control law and an adaptive law of the ship-UAV according to the event-triggered control law, the adaptive parameters, the robust damping term and the disturbance compensation mechanism; S6: Based on the ship-UAV control law and adaptive law, adaptive control of the ship-UAV collaborative system is realized.
2. The autonomous navigation control method of the air-sea collaborative system for asynchronous collaborative search tasks according to claim 1 is characterized in that: S1 constructs the ship-UAV nonlinear system model, as shown in formulas (1) and (2), in, Where, formula (1) is the nonlinear system model of the UAV, formula (2) is the nonlinear system model of the ship, [x jj ,y jj ,z a ,φ a ,θ a ,ψ jj ] T , jj=s, a represents the forward, drift, heave displacement and roll, pitch and pitch angle of the ship-UAV cooperative system, and v represents the forward, drift and pitch speed of the ship, a =[u ax ,u ay ,u az ,p a ,q a ,r a ] T It represents the speed and angular velocity of the drone along the ox, oy, oz axes, i.e. the forward, drift, heave speed of the drone and the angular velocity of the roll, pitch and yaw of the drone; m u ,m v ,m r It represents the additional mass of the ship in the forward, drifting and bow rolling directions, d ii1 ,d ii2 ,d ii3 ,ii=u,v,r represents the nonlinear damping term of the model; m a represents the mass of the drone, g represents the acceleration of gravity, d represents the diagonal diameter of the drone, and I xx ,I yy ,I zz represents the rotational inertia of the drone along the ox, oy, oz axis, k dx ,k dy ,k dz It represents the rotational drag coefficient of the drone along the ox, oy, oz axis, d ll ,ll=u s ,v s ,r s ,u ax ,u ay ,u az ,p a ,q a ,r a It indicates the external interference force / torque on the ship in the forward, drifting, and pitching directions and on the UAV in the forward, drifting, heave, roll, pitch, and pitching directions; τ f represents the rotor force of the UAV, τ φ ,τ θ ,τ ψ represents the roll, pitch and pitch moment of the UAV, τ u ,τ r It represents the forward thrust and turning moment of the ship. It represents the nonlinear term of the speed and angular velocity of the drone along the ox, oy, oz axes. They represent the nonlinear terms of the ship's forward, sideways and bow rolling speeds respectively.
3. The autonomous navigation control method of the air-sea collaborative system for asynchronous collaborative search tasks according to claim 1 is characterized in that: S2 constructs a parallel control law for the ship and the aircraft, obtains a ship-UAV asynchronous collaborative search and navigation waypoint path according to the parallel control law for the ship and the aircraft, and then obtains a virtual reference path for the ship and the UAV, and obtains an expected angle and an expected speed of the ship and the UAV according to the reference path, including: S21. Constructing the parallel control law of the motor ship: Define the ship parallel search width L w , turn to search width L s , UAV cycle width W sl and the drone cycle length L sl , where W sl ≤2W sc , W sc Indicates the search radius of the drone; In the parallel search width L of the ship w In the distance of the segment, the UAV makes a circular motion around the ship, searching for the width L according to the steering s and the drone cycle width W sl , obtain the number of complete cycles n of the UAV and the distance m from the ship after the cycle ends, that is, the parallel control law of the UAV and the ship, as shown in formula (3), When m≤W sl When the drone flies to the other side of the ship, it tracks the waypoints for the next section of the path; When m>W sl When the drone continues to cycle to L w End, and then track the waypoints of the next path; S22, connecting all waypoints to form a waypoint path; S23, using L1 ship-L1 drone to obtain a virtual reference path of ship-drone, wherein the L1 ship and L1 drone are virtual ships and drones set to obtain a straight line or arc navigation path: S231: Determine the reference path of the ship through L1 real-time ship planning, as shown in formula (4), In the formula, x sd ,y sd ,ψ sd Indicates the forward and drift distance and heading angle of L1 ship, u sd ,r sd represents the forward speed and yaw angular velocity of L1 ship, u sd According to the actual situation, set sd As shown in formula (5), Where, L 1s is the distance from L1 ship to the turning reference point, η s =ψ sd -ψ L1s , ψ L1s is the azimuth of the L1 ship to the reference point, η s Indicates the heading difference angle of L1 ship; The azimuth angle ψ from the actual ship to the L1 ship r As shown in formula (6), In the formula, x se =x sd -x s ,y se =y sd -y s is the ship's forward and horizontal drift distance error; x s and s Indicates the actual forward and sideways displacement of the ship; S232: Determine the reference path of the drone through L1 drone real-time planning, as shown in formula (7), Among them, x ad ,y ad ,ψ ad Indicates the forward and drift distances and heading angles of the L1 UAV, u ad ,r ad represents the forward speed and yaw rate of the L1 UAV, L ls ,L la are the total distances of L1 ship and L1 UAV, and the heave distance z of L1 UAV ad The expected flight altitude of the UAV is set according to the search mission requirements; Obtain the expected angle and expected speed, that is, the forward and drift distances, heading angles, forward speeds, bow angular velocity and heave distance of the L1 ship and L1 UAV.
4. The autonomous navigation control method of the air-sea collaborative system for asynchronous collaborative search tasks according to claim 1 is characterized in that: S3 obtains the position error and attitude error of the ship-UAV according to the expected angle and the expected speed, and constructs virtual control laws of the position error and attitude error respectively to eliminate the position error and attitude error of the ship-UAV, including: S31. According to the expected angle and expected speed, define the ship position error and the UAV forward, drift, and heave distance errors, that is, the UAV position error, as shown in formula (8): In the formula, z se represents the ship position error, x se Represents the ship's forward distance error, y se Indicates the ship's drift distance error, x ae Represents the UAV forward distance error, y ae Indicates the UAV drift distance error, z ae Indicates the heave distance error of the UAV, x ad Indicates the distance traveled by the L1 drone, y ad Indicates the horizontal drift distance of the L1 drone, z ad Indicates the rise and fall distance of the L1 drone, x a Indicates the actual distance the drone moves forward, y a Indicates the actual drift distance of the drone, z a Indicates the actual UAV heave distance; The ship position error and the drone position error are derived, as shown in formula (9): In the formula, ψ se =ψ r -ψ s is the ship's pitch angle error; ψ s Indicates the actual ship's pitch angle; Design the virtual control law of position error, as shown in formula (10): In the formula, They represent the virtual control laws for the ship position error and the UAV forward, drift, and heave distance errors, respectively. They represent the virtual control law Positive design parameters; S32. According to the expected angle and expected speed, define the ship attitude error, the UAV roll, pitch, and bow angle errors, that is, the UAV attitude error, as shown in formula (11), In the formula, ψ se ,φ ae ,θ ae ,ψ ae Respectively represent the ship's bow angle, UAV's roll, UAV's pitch and UAV's bow angle error; φ ad represents the roll angle of the L1 drone, θ ad represents the reference pitch angle of the L1 UAV, φ a represents the roll angle of the actual drone, θ a represents the actual pitch angle of the UAV, ψ a represents the actual pitch angle of the UAV; ψ ad Indicates the heading angle of the L1 UAV; The ship attitude error and the UAV attitude error are derived, as shown in formula (12): Design the virtual control law of attitude error, as shown in formula (13): In the formula, is a virtual control law greater than zero Control parameters.
5. The autonomous navigation control method of the air-sea collaborative system for asynchronous collaborative search tasks according to claim 1 is characterized in that: S4 uses radial basis function neural network and minimum learning parameter algorithm to approximate the nonlinear terms of the ship-UAV nonlinear system model, and obtains adaptive parameters and robust damping terms of the virtual control law of position error and attitude error, respectively, including: S41. Introduce dynamic surface technology to reduce the order of the derivative of the virtual control law of the position error, as shown in formula (14): In the formula, ∈ i is a time constant greater than zero, and the dynamic surface error y i =α i -β i β i Dynamic surface signal representing position error, α i represents the virtual control law of position error; Define the speed error i e =β i -i, and take the derivative, as shown in formula (15), In the formula, f i ,i=u s ,u ax ,u ay ,u az It represents the nonlinear terms of the ship's forward movement, the UAV's forward movement, drift, and heave speed in the ship-UAV nonlinear system model; They represent the derivatives of the ship's forward speed, the UAV's forward speed, the drift speed, and the heave speed error respectively; d wi It represents the external interference force on the ship's forward movement and the UAV's forward movement, drift, and heave directions in the ship-UAV nonlinear system model; S42, using radial basis function neural network to i Perform online approximation and introduce the adaptive parameters in the minimum learning parameter algorithm to simplify it, as shown in formula (16): In the formula, A i represents f i Neural network weight update law, S i represents the Gaussian function, ε i represents the approximation error, λ i Adaptive parameters introduced by the minimum learning parameter algorithm, Represents λ i The robust damping term, γ i1 and γ i2 is a positive constant; S43, introduce the dynamic surface technology to reduce the order of the derivative of the virtual control law of the attitude error, as shown in formula (17), In the formula, ∈ j is a time constant greater than zero, and the dynamic surface error y j =α j -β j , β j Dynamic surface signal representing attitude error, α j represents the virtual control law of attitude error; Define the angular velocity error j e =β j -j,j=r s ,r a ,p a ,q a , and take the derivative, as shown in formula (18), In the formula, f j ,j=r s ,p a ,q a ,r a represents the nonlinear terms of the ship's bow angular velocity, the UAV's roll, pitch and bow angular velocity in the ship-UAV nonlinear system model; d wj It represents the ship's bow angle in the ship-UAV nonlinear system model, and the external interference forces on the UAV in the roll, pitch and bow directions; S44, using radial basis function neural network to j Perform online approximation and introduce the adaptive parameters in the minimum learning parameter algorithm to simplify, as shown in formula (19): In the formula, A j represents f j Neural network weight update law, S j represents the Gaussian function, ε j represents the approximation error, λ j Adaptive parameters introduced by the minimum learning parameter algorithm, Represents λ j The robust damping term, γ j1 and γ j2 is a positive constant.
6. The autonomous navigation control method of the air-sea collaborative system for asynchronous collaborative search tasks according to claim 1 is characterized in that: S5 builds event-triggered control laws based on event-triggered mechanisms, including: S51. Construct an event-triggered control law for position error based on the event-triggered mechanism: S511: Define the intermediate variables of the ship-UAV nonlinear system to simplify the control design. The intermediate variables are shown in formula (20): In the formula, The actuator intermediate control law representing the ship's forward direction, the UAV's forward direction, the drift direction, and the heave direction, that is, the position error actuator intermediate control law; S512: Introduce an input-based event trigger mechanism into the intermediate control law of the position error actuator to construct an event trigger rule, as shown in formulas (21) and (22), In the formula, ζ i In order to introduce the event-triggered control law of the position error actuator, express The last trigger time of Represents τ ι The last trigger time of g i ,h i is a constant parameter, satisfying 0 <g i <1,h i >0, where i=u s ,u ax ,u ay ,u az ; S513: Obtain a control signal of the position error actuator according to the event triggering mechanism, as shown in formula (23): In the formula, ξ i1 ,ξ i2 is a constant whose absolute value is less than 1; S52. Construct an event-triggered control law for attitude error based on the event-triggered mechanism: S521: Define the intermediate variables of the ship-UAV nonlinear system to simplify the control design. The intermediate variables are shown in formula (24): In the formula, The actuator intermediate control law representing the ship's pitch direction, the UAV's roll, pitch and pitch direction, that is, the attitude error actuator intermediate control law; S522: Introduce an input-based event trigger mechanism into the intermediate control law of the attitude error actuator to construct an event trigger rule, as shown in formulas (25) and (26), In the formula, ζ ρ In order to introduce the event-triggered control law of the attitude error actuator, express The last trigger time, g j ,h j is a constant parameter, satisfying 0 <g j <1,h j >0; S523: Obtain a control signal of the attitude error actuator according to the event triggering mechanism, as shown in formula (27): In the formula, ξ j1 ,ξ j2 is a constant whose absolute value is less than 1.
7. The autonomous navigation control method of the air-sea collaborative system for asynchronous collaborative search tasks according to claim 6 is characterized in that: S5 designs the control law and the adaptive law of the ship-UAV according to the event triggering control law, the adaptive parameters, the robust damping term and the disturbance compensation mechanism, including: S53, Introduction As λ i The estimated value of As ω i The estimated value of is used to design the position control law and the adaptive law according to the control signal of the ship-UAV position error actuator, the adaptive parameters of the position error virtual control law, the robust damping term and the disturbance compensation mechanism, as shown in formulas (28) and (29), In the formula, k i ,Γ i , δ i ,μ i is a design parameter greater than zero; i represents the adaptive parameter of the virtual control law of position error, ω i Represents the external interference force d wi The maximum value of S54, Introduction and As λ j and ω j According to the estimated value of the attitude error actuator control signal, the adaptive parameters of the attitude error virtual control law, the robust damping term and the disturbance compensation mechanism, the ship-UAV attitude controller and the adaptive law are designed, as shown in formulas (30) and (31). In the formula, I ρ =I xx ,I yy ,I zz , k j ,Γ j , δ j ,μ j is a design parameter greater than zero, λ j represents the adaptive parameter of the virtual control law of attitude error, ω j Represents the external interference force d wj The maximum value of .
8. The autonomous navigation control method of the air-sea collaborative system for asynchronous collaborative search tasks according to claim 4 is characterized in that: The nonlinear decoupling technology is used to solve formula (28) to obtain the reference roll angle and pitch angle φ of the UAV: ad ,θ ad , as shown in formula (32),
Citation Information
Patent Citations
USV-UAV cooperative path tracking adaptive controller design method based on 3D mapping guidance
CN113419428A
Underwater glider pitch angle robust adaptive control method based on event triggering strategy
CN114460948A
Ship adaptive fuzzy output feedback track tracking control method and control system
CN115469654A
Machine / ship cooperative multi-task event trigger control method based on synchronous guidance
CN117193344A
Device and method for refining aircraft trajectory
RU2794003C1
Cited By
Autonomous tugboat event triggering quantitative towing control method based on command filtering
CN119739077A
Ship air-sea cooperative task guidance and gain adaptive control method oriented to surround alert
CN120010253A
Aircraft / ship cooperative arrival navigation control method based on fuzzy observer
CN120630994A
