Unmanned aerial vehicle route safety level cost value determination method, equipment and medium
Through the method of determining the value of the drone route safety level, the optimization of the drone flight route has solved the problem that traditional methods are difficult to consider the risks of ground obstacles and crowded areas, and improved the safety of drone flight.
Patent Information
- Application Number
- CN202411684594.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-11-22
- Publication Date
- 2025-03-14
- Estimated Expiration
- 2044-11-22
AI Technical Summary
Traditional drone flight route planning methods are difficult to fully consider the risks of ground obstacles and the risks of crowded areas, resulting in insufficient safety of drone flights.
The drone route safety level value determination method is used to determine the grid safety level of each target grid through the target grid map and grid coordinate system, and calculate the safety level value according to the amount of safety level changes, thereby optimizing the drone flight route.
It improves the safety of drone flight routes, reduces drone damage and ground danger caused by sudden accidents, and ensures the safety of drone's low-altitude flight.
Smart Images

Figure CN119618220A_ABST
Abstract
Description
Background Art
[0002] With the booming development of the drone industry, the number of drone flights has continued to increase. According to statistics from the Civil Aviation Administration of China, the total flight hours of civil drones in China in 2023 reached 23.11 million, an increase of 11.8% year-on-year. Among them, most drones operate at low altitudes, and the density of low-altitude flights is increasing. As a result, low-altitude safety issues continue to emerge. Therefore, it is necessary to plan drone flight routes more scientifically and rationally to improve the safety level of low-altitude operations.
[0003] Traditional flight route planning methods, such as the A* algorithm, are based on heuristic search algorithms and are suitable for quickly searching for the shortest flight route, but they lack consideration for flight safety. Low-altitude drones need to fully consider the risk of ground obstacles throughout the flight process, and a large number of operating scenarios in crowded areas also need to consider the risk of drones crashing into people on the ground. However, traditional flight route planning methods do not focus on analyzing the risk of ground obstacles when planning drone flight routes, making it difficult to fully ensure the flight safety of drones. Summary of the invention
[0004] In view of the above technical problems, the technical solution adopted by the present invention is:
[0005] According to one aspect of the present application, a method for determining a cost value of a safety level of a UAV route is provided, which is applied to a flight route planning system. The flight route planning system includes a target grid map corresponding to a target space, the target grid map includes a plurality of target grids, the target grid map corresponds to a grid coordinate system, each target grid corresponds to a grid coordinate in the grid coordinate system, each target grid corresponds to a grid safety level, and the grid safety level corresponding to the target grid is determined according to the safety interval between the target grid and an obstacle;
[0006] The method for determining the safety level cost value of the drone route described in this application includes the following steps:
[0007] Step S100, in response to receiving a flight route planning request from a target UAV, determining a plurality of initial flight routes from the starting grid to the destination grid according to the starting grid coordinates of the starting grid and the destination grid coordinates of the destination grid included in the flight route planning request;
[0008] Step S200: Obtain the grid security levels corresponding to a number of target grids between the starting grid and the destination grid on each initial flight route, and obtain a grid security level list set V = (V 1 ,V 2 ,...,V i ,...,V n );V i =(V i1,V i2 ,...,V ig ,...,V if(i) ), where i = 1, 2, ..., n, and n is the number of initial flight routes; V i is the grid safety level list corresponding to the i-th initial flight route; g = 1, 2, ..., f(i); f(i) is the number of target grids between the starting grid and the destination grid on the i-th initial flight route; V ig is the grid safety level corresponding to the gth target grid between the starting grid and the destination grid on the i-th initial flight route; the grid safety level is determined according to the safety interval between the corresponding target grid and the obstacle;
[0009] Step S300: According to V ig and V i(g+1) , determine the safety level change O corresponding to the gth target grid between the starting grid and the destination grid on the i-th initial flight route ig ;
[0010] Step S400: Determine the safety level cost value corresponding to the gth target grid between the starting grid and the destination grid on the i-th initial flight route. Among them, e is a natural constant;
[0011] Step S500: determining a target flight route from a plurality of initial flight routes according to the safety level cost values of a plurality of target grids on each initial flight route.
[0012] In an exemplary embodiment of the present application, step S100 includes:
[0013] Step S110: The grid coordinates are (x a ,y a )、(x a ,y b )、(x b ,y a ) and (x b ,y b ) is determined as the target flight area; where x a is the horizontal coordinate of the starting grid coordinate; y a is the ordinate of the starting grid coordinate; x b is the horizontal coordinate of the target grid coordinate; y b is the ordinate of the destination grid coordinate; the starting grid corresponding to the starting grid coordinate is the target grid of the starting position point of the target UAV in the target grid map; the destination grid corresponding to the destination grid coordinate is the target grid of the destination position point of the target UAV in the target grid map;
[0014] Step S120 , according to a preset flight route planning algorithm, starting from the starting grid, traversing each target grid in the target flight area, and ending at the destination grid, to determine a number of initial flight routes.
[0015] In an exemplary embodiment of the present application, the grid security level corresponding to the target grid is determined by the following steps:
[0016] Step S010: Obtain the distance between each target grid and each obstacle in the target space, and obtain a distance list set A=(A 1 ,A 2 ,...,A m ,...,A h );A m =(A m1 ,A m2 ,...,A mj ,...,A mk ), where m = 1, 2, ..., h, h is the number of target grids, A m is the distance list corresponding to the mth target grid; j = 1, 2, ..., k; k is the number of obstacles in the target space; A mj is the distance between the mth target grid and the jth obstacle in the target space;
[0017] Step S020: MIN(A m ) is determined as the safety interval D corresponding to the mth target grid. m ; Wherein, MIN() is a preset minimum value determination function;
[0018] Step S030: If 0<D m ≤d 1 , then the grid security level corresponding to the mth target grid is determined to be c 1 ;
[0019] If d 1 <D m ≤d 2 , then the grid security level corresponding to the mth target grid is determined to be c 2 ;
[0020] If D m >d 2 , then the grid security level corresponding to the mth target grid is determined to be c 3 ;
[0021] Among them, d 1 and d 2 is the preset safety interval threshold; c 3 >c 2 >c1 >0.
[0022] In an exemplary embodiment of the present application, the distance between each target grid and each obstacle in the target space is determined by the following steps:
[0023] Step S011, obtain the coordinates of the center of each target grid in the grid coordinate system, and obtain a grid center coordinate list I=(I 1 ,I 2 ,...,I m ,...,I h );I m =(I m1 ,I m2 );where I m is the coordinate of the center of the mth target grid in the grid coordinate system; I m1 For I m The horizontal axis, I m2 For I m The vertical coordinate of
[0024] Step S012: Obtain the coordinates of the center of each obstacle in the target space in the grid coordinate system to obtain an obstacle center coordinate list L=(L 1 ,L 2 ,...,L j ,...,L k );L j =(L j1 ,L j2 ), where L j is the coordinate of the center of the jth obstacle in the target space in the grid coordinate system; L j1 For L j The horizontal axis, L j2 For L j The vertical coordinate of
[0025] Step S013: Determine the distance A between the mth target grid and the jth obstacle in the target space. mj =((I m1 -L j1 ) 2 +(I m2 -L j2 ) 2 ) 1 / 2 .
[0026] In an exemplary embodiment of the present application, step S300 includes:
[0027] Step S310: If V ig c 3 , and V i(g+1) c3 ,but
[0028] If V ig c 2 , and V i(g+1) c 3 ,but
[0029] If V ig c 1 , and V i(g+1) c 3 ,but
[0030] If V ig c 1 , and V i(g+1) c 2 ,but
[0031] If V ig c 2 , and V i(g+1) c 2 ,but
[0032] If V ig c 3 , and V i(g+1) c 2 ,but
[0033] If V ig c 1 , and V i(g+1) c 1 ,but
[0034] If V ig c 2 , and V i(g+1) c 1 ,but
[0035] If V ig c 3 , and V i(g+1) c 1 , then O ig =c 3 .
[0036] In an exemplary embodiment of the present application, step S500 includes:
[0037] Step S510, determining an estimated cost value of each target grid on each initial flight route according to the starting grid coordinates, the destination grid coordinates and each corresponding grid coordinate on each initial flight route;
[0038] Step S520, determining a total cost value corresponding to each initial flight route according to the estimated cost values and safety level cost values of a plurality of target grids on each initial flight route;
[0039] Step S530: determine the initial flight route with the smallest total cost as the target flight route.
[0040] In an exemplary embodiment of the present application, step S510 includes:
[0041] Step S511: Obtain the grid coordinates corresponding to a number of target grids between the starting grid and the destination grid on each initial flight route, and obtain the initial flight route coordinate list set E=(E 1 ,E 2 ,...,E i ,...,E n );E i =(E i1 ,E i2 ,...,E ig ,...,E if(i) );E ig =(E ig1 ,E ig2 ), where E i is the initial flight route coordinate list corresponding to the i-th initial flight route; E ig is the grid coordinates corresponding to the gth target grid between the starting grid and the destination grid on the i-th initial flight route; E ig1 For E ig The horizontal axis of E ig2 For E ig The vertical coordinate of
[0042] Step S512: determine the number of cells along the i-th initial flight route from the starting grid to E ig The corresponding cumulative cost value H at the target grid ig =|E ig1 -x a |+|E ig2 -y a |;
[0043] Step S513: Determine the route along the i-th initial flight path from E ig The corresponding key cost value M from the target grid to the destination grid ig =((E ig1 -x b )2 +(E ig2 -y b ) 2 ) 1 / 2 ;
[0044] Step S514: If H ig ≤M ig , then determine E ig The corresponding position coefficient T at the target grid ig =M ig / H ig Otherwise, determine E ig The corresponding position coefficient T at the target grid ig =H ig / M ig ;
[0045] Step S515: Determine E ig The corresponding cumulative cost coefficient of the target grid Among them, e is a natural constant;
[0046] Step S516: Determine E ig The corresponding target grid's key cost coefficient W ig =1-U ig ;
[0047] Step S517: According to U ig and W ig , determine E ig The estimated cost value Z of the corresponding target grid ig =U ig ×H ig +W ig ×M ig .
[0048] In an exemplary embodiment of the present application, step S520 includes:
[0049] Step S521: According to Z ig and P ig , determine the total cost B corresponding to the i-th initial flight route i =∑ f(i) g=1 (Z ig -P ig ).
[0050] According to one aspect of the present application, a non-transitory computer-readable storage medium is provided, in which at least one instruction or at least one program is stored, and the at least one instruction or the at least one program is loaded and executed by a processor to implement the aforementioned method for determining the cost value of the drone route safety level.
[0051] According to one aspect of the present application, an electronic device is provided, including a processor and the aforementioned non-transitory computer-readable storage medium.
[0052] The present invention has at least the following beneficial effects:
[0053] The method for determining the safety level cost value of a UAV route of the present invention determines a plurality of initial flight routes corresponding to the target UAV according to the starting grid coordinates and the destination grid coordinates of the target UAV, obtains the grid safety level corresponding to each target grid on each initial flight route according to the safety interval between each target grid located between the starting grid and the destination grid and the obstacle on each initial flight route; determines the change amount of the safety level corresponding to each target grid according to the grid safety levels corresponding to two adjacent target grids; and obtains the safety level cost value of each target grid on each initial flight route according to the change amount of the safety level corresponding to each target grid. By introducing the safety level proxy value and taking into full consideration various low-altitude risk factors, the gradient order of the grid safety level of each target grid on the UAV's flight route is analyzed to obtain the safety level proxy value of each target grid, which provides an important basis for scientifically and rationally planning the UAV's flight route, so as to facilitate the subsequent safety planning of the UAV route according to the safety level proxy value, thereby improving the safety of the determined target flight route and reducing the serious consequences of UAV damage caused by collisions with ground obstacles due to sudden accidents such as power outages or communication failures during flight, thereby ensuring the flight safety of the UAV. BRIEF DESCRIPTION OF THE DRAWINGS
[0054] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0055] Figure 1 A flowchart of a method for determining a cost value of a drone route safety level provided in an embodiment of the present invention. DETAILED DESCRIPTION
[0056] 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 those skilled in the art without creative work are within the scope of protection of the present invention.
[0057] As the number of drones in flight increases, for the sake of drone flight safety, it is necessary to manage the flight of drones, that is, to plan the flight routes of drones so that each drone can fly according to its own flight route. The flight environment of the ultra-low altitude airspace where drones are located has gradually become more complex and changeable with the development of the drone industry. Therefore, in order to ensure the safety of drones during flight, it is necessary to plan the flight routes reasonably and safely. Therefore, a method for determining the value of the drone route safety level is proposed in this application.
[0058] A method for determining a cost value of a safety level of an unmanned aerial vehicle (UAV) route is applied to a flight route planning system. The flight route planning system includes a target grid map corresponding to a target space. The target grid map includes a plurality of target grids. The target grid map corresponds to a grid coordinate system. Each target grid corresponds to a grid coordinate in the grid coordinate system. Each target grid corresponds to a grid safety level. The grid safety level corresponding to the target grid is determined according to the safety interval between the target grid and an obstacle.
[0059] The target space is the space where the target UAV flies.
[0060] The grid security level corresponding to the target grid is determined through steps S010 to S030:
[0061] Step S010: Obtain the distance between each target grid and each obstacle in the target space, and obtain a distance list set A=(A 1 ,A 2 ,...,A m ,...,A h );A m =(A m1 ,A m2 ,...,A mj ,...,A mk ), where m = 1, 2, ..., h, h is the number of target grids, A m is the distance list corresponding to the mth target grid; j = 1, 2, ..., k; k is the number of obstacles in the target space; A mj is the distance between the mth target grid and the jth obstacle in the target space;
[0062] The distance between each target grid and each obstacle in the target space is determined by steps S011 to S013:
[0063] Step S011, obtain the coordinates of the center of each target grid in the grid coordinate system, and obtain a grid center coordinate list I=(I 1 ,I 2 ,...,I m,...,I h );I m =(I m1 ,I m2 );where I m is the coordinate of the center of the mth target grid in the grid coordinate system; I m1 For I m The horizontal axis, I m2 For I m The vertical coordinate of
[0064] Step S012: Obtain the coordinates of the center of each obstacle in the target space in the grid coordinate system to obtain an obstacle center coordinate list L=(L 1 ,L 2 ,...,L j ,...,L k );L j =(L j1 ,L j2 ), where L j is the coordinate of the center of the jth obstacle in the target space in the grid coordinate system; L j1 For L j The horizontal axis, L j2 For L j The vertical coordinate of
[0065] The obstacle in the target space may be an obstacle on the ground whose height is greater than a preset height threshold.
[0066] Step S013: Determine the distance A between the mth target grid and the jth obstacle in the target space. mj =((I m1 -L j1 ) 2 +(I m2 -L j2 ) 2 ) 1 / 2 .
[0067] Step S020: MIN(A m ) is determined as the safety interval D corresponding to the mth target grid. m ; Wherein, MIN() is a preset minimum value determination function;
[0068] Step S030: If 0<D m ≤d 1 , then the grid security level corresponding to the mth target grid is determined to be c 1 ;
[0069] If d 1 <D m ≤d 2, then the grid security level corresponding to the mth target grid is determined to be c 2 ;
[0070] If D m >d 2 , then the grid security level corresponding to the mth target grid is determined to be c 3 ;
[0071] Among them, d 1 and d 2 is the preset safety interval threshold; c 3 >c 2 >c 1 >0.
[0072] c 1 、c 2 、c 3 It can be determined by staff based on existing grid safety level determination methods, or it can be set by staff themselves based on civil aviation drone flight standards or rules.
[0073] like Figure 1 As shown, the method for determining the cost value of the safety level of the drone route described in this application includes the following steps:
[0074] Step S100, in response to receiving a flight route planning request from a target UAV, determining a plurality of initial flight routes from the starting grid to the destination grid according to the starting grid coordinates of the starting grid and the destination grid coordinates of the destination grid included in the flight route planning request;
[0075] Further, step S100 includes steps S110 to S120:
[0076] Step S110: The grid coordinates are (x a ,y a )、(x a ,y b )、(x b ,y a ) and (x b ,y b ) is determined as the target flight area; where x a is the horizontal coordinate of the starting grid coordinate; y a is the ordinate of the starting grid coordinate; x b is the horizontal coordinate of the target grid coordinate; y b is the ordinate of the destination grid coordinate;
[0077] The starting grid corresponding to the starting grid coordinates is the target grid of the starting position point of the target UAV in the target grid map; the destination grid corresponding to the destination grid coordinates is the target grid of the destination position point of the target UAV in the target grid map.
[0078] Step S120 , according to a preset flight route planning algorithm, starting from the starting grid, traversing each target grid in the target flight area, and ending at the destination grid, to determine a number of initial flight routes.
[0079] The preset flight route planning algorithm may adopt an existing path planning algorithm, such as a traditional A-star algorithm.
[0080] Step S200: Obtain the grid security levels corresponding to a number of target grids between the starting grid and the destination grid on each initial flight route, and obtain a grid security level list set V = (V 1 ,V 2 ,...,V i ,...,V n );V i =(V i1 ,V i2 ,...,V ig ,...,V if(i) ), where i = 1, 2, ..., n, and n is the number of initial flight routes; V i is the grid safety level list corresponding to the i-th initial flight route; g = 1, 2, ..., f(i); f(i) is the number of target grids between the starting grid and the destination grid on the i-th initial flight route; V ig is the grid safety level corresponding to the gth target grid between the starting grid and the destination grid on the i-th initial flight route;
[0081] Step S300: According to V ig and V i(g+1) , determine the safety level change O corresponding to the gth target grid between the starting grid and the destination grid on the i-th initial flight route ig ;
[0082] Among them, O ig The determination conditions are shown in step S310:
[0083] Step S310: If V ig c 3 , and V i(g+1) c 3 ,but
[0084] If V ig c 2 , and Vi(g+1) c 3 ,but
[0085] If V ig c 1 , and V i(g+1) c 3 ,but
[0086] If V ig c 1 , and V i(g+1) c 2 ,but
[0087] If V ig c 2 , and V i(g+1) c 2 ,but
[0088] If V ig c 3 , and V i(g+1) c 2 ,but
[0089] If V ig c 1 , and V i(g+1) c 1 ,but
[0090] If V ig c 2 , and V i(g+1) c 1 ,but
[0091] If V ig c 3 , and V i(g+1) c 1 , then O ig =c 3 .
[0092] Step S400: Determine the safety level cost value corresponding to the gth target grid between the starting grid and the destination grid on the i-th initial flight route. Among them, e is a natural constant;
[0093] Step S500, determining a target flight route from a plurality of initial flight routes according to the safety level cost values of a plurality of target grids on each initial flight route;
[0094] Further, step S500 includes steps S510 to S530:
[0095] Step S510, determining an estimated cost value of each target grid on each initial flight route according to the starting grid coordinates, the destination grid coordinates and each corresponding grid coordinate on each initial flight route;
[0096] Wherein, step S510 includes steps S511 to S517:
[0097] Step S511: Obtain the grid coordinates corresponding to a number of target grids between the starting grid and the destination grid on each initial flight route, and obtain the initial flight route coordinate list set E=(E 1 ,E 2 ,...,E i ,...,E n );E i =(E i1 ,E i2 ,...,E ig ,...,E if(i) );E ig =(E ig1 ,E ig2 ), where E i is the initial flight route coordinate list corresponding to the i-th initial flight route; E ig is the grid coordinates corresponding to the gth target grid between the starting grid and the destination grid on the i-th initial flight route; E ig1 For E ig The horizontal axis of E ig2 For E ig The vertical coordinate of
[0098] Step S512: determine the number of cells along the i-th initial flight route from the starting grid to E ig The corresponding cumulative cost value H at the target grid ig =|E ig1 -x a |+|E ig2 -y a |;
[0099] Step S513: Determine the route along the i-th initial flight path from E ig The corresponding key cost value M from the target grid to the destination grid ig =((E ig1 -x b ) 2 +(E ig2 -y b ) 2 ) 1 / 2 ;
[0100] Step S514: If H ig ≤M ig , then determine E ig The corresponding position coefficient T at the target grid ig =M ig / H ig Otherwise, determine E ig The corresponding position coefficient T at the target grid ig =H ig / M ig ;
[0101] Step S515: Determine E ig The corresponding cumulative cost coefficient of the target grid Among them, e is a natural constant;
[0102] Step S516: Determine E ig The corresponding target grid's key cost coefficient W ig =1-U ig ;
[0103] Step S517: According to U ig and W ig , determine E ig The estimated cost value Z of the corresponding target grid ig =U ig ×H ig +W ig ×M ig .
[0104] Step S520, determining a total cost value corresponding to each initial flight route according to the estimated cost values and safety level cost values of a plurality of target grids on each initial flight route;
[0105] Specifically, step S520 includes step S521:
[0106] Step S521: According to Z ig and P ig , determine the total cost B corresponding to the i-th initial flight route i =∑ f(i) g=1 (Z ig -P ig ).
[0107] Step S530: determine the initial flight route with the smallest total cost as the target flight route.
[0108] The method for determining the cost value of the safety level of the route of the unmanned aerial vehicle of the present invention determines several initial flight routes corresponding to the target unmanned aerial vehicle according to the starting grid coordinates and the destination grid coordinates of the target unmanned aerial vehicle, determines the cost value of the safety level corresponding to the target grid according to the grid safety level of each target grid on each initial flight route and the grid safety level of the key grid corresponding to the target grid, and determines the estimated cost value of each target grid on each initial flight route according to the starting grid coordinates, the destination grid coordinates and each grid coordinate corresponding to each initial flight route, thereby determining the total cost value corresponding to each initial flight route, and determining the initial flight route with the smallest total cost value as the target flight route of the target unmanned aerial vehicle. By analyzing the gradual change order of the grid safety level of each target grid on the flight route of the unmanned aerial vehicle, the safety of the determined target flight route is improved, the serious consequences caused by sudden accidents during the flight of the unmanned aerial vehicle are avoided, and the flight safety of the unmanned aerial vehicle is guaranteed.
[0109] An embodiment of the present invention further provides a computer program product, which includes program code. When the program product is run on an electronic device, the program code is used to enable the electronic device to execute the steps of the method according to various exemplary embodiments of the present invention described above in this specification.
[0110] In addition, although the steps of the method in the present disclosure are described in a specific order in the drawings, this does not require or imply that the steps must be performed in this specific order, or that all the steps shown must be performed to achieve the desired results. Additionally or alternatively, some steps may be omitted, multiple steps may be combined into one step, and / or one step may be decomposed into multiple steps, etc.
[0111] Through the description of the above implementation, it is easy for those skilled in the art to understand that the example implementation described here can be implemented by software, or by software combined with necessary hardware. Therefore, the technical solution according to the implementation of the present disclosure can be embodied in the form of a software product, which can be stored in a non-volatile storage medium (which can be a CD-ROM, a USB flash drive, a mobile hard disk, etc.) or on a network, including several instructions to enable a computing device (which can be a personal computer, a server, a mobile terminal, or a network device, etc.) to execute the method according to the implementation of the present disclosure.
[0112] In an exemplary embodiment of the present disclosure, an electronic device capable of implementing the above method is also provided.
[0113] It will be appreciated by those skilled in the art that various aspects of the present invention may be implemented as a system, method or program product. Therefore, various aspects of the present invention may be specifically implemented in the following forms, namely: a complete hardware implementation, a complete software implementation (including firmware, microcode, etc.), or a combination of hardware and software, which may be collectively referred to herein as a "circuit", "module" or "system".
[0114] The electronic device according to this embodiment of the present invention is only an example and should not bring any limitation to the functions and scope of use of the embodiments of the present invention.
[0115] The electronic device is presented in the form of a general-purpose computing device. The components of the electronic device may include, but are not limited to: the at least one processor mentioned above, the at least one storage device mentioned above, and a bus connecting different system components (including storage devices and processors).
[0116] The storage stores program codes, which can be executed by the processor, so that the processor executes the steps according to various exemplary embodiments of the present invention described in the above “Exemplary Method” section of this specification.
[0117] The memory may include readable media in the form of volatile memory, such as random access memory (RAM) and / or cache memory, and may further include read only memory (ROM).
[0118] The storage may also include a program / utility having a set (at least one) of program modules, such program modules including but not limited to: an operating system, one or more application programs, other program modules and program data, each of which or some combination may include the implementation of a network environment.
[0119] The bus may represent one or more of several types of bus structures including a memory bus or memory controller, a peripheral bus, an accelerated graphics port, a processor, or a local bus using any of a variety of bus architectures.
[0120] The electronic device may also communicate with one or more external devices (e.g., keyboards, pointing devices, Bluetooth devices, etc.), one or more devices that enable a user to interact with the electronic device, and / or any device that enables the electronic device to communicate with one or more other computing devices (e.g., routers, modems, etc.). Such communication may be performed via an input / output (I / O) interface. Furthermore, the electronic device may also communicate with one or more networks (e.g., local area networks (LANs), wide area networks (WANs), and / or public networks, such as the Internet) via a network adapter.
[0121] Through the description of the above implementation, it is easy for those skilled in the art to understand that the example implementation described here can be implemented by software, or by software combined with necessary hardware. Therefore, the technical solution according to the implementation of the present disclosure can be embodied in the form of a software product, which can be stored in a non-volatile storage medium (which can be a CD-ROM, a USB flash drive, a mobile hard disk, etc.) or on a network, including several instructions to enable a computing device (which can be a personal computer, a server, a terminal device, or a network device, etc.) to execute the method according to the implementation of the present disclosure.
[0122] In an exemplary embodiment of the present disclosure, a computer-readable storage medium is also provided, on which a program product capable of implementing the above method of the present specification is stored. In some possible implementations, various aspects of the present invention can also be implemented in the form of a program product, which includes a program code, and when the program product is run on a terminal device, the program code is used to enable the terminal device to execute the steps according to various exemplary embodiments of the present invention described in the above "Exemplary Method" section of the present specification.
[0123] The program product may use any combination of one or more readable media. The readable medium may be a readable signal medium or a readable storage medium. The readable storage medium may be, for example, but not limited to, an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device or device, or any combination of the above. More specific examples (non-exhaustive list) of readable storage media include: an electrical connection with one or more wires, a portable disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above.
[0124] Computer readable signal media may include data signals propagated in baseband or as part of a carrier wave, in which readable program code is carried. Such propagated data signals may take a variety of forms, including but not limited to electromagnetic signals, optical signals, or any suitable combination of the above. Readable signal media may also be any readable medium other than a readable storage medium, which may send, propagate, or transmit a program for use by or in conjunction with an instruction execution system, apparatus, or device.
[0125] The program code embodied on the readable medium may be transmitted using any appropriate medium, including but not limited to wireless, wired, optical cable, RF, etc., or any suitable combination of the foregoing.
[0126] Program code for performing the operations of the present invention may be written in any combination of one or more programming languages, including object-oriented programming languages such as Java, C++, etc., and conventional procedural programming languages such as "C" or similar programming languages. The program code may be executed entirely on the user computing device, partially on the user device, as a separate software package, partially on the user computing device and partially on a remote computing device, or entirely on a remote computing device or server. In cases involving a remote computing device, the remote computing device may be connected to the user computing device through any type of network, including a local area network (LAN) or a wide area network (WAN), or may be connected to an external computing device (e.g., through the Internet using an Internet service provider).
[0127] In addition, the above-mentioned figures are only schematic illustrations of the processes included in the method according to an exemplary embodiment of the present invention, and are not intended to be limiting. It is easy to understand that the processes shown in the above-mentioned figures do not indicate or limit the time sequence of these processes. In addition, it is also easy to understand that these processes can be performed synchronously or asynchronously, for example, in multiple modules.
[0128] It should be noted that, although several modules or units of the device for action execution are mentioned in the above detailed description, this division is not mandatory. In fact, according to the embodiments of the present disclosure, the features and functions of two or more modules or units described above can be embodied in one module or unit. On the contrary, the features and functions of one module or unit described above can be further divided into multiple modules or units to be embodied.
[0129] The above is only a specific embodiment of the present invention, but the protection scope of the present invention is not limited thereto. Any changes or substitutions that can be easily thought of by a person skilled in the art within the technical scope disclosed by the present invention should be included in the protection scope of the present invention. Therefore, the protection scope of the present invention shall be subject to the protection scope of the claims.
Claims
1. A method for determining the cost value of the safety level of an unmanned aerial vehicle route, characterized in that: Applied to flight route planning system; The method comprises the following steps: Step S100, in response to receiving a flight route planning request from a target UAV, determining a plurality of initial flight routes from the starting grid to the destination grid according to the starting grid coordinates of the starting grid and the destination grid coordinates of the destination grid included in the flight route planning request; Step S200: Obtain the grid security levels corresponding to a number of target grids between the starting grid and the destination grid on each of the initial flight routes, and obtain a grid security level list set V = (V1, V2, ..., V i ,...,V n );V i =(V i1 ,V i2 ,...,V ig ,...,V if(i) ), wherein i=1, 2, ..., n, and n is the number of the initial flight routes; V i is a grid safety level list corresponding to the i-th initial flight route; g = 1, 2, ..., f(i); f(i) is the number of target grids between the starting grid and the destination grid on the i-th initial flight route; V ig is the grid safety level corresponding to the g-th target grid between the starting grid and the destination grid on the i-th initial flight route; the grid safety level is determined according to the safety interval between the corresponding target grid and the obstacle; Step S300: According to V ig and V i(g+1) , determine the safety level change O corresponding to the g-th target grid between the starting grid and the destination grid on the i-th initial flight route ig ; Step S400: Determine the safety level cost value corresponding to the gth target grid between the starting grid and the destination grid on the i-th initial flight route. Among them, e is a natural constant.
2. The method according to claim 1, characterized in that The flight route planning system includes a target grid map corresponding to the target space, the target grid map includes a plurality of target grids, the target grid map corresponds to a grid coordinate system, and each of the target grids corresponds to a grid coordinate in the grid coordinate system; Wherein, the step S100 includes: Step S110: The grid coordinates are (x a ,y a )、(x a ,y b )、(x b ,y a ) and (x b ,y b ) is determined as the target flight area; where x a is the horizontal coordinate of the starting grid coordinate; a is the ordinate of the starting grid coordinate; b is the horizontal coordinate of the target grid coordinate; b is the ordinate of the destination grid coordinate; the starting grid corresponding to the starting grid coordinate is the target grid of the starting position point of the target UAV in the target grid map; the destination grid corresponding to the destination grid coordinate is the target grid of the destination position point of the target UAV in the target grid map; Step S120, according to a preset flight route planning algorithm, starting from the starting grid, traversing each target grid in the target flight area, and ending at the destination grid, to determine a number of initial flight routes.
3. The method according to claim 2, characterized in that The grid security level corresponding to the target grid is determined by the following steps: Step S010: Obtain the distance between each target grid and each obstacle in the target space, and obtain a distance list set A = (A1, A2, ..., A m ,...,A h );A m =(A m1 ,A m2 ,...,A mj ,...,A mk ), wherein m=1, 2, ..., h, and h is the number of target grids; A m is the distance list corresponding to the mth target grid; j = 1, 2, ..., k; k is the number of obstacles in the target space; A mj is the distance between the mth target grid and the jth obstacle in the target space; Step S020: MIN(A m ) is determined as the safety interval D corresponding to the mth target grid. m ; Wherein, MIN() is a preset minimum value determination function; Step S030: If 0<D m ≤d1, then determine that the grid security level corresponding to the mth target grid is c1; If d1<D m ≤d2, then determine that the grid security level corresponding to the mth target grid is c2; If D m >d2, then determine that the grid security level corresponding to the mth target grid is c3; Among them, d1 and d2 are preset safety interval thresholds; c3>c2>c1>0.
4. The method according to claim 3, characterized in that The distance between each target grid and each obstacle in the target space is determined by the following steps: Step S011, obtain the coordinates of the center of each target grid in the grid coordinate system, and obtain a grid center coordinate list I = (I1, I2, ..., I m ,...,I h );I m =(I m1 ,I m2 );where I m is the coordinate of the center of the mth target grid in the grid coordinate system; m1 For I m The horizontal axis, I m2 For I m The vertical coordinate of Step S012: Obtain the coordinates of the center of each obstacle in the target space in the grid coordinate system to obtain an obstacle center coordinate list L = (L1, L2, ..., L j ,...,L k );L j =(L j1 ,L j2 ), where L j is the coordinate of the center of the jth obstacle in the target space in the grid coordinate system; L j1 For L j The horizontal axis, L j2 For L j The vertical coordinate of Step S013: Determine the distance A between the mth target grid and the jth obstacle in the target space. mj =((I m1 -L j1 ) 2 +(I m2 -L j2 ) 2 ) 1 / 2 .
5. The method according to claim 2, characterized in that: The step S300 includes: Step S310: If V ig is c3, and V i(g+1) is c3, then If V ig is c2, and V i(g+1) is c3, then If V ig is c1, and V i(g+1) is c3, then If V ig is c1, and V i(g+1) is c2, then If V ig is c2, and V i(g+1) is c2, then If V ig is c3, and V i(g+1) is c2, then If V ig is c1, and V i(g+1) is c1, then If V ig is c2, and V i(g+1) is c1, then If V ig is c3, and V i(g+1) is c1, then O ig =c3.
6. The method according to claim 5, characterized in that After step S400, the method further includes: Step S500, determining a target flight route from a plurality of initial flight routes according to the safety level cost values of a plurality of target grids on each of the initial flight routes; Wherein, the step S500 includes: Step S510, determining an estimated cost value of each target grid on each of the initial flight routes according to the starting grid coordinates, the destination grid coordinates and each corresponding grid coordinate on each of the initial flight routes; Step S520: determining a total cost value corresponding to each of the initial flight routes according to the estimated cost values and safety level cost values of the plurality of target grids on each of the initial flight routes; Step S530: determine the initial flight route with the smallest total cost as the target flight route.
7. The method according to claim 6, characterized in that The step S510 includes: Step S511, obtaining the grid coordinates corresponding to a number of target grids between the starting grid and the destination grid on each of the initial flight routes, and obtaining an initial flight route coordinate list set E = (E1, E2, ..., E i ,...,E n );E i =(E i1 ,E i2 ,...,E ig ,...,E if(i) );E ig =(E ig1 ,E ig2 ), where E i is a list of initial flight route coordinates corresponding to the i-th initial flight route; E ig is the grid coordinate corresponding to the gth target grid between the starting grid and the destination grid on the i-th initial flight route; E ig1 For E ig The horizontal axis of E ig2 For E ig The vertical coordinate of Step S512: determine the route from the starting grid to E along the i-th initial flight route. ig The corresponding cumulative cost value H at the target grid ig =|E ig1 -x a |+|E ig2 -y a |; Step S513: determine the route along the i-th initial flight path from E ig The key cost value M from the corresponding target grid to the destination grid ig =((E ig1 -x b ) 2 +(E ig2 -y b ) 2 ) 1 / 2 ; Step S514: If H ig ≤M ig , then determine E ig The corresponding position coefficient T at the target grid ig =M ig / H ig Otherwise, determine E ig The corresponding position coefficient T at the target grid ig =H ig / M ig ; Step S515: Determine E ig The corresponding cumulative cost coefficient of the target grid Among them, e is a natural constant; Step S516: Determine E ig The corresponding target grid's key cost coefficient W ig =1-U ig ; Step S517: According to U ig and W ig , determine E ig The estimated cost value Z of the corresponding target grid ig =U ig ×H ig +W ig ×M ig .
8. The method according to claim 7, characterized in that The step S520 includes: Step S521: According to Z ig and P ig , determine the total cost B corresponding to the i-th initial flight route i =∑ f(i) g=1 (Z ig -P ig ).
9. A non-transitory computer-readable storage medium, wherein at least one instruction or at least one program is stored in the storage medium, characterized in that: The at least one instruction or the at least one program is loaded and executed by the processor to implement the method for determining the cost value of the drone route safety level as described in any one of claims 1-8.
10. An electronic device, characterized in that: The invention comprises a processor and the non-transitory computer-readable storage medium as claimed in claim 9.
Citation Information
Patent Citations
Unmanned aerial vehicle route planning method and system based on airspace grid
CN118913292A
UAV path planning method and device guided by the safety situation, UAV and storage medium
US20210327287A1
Three-dimensional safe route planning method for unmanned aerial vehicle
WO2021213540A1