Unmanned ship cluster dynamic coverage planning and guidance system
By designing the dynamic coverage planning and guidance system of unmanned boat clusters, the visual line guidance law of the group-based dynamic coverage module and cascade expansion state observer is solved, and the problem of insufficient dynamic coverage and side slip angle estimation performance of multiple unmanned boats is solved. , realize efficient and safe collaborative operation and precise guidance of unmanned boats.
Patent Information
- Application Number
- CN202410952630.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-16
- Publication Date
- 2024-11-08
AI Technical Summary
The existing dynamic coverage planning method of unmanned boats is mainly aimed at single unmanned boat design. Multiple unmanned boats have fewer dynamic coverage strategies, and real-time planning requires additional computing resources and time. The visual line-of-view guidance method based on the expansion state observer is The side slip angle cannot be effectively estimated under measurement noise.
A dynamic coverage planning and guidance system for unmanned boat clusters was designed, and time-varying coverage trajectory was generated using group-based dynamic coverage modules to realize collision avoidance and communication between unmanned boats, and the cascade-based expansion state was used in the guidance layer. The line-of-sight guidance law of the observer suppresses measurement noise and accurately estimates the side slip angle.
The system can improve overall efficiency in a multi-unmanned boat environment, reduce computing resources and time consumption, ensure safe and efficient cooperation among unmanned boats, and accurately estimate the side slip angle in a noisy environment, improving the reliability of practical applications.
Smart Images

Figure CN118915731A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of unmanned boat motion control, and in particular to an unmanned boat cluster dynamic coverage planning and guidance system. Background Art
[0002] In recent years, unmanned surface vehicles (ASVs) have attracted the interest of many researchers with their low cost, high mobility, and intelligence. In particular, dynamic coverage plays an important role in the practical application of unmanned vehicles. Unmanned vehicle dynamic coverage aims to control mobile unmanned vehicles with limited sensing range to efficiently cover a given area. Unmanned vehicle dynamic coverage technology has important practical significance and research value in the fields of resource exploration, ocean mapping, and maritime search and rescue.
[0003] In terms of dynamic coverage planning of unmanned boats, corresponding research results have been achieved at home and abroad. M.Arzamendia et al. introduced genetic algorithms into the constrained path planning of unmanned boats to maximize the coverage area of Lake Ypacarai. B.Xing et al. proposed an improved deep reinforcement learning algorithm to improve the slow convergence speed of unmanned boat full coverage path planning. Y.Ma et al. designed an improved BA* algorithm to improve its shortcomings of low continuity and high dependence on high-precision environmental modeling. AFBrown proposed a real-time BIT* algorithm suitable for path coverage, which can find complex paths in a limited space and ensure dynamic feasibility. Y.Ma et al. proposed an improved collaborative coverage algorithm based on the BA* algorithm to realize functions such as area division, recall and transfer, area exchange and obstacle recognition. S.Shriyam et al. proposed a particle swarm optimization method to calculate the optimal area division under the condition of considering the detection rate constraint of unmanned boats.
[0004] In terms of unmanned boat guidance, typical guidance methods include tracking guidance, parallel approach guidance, line-of-sight guidance, etc. Among them, line-of-sight guidance, as a mature method, has been widely studied in the design of tracking controllers. D. Li et al. proposed an integral line-of-sight guidance method, adding an integral term to the classical line-of-sight guidance law to compensate for the influence of the sideslip angle. S. Dai et al. proposed an adaptive line-of-sight guidance method, estimating the sideslip angle as an unknown constant parameter. L. Liu et al. proposed a line-of-sight guidance method based on an extended state observer, using the extended state observer to identify the sideslip angle.
[0005] There are already some feasible technical solutions for the problem of dynamic coverage planning and guidance of unmanned boats, but the existing patents still have the following problems:
[0006] First, the existing unmanned boat dynamic coverage planning methods are generally designed for a single unmanned boat, and there is little research on the dynamic coverage strategy of multiple unmanned boats.
[0007] Second, most of the existing real-time dynamic coverage planning methods for unmanned boats require re-planning algorithms, which results in the consumption of additional computing resources and time.
[0008] Third, in the existing line-of-sight guidance method of unmanned boats based on the extended state observer (ESO), the estimation performance of the sideslip angle by the high-gain observer cannot be guaranteed in the presence of measurement noise. Summary of the invention
[0009] In view of the shortcomings of the prior art, the present invention provides a dynamic coverage planning and guidance system for an unmanned boat swarm. In the planning layer, the present invention designs a group-based dynamic coverage module for multiple unmanned boats to generate a time-varying coverage trajectory, without the need to re-plan the trajectory according to the actual sea conditions, saving a lot of computing resources and time; at the same time, in the coverage process, the collision avoidance and connectivity maintenance functions between the unmanned boats and the obstacle avoidance function between the unmanned boats and obstacles are realized. In the guidance layer, a line-of-sight guidance law based on a cascaded extended state observer (CESO) is designed, and the cascaded extended state observer is used to effectively suppress measurement noise, improve the shortcoming of the high-gain observer in the presence of measurement noise for the sideslip angle estimation, and can accurately estimate the unknown sideslip angle, and then generate the desired guidance signal based on the line-of-sight guidance method.
[0010] The technical means adopted by the present invention are as follows:
[0011] A dynamic coverage planning and guidance system for an unmanned boat swarm includes a motion planning design unit and a kinematic guidance law design unit; the motion planning design unit includes a dynamic coverage module, an integrator module and a safety planning module, and the kinematic guidance law design unit includes a heading sensor module, a cascaded extended state observer module, a line-of-sight guidance module and an unmanned boat module; wherein:
[0012] The dynamic coverage module includes a time-varying radial sensor module, a coverage level calculation module, a transition condition C1 module, a transition condition C2 module, a coverage planning module, a cluster planning module and a cluster coverage planning module; the transition condition C1 module includes a standard coverage error calculation module and a C1 module, and the transition condition C2 module includes a cluster point generator module, a first comparator and a C2 module;
[0013] The safety planning module includes a collision avoidance planning module, an obstacle avoidance planning module, a connection maintenance module and a second comparator;
[0014] The cascade extended state observer module includes a first-stage extended state observer module and a second-stage extended state observer module;
[0015] The input end of the time-varying radial sensor module is respectively connected to the smooth transition function, the predefined coverage points in the area and the trajectory points of the unmanned boat coverage planning output by the integrator, and the output end of the time-varying radial sensor module is connected to the input end of the coverage level calculation module and the input end of the coverage session module;
[0016] The input end of the coverage level module is connected to the output end of the time-varying radial sensor module, and the output end of the coverage level module is respectively connected to the input end of the standard coverage error calculation module, the input end of the cluster point generator module and the input end of the coverage planning module;
[0017] The input end of the standard coverage error calculation module is connected to the output end of the coverage level module, and the output end of the standard coverage error calculation module is connected to the C1 module;
[0018] The input end of the cluster point generator module is connected to the output end of the coverage level calculation module, the predefined coverage points in the area, and the trajectory points of the unmanned boat coverage planning output by the integrator, and the output end of the cluster point generator module is connected to the input end of the first comparator;
[0019] The input end of the first comparator is connected to the output end of the cluster point generator module and the trajectory point of the unmanned boat coverage planning output by the integrator, and the output end of the first comparator is connected to the input end of the C2 module and the cluster planning module;
[0020] The input end of the coverage planning module is connected to the output end of the time-varying radial sensor module, the output end of the coverage level calculation module, the predefined coverage points in the area, and the trajectory points of the unmanned boat coverage planning output by the integrator, and the output end of the coverage planning module is connected to the input end of the cluster coverage planning module;
[0021] The input end of the cluster coverage planning module is connected to the smooth transition function, the output end of the coverage planning module and the output end of the cluster planning module, and the output end of the cluster coverage planning module is connected to the input end of the integrator;
[0022] The input end of the cluster planning module is connected to the output end of the first comparator, and the output end of the cluster planning module is connected to the input end of the cluster coverage planning module.
[0023] Compared with the prior art, the present invention has the following advantages:
[0024] 1. Compared with the existing unmanned boat dynamic coverage planning method, the cluster dynamic coverage strategy adopted by the present invention is specially designed for multiple unmanned boat systems. This strategy not only ensures the independent coverage capability of each unmanned boat, but also significantly improves the overall efficiency of marine operations by strengthening the cooperation between unmanned boats.
[0025] 2. Compared with the existing unmanned boat dynamic coverage planning method, the cluster dynamic coverage method adopted by the present invention is real-time planning and does not require re-planning. While covering, it realizes the collision avoidance of dynamic and static obstacles and the maintenance of communication between multiple unmanned boats, making it safer, more efficient and reliable in practical applications.
[0026] 3. Compared with the existing unmanned boat line-of-sight guidance based on an extended state observer, the line-of-sight guidance method based on a cascaded extended state observer proposed in the present invention can overcome the limitation of the traditional extended state observer that amplifies the adverse effect of measurement noise on estimation performance due to high gain, and is convenient for effectively filtering out the noise of the bow angle in a noisy environment to accurately estimate the sideslip angle, which is more conducive to practical application. BRIEF DESCRIPTION OF THE DRAWINGS
[0027] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. 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.
[0028] Figure 1 The present invention is a schematic diagram of the structure of a dynamic coverage planning and guidance system for an unmanned boat cluster.
[0029] Figure 2 This is a simulation diagram of the dynamic coverage motion trajectory of a cluster of four under-actuated unmanned boats in an embodiment of the present invention.
[0030] Figure 3 This is a simulation diagram of the dynamic coverage error of the standard cluster of unmanned boats in an embodiment of the present invention.
[0031] Figure 4 This is a real-time distance simulation diagram between four under-actuated unmanned boats in an embodiment of the present invention.
[0032] Figure 5 This is a simulation diagram of the sideslip angle estimation of the first under-actuated unmanned boat in an embodiment of the present invention.
[0033] Figure 6 This is a simulation diagram of the sideslip angle estimation of the second under-actuated unmanned boat in an embodiment of the present invention.
[0034] Figure 7 This is a simulation diagram of the sideslip angle estimation of the third under-actuated unmanned boat in an embodiment of the present invention.
[0035] Figure 8 This is a simulation diagram of the sideslip angle estimation of the fourth under-actuated unmanned boat in an embodiment of the present invention.
[0036] Fig. 9This is a simulation diagram of the longitudinal tracking error of four under-actuated unmanned boats in an embodiment of the present invention.
[0037] Fig.10 This is a simulation diagram of the lateral tracking error of four under-actuated unmanned boats in an embodiment of the present invention. DETAILED DESCRIPTION
[0038] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme 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 only 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 should fall within the scope of protection of the present invention.
[0039] like Figure 1 As shown, the present invention provides a dynamic coverage planning and guidance system for unmanned boat swarms, designs a group-based dynamic coverage method to generate a time-varying coverage trajectory, does not need to re-plan the trajectory according to the actual sea conditions, and saves a lot of computing resources and time; at the same time, in the coverage process, the collision avoidance and connection maintenance functions between unmanned boats and the obstacle avoidance function between unmanned boats and obstacles are realized. A line-of-sight guidance law based on a cascaded extended state observer (CESO) is designed in the guidance layer, and the cascaded extended state observer is used to effectively suppress measurement noise, improve the shortcoming of the high-gain observer in the presence of measurement noise. The side slip angle estimation effect is poor, and the unknown side slip angle can be accurately estimated, and then the desired guidance signal is generated based on the line-of-sight guidance method.
[0040] In this embodiment, the kinematic model equation of the unmanned boat is described as:
[0041]
[0042] In the formula, x i is the X-axis coordinate of the unmanned boat in the earth coordinate system; i is the Y-axis coordinate of the unmanned boat in the earth coordinate system; ψ i is the bow pitch angle; u i is the longitudinal velocity; v i is the drift speed; r i is the yaw angular velocity.
[0043] Furthermore, formula (1) is rewritten as follows:
[0044]
[0045] In the formula, is the total speed of the unmanned boat; φ i =ψ i +βi is the actual heading angle; β i =arctan(v i / u i ) is the sideslip angle,
[0046] The input end of the unmanned boat kinematic system is connected to the unmanned boat speed signal U i ,φ i The output of the unmanned boat kinematic system is connected to the position signal p of the unmanned boat. i =[x i ,y i ] T connected.
[0047] like Figure 1 As shown, an unmanned boat cluster dynamic coverage planning and guidance system disclosed in an embodiment of the present invention, an unmanned boat cluster dynamic coverage planning and guidance system, including a motion planning design unit and a kinematic guidance law design unit; the motion planning design unit includes a dynamic coverage module, an integrator module and a safety planning module, and the kinematic guidance law design unit includes a heading sensor module, a cascaded extended state observer module, a line of sight guidance module and an unmanned boat module. The dynamic coverage module includes a time-varying radial sensor module, a coverage level calculation module, a transition condition C1 module, a transition condition C2 module, a coverage planning module, a cluster planning module and a cluster coverage planning module. The transition condition C1 module includes a standard coverage error calculation module and a C1 module, and the transition condition C2 module includes a cluster point generator module, a first comparator and a C2 module. The safety planning module includes a collision avoidance planning module, an obstacle avoidance planning module, a connection maintenance module and a second comparator. The cascaded extended state observer module includes a first-level extended state observer module and a second-level extended state observer module.
[0048] Specifically, the input of the dynamic coverage module is respectively connected to the smooth transition function γ(t), the predefined coverage points in the region The output terminal p of the integrator module id =[x id ,y id ] T The output end of the dynamic coverage module is connected to the input end of the integrator module. The input end of the integrator module is respectively connected to the output end of the dynamic coverage module and the output end of the second comparator module; the output end of the integrator module is respectively connected to the input end of the dynamic coverage module, the input end of the line of sight guidance module and the input end of the safety planning module. The input end of the collision avoidance planning module is connected to the output end of the integrator module; the output end of the collision avoidance planning module is connected to the input end of the second comparator module. The input ends of the obstacle avoidance planning module are respectively connected to the position coordinates of the obstacles. The output end of the integrator module is connected; the output end of the obstacle avoidance planning module is connected to the input end of the second comparator module. The input end of the connectivity maintenance module is connected to the output end of the integrator module; the output end of the connectivity maintenance module is connected to the input end of the second comparator module. The input end of the second comparator module is respectively connected to the output end of the collision avoidance planning module, the output end of the obstacle avoidance planning module and the output end of the connectivity maintenance module; the output end of the second comparator module is connected to the input end of the integrator module. The input end of the heading sensor module is respectively connected to the output end of the line of sight guidance module, the noise signal ν iφ The output end of the heading sensor module is connected to the input end of the first-level extended state observer module. The input end of the first-level extended state observer module is respectively connected to the output end of the heading sensor module and the output end of the line-of-sight guidance module; the output end of the first-level extended state observer module is connected to the input end of the second-level extended state observer module. The input end of the second-level extended state observer module is respectively connected to the output end of the first-level extended state observer module and the output end of the line-of-sight guidance module; the output end of the second-level extended state observer module is connected to the input end of the line-of-sight guidance module. The input end of the line-of-sight guidance module is respectively connected to the output end of the integrator module, the output end of the second-level extended state observer module, and the output end of the unmanned boat module; the output end of the line-of-sight guidance module is connected to the input end of the unmanned boat module. The input end of the unmanned boat module is connected to the output end of the line-of-sight guidance module; the output end of the unmanned boat module is connected to the input end of the line-of-sight guidance module.
[0049] The system of the present invention adopts a multi-operation mode structure: coverage mode, transition mode 1, cluster mode and transition mode 2. In coverage mode, the unmanned boat moves within a given domain to improve the coverage level. In transition mode, the unmanned boat prepares for the next operation mode. In cluster mode, the unmanned boat does not provide coverage, but goes to an area that lacks full coverage within a given domain. The specific establishment of each functional module is described in detail below.
[0050] Time-varying radial sensor module establishment
[0051] The input end of the time-varying radial sensor module is respectively connected to the smooth transition function γ(t), the area coverage point And the trajectory point p of the unmanned boat planning id The output signal S of the time-varying radial sensor module is obtained by the following transformation i :
[0052]
[0053] In the formula, S i That is the time-varying radial sensor model; represents the time-invariant radial sensor model; M i is the peak perceptual level; R i is the perception radius; p id Its update law will be given later.
[0054] Coverage level calculation module established
[0055] The input end of the coverage level calculation module and the output end signal S of the sensor module i The output signal Q of the coverage level calculation module is obtained through the following transformation:
[0056]
[0057] Where, Q is the cumulative coverage level of the unmanned boat; C * is the expected coverage level; k is a positive constant.
[0058] Transition condition C1 module establishment
[0059] Standard coverage error module establishment
[0060] The input end of the standard coverage error module is connected to the output end signal Q of the coverage level calculation module. The output end signal of the standard coverage error module is obtained through the following transformation:
[0061]
[0062] In the formula, This is the standard coverage error; To cover the area The area of h(v)=(max{0,v}) 3 .
[0063] Transition condition C1 module establishment
[0064] Output signal based on standard overlay error module The transition condition C1 from the unmanned boat coverage mode to the cluster mode is obtained through the following transformation:
[0065]
[0066] In the formula, Δt e >0 is a preset period of time; To specify the threshold.
[0067] Cluster point generator module establishment
[0068] The input of the cluster point generator module is connected to the output signal Q of the coverage level calculation module, the regional coverage point And the real-time planning trajectory point p of the leading unmanned boat1d The output signal pd of the cluster point generator module is obtained through the following transformation es :
[0069]
[0070] In the formula, p des That is, the cluster point designed for the leading unmanned boat in the cluster mode; μ1, μ2>0 are the weights.
[0071] Transition condition C2 module establishment
[0072] The output signal p of the cluster point generator module des , the trajectory point p of the unmanned boat planning id They are respectively connected to the input end of the comparator module 1. The output end signal of the comparator module 1 is transformed as follows to obtain the transition condition C2 from the unmanned boat cluster mode to the coverage mode:
[0073]
[0074] In the formula, ε i =d i +ε i , d i is the expected distance from each unmanned boat to the cluster point in cluster mode, ε i For the allowable error.
[0075] Coverage planning module established
[0076] The input end of the coverage planning module is respectively connected to the output end signal S i , the output signal Q of the coverage level calculation module, the trajectory point p of the unmanned boat planning id And regional coverage points The output signal of the coverage planning module is obtained through the following transformation
[0077]
[0078] In the formula, This is the covering planning law; is a 2×2 diagonal matrix.
[0079] Cluster planning module establishment
[0080] The input end of the cluster planning module is connected to the output signal of the first comparator module, and the output end signal of the cluster planning module is obtained through the following transformation:
[0081]
[0082] In the formula, is the cluster planning law, is a 2×2 diagonal matrix.
[0083] Cluster coverage planning module establishment
[0084] The input end of the cluster coverage planning module is respectively connected to the output end signal of the coverage planning module Output signal of cluster planning module And the smooth transition function γ(t) is connected, and the output signal of the cluster coverage planning module is obtained through the following transformation
[0085]
[0086] In the formula, This is the nominal cluster dynamic coverage planning law.
[0087] Collision avoidance planning module established
[0088] The input end of the collision avoidance planning module and the trajectory point p planned by the unmanned boat id The output signal of the collision avoidance planning module is obtained through the following transformation
[0089]
[0090] In the formula, That is the collision avoidance law; i,j∈1,...,N,i≠j, and for all i=1,...,N, we have The detection area radius of the unmanned boat that can detect other unmanned boats; d icol It is the collision avoidance distance, i.e. the minimum safe distance between unmanned boats; is a 2×2 diagonal matrix.
[0091] Obstacle avoidance planning module established
[0092] The input end of the obstacle avoidance planning module is respectively connected to the trajectory point p of the unmanned boat planning id , the location coordinates of the obstacle The output signal of the obstacle avoidance planning module is obtained through the following transformation
[0093]
[0094] In the formula, This is the obstacle avoidance law; k = 1,...,N o , and for all i=1,...,N, there is D iobs >d iobs >0. D iobsThe radius of the detection area for the unmanned boat to detect obstacles; d iobs is the minimum safe distance between the unmanned boat and the center of mass of the obstacle; is a 2×2 diagonal matrix.
[0095] Unicom maintenance module established
[0096] Connect the input end of the module to the trajectory point p planned by the unmanned boat id The output signal of the connection holding module is obtained through the following transformation
[0097]
[0098] In the formula, This is the connectivity preservation law; for all i=1,...,N, D iloss >d iloss >0.d iloss D is the radius of the area where the communication quality begins to degrade; iloss is the loss radius, i.e. the maximum distance at which the unmanned boat can maintain communication; is a 2×2 diagonal matrix.
[0099] The second comparator module establishes
[0100] The input end of the second comparator module is respectively connected to the output end signal of the collision avoidance planning module Output signal of obstacle avoidance planning module And the output signal of the Unicom holding module The output signal of the second comparator module is obtained by the following transformation
[0101]
[0102] In the formula, This is the safety planning law.
[0103] Integrator module creation
[0104] The input of the integrator module is connected to the output signal of the dynamic coverage module The output signal of the second comparator module The output signal p of the integrator is obtained by the following transformation id :
[0105]
[0106] In the formula, p id That is, the trajectory points of the generated unmanned boat coverage plan.
[0107] The first-level extended state observer module is established
[0108] The input of the first-stage extended state observer module is connected to the output signal y of the heading sensor iφ , the output signal r of the line-of-sight guidance module ir The output signal of the first-level extended state observer module is obtained through the following transformation
[0109]
[0110] The second-level extended state observer module is established
[0111] The input end of the second-stage extended state observer module is respectively connected to the output end signal of the first-stage extended state observer module And the output signal r of the line-of-sight guidance module ir The output signal of the second-level extended state observer module is obtained through the following transformation
[0112]
[0113] In the formula, y iφ =φ ir +ν iφ That is the actual heading signal obtained by the heading sensor; φ ir is the reference heading angle signal of the unmanned boat, which will be defined later; ν iφ is the noise signal; That is the heading angle signal estimated by the cascade extended state observer; are intermediate variables, which are the intermediate estimates of the heading angle and sideslip angle differential signals of the cascade extended state observer; is the expanded state variable β id The estimate, is a positive observer gain, is the gain of the traditional extended state observer. The integrated traditional speed extended state observer refers to the observer without cascade structure commonly used in the prior art.
[0114] Line-of-sight guidance module established
[0115] The input of the line-of-sight guidance module is respectively connected to the output signal p of the integrator module id , the output signal of the cascaded extended state observer module The output signal p of the unmanned boat module i =[x i ,y i ] TBased on the line-of-sight guidance principle, the output signal U of the line-of-sight guidance module is obtained through the following transformation ir 、r ir ,φ ir :
[0116]
[0117] Where U ir That is the reference combined speed signal of the unmanned boat; r ir is the reference bow angular velocity signal of the unmanned boat; φ ir That is the reference heading angle signal of the unmanned boat; p i =[x i ,y i ] T is the coordinate of the unmanned boat in the earth coordinate system; φ id is the tangent angle of the coverage trajectory; x ie is the longitudinal error of the unmanned boat tracking trajectory; y ie is the lateral error of the unmanned boat tracking trajectory; is a positive constant; are all normal numbers, is the forward distance of the i-th unmanned boat.
[0118] The scheme and effect of the present invention are further described below through specific application examples.
[0119] The simulation test in this embodiment is as follows:
[0120] The number of controlled underactuated unmanned boats in the simulation system is N = 4, and the number of obstacles is N o =2, the kinematic model of the unmanned boat satisfies equation (2). The initial positions of the unmanned boat are set to p1(0)=[14,10] T , p2(0)=[11,19] T , p3(0)=[19,19] T , p4(0)=[19,11] T ; The positions of obstacles are set to
[0121] The external measurement noise signal of the system follows the normal distribution N(0,0.02 2 ) is a random white noise.
[0122] The cluster dynamic coverage planning algorithm parameters are designed as follows:
[0123] The initial positions of the unmanned boat planning are set as p 1d (0) = [12, 12] T , p 2d (0) = [12, 20]T , p 3d (0) = [20, 20] T , p 4d (0) = [20, 12] T ; C * =40, k=2.5, τ1=1, τ2=1, ω1=π, ω2=π, Δt e =8, d1=0, d2=d3=d4=8, ε1=1.5, ε2=ε3=ε4=0.5, M i =0.1, R i =1.6, μ1=1, μ2=2.5×10 4 , D icol =4.6, d icol =3.2, D iobs =5.2, d iobs =4,D iloss =19,d iloss =13,
[0124] The cluster dynamic coverage guidance algorithm is designed as follows:
[0125] k i1 =0.01, k i2 =5,Δ ix =1,Δ iφ =1,Δ i =5.
[0126] The simulation results are as follows Figures 2 to 10 shown.
[0127] Figure 2 This is the coverage motion trajectory diagram of the four unmanned boats. It can be seen from the figure that the four unmanned boats have achieved complete coverage of the target area while completing the obstacle avoidance mission. Figure 3 It is a curve graph of the change of normalized coverage error over time. It can be seen from the figure that before 1550 seconds, the normalized coverage error converges to a value very close to zero. Figure 4 This is a real-time distance curve between the four unmanned boats. It can be seen from the figure that the four unmanned boats are all at a safe distance and within the limited communication distance. Figures 5 to 8 It is the sideslip angle estimation curve of four unmanned boats. It can be seen from the figure that in the presence of measurement noise, the estimation performance of the cascade extended state observer for the sideslip angle is better than that of the traditional extended state observer. Fig. 9 and Fig.10They are the longitudinal tracking error and lateral tracking error curves of the four unmanned boats. It can be seen from the figure that between 300 seconds to 400 seconds, 800 seconds to 850 seconds, 900 seconds to 1000 seconds, and 1100 seconds to 1200 seconds, the unmanned boats experienced a cluster mode with a slightly large tracking error, but then quickly converged to near zero and maintained it.
[0128] 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. A dynamic coverage planning and guidance system for unmanned boat swarms, It is characterized in that It includes a motion planning design unit and a kinematic guidance law design unit; the motion planning design unit includes a dynamic coverage module, an integrator module and a safety planning module, and the kinematic guidance law design unit includes a heading sensor module, a cascaded extended state observer module, a line-of-sight guidance module and an unmanned boat module; wherein: The dynamic coverage module includes a time-varying radial sensor module, a coverage level calculation module, a transition condition C1 module, a transition condition C2 module, a coverage planning module, a cluster planning module and a cluster coverage planning module; the transition condition C1 module includes a standard coverage error calculation module and a C1 module, and the transition condition C2 module includes a cluster point generator module, a first comparator and a C2 module; The safety planning module includes a collision avoidance planning module, an obstacle avoidance planning module, a connection maintenance module and a second comparator; The cascade extended state observer module includes a first-stage extended state observer module and a second-stage extended state observer module; The input end of the time-varying radial sensor module is respectively connected to the smooth transition function, the predefined coverage points in the area and the trajectory points of the unmanned boat coverage planning output by the integrator, and the output end of the time-varying radial sensor module is connected to the input end of the coverage level calculation module and the input end of the coverage session module; The input end of the coverage level module is connected to the output end of the time-varying radial sensor module, and the output end of the coverage level module is respectively connected to the input end of the standard coverage error calculation module, the input end of the cluster point generator module and the input end of the coverage planning module; The input end of the standard coverage error calculation module is connected to the output end of the coverage level module, and the output end of the standard coverage error calculation module is connected to the C1 module; The input end of the cluster point generator module is connected to the output end of the coverage level calculation module, the predefined coverage points in the area, and the trajectory points of the unmanned boat coverage planning output by the integrator, and the output end of the cluster point generator module is connected to the input end of the first comparator; The input end of the first comparator is connected to the output end of the cluster point generator module and the trajectory point of the unmanned boat coverage planning output by the integrator, and the output end of the first comparator is connected to the input end of the C2 module and the cluster planning module; The input end of the coverage planning module is connected to the output end of the time-varying radial sensor module, the output end of the coverage level calculation module, the predefined coverage points in the area, and the trajectory points of the unmanned boat coverage planning output by the integrator, and the output end of the coverage planning module is connected to the input end of the cluster coverage planning module; The input end of the cluster coverage planning module is connected to the smooth transition function, the output end of the coverage planning module and the output end of the cluster planning module, and the output end of the cluster coverage planning module is connected to the input end of the integrator; The input end of the cluster planning module is connected to the output end of the first comparator, and the output end of the cluster planning module is connected to the input end of the cluster coverage planning module.
2. According to claim 1, a dynamic coverage planning and guidance system for unmanned boat swarms, It is characterized in that The input end of the collision avoidance control module is connected to the track point of the unmanned boat coverage plan output by the integrator, and the output end of the collision avoidance control module is connected to the input end of the second comparator; The input end of the obstacle avoidance control module is connected to the track points of the unmanned boat coverage plan and the position coordinates of the obstacles output by the integrator, and the output end of the obstacle avoidance control module is connected to the input end of the second comparator; The input end of the connection maintaining module is connected to the track point of the unmanned boat coverage plan output by the divider, and the output end of the connection maintaining module is connected to the input end of the second comparator; The input end of the second comparator is connected to the output end of the collision avoidance control module, the output end of the obstacle avoidance control module and the output end of the connection maintaining module, and the output end of the second comparator is connected to the input end of the integrator module; The input end of the integrator module is connected to the output end of the second comparator and the output end of the cluster coverage planning module, and the output end of the integrator module outputs the trajectory points of the unmanned boat coverage planning.
3. According to claim 1, a dynamic coverage planning and guidance system for unmanned boat swarms, It is characterized in that The input end of the heading sensor is connected to the reference heading angle signal and the noise signal of the unmanned boat, and the output end of the heading sensor is connected to the input end of the first-stage expanded observer; The input end of the first-stage expanded observer is connected to the output end of the heading sensor and the reference bow angular velocity signal of the unmanned boat, and the output end of the first-stage expanded observer is connected to the input end of the second-stage expanded observer; The input end of the second-stage expanded observer is connected to the output end of the first-stage expanded observer and the reference bow angular velocity signal of the unmanned boat, and the output end of the second-stage expanded observer is connected to the line-of-sight guidance module; The input end of the line-of-sight guidance module is connected to the output end of the second-stage expansion observer and the position signal of the unmanned boat, and the output end of the line-of-sight guidance module is connected to the control end of the unmanned boat.
4. According to claim 1, a dynamic coverage planning and guidance system for unmanned boat swarms, It is characterized in that The time-varying radial sensor module is configured as: Among them, S i is the time-varying radial sensor model, γ(t) is the smooth transition function, is the area coverage point, p id The trajectory points planned for the unmanned boat; represents the time-invariant radial sensor model; M i is the peak perceptual level; R i is the perception radius; The coverage level calculation module is configured to: Among them, Q is the cumulative coverage level of unmanned boats, C * is the expected coverage level, k is a positive constant; The standard coverage error calculation module is set to: in, is the standard coverage error, To cover the area The area of the 3 ; The C1 module is set up as: C1: Among them, Δt e >0 is a preset period of time. To specify the threshold; The cluster point generator module is configured as follows: Among them, p des is the cluster point designed for the leader unmanned boat in cluster mode, μ 1 ,μ 2 >0 is weight, p 1d To lead the unmanned boat to plan trajectory points in real time; The C2 module is set up as: C2: Among them, ε i =d i +ε i , d i is the expected distance from each unmanned boat to the cluster point in cluster mode, ε i is the allowable error; The coverage planning module is configured to: in, To cover planning laws, is a 2×2 diagonal matrix; The cluster planning module is configured to: in, For cluster planning law, is a 2×2 diagonal matrix; The cluster coverage planning module is configured as follows: in, Dynamic coverage planning law for nominal clusters.
5. The unmanned boat swarm dynamic coverage planning and guidance system according to claim 4, It is characterized in that The collision avoidance planning module is configured as follows: in, For the collision avoidance law, i,j∈1,...,N,i≠j, and for all i=1,...,N, we have D lociloci >d>0,D icol is the detection area radius where the unmanned boat can detect other unmanned boats, d icol To avoid collision distance, is a 2×2 diagonal matrix; The obstacle avoidance planning module is configured as follows: in, is the obstacle avoidance law; k=1,…,N o , and for all i=1,...,N, there is D sboisboi >d>0,D iobs is the detection area radius of the unmanned boat to detect obstacles, d iobs is the minimum safe distance between the unmanned boat and the center of the obstacle, is a 2×2 diagonal matrix; The connection maintaining module is configured as follows: in, is the connectivity preservation law, for all i=1,…,N, D iloss >d iloss >0,d iloss D is the radius of the area where the communication quality begins to degrade. iloss is the loss radius, is a 2×2 diagonal matrix.
6. The unmanned boat swarm dynamic coverage planning and guidance system according to claim 5, It is characterized in that The first-level extended state observer module is set as: The second-level extended state observer module is set as: Among them, y iφ =φ ir +ν iφ is the actual heading signal obtained by the heading sensor, φ ir is the reference heading angle signal of the unmanned boat, ν iφ is the noise signal, is the heading angle signal estimated by the cascade extended state observer, are intermediate variables, which are the intermediate estimates of the heading angle and sideslip angle differential signals of the cascade extended state observer. is the expanded state variable β id The estimate, is a positive observer gain, is the gain of the traditional extended state observer.
7. The unmanned boat swarm dynamic coverage planning and guidance system according to claim 6, It is characterized in that The line-of-sight guidance module is configured as follows: Among them, U ir is the reference combined speed signal of the unmanned boat, r ir is the reference bow angular velocity signal of the unmanned boat, φ ir is the reference heading angle signal of the unmanned boat, p i =[x i ,y i ] T is the coordinate of the unmanned boat in the earth coordinate system, φ id is the tangent angle of the covered trajectory, x ie is the longitudinal error of the unmanned boat tracking trajectory, y ie is the lateral error of the unmanned boat tracking trajectory, is a positive constant, are all normal numbers, is the forward distance of the i-th unmanned boat.
