Multi-machine cooperative trajectory planning method based on spatial discretization modeling
By building a drone cruise network and patrol space model, analyzing the relative position and environmental impact of the drone cluster, the coordinated trajectory planning and real-time regulation of the drone cluster are realized, and the drone in complex environments in the existing technology is solved The problem of difficulty in regulation has improved emergency response capabilities.
Patent Information
- Application Number
- CN202411149140.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-21
- Publication Date
- 2024-11-12
AI Technical Summary
The prior art is difficult to realize intelligent regulation and dynamic adjustment of drone trajectory in complex or changing environments, and cannot effectively respond to complex environments and emergency situations.
By building a drone cruise network, obtaining drone status and environmental data in real time, building a patrol space model, analyzing the relative position and environmental impact of the drone cluster, carrying out comprehensive trajectory planning and real-time regulation, and real-time coordination of the drone cluster to realize the coordinated trajectory of the drone cluster planning.
It improves the drone team's response capabilities in complex environments and emergency situations, realizes intelligent trajectory planning and real-time regulation, and enhances monitoring efficiency and environmental adaptability.
Smart Images

Figure CN118939000A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of data analysis, and in particular to a multi-machine collaborative trajectory planning method based on spatial discretization modeling. Background Art
[0002] Spatial discretization UAV trajectory planning is a method that divides the UAV flight environment into discrete units and applies algorithms on these units to find the optimal flight path; this method can improve computational efficiency, simplify problems, and adapt to complex environments; In the current environment, the application areas of drones are becoming more and more extensive. Drones can be used to replace manual data collection or operations over long distances. However, under current technical conditions, people's use of drones is still relatively rough. The operation of drones generally involves planning trajectories in advance or performing online control. This mode cannot perform intelligent regulation in complex or changing environments, or perform dynamic analysis of complex situations to obtain the best and optimal adjustments. Summary of the invention
[0003] The purpose of the present invention is to provide a multi-machine collaborative trajectory planning method based on spatial discretization modeling to solve the problems raised in the above background technology.
[0004] In order to solve the above technical problems, the present invention provides the following technical solutions: A multi-machine collaborative trajectory planning method based on spatial discretization modeling, the method comprising the following steps: S100, constructing a drone cruise network by connecting the drone group in series; positioning each drone in real time, and using the cruise network to obtain status data and environmental data of each drone; S200, constructing an inspection space model for each drone based on the collected data, and integrating the inspection space models based on the positioning of each drone to construct a combined inspection model; S300, performing collaborative trajectory planning analysis on the drone group according to the combined inspection model; planning the relative spatial position of each drone in the group by analyzing the impact of the operation association within the group of each drone; and regulating the driving direction of the drone by analyzing the environmental impact of the operation area of each drone; S400, based on the environmental impact of each drone and the relative spatial position analysis results within the group, comprehensive inspection trajectory node planning is performed for the drone group, and real-time regulation is performed based on the planning results.
[0005] The specific steps of S100 are as follows: S101, connecting the communication devices of each drone in series through a wireless communication network to build a communication cruise network for the drones; and using the cruise network to perform data communication between the drones and the monitoring end; S102: The monitoring end locates and obtains the real-time position of the drone according to the positioning device of the drone, and collects the real-time operation status data and real-time environment data of the drone through the cruise network.
[0006] The drone communication device is a 5G wireless communication chip; the drone positioning device is a GPS positioning chip; the real-time operating status data of the drone includes speed data, distance data, power data, time data and direction data; the real-time environmental data includes wind direction data, temperature data, humidity data and obstacle data.
[0007] The S200 constructs the inspection space model for each drone according to the collected data, and integrates the inspection space model according to the positioning of each drone. The specific steps of constructing the combined inspection model are as follows: S201, obtaining the real-time positioning results of each drone according to the collected data, performing three-dimensional spatial modeling on the real-time spatial position of each drone according to the positioning results, marking the drone position nodes according to the actual environment, and assigning node numbers; S202. Based on the real-time monitoring range of each UAV as the spatial cutting value, spatial discrete modeling is performed on each UAV to obtain the real-time monitoring space area of each UAV during operation; the monitoring space area of the UAV is a spherical space with the current UAV node as the center and the monitoring distance R as the radius; the real-time detection space area intervals of each node UAV are fused, and each UAV node is used as a connection object to perform spatial straight line interconnection to obtain a closed node interconnection group, which is compared with the actual UAV connection group; the detection space area of each interconnected UAV is obtained by six-sided connected sections through section connection, and the maximum monitoring space area of the current UAV connection group is obtained according to the adjacent sections, and a UAV combination inspection model is constructed.
[0008] The detection space area of the drone connection group is obtained by performing six adjacent cut surfaces, wherein the six surfaces are respectively the vertical upper and lower surfaces and the horizontal front, back, left and right surfaces of the current drone connection group as a whole; wherein the adjacent cut surface is a cut surface approximated in a certain direction until there is a contact point with the monitoring area of a drone in the drone connection group, and then this adjacent cut surface is used as the component plane of the maximum monitoring space area of the drone connection group; the critical surfaces in the six directions are combined and the plane is extended to construct a spatial three-dimensional cube, and this three-dimensional cube is the maximum monitoring space area of the current drone connection group.
[0009] In the above S300, the coordinated trajectory planning analysis of the drone group is performed according to the combined inspection model; the relative spatial position of each drone in the group is planned by analyzing the impact of the operation association of each drone in the group; the specific steps of planning the operation trajectory of each drone by analyzing the environmental impact of the operation area of each drone are as follows: S301, combining the maximum monitoring space area of the drone connection group and the monitoring space area of each drone in the group, analyzing the best relative position of each drone in real time through random node combination, and obtaining the best node operation distribution in the current drone group connection; S302, analyzing the operating environment impact of each drone in a distributed manner, and combining the environmental impact analysis results of each drone to comprehensively analyze the operating environment impact of the drone connection group, and adjusting the orientation of the drone connection group according to the analysis results.
[0010] The specific analysis steps in S301 are as follows: Construct a three-dimensional space coordinate system with any drone node in the drone connection group as the origin, obtain the spatial coordinates of each drone node, and construct a node coordinate set ;in are the coordinates of each node; n is the node number; the distance between each adjacent node is calculated, and the calculation formula is: ;in is the distance between the target node and the adjacent nodes; is the number of the straight-line distance segment between the target node and the adjacent node; m is the number of the adjacent node of the target node; is the coordinates of the neighboring nodes of the target node; The distance between the target node and its adjacent nodes Calculate the result, take Compare with the monitoring distance R of the current target node drone; if , then Adjust the monitoring distance of the current drone; if , then R is the monitoring distance of the current UAV; according to the adjustment results of the monitoring distance of each UAV, the monitoring space area of each UAV is calculated, and the calculation formula is: ;in is the monitoring space area volume of each UAV; is the monitoring distance of each drone; the regional utilization rate is analyzed by combining the monitoring space volume of each drone with the maximum monitoring space area of the current drone connection group, and the calculation formula is: ;in is the real-time space utilization of the current drone connection group; is the volume of the maximum monitoring space area of the current drone connection group; by adjusting the relative spatial position of each drone in the drone connection group, the corresponding area utilization rate of each drone connection group after the relative position adjustment is obtained and a set is constructed, and the area utilization rate corresponding to the relative position adjustment of each drone connection group is obtained in the set. The relative spatial position node distribution of each drone in the corresponding drone connection group; the monitoring distance of the drone is adjusted because if the distance between adjacent drones is less than the monitoring distance of the initial drone, it will cause interference in the drone monitoring data; by analyzing the regional utilization rate and taking the corresponding drone position distribution of the maximum value, it is because when the utilization rate reaches the maximum value, the monitoring efficiency of the drone connection group can be increased.
[0011] The specific analysis steps in S302 are as follows: The impact of each drone’s real-time environmental data on the drone’s monitoring operations is analyzed, and the calculation formula is: ;in The energy required for each drone to overcome the wind direction and speed it is experiencing in real time; Overcoming wind speed for drones The energy required to travel a unit distance; st is the real-time wind speed; is the angle between the driving direction of each drone and the wind direction; by adjusting the driving angle of each drone, the energy required to overcome the influence of the wind environment under different adjusted angles of each drone ,Pick The corresponding angle is used to adjust the driving angle of each drone; since there are two angles between the driving direction of the drone and the wind direction, arrows are marked on the driving direction and wind direction of the drone respectively, and the angle between the two arrows is taken as ; The nodes at the edge of the drone connection group in each direction are taken as boundary nodes, and each boundary node is connected to build a comprehensive combination model corresponding to the current drone connection group. The comprehensive environmental impact analysis is performed on the combination model. The calculation formula is: ;in The energy required for the combined model to overcome the wind direction and speed it is subject to in real time; is the angle between the driving direction of the combined model and the wind direction; the energy required to overcome the influence of the wind environment under different angles after the combined model is adjusted according to the driving angle of the combined model ,Pick The driving angle of the combined model is adjusted according to the corresponding angle.
[0012] In S400, the specific steps of combining the environmental impact of each drone and the relative spatial position analysis results within the group to plan the nodes of the comprehensive inspection trajectory of the drone group and to perform real-time control according to the planning results are as follows: Combined with the environmental operation trajectory of each UAV and the relative spatial position analysis results within the group, the comprehensive inspection trajectory node planning of the UAV connection group is carried out, and the calculation formula is: * *S; where The predicted remaining energy of each UAV; is the current remaining energy of each drone; S is the remaining operating distance of each drone; if there is , then the drones with insufficient remaining energy will be warned, and they will be removed from the drone connection group, and the above drone relative positions and environmental impacts will be re-analyzed for the remaining drone connection groups; otherwise, the relative driving space position and driving direction control results of each drone in the drone connection group will be output; is the preset threshold.
[0013] The location analysis data and driving direction analysis data of each drone are backed up; the driving position and driving direction control results of each drone are fed back to the monitoring end.
[0014] Compared with the prior art, the beneficial effects achieved by the present invention are as follows: the present invention constructs a drone connection group and an inspection communication network by combining a group of operating drones to realize the interconnection and data communication of independent drones; obtains the optimal position distribution of the drone group by combining and analyzing the utilization of the monitoring area affected by the different position distributions of each drone in the drone connection group; regulates the driving angle of the drone by analyzing the real-time environmental impact of each drone; conducts a comprehensive environmental impact analysis on the drone connection group to determine the direction control of the drone connection group; conducts comprehensive node judgment and early warning on each drone in combination with the position analysis and environmental analysis of the drone; the present invention can conduct a comprehensive analysis of the drone group, and perform intelligent regulation and control according to the real-time environment to obtain real-time optimal trajectory planning, which greatly improves the drone group's ability to respond to emergencies and complex environments. BRIEF DESCRIPTION OF THE DRAWINGS
[0015] The accompanying drawings are used to provide a further understanding of the present invention and constitute a part of the specification. Together with the embodiments of the present invention, they are used to explain the present invention and do not constitute a limitation of the present invention. In the accompanying drawings: Figure 1 It is a schematic diagram of the steps of a multi-machine collaborative trajectory planning method based on spatial discretization modeling of the present invention. DETAILED DESCRIPTION
[0016] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions 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 are within the scope of protection of the present invention.
[0017] See also Figure 1 , the present invention provides a technical solution: A multi-machine collaborative trajectory planning method based on spatial discretization modeling, the method comprising the following steps: S100, constructing a drone cruise network by connecting the drone group in series; positioning each drone in real time, and using the cruise network to obtain status data and environmental data of each drone; S200, constructing an inspection space model for each drone based on the collected data, and integrating the inspection space models based on the positioning of each drone to construct a combined inspection model; S300, performing collaborative trajectory planning analysis on the drone group according to the combined inspection model; planning the relative spatial position of each drone in the group by analyzing the impact of the operation association within the group of each drone; and regulating the driving direction of the drone by analyzing the environmental impact of the operation area of each drone; S400, based on the environmental impact of each drone and the relative spatial position analysis results within the group, comprehensive inspection trajectory node planning is performed for the drone group, and real-time regulation is performed based on the planning results.
[0018] The specific steps of S100 are as follows: S101, connecting the communication devices of each drone in series through a wireless communication network to build a communication cruise network for the drones; and using the cruise network to perform data communication between the drones and the monitoring end; S102: The monitoring end locates and obtains the real-time position of the drone according to the positioning device of the drone, and collects the real-time operation status data and real-time environment data of the drone through the cruise network.
[0019] The drone communication device is a 5G wireless communication chip; the drone positioning device is a GPS positioning chip; the real-time operating status data of the drone includes speed data, distance data, power data, time data and direction data; the real-time environmental data includes wind direction data, temperature data, humidity data and obstacle data.
[0020] The S200 constructs the inspection space model for each drone according to the collected data, and integrates the inspection space model according to the positioning of each drone. The specific steps of constructing the combined inspection model are as follows: S201, obtaining the real-time positioning results of each drone according to the collected data, performing three-dimensional spatial modeling on the real-time spatial position of each drone according to the positioning results, marking the drone position nodes according to the actual environment, and assigning node numbers; S202. Based on the real-time monitoring range of each UAV as the spatial cutting value, spatial discrete modeling is performed on each UAV to obtain the real-time monitoring space area of each UAV during operation; the monitoring space area of the UAV is a spherical space with the current UAV node as the center and the monitoring distance R as the radius; the real-time detection space area intervals of each node UAV are fused, and each UAV node is used as a connection object to perform spatial straight line interconnection to obtain a closed node interconnection group, which is compared with the actual UAV connection group; the detection space area of each interconnected UAV is obtained by six-sided connected sections through section connection, and the maximum monitoring space area of the current UAV connection group is obtained according to the adjacent sections, and a UAV combination inspection model is constructed.
[0021] The detection space area of the drone connection group is obtained by performing six adjacent cut surfaces, wherein the six surfaces are respectively the vertical upper and lower surfaces and the horizontal front, back, left and right surfaces of the current drone connection group as a whole; wherein the adjacent cut surface is a cut surface approximated in a certain direction until there is a contact point with the monitoring area of a drone in the drone connection group, and then this adjacent cut surface is used as the component plane of the maximum monitoring space area of the drone connection group; the critical surfaces in the six directions are combined and the plane is extended to construct a spatial three-dimensional cube, and this three-dimensional cube is the maximum monitoring space area of the current drone connection group.
[0022] In the above S300, the coordinated trajectory planning analysis of the drone group is performed according to the combined inspection model; the relative spatial position of each drone in the group is planned by analyzing the impact of the operation association of each drone in the group; the specific steps of planning the operation trajectory of each drone by analyzing the environmental impact of the operation area of each drone are as follows: S301, combining the maximum monitoring space area of the drone connection group and the monitoring space area of each drone in the group, analyzing the best relative position of each drone in real time through random node combination, and obtaining the best node operation distribution in the current drone connection group; S302, analyzing the operating environment impact of each drone in a distributed manner, and combining the environmental impact analysis results of each drone to comprehensively analyze the operating environment impact of the drone connection group, and adjusting the orientation of the drone connection group according to the analysis results.
[0023] The specific analysis steps in S301 are as follows: Construct a three-dimensional space coordinate system with any drone node in the drone connection group as the origin, obtain the spatial coordinates of each drone node, and construct a node coordinate set ;in are the coordinates of each node; n is the node number; the distance between each adjacent node is calculated, and the calculation formula is: ;in is the distance between the target node and the adjacent nodes; is the number of the straight-line distance segment between the target node and the adjacent node; m is the number of the adjacent node of the target node; is the coordinates of the neighboring nodes of the target node; The distance between the target node and its adjacent nodes Calculate the result, take Compare with the monitoring distance R of the current target node drone; if , then Adjust the monitoring distance of the current drone; if , then R is the monitoring distance of the current UAV; according to the adjustment results of the monitoring distance of each UAV, the monitoring space area of each UAV is calculated, and the calculation formula is: ;in is the monitoring space area volume of each UAV; is the monitoring distance of each drone; the regional utilization rate is analyzed by combining the monitoring space volume of each drone with the maximum monitoring space area of the current drone connection group, and the calculation formula is: ;in is the real-time space utilization of the current drone connection group; is the volume of the maximum monitoring space area of the current drone connection group; by adjusting the relative spatial position of each drone in the drone connection group, the corresponding area utilization rate of each drone connection group after the relative position adjustment is obtained and a set is constructed, and the area utilization rate corresponding to the relative position adjustment of each drone connection group is obtained in the set. The relative spatial position node distribution of each drone in the corresponding drone connection group.
[0024] The specific analysis steps in S302 are as follows: The impact of each drone’s real-time environmental data on the drone’s monitoring operations is analyzed, and the calculation formula is: ;in The energy required for each drone to overcome the wind direction and speed it is experiencing in real time; Overcoming wind speed for drones The energy required to travel a unit distance; st is the real-time wind speed; is the angle between the driving direction of each drone and the wind direction; by adjusting the driving angle of each drone, the energy required to overcome the influence of the wind environment under different adjusted angles of each drone ,Pick The driving angle of each drone is adjusted according to the corresponding angle; The nodes at the edge of the drone connection group in each direction are taken as boundary nodes, and each boundary node is connected to build a comprehensive combination model corresponding to the current drone connection group. The comprehensive environmental impact analysis is performed on the combination model. The calculation formula is: ;in The energy required for the combined model to overcome the wind direction and speed it is subject to in real time; is the angle between the driving direction of the combined model and the wind direction; the energy required to overcome the influence of the wind environment under different angles after the combined model is adjusted according to the driving angle of the combined model ,Pick The driving angle of the combined model is adjusted according to the corresponding angle.
[0025] In S400, the specific steps of combining the environmental impact of each drone and the relative spatial position analysis results within the group to plan the nodes of the comprehensive inspection trajectory of the drone group and to perform real-time control according to the planning results are as follows: Combined with the environmental operation trajectory of each UAV and the relative spatial position analysis results within the group, the comprehensive inspection trajectory node planning of the UAV connection group is carried out, and the calculation formula is: * *S; where The predicted remaining energy of each UAV; is the current remaining energy of each drone; S is the remaining operating distance of each drone; if there is , then the drones with insufficient remaining energy will be warned, and they will be removed from the drone connection group, and the above drone relative positions and environmental impacts will be re-analyzed for the remaining drone connection groups; otherwise, the relative driving space position and driving direction control results of each drone in the drone connection group will be output; is the preset threshold.
[0026] The location analysis data and driving direction analysis data of each drone are backed up; the driving location and driving direction control results of each drone are fed back to the monitoring end; In the example: A monitoring center currently monitors a group of drones in operation, and needs to plan the trajectory of the drone group. The monitoring center adopts the multi-machine collaborative trajectory planning method based on spatial discretization modeling of the present invention, and connects the communication equipment of each drone in series through a wireless communication network to build a communication cruise network for drones; the cruise network is used to communicate data between drones and the monitoring end; the monitoring end locates and obtains the real-time position of the drone according to the positioning equipment of the drone, and collects the real-time operation status data and real-time environmental data of the drone through the cruise network; the positioning equipment of the drone is a GPS positioning chip; the real-time operation status data of the drone includes speed data, distance data, power data, time data and direction data; the real-time environmental data includes wind direction data, temperature data, humidity data and obstacle data; According to the collected data, the real-time positioning results of each drone are obtained. According to the positioning results, the real-time spatial position of each drone is modeled in three dimensions. The drone position nodes are marked according to the actual environment, and the node numbers are assigned. According to the real-time monitoring range of each drone as the spatial cutting value, each drone is modeled in space discreteness to obtain the real-time monitoring space area of each drone during operation. The real-time detection space area intervals of each node drone are fused, and each drone node is used as the connection object to obtain a closed node interconnection group through spatial straight line interconnection, which is a drone connection group according to the actual situation. The detection space area of each interconnected drone is obtained by six-sided connection surface connection through surface connection, and the maximum monitoring space area of the current drone connection group is obtained according to the adjacent surface connection, and a drone combination inspection model is constructed. Combined with the maximum monitoring space area of the drone connection group and the monitoring space area of each drone in the group, the best relative position analysis of each drone in real time is analyzed through random node combination to obtain the best node operation distribution in the current drone connection group; the operation environment impact of each drone is analyzed through distributed analysis, and the operation impact environment of the drone connection group is synthesized by combining the environmental impact analysis results of each drone, and the orientation of the drone connection group is adjusted according to the analysis results; a three-dimensional space coordinate system is constructed with any drone node in the drone connection group as the origin, the spatial coordinates of each drone node are obtained, and a node coordinate set is constructed ; Calculate the distance between each adjacent node separately, and the calculation formula is: ; The distance between the target node and the adjacent nodes Calculate the result, take Compare with the monitoring distance R of the current target node drone; if , then Adjust the monitoring distance of the current drone; if , then R is the monitoring distance of the current UAV; according to the adjustment results of the monitoring distance of each UAV, the monitoring space area of each UAV is calculated, and the calculation formula is: ; Combine the monitoring space volume of each drone with the maximum monitoring space area of the current drone connection group to perform regional utilization analysis, and the calculation formula is: ; By adjusting the relative spatial position of each drone in the drone connection group, the corresponding area utilization rate of each drone connection group after the relative position adjustment is obtained and a set is constructed, and the area utilization rate of each drone connection group after the relative position adjustment is obtained is obtained in the set. The relative spatial position node distribution of each drone in the corresponding drone connection group; The impact of each drone’s real-time environmental data on the drone’s monitoring operations is analyzed, and the calculation formula is: ; By adjusting the driving angle of each drone, the energy required to overcome the influence of the wind environment under different adjusted angles of each drone ,Pick The corresponding angle is used to adjust the driving angle of each drone; the nodes at the edge of the drone connection group in each direction are taken as boundary nodes, and each boundary node is connected to build a comprehensive combination model corresponding to the current drone connection group. The combination model is analyzed for the comprehensive environmental impact, and the calculation formula is: ; The energy required to overcome the influence of wind environment under different angles after the combined model is adjusted by the driving angle of the combined model ,Pick The corresponding angle is used to adjust the driving angle of the combined model; combined with the environmental operation trajectory of each drone and the relative spatial position analysis results within the group, the drone connection group is planned for comprehensive inspection trajectory nodes, and the calculation formula is: * *S; if present , then the drones with insufficient remaining energy will be warned, and they will be removed from the drone connection group, and the above drone relative positions and environmental impacts will be re-analyzed for the remaining drone connection groups; otherwise, the relative driving space position and driving direction control results of each drone in the drone connection group will be output; The location analysis data and driving direction analysis data of each drone are backed up; the driving position and driving direction control results of each drone are fed back to the monitoring end.
[0027] It should be noted that, in this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device.
[0028] Finally, it should be noted that the above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art can still modify the technical solutions described in the aforementioned embodiments or replace some of the technical features therein by equivalents. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.
Claims
1. A multi-machine collaborative trajectory planning method based on spatial discretization modeling, characterized by: The method comprises the following steps: S100, constructing a drone cruise network by connecting the drone group in series; positioning each drone in real time, and using the cruise network to obtain status data and environmental data of each drone; S200, constructing an inspection space model for each drone based on the collected data, and integrating the inspection space models based on the positioning of each drone to construct a combined inspection model; S300, performing collaborative trajectory planning analysis on the drone group according to the combined inspection model; planning the relative spatial position of each drone in the group by analyzing the impact of the operation association within the group of each drone; and regulating the driving direction of the drone by analyzing the environmental impact of the operation area of each drone; S400, based on the environmental impact of each drone and the relative spatial position analysis results within the group, comprehensive inspection trajectory node planning is performed for the drone group, and real-time regulation is performed based on the planning results.
2. The multi-machine collaborative trajectory planning method based on spatial discretization modeling according to claim 1 is characterized in that: The specific steps of S100 are as follows: S101, connecting the communication devices of each drone in series through a wireless communication network to build a communication cruise network for the drones; and using the cruise network to perform data communication between the drones and the monitoring end; S102: The monitoring end locates and obtains the real-time position of the drone according to the positioning device of the drone, and collects the real-time operation status data and real-time environment data of the drone through the cruise network.
3. The multi-machine collaborative trajectory planning method based on spatial discretization modeling according to claim 2 is characterized by: The drone communication device is a 5G wireless communication chip; the drone positioning device is a GPS positioning chip; the real-time operating status data of the drone includes speed data, distance data, power data, time data and direction data; the real-time environmental data includes wind direction data, temperature data, humidity data and obstacle data.
4. The multi-machine collaborative trajectory planning method based on spatial discretization modeling according to claim 3 is characterized by: The S200 constructs the inspection space model for each drone according to the collected data, and integrates the inspection space model according to the positioning of each drone. The specific steps of constructing the combined inspection model are as follows: S201, obtaining the real-time positioning results of each drone according to the collected data, performing three-dimensional spatial modeling on the real-time spatial position of each drone according to the positioning results, marking the drone position nodes according to the actual environment, and assigning node numbers; S202, based on the real-time monitoring range of each drone as the spatial cutting value, perform spatial discrete modeling on each drone to obtain the real-time monitoring space area of each drone during operation; the monitoring space area of the drone is a spherical space with the current drone node as the sphere center and the monitoring distance R as the radius; The real-time detection space area intervals of each node drone are fused, and each drone node is used as the connection object for spatial straight line interconnection to obtain a closed node interconnection group, which is compared with the actual drone connection group; the detection space area of each interconnected drone is obtained by six-sided connection surface through surface connection, and the maximum monitoring space area of the current drone connection group is obtained according to the adjacent surface, and a drone combination inspection model is constructed.
5. The multi-machine collaborative trajectory planning method based on spatial discretization modeling according to claim 4 is characterized by: The detection space area of the drone connection group is obtained by performing six adjacent cut surfaces, wherein the six surfaces are respectively the vertical upper and lower surfaces and the horizontal front, back, left and right surfaces of the current drone connection group as a whole; wherein the adjacent cut surface is a cut surface approximated in a certain direction until there is a contact point with the monitoring area of a drone in the drone connection group, and then this adjacent cut surface is used as the component plane of the maximum monitoring space area of the drone connection group; the critical surfaces in the six directions are combined and the plane is extended to construct a spatial three-dimensional cube, and this three-dimensional cube is the maximum monitoring space area of the current drone connection group.
6. The multi-machine collaborative trajectory planning method based on spatial discretization modeling according to claim 5 is characterized by: In the above S300, the coordinated trajectory planning analysis of the drone group is performed according to the combined inspection model; the relative spatial position of each drone in the group is planned by analyzing the impact of the operation association of each drone in the group; the specific steps of planning the operation trajectory of each drone by analyzing the environmental impact of the operation area of each drone are as follows: S301, combining the maximum monitoring space area of the drone connection group and the monitoring space area of each drone in the group, analyzing the best relative position of each drone in real time through random node combination, and obtaining the best node operation distribution in the current drone connection group; S302, analyzing the operating environment impact of each drone in a distributed manner, and combining the environmental impact analysis results of each drone to comprehensively analyze the operating environment impact of the drone connection group, and adjusting the orientation of the drone connection group according to the analysis results.
7. The multi-machine collaborative trajectory planning method based on spatial discretization modeling according to claim 6 is characterized by: The specific analysis steps in S301 are as follows: Construct a three-dimensional space coordinate system with any drone node in the drone connection group as the origin, obtain the spatial coordinates of each drone node, and construct a node coordinate set ;in are the coordinates of each node; n is the node number; the distance between each adjacent node is calculated, and the calculation formula is: ;in is the distance between the target node and the adjacent nodes; is the number of the straight-line distance segment between the target node and the adjacent node; m is the number of the adjacent node of the target node; is the coordinates of the neighboring nodes of the target node; The distance between the target node and its adjacent nodes Calculate the result, take Compare with the monitoring distance R of the current target node drone; if , then Adjust the monitoring distance of the current drone; if , then R is the monitoring distance of the current UAV; according to the adjustment results of the monitoring distance of each UAV, the monitoring space area of each UAV is calculated, and the calculation formula is: ;in is the monitoring space area volume of each UAV; is the monitoring distance of each drone; the regional utilization rate is analyzed by combining the monitoring space volume of each drone with the maximum monitoring space area of the current drone connection group, and the calculation formula is: ;in is the real-time space utilization of the current drone connection group; is the volume of the maximum monitoring space area of the current drone connection group; by adjusting the relative spatial position of each drone in the drone connection group, the corresponding area utilization rate of each drone connection group after the relative position adjustment is obtained and a set is constructed, and the area utilization rate corresponding to the relative position adjustment of each drone connection group is obtained in the set. The relative spatial position node distribution of each drone in the corresponding drone connection group.
8. The multi-machine collaborative trajectory planning method based on spatial discretization modeling according to claim 7 is characterized by: The specific analysis steps in S302 are as follows: The impact of each drone’s real-time environmental data on the drone’s monitoring operations is analyzed, and the calculation formula is: ;in The energy required for each drone to overcome the wind direction and speed it is experiencing in real time; Overcoming wind speed for drones The energy required to travel a unit distance; st is the real-time wind speed; is the angle between the driving direction of each drone and the wind direction; by adjusting the driving angle of each drone, the energy required to overcome the influence of the wind environment under different adjusted angles of each drone ,Pick The driving angle of each UAV is adjusted according to the corresponding angle; The nodes at the edge of the drone connection group in each direction are taken as boundary nodes, and each boundary node is connected to build a comprehensive combination model corresponding to the current drone connection group. The comprehensive environmental impact analysis is performed on the combination model. The calculation formula is: ;in The energy required for the combined model to overcome the wind direction and speed it is subject to in real time; is the angle between the driving direction of the combined model and the wind direction; the energy required to overcome the influence of the wind environment under different angles after the combined model is adjusted according to the driving angle of the combined model ,Pick The driving angle of the combined model is adjusted according to the corresponding angle.
9. The multi-machine collaborative trajectory planning method based on spatial discretization modeling according to claim 8 is characterized by: In S400, the specific steps of combining the environmental impact of each drone and the relative spatial position analysis results within the group to plan the nodes of the comprehensive inspection trajectory of the drone connection group and perform real-time control according to the planning results are as follows: Combined with the environmental operation trajectory of each UAV and the relative spatial position analysis results within the group, the comprehensive inspection trajectory node planning of the unmanned connection group is carried out, and the calculation formula is: * *S; where The predicted remaining energy of each UAV; is the current remaining energy of each drone; S is the remaining operating distance of each drone; if there is , then the drones with insufficient remaining energy will be warned, and they will be removed from the drone connection group, and the above drone relative positions and environmental impacts will be re-analyzed for the remaining drone connection groups; otherwise, the relative driving space position and driving direction control results of each drone in the drone connection group will be output; is the preset threshold.
10. The multi-machine collaborative trajectory planning method based on spatial discretization modeling according to claim 9 is characterized in that: The location analysis data and driving direction analysis data of each drone are backed up; the driving position and driving direction control results of each drone are fed back to the monitoring end.
Citation Information
Cited By
Medium and low altitude wind speed networking method and system based on unmanned aerial vehicle observation
CN121728426A
