Long-range path planning method of unmanned aerial vehicle, electronic equipment and storage medium
By receiving and judging obstacle information during UAV trajectory planning, the computational complexity problem in high-density flight and highly dynamic airspace environments is solved, and real-time trajectory adjustment and efficient path planning of the UAV are achieved.
Patent Information
- Application Number
- CN202511195452.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2025-08-26
- Publication Date
- 2025-10-03
- Estimated Expiration
- 2045-08-26
AI Technical Summary
Existing UAV trajectory planning has high computational complexity in high-density flight and highly dynamic low-altitude airspace environments, cannot meet the needs of real-time trajectory planning, and cannot adapt to dynamic airspace environments.
By receiving obstacle information before the preset track planning period, the initial track is calculated, and whether new obstacle information is received is determined during the initial track calculation phase. If not, it is directly used as the planned path. If so, it is determined whether there is a trajectory conflict. If there is no conflict, it is used as a pending track. If there is a conflict, the track planning is restarted until the destination is reached.
It reduces the computational complexity, improves the data processing efficiency, and realizes the real-time dynamic track adjustment of UAVs in highly dynamic airspace environments, adapting to highly dynamic airspace environments.
Smart Images

Figure CN120740604A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of unmanned aerial vehicle (UAV) path planning, and in particular to a long-range path planning method, electronic equipment, and storage medium for an UAV. Background Art
[0002] In the future, high-density flight and highly dynamic low-altitude airspace environments, drone trajectory planning will need to dynamically adjust to the surrounding environment and possess good scalability to accommodate the growing number of drones. However, current drone trajectory planning is primarily based on centralized planning. As the number of drones increases, the computational complexity required for planning increases rapidly, reducing computational accuracy and failing to meet the real-time trajectory planning needs of a large number of drones. Furthermore, it is primarily based on static planning within a given airspace environment, making it incapable of adapting to highly dynamic airspace environments. Summary of the Invention
[0003] In response to the above technical problems, the present invention provides a long-range path planning method, electronic device and storage medium for an unmanned aerial vehicle (UAV), which can reduce the problem of excessive computational complexity and realize dynamic track adjustment according to the surrounding environment of the UAV to adapt to the highly dynamic airspace environment.
[0004] According to a first aspect of the present invention, a method for long-range path planning of an unmanned aerial vehicle is provided, comprising the following steps: S100, based on the obstacle information received before the start time of the preset track planning period, calculate the initial track corresponding to the target UAV within the preset airspace range; the preset starting point of the preset airspace range is the position point in the original track of the target UAV corresponding to the time length T1 from the current time.
[0005] S200: If no new obstacle information is received when calculating the initial track, the initial track is used as the target planning path; otherwise, it is determined whether there is a trajectory conflict between the obtained initial track and the new obstacle. If there is a trajectory conflict, the original track of the target UAV is continued at the preset starting point; otherwise, the initial track is used as the track to be confirmed.
[0006] S300, detecting whether new obstacle information is received within the judgment period corresponding to the trajectory conflict. If received, the original track of the target UAV is continued at the preset starting point; otherwise, the track to be confirmed is determined as the target planned path.
[0007] S400, if the target UAV receives new obstacle information during the execution of the target planned path and determines that the new obstacle has a trajectory conflict with the target planned path, restart the preset track planning period and update the preset airspace range, and return to step S100 until the end point is reached; otherwise, the preset target point of the preset airspace range is used as the new preset starting point and the preset airspace range is updated, the starting time of the preset track planning period is determined and the execution returns to step S100 until the end point is reached.
[0008] According to a second aspect of the present invention, a non-transitory computer-readable storage medium is provided, wherein the storage medium stores at least one instruction or at least one program, and the at least one instruction or the at least one program is loaded and executed by a processor to implement the above-mentioned long-range path planning method for a drone.
[0009] According to a third aspect of the present invention, there is provided an electronic device comprising a processor and the above-mentioned non-transitory computer-readable storage medium.
[0010] The present invention has at least the following beneficial effects: The present invention provides a long-range path planning method for an unmanned aerial vehicle (UAV). First, based on obstacle information received before the start time of a preset track planning period, an initial track corresponding to a target UAV within a preset airspace is calculated. It is determined whether new obstacle information is received when calculating the initial track. If not, the initial track is directly used as the target planning path. If new obstacle information is received, it is determined whether there is a track conflict with the initial track. If not, the initial track is used as a pending track. Since new obstacle information may also be received during the calculation stage of the initial track, there is no need to recalculate the track at this time, and only needs to determine whether the track conflicts, thereby improving data processing efficiency. If no new obstacle information is received within the judgment period corresponding to the track conflict, the pending track is determined as the target planning path. When the target UAV executes the target planning path, if a new obstacle with a track conflict is detected, the track planning is restarted. Otherwise, a new track calculation is triggered before reaching the preset target point to implement track planning one track segment after another. This reduces the problem of excessive computational complexity caused by an increase in the number of UAVs, and enables the UAV to adjust its track in real time according to the surrounding environment, thereby adapting to a highly dynamic airspace environment. BRIEF DESCRIPTION OF THE DRAWINGS
[0011] 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.
[0012] Figure 1 A flowchart of a long-range path planning method for a UAV provided in an embodiment of the present invention; Figure 2 A schematic diagram of the positional relationship between a preset starting point and a preset target point provided in an embodiment of the present invention. DETAILED DESCRIPTION
[0013] The following will clearly and completely describe the technical solutions in the embodiments of the present invention in conjunction with the accompanying drawings. 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 shall fall within the scope of protection of the present invention.
[0014] The present invention provides a long-range path planning method for a UAV, such as Figure 1 As shown, the following steps are included: S100, based on obstacle information received before the start time of the preset trajectory planning period, calculate the initial trajectory of the target UAV within a preset airspace range; the preset starting point of the preset airspace range is the position point in the original trajectory of the target UAV corresponding to the time length T1 from the current time; it can be understood that the preset airspace range refers to the future trajectory segment of the target UAV corresponding to the preset trajectory planning period, that is, the range corresponding to a future trajectory segment in the current trajectory of the target UAV. In a specific implementation, the initial trajectory is calculated using a trajectory planning algorithm, such as the A-Star algorithm.
[0015] Specifically, the obstacle information includes dynamic obstacle information and static obstacle information. For example, static obstacle information includes obstacles such as buildings and trees whose heights are within the planned trajectory altitude range. Static obstacle information can be detected by onboard sensors.
[0016] Furthermore, the dynamic obstacle information includes broadcast messages from a given drone received by the target drone within a preset time window before the start of a preset trajectory planning period, as well as dynamic flying objects detected by the target drone's onboard sensors. This information can be understood as meaning that the given drone is a drone within a certain airspace that has a probability of affecting the target drone's flight trajectory, such as drones located in the same urban area as the target drone. In one implementation scenario, a tree branch swaying due to wind direction would be detected as a dynamic flying object by the onboard sensors.
[0017] Specifically, the duration corresponding to the preset track planning period is obtained through the following steps: S01: Estimate the acquisition time of the target planned path based on the amount of data corresponding to the received obstacle information. For example, estimate the acquisition time of the target planned path based on the amount of historical calculation data and calculation time.
[0018] S02: Using the acquired duration corresponding to the target planned path as the duration corresponding to the preset track planning period.
[0019] Furthermore, T1 meets the following conditions: T1≥T2+T0, where T2 is the duration corresponding to the preset track planning period, and T0 is the preset fault tolerance time. For example, the preset fault tolerance time may be 1 second.
[0020] As mentioned above, the duration of the preset trajectory planning period and the fault tolerance period are limited, and then the flight distance of the target UAV after flying for this duration is estimated to reasonably determine the trajectory section to be planned, and ensure that the target planned path is acquired before reaching the planned trajectory section, so that the target UAV can seamlessly connect the current trajectory and the target planned path to ensure the stable flight of the target UAV.
[0021] S200: If no new obstacle information is received when calculating the initial track, the initial track is used as the target planning path; otherwise, it is determined whether there is a trajectory conflict between the obtained initial track and the new obstacle. If there is a trajectory conflict, the original track of the target UAV is continued at the preset starting point; otherwise, the initial track is used as the track to be confirmed.
[0022] Specifically, the following steps are used to determine whether there is a trajectory conflict between the initial track and the new obstacle: S201: If the new obstacle is a static obstacle, determine whether the closest distance between the initial track and the static obstacle is less than a first preset distance threshold. Those skilled in the art can set the first preset distance threshold according to actual needs, which will not be described in detail here.
[0023] S202: If the distance is less than a first preset distance threshold, it is determined that there is a trajectory conflict between the initial track and the new obstacle; otherwise, it is determined that there is no trajectory conflict between the initial track and the new obstacle.
[0024] In step S203, if the new obstacle is a dynamic object, a determination is made as to whether there is at least one time point at which the distance between the initial trajectory and the predicted trajectory of the dynamic object is less than a second preset distance threshold; wherein the second preset distance threshold is greater than the first preset distance threshold. Those skilled in the art will determine the second preset distance threshold based on actual needs, and this description is omitted here.
[0025] S204: If there is at least one time point, it is determined that there is a trajectory conflict between the initial track and the new obstacle; otherwise, it is determined that there is no trajectory conflict between the initial track and the new obstacle.
[0026] As mentioned above, since new obstacle information may also be received during the calculation stage of the initial track, there is no need to recalculate the track at this time, and it is only necessary to determine whether the tracks conflict, which improves data processing efficiency. When determining whether there is a track conflict between the initial track and the new obstacle, since the drone will be affected by wind and other factors, resulting in a slight deviation in the flight position, a distance threshold is set. As long as the distance is less than the distance threshold, it is considered that there is a risk of track conflict. Moreover, since there is a certain deviation in the predicted track of dynamic flying objects, a larger distance threshold is set for dynamic obstacles than for static obstacles to avoid the risk of track conflict, thereby ensuring the normal flight of the drone.
[0027] S300, detecting whether new obstacle information is received within the judgment period corresponding to the trajectory conflict. If received, the original track of the target UAV is continued at the preset starting point; otherwise, the track to be confirmed is determined as the target planned path.
[0028] As mentioned above, since the judgment time corresponding to the trajectory conflict is much shorter than the calculation time corresponding to the initial track, the probability of receiving new obstacle information during the trajectory conflict judgment process is extremely small. Based on this situation, when the new obstacle information is received, the initial track can be abandoned without having to determine whether there is a trajectory conflict again. This avoids falling into multiple loops and causing the acquisition time of the target planned path to be too long, which in turn causes the target UAV to be unable to fly according to the target planned path at the preset starting point.
[0029] S400, if the target UAV receives new obstacle information during the execution of the target planned path and determines that the new obstacle has a trajectory conflict with the target planned path, restart the preset track planning period and update the preset airspace range, and return to step S100 until the end point is reached; otherwise, the preset target point of the preset airspace range is used as the new preset starting point and the preset airspace range is updated, the starting time of the preset track planning period is determined and the execution returns to step S100 until the end point is reached.
[0030] Specifically, the starting time of the preset trajectory planning period is the time corresponding to the duration T1 reversed from the time when the predicted target UAV flies to the preset target point.
[0031] As mentioned above, when the target UAV reaches the preset starting point, it will fly according to the target planned path and detect new obstacles through onboard sensors. If it is determined that the detected new obstacle has a trajectory conflict with the target planned path, a new track planning step will be restarted. If there is no trajectory conflict, the track planning cycle needs to be started before reaching the target point, and track planning is implemented one track segment after another, which reduces the problem of excessive computational complexity caused by the increase in the number of UAVs, and realizes the real-time dynamic track adjustment of the UAV according to the surrounding environment, thereby adapting to the highly dynamic airspace environment.
[0032] Further, if Figure 2 As shown, the preset target point within the preset airspace is obtained through the following steps: S10, with the preset starting point as the center of the sphere, sets the intersection of the line between the preset starting point and the end point and the sphere with a radius of R as the point to be confirmed; where R is the length of the preset track planning section; it can be understood that: the length of the track planned each time is R, that is, R refers to the distance between the preset starting point and the preset target point in the preset airspace range.
[0033] In a specific embodiment, the preset track planning segment length is obtained through the following steps: S11, based on the current position of the target UAV, obtains the total number score of UAVs and the static object complexity score within the target airspace corresponding to the future original trajectory of the target UAV. This can be understood as follows: each time trajectory planning is performed, the target airspace is dynamically adjusted according to the current position of the target UAV.
[0034] In specific implementations, those skilled in the art will define scoring rules for the total number of drones and the complexity of static objects based on actual needs. For example, the greater the number of drones, the higher the total number score; the greater the number of static objects within the target airspace, the higher the static object complexity score.
[0035] S12, calculate the airspace complexity score corresponding to the target airspace range based on the total number score of drones and the static object complexity score within the target airspace range.
[0036] Specifically, the airspace complexity score D corresponding to the target airspace range meets the following conditions: D=w1×d1+w2×d2, where d1 is the total number of drones score, d2 is the static object complexity score, w1 and w2 are the preset weights corresponding to the total number of drones score and the static object complexity score, respectively.
[0037] S13, according to the preset correspondence between the airspace complexity score and the track planning segment length, obtain the preset track planning segment length; it can be understood that: there are preset several airspace complexity score intervals and several track planning segment length intervals, and the airspace complexity score intervals and the track planning segment length intervals correspond one to one.
[0038] Specifically, the length of the preset trajectory planning segment is inversely proportional to the airspace complexity score.
[0039] S20: If the point to be confirmed is located inside any obstacle, a point located outside the obstacle and closest to the point to be confirmed on the sphere is used as the target point; otherwise, the point to be confirmed is used as the target point.
[0040] As mentioned above, when obtaining the preset trajectory planning segment length, the airspace complexity is taken into consideration, and the two dimensions of the number of drones and static obstacles are introduced to make the obtained airspace complexity more reasonable. Since the higher the airspace complexity, the greater the probability of trajectory conflict among drones, a smaller preset trajectory planning segment length is set, and the trajectory planning frequency is increased to effectively ensure the safe flight of the target drone in a highly dynamic airspace environment.
[0041] Furthermore, when the target drone reaches the destination, it is necessary to further perform drone path planning on the target location corresponding to the destination so as to clearly capture the target event in the target location. That is, the method further includes the following steps: S1, when the target UAV reaches the end point and the target location corresponding to the end point is a preset area type, obtain the target area image taken by the target UAV; it can be understood that: the end point refers to the shooting point directly above the target location and at an initial shooting height h1 from the center of the target location, that is, h1 is the shooting height corresponding to the target area image.
[0042] Specifically, the target location is a location extracted from the received police incident filming instruction text using a preset large language model; the police incident filming instruction text also includes the target event. In a specific implementation, the natural language processing module determines the target location as a specific address or area. This can be understood as using a pre-trained binary classification model to determine the target location as a preset specific address type or preset area type, for example, a specific location is a certain lane and number, and an area can be a residential community or a park.
[0043] Specifically, the end point position is determined by the following steps: Based on the boundary coordinates of the target location, the center point of the rectangular area corresponding to the boundary coordinates of the target location is marked; this can be understood as: obtaining the boundary coordinates of the target location by calling the GIS module.
[0044] Based on the target drone's shooting parameters, the initial shooting height h1 corresponding to the target drone's center point in the rectangular area is determined so that the range of the target drone's shooting at height h1 covers the rectangular area corresponding to the boundary coordinates of the target location. In the specific implementation, distortion is not considered.
[0045] Specifically, h1 meets the following conditions: , where L and W are the length and width of the rectangular area, respectively, and α and β are the horizontal and vertical viewing angles of the camera, respectively.
[0046] The end point is determined based on the center point of the rectangular area and the initial shooting height h1. This can be understood as follows: in the vertical direction corresponding to the center point of the rectangular area, the position at the initial shooting height h1 is determined as the target shooting point.
[0047] As mentioned above, when obtaining a full-view image of the target location, a larger calculated height is selected to ensure that the rectangular area can be completely covered. By obtaining a full-view image of the target location, it is possible to prevent omissions in the shooting of subsequent event information when the specific location of the incident is not described in the police information, thereby ensuring the comprehensiveness and reliability of the acquisition of event information.
[0048] Furthermore, the method further comprises the following steps: When the target location is a preset specific address type, the GIS module is called to obtain the location coordinates of the target location, and the obtained location coordinates are used as the end point; the preset specific address type is positioning data accurate to the building unit.
[0049] The target trajectory corresponding to the target UAV is generated according to the trajectory planning algorithm, so that the target UAV flies to the destination according to the target trajectory.
[0050] In this embodiment, when the target location has specific location information, the track can be directly generated according to the track planning algorithm, so that the target UAV can quickly reach the specific shooting location.
[0051] S2, according to the shooting range corresponding to the preset target shooting height h2, the target area image is segmented, and the target event occurrence label corresponding to each sub-area image is obtained; the target event occurrence label is either yes or no; it can be understood as: each sub-area image obtained after segmentation is sent to the target event detection model, and the event corresponding to the sub-area image is obtained. If the similarity with the target event is higher than the similarity threshold, the target event occurrence label corresponding to the sub-area image is set to: yes.
[0052] Specifically, h2
[0053] Furthermore, the target shooting height h2 is determined by the following steps: Obtain a manually annotated historical image sample set; the historical image sample set includes image sample subsets corresponding to each preset event type, as well as a number of shooting heights and event information corresponding to each image sample subset. For example, the shooting heights can range from 20m to 100m, with each height being 10m apart. Event information can include the number of vehicles, the number of people, and fires, etc.
[0054] For any preset event type corresponding to several shooting heights and event information, the event detection accuracy corresponding to each shooting height is obtained; this can be understood as: comparing the detection results of the event detection module with the marked event information to obtain the event detection accuracy, among which different preset event types calculate their own corresponding event detection accuracy separately.
[0055] According to the event detection accuracy corresponding to each shooting height, a height-accuracy relationship fitting curve corresponding to the preset event type is constructed.
[0056] Based on the preset event type corresponding to the target event, the maximum shooting height corresponding to the preset accuracy is found from the height-accuracy relationship fitting curve corresponding to the target event, and the maximum shooting height is determined as the target shooting height h2.
[0057] It should be noted that since this solution is carried out for a larger area, when the preset accuracy needs to be met during shooting, the shooting height is usually lower than the shooting height that covers the entire picture. If there are special circumstances, that is, when h2≥h1, the accuracy can also be met, and in this case it is set to h2=h1.
[0058] As mentioned above, the target area image obtained is an image of a larger range, and the target event occurring locally cannot be clearly displayed. Therefore, it is necessary to determine a suitable shooting height to ensure that the event detection accuracy meets the requirements and make the obtained event information more accurate, which is conducive to the staff to grasp the clear event situation in a timely manner and give reasonable handling measures in a timely manner.
[0059] Furthermore, in step S2, the target area image is segmented by the following steps: S21: When the width of the shooting range corresponding to the target area image is an integer multiple of the width of the shooting range corresponding to the target shooting height h2, the target area image is evenly segmented based on the shooting range corresponding to the target shooting height h2. This can be understood as follows: when the width of the shooting range P1 corresponding to the target area image is an integer multiple of the width of the shooting range P2 corresponding to the target shooting height h2, the length of P1 is also an integer multiple of the length of P2. In a specific implementation, since the drone's shooting ratio is consistent, the ratio of the image's length to width is a fixed value, and the number of segmented sub-area images is the ratio of the area of P1 to the area of P2.
[0060] S22: When the width of the shooting range corresponding to the target area image is not an integer multiple of the width of the shooting range corresponding to the target shooting height h2, the target area image is extended in length and width until the width of the shooting range corresponding to the obtained virtual area frame is an integer multiple of the width of the shooting range corresponding to the target shooting height h2; wherein the virtual area frame coincides with the center of the target area image.
[0061] S23, based on the shooting range corresponding to the target shooting height h2, the virtual area frame is evenly divided to achieve segmentation of the target area image; it can be understood that: even segmentation is performed according to the size of the virtual area frame, and the edge image after segmentation removes the extended blank area, which is the sub-area image corresponding to the target area image.
[0062] As mentioned above, since the event detection accuracy of the image captured at the target shooting height can meet the requirements, when the target location is divided into regions, the target area image is evenly divided with the shooting range corresponding to the target shooting height as the reference benchmark to achieve preliminary positioning of the shooting point when shooting at the h2 height, ensuring the comprehensiveness of the event information in the target location and the accuracy of the event information captured in each sub-area.
[0063] S3, traversing the track waypoints corresponding to each sub-region image in the order from target event occurrence label to target event occurrence label, and generating a second route corresponding to the target shooting height h2.
[0064] Specifically, in step S3, the track waypoints corresponding to the sub-region image are obtained through the following steps: S31 , obtaining a first world coordinate in a world coordinate system corresponding to the center point of the sub-region image according to the pixel coordinate corresponding to the center point of the sub-region image.
[0065] Specifically, step S31 includes the following steps: S311, converting the pixel coordinates corresponding to the center point of the sub-region image into the camera coordinates corresponding to the center point of the sub-region image; wherein the camera coordinates corresponding to the center point of the sub-region image (X c , Y c , Z c ) meets the following conditions: (X c , Y c , Z c)=(Z0×(u-u0)×dx / f,Z0×(v-v0)×dy / f,Z0), where Z0 is the depth distance from the target point to the optical center of the camera, dx and dy represent the pixel sizes in the horizontal and vertical directions, respectively, f is the focal length of the camera, u and v are the horizontal and vertical coordinates of the pixel coordinates corresponding to the center point of the sub-region image, and u0 and v0 are the horizontal and vertical coordinates of the pixel coordinates corresponding to the principal point, respectively.
[0066] S312, convert the camera coordinates corresponding to the center point of the sub-region image into the first world coordinates (X e , Y e , Z e ).
[0067] Specifically, the conversion process meets the following conditions: , where r is a 3×3 rotation matrix and t is a 3×1 translation vector.
[0068] S33, replacing the vertical coordinates in the first world coordinates with the target shooting height h2 to obtain the second world coordinates corresponding to each sub-region image; it can be understood that the second world coordinates corresponding to the sub-region image refer to the world coordinates corresponding to the sub-region image mapped to the target shooting height.
[0069] S35 , using the second world coordinates corresponding to each sub-region image as the track waypoint corresponding to the sub-region image; it can be understood that the second world coordinates include longitude, latitude and vertical height.
[0070] As described above, the corresponding track waypoint is calculated by the center point of the sub-area image, so that the drone can completely capture the area range in the sub-area image when shooting at the track waypoint position, with a lower shooting height and higher clarity, which is conducive to improving the recognition accuracy of event information.
[0071] Furthermore, step S3 further includes the following steps: S32: Starting from the target shooting point and based on the track waypoints corresponding to the sub-region images with the target event occurrence label, a first sub-route is generated by a track planning algorithm. For example, the track planning algorithm may be an A-Star algorithm.
[0072] S34, using the last track waypoint in the first sub-route as a new starting point, and generating a second sub-route through a track planning algorithm based on the track waypoints corresponding to several sub-region images with target event occurrence labels as none.
[0073] S36 , merging the first sub-route and the second sub-route to obtain a second route. It can be understood that merging the first sub-route and the second sub-route means connecting the end point of the first sub-route and the starting point of the second sub-route.
[0074] As mentioned above, by dividing the target area image according to the shooting range of the target shooting height and obtaining the track waypoints corresponding to each sub-area image at the target shooting height, the drone's flight route can be obtained, so that the drone can shoot the sub-area at each track waypoint when flying along the flight route, which is beneficial to improving the recognition accuracy of event information, and by generating routes in order from label to no label, it is beneficial to timely capture the target event, timely obtain event information and improve event processing efficiency.
[0075] S4, obtains the image to be analyzed corresponding to each sub-area photographed in sequence by the target UAV along the second route and performs real-time detection of the target event. When the target event is detected from the image to be analyzed, the corresponding image to be analyzed is sent to the background. This can be understood as: the UAV takes pictures at each track point in the second route.
[0076] Specifically, the sub-region corresponds to the sub-region image one-to-one; it can be understood that the sub-region refers to the ground area corresponding to the sub-region image.
[0077] As mentioned above, when the target event detection module detects a target event, it promptly sends the corresponding image to be analyzed to the control center and ends the task. The route obtained by the above method enables the target drone to quickly and accurately detect the specific location and event information of the event.
[0078] Furthermore, step S4 further includes the following steps: S41, when a target event is detected from the image to be analyzed, determining the event occurrence area corresponding to the target event in the image to be analyzed; it can be understood that: when detecting the target event, the event detection module can identify the event occurrence area.
[0079] In step S42, if the center point of the event area is within the preset center range of the image to be analyzed, the image to be analyzed is sent to the background and the navigation is terminated; otherwise, the image to be analyzed is sent to the background and the target drone is controlled to translate toward the center point of the event area corresponding to the target shooting height h2 according to the preset translation step length, and a new image to be analyzed is captured at the end of the translation, and the process returns to step S41 until the navigation is terminated; those skilled in the art set the preset translation step length according to actual needs, for example, 5m.
[0080] As mentioned above, when capturing the target event, the position of the target event in the image to be analyzed is also taken into consideration. When the position offset of the target event is large, it is considered that only part or a small part of the target event occurrence area is captured. Therefore, the flight trajectory needs to be adjusted at this time, and the drone is translated along the direction of the center of the event occurrence area, while ensuring that the flight altitude remains unchanged, so that the image to be analyzed captured again can include more of the event occurrence area. The real-time dynamic adjustment of the route is conducive to the identification and overview analysis of the overall event.
[0081] An embodiment of the present invention also provides a non-transitory computer-readable storage medium, which can be set in an electronic device to store at least one instruction or at least one program related to implementing a method in a method embodiment. The at least one instruction or the at least one program is loaded and executed by the processor to implement the method provided in the above embodiment.
[0082] An embodiment of the present invention further provides an electronic device including a processor and the aforementioned non-transitory computer-readable storage medium.
[0083] Although some specific embodiments of the present invention have been described in detail by way of example, it should be understood by those skilled in the art that the above examples are for illustration only and are not intended to limit the scope of the present invention. It should also be understood by those skilled in the art that various modifications may be made to the embodiments without departing from the scope and spirit of the present invention. The scope of the present invention is defined by the appended claims.
Claims
1. A long-range path planning method for an unmanned aerial vehicle, characterized in that: The method comprises the following steps: S100, calculating an initial trajectory of the target UAV within a preset airspace based on obstacle information received before the start time of a preset trajectory planning period; the preset starting point of the preset airspace is a position point in the original trajectory of the target UAV that is T1 away from the current time; S200, if no new obstacle information is received when calculating the initial track, the initial track is used as the target planning path; Otherwise, determine whether the obtained initial track conflicts with the new obstacle. If there is a conflict, continue to execute the original track of the target UAV at the preset starting point. Otherwise, use the initial track as the track to be confirmed. S300, detecting whether new obstacle information is received within the judgment period corresponding to the trajectory conflict. If so, continuing the original trajectory of the target UAV at the preset starting point; otherwise, determining the unconfirmed trajectory as the target planned path; At step S400, if the target UAV receives new obstacle information while executing the target planned path and determines that the new obstacle conflicts with the target planned path, the preset trajectory planning period is restarted and the preset airspace range is updated, and the process returns to step S100 until the destination is reached; Otherwise, the preset target point of the preset airspace range is used as the new preset starting point and the preset airspace range is updated, the starting time of the preset track planning period is determined and the process returns to step S100 until the end point is reached.
2. The long-range path planning method for a UAV according to claim 1, characterized in that: Use the following steps to obtain the duration of the preset track planning period: S01, based on the amount of data corresponding to the received obstacle information, estimate the acquisition time corresponding to the target planned path; S02: Using the acquired duration corresponding to the target planned path as the duration corresponding to the preset track planning period.
3. The long-range path planning method for a UAV according to claim 1, characterized in that: The obstacle information includes dynamic obstacle information and static obstacle information; The dynamic obstacle information includes broadcast messages sent by a given drone and received by the target drone within a preset time window before the start time of the preset trajectory planning period, and dynamic flying objects detected by the target drone's onboard sensors.
4. The long-range path planning method for a UAV according to claim 1, characterized in that: T1 meets the following conditions: T1≥T2+T0, where T2 is the duration corresponding to the preset track planning period, and T0 is the preset fault tolerance time.
5. The long-range path planning method for a UAV according to claim 1, characterized in that: In step S200, the following steps are used to determine whether there is a trajectory conflict between the initial track and the new obstacle: S201, if the new obstacle is a static obstacle, determine whether the closest distance between the initial track and the static obstacle is less than a first preset distance threshold; S202: If the distance is less than a first preset distance threshold, it is determined that there is a trajectory conflict between the initial track and the new obstacle; otherwise, it is determined that there is no trajectory conflict between the initial track and the new obstacle; S203, if the new obstacle is a dynamic flying object, determining whether there is at least one time point when the distance between the initial track and the predicted track of the dynamic flying object is less than a second preset distance threshold; wherein the second preset distance threshold is greater than the first preset distance threshold; S204: If there is at least one time point, it is determined that there is a trajectory conflict between the initial track and the new obstacle; otherwise, it is determined that there is no trajectory conflict between the initial track and the new obstacle.
6. The long-range path planning method for a UAV according to claim 1, characterized in that: Get the preset target point within the preset airspace by following the steps below: S10, taking the preset starting point as the center of the sphere, setting the intersection of the line between the preset starting point and the end point and the sphere with a radius of R as the point to be confirmed; where R is the length of the preset track planning section; S20: If the point to be confirmed is located inside any obstacle, a point located outside the obstacle and closest to the point to be confirmed on the sphere is used as the target point; otherwise, the point to be confirmed is used as the target point.
7. The long-range path planning method for a UAV according to claim 6, characterized in that: To obtain the preset track planning segment length, follow the steps below: S11, taking the current position of the target UAV as a reference, obtaining the total number score of UAVs and the complexity score of static objects within the target airspace corresponding to the future original track of the target UAV; S12, calculate the airspace complexity score corresponding to the target airspace range based on the total number score of drones and the complexity score of static objects within the target airspace range; S13, according to the preset correspondence between the airspace complexity score and the track planning segment length, obtaining the preset track planning segment length; wherein the preset track planning segment length is inversely proportional to the airspace complexity score.
8. The long-range path planning method for a UAV according to claim 1, characterized in that: The method further comprises the steps of: S1: When the target UAV reaches the destination and the destination corresponds to a preset area type, obtain the target area image taken by the target UAV: S2, segmenting the target area image according to the shooting range corresponding to the preset target shooting height h2, and obtaining the target event occurrence label corresponding to each sub-area image; the target event occurrence label is either yes or no; wherein h2 < h1, h1 is the shooting height corresponding to the target area image; S3, traversing the track waypoints corresponding to each sub-region image in the order from target event occurrence label to target event occurrence label, and generating a second route corresponding to the target shooting height h2; S4, obtaining the image to be analyzed corresponding to each sub-area photographed sequentially by the target UAV along the second route and performing real-time detection of the target event, until the target event is detected from the image to be analyzed, and then sending the corresponding image to be analyzed to the background; wherein, the sub-area corresponds to the sub-area image one-to-one.
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 long-range path planning method for a drone as described in any one of claims 1-8.
10. An electronic device, characterized in that: The device comprises a processor and the non-transitory computer-readable storage medium as claimed in claim 9.
Citation Information
Patent Citations
Unmanned plane path planning method
CN108958293A
Test system and method for unmanned aerial vehicle detection device
CN113960644A
Low-altitude unmanned aerial vehicle three-dimensional grid flight path planning method
CN117806358A
Unmanned aerial vehicle route planning method for low-altitude airspace unmanned aerial vehicle operation
CN119845275A
Cooperative path planning method and device for automatic control aerocraft and aerocraft system
US20210294357A1