Terrain surveying and mapping method and system based on mooring unmanned aerial vehicle

By detecting and adjusting the terrain surveying and mapping methods of tethered drones, avoiding obstacles, solving the problem of tethered cable winding, and improving the scope of the surveying and mapping area and working efficiency.

CN119022895APending Publication Date: 2024-11-26NINGXIA HUI AUTONOMOUS REGION LAND & RESOURCES SURVEY & MONITORING INST (NINGXIA HUI AUTONOMOUS REGION GEOLOGICAL DISASTER EMERGENCY CENT NINGXIA HUI AUTONOMOUS REGION MINERAL RESOURCES RESERVE REVIEW CENT) +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411027008.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-30
Publication Date
2024-11-26

AI Technical Summary

Technical Problem

When using tethered drones for terrain mapping, tethered cables may be entangled in obstacles, causing the drone to be unable to detect and reduce the scope of the surveying and mapping area, affecting the overall surveying and mapping work.

Method used

By obtaining the drone detection position and the cable output length of the cable tied, calculate the distance between the device and the cable difference length, determine whether it exceeds the permitted difference length, output the winding signal and adjust the drone path to avoid obstacles, ensure that The cable is not wound, achieving effective use of the cable.

Benefits of technology

Timely reminders and avoid obstacles have increased the actual available length of the tied cable, increased the scope of the surveying and mapping area, reduced interference to staff, and improved the operational effect of terrain surveying and mapping.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119022895A_ABST
    Figure CN119022895A_ABST
Patent Text Reader

Abstract

The invention relates to a topographic surveying and mapping method and system based on a mooring unmanned aerial vehicle, and relates to the technical field of topographic surveying and mapping, and the method comprises the steps: obtaining the detection position of the unmanned aerial vehicle and the cable outgoing length of a mooring cable; performing calculation according to a preset ground initial position and the unmanned aerial vehicle detection position to determine an equipment distance; performing difference calculation according to the cable outgoing length and the equipment distance to determine the cable difference length; judging whether the cable phase difference length is greater than a preset allowable phase difference length or not; if the cable difference length is not greater than the allowable difference length, controlling the unmanned aerial vehicle to continuously move along a preset surveying and mapping path; and if the cable difference length is greater than the allowable difference length, outputting a winding signal and prompting. The method has the effect of reducing the situation that the whole surveying and mapping work is affected due to the fact that the mooring cable is wound around the obstacle.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of terrain surveying and mapping technology, and in particular to a terrain surveying and mapping method and system based on a tethered drone. Background Art

[0002] A tethered drone is a special form of multi-rotor drone. It is connected to a ground power source via a tethered cable, which serves as a power source instead of traditional lithium batteries, enabling it to hover in the air for a long time. It is suitable for scenarios that require long-term aerial operations, such as terrain mapping.

[0003] In the related art, when using tethered drones for terrain surveying, the staff plans the surveying route in advance, and then controls the tethered drone to move along the surveying route to obtain images of each location point on the route in real time, and then processes the images to obtain the terrain model.

[0004] In the above-mentioned related technologies, when using a tethered drone for terrain mapping, when the drone moves according to a predetermined flight path, the tethered cable may be entangled with obstacles in the mapping area. At this time, the staff cannot know this situation and will still control the drone to continue flying. At this time, the overall available length of the tethered cable is reduced, thereby reducing the area that the drone can map, affecting the overall mapping work, and there is still room for improvement. Summary of the invention

[0005] In order to reduce the occurrence of tethered cables getting entangled in obstacles and affecting the overall surveying and mapping work, the present application provides a terrain surveying and mapping method and system based on a tethered drone.

[0006] In a first aspect, the present application provides a terrain surveying and mapping method based on a tethered drone, which adopts the following technical solution:

[0007] A terrain surveying and mapping method based on a tethered drone, comprising:

[0008] Get the detection position of the drone and the cable outlet length of the tethered cable;

[0009] Calculate the distance between devices based on the preset initial ground position and the drone detection position;

[0010] Calculate the difference based on the cable outlet length and the distance between devices to determine the cable length difference;

[0011] Determine whether the cable phase difference length is greater than a preset allowable phase difference length;

[0012] If the cable phase difference length is not greater than the permitted phase difference length, the UAV is controlled to continue moving along the preset mapping path;

[0013] If the cable phase difference length is greater than the allowable phase difference length, a winding signal is output and a prompt is given.

[0014] Optionally, after the entanglement signal is output, the terrain mapping method based on the tethered drone also includes:

[0015] Define the current drone detection location as an outlier;

[0016] The paths that have been traveled on the surveying route are defined as past paths, and the positions where the cable phase difference length is less than the preset reference phase difference length in the past paths are defined as valid points;

[0017] Determine the distance between points on the past path based on abnormal points and valid points;

[0018] According to the preset sorting rules, the distance between points with the smallest value is determined, and the valid point corresponding to the distance between points is defined as the critical point, and the past path before the critical point is defined as the valid path;

[0019] Determine each detection point in the effective path according to the critical point and the preset unit interval distance, and determine the point detection order according to each detection point;

[0020] According to the point detection sequence, the drone is controlled to move to the abnormal points one after another, and it is judged in real time whether the cable phase difference length is less than the reference phase difference length;

[0021] If the cable phase difference lengths are all less than the reference phase difference length, the drone is controlled to continue moving along the surveying path at the abnormal point;

[0022] If the cable phase difference lengths are not all less than the reference phase difference lengths, the drone is controlled to retreat to the current detection point, and the drone is controlled to move to the next detection point on the past path according to the point detection sequence and continue to move toward the abnormal point until the cable phase difference lengths are all less than the reference phase difference lengths.

[0023] Optionally, the step of determining the point detection order according to each detection point includes:

[0024] The flight direction of the UAV when the abnormal point exists is defined as the abnormal direction;

[0025] The detection direction is determined with the detection point as the starting point and the abnormal point as the penetration point, and the direction angle is determined according to the detection direction and the abnormal direction;

[0026] Determine the backoff distance on the surveying path based on the detection points and abnormal points, and calculate the point selection parameters based on the backoff distance and the direction angle;

[0027] According to the point selection parameters, the detection points are sorted from large to small to determine the point detection order.

[0028] Optionally, after the point selection parameters are determined, the terrain surveying method based on the tethered drone also includes:

[0029] Determine whether there are at least two detection points with the same point selection parameters;

[0030] If there are not at least two detection points with the same point selection parameters, the point detection order is determined according to the point selection parameters of each detection point;

[0031] If there are at least two detection points with the same point selection parameters, the detection points with the same point selection parameters are mutually defined as comparison points;

[0032] In the point detection sequence, the detection point that is before the comparison point and closest to each comparison point is defined as the standard point;

[0033] Determine the standard distance based on the comparison point and the standard point;

[0034] The comparison points are sorted from small to large according to the standard distance, and the point detection order is determined according to the sorting.

[0035] Optionally, also include:

[0036] Determine whether there is a standard point;

[0037] If there is a standard point, the comparison points are sorted according to the standard point;

[0038] If there is no standard point, the detection point after the comparison point and closest to each comparison point in the point detection sequence is defined as the end point;

[0039] Determine the distance between the ends based on the comparison point and the end point;

[0040] The comparison points are sorted from large to small according to the distance between the ends, and the point detection order is determined according to the sorting.

[0041] Optionally, when the UAV moves back to the abnormal point, the terrain mapping method based on the tethered UAV further includes:

[0042] The path of the UAV moving from the detection point to the outlier point is defined as the first boundary path, and the path from the detection point to the outlier point on the surveying path is defined as the second boundary path;

[0043] The area enclosed by the first boundary path and the second boundary path is defined as an obstacle area, and the overall area of ​​the area is obtained according to the obstacle area;

[0044] Determine whether the overall area of ​​the region is greater than a preset upper limit area;

[0045] If the overall area of ​​the region is not larger than the upper limit set area, an obstacle signal is output and the obstacle area is marked in the preset mapping area;

[0046] If the overall area of ​​the region is larger than the upper limit setting area, a detection abnormality signal is output.

[0047] Optionally, after the UAV has completely moved on the mapping path, the terrain mapping method based on the tethered UAV further includes:

[0048] Counting obstacle signals to determine the number of obstacles;

[0049] Calculate the unit obstacle value based on the number of obstacles and the preset survey area;

[0050] When the unit obstacle value is greater than the preset upper obstacle value, an obstacle excessive signal is output.

[0051] In the second aspect, the present application provides a terrain mapping system based on a tethered drone, which adopts the following technical solution:

[0052] A terrain mapping system based on a tethered drone, comprising:

[0053] An acquisition module is used to obtain the detection position of the drone and the cable outlet length of the tethered cable;

[0054] A processing module, connected to the acquisition module and the judgment module, for storing and processing information;

[0055] A judgment module, connected with the acquisition module and the processing module, for judging the information;

[0056] The processing module calculates the distance between the devices based on the preset ground initial position and the drone detection position;

[0057] The processing module performs difference calculation based on the cable outlet length and the distance between the devices to determine the cable length difference;

[0058] The judging module judges whether the phase difference length of the cable is greater than the preset permissible phase difference length;

[0059] If the judging module judges that the cable phase difference length is not greater than the permitted phase difference length, the processing module controls the UAV to continue moving along the preset surveying and mapping path;

[0060] If the judging module judges that the cable phase difference length is greater than the permitted phase difference length, the processing module outputs a winding signal and prompts.

[0061] In summary, the present application includes at least one of the following beneficial technical effects:

[0062] 1. When the drone is conducting terrain surveying and mapping, the elongation of the tethered cable and the position of the drone can be analyzed, so that when there is a situation where the cable is entangled with an obstacle, it can be promptly prompted, so as to facilitate timely handling of the situation and reduce the occurrence of the tethered cable being entangled with obstacles and affecting the overall surveying and mapping work;

[0063] 2. When the cable is entangled with an obstacle, the obstacle can be avoided by retreating, so that the drone can continue to perform terrain mapping work;

[0064] 3. When a large obstacle appears during the drone avoidance process, there may be equipment damage. At this time, mark it so that the staff can intervene in time. BRIEF DESCRIPTION OF THE DRAWINGS

[0065] Figure 1 It is a flow chart of the terrain mapping method based on tethered UAV.

[0066] Figure 2 It is a flow chart of the obstacle entanglement avoidance processing method.

[0067] Figure 3 It is a flow chart of the method for determining the point detection sequence.

[0068] Figure 4 It is a flow chart of the detection point sorting method.

[0069] Figure 5 is a flow chart of the terminal case sorting method.

[0070] Figure 6 It is a flow chart of the detection situation analysis method.

[0071] Figure 7 It is a flow chart of the method for marking excessive obstacles.

[0072] Figure 8 It is a module flow chart of the terrain mapping method based on tethered UAV. DETAILED DESCRIPTION

[0073] In order to make the purpose, technical solutions and advantages of this application more clear, the following Figure 1-Figure 8 It should be understood that the specific embodiments described herein are only used to explain the present application and are not used to limit the present application.

[0074] The embodiments of the present application are further described in detail below in conjunction with the drawings in the specification.

[0075] The embodiment of the present application discloses a terrain surveying and mapping method based on a tethered drone. When the drone performs terrain surveying and mapping operations, the length of the extended tethered cable and the position of the drone are analyzed to determine whether the tethered cable of the drone is entangled in an obstacle. When the cable is entangled in an obstacle, the obstacle can be bypassed by an avoidance method, thereby effectively increasing the actual available length of the cable, thereby improving the overall surveying and mapping operation effect.

[0076] Reference Figure 1 The method flow of the terrain mapping method based on the tethered UAV includes the following steps:

[0077] Step S100: Obtain the detection position of the drone and the cable outlet length of the tethered cable.

[0078] The drone detection position refers to the position of the drone when it is performing terrain surveying and mapping. This position is a spatial position point and can be obtained through the positioning equipment carried by the drone. The cable outlet length is the length of the tethered cable in use and can be obtained through the outlet of the tethered cable according to the meter. When the tethered cable is not in use, it is stored in a manner similar to a tape measure so that the cable can extend from the outlet as long as it needs to be used.

[0079] Step S101: Calculate based on the preset ground initial position and the drone detection position to determine the distance between the devices.

[0080] The ground initial position is the location point of the device for acquiring information at the outlet of the tethered cable on the ground, and the distance between the devices is the straight-line distance between the ground initial position and the drone detection position.

[0081] Step S102: performing a difference calculation based on the cable outlet length and the distance between the devices to determine the cable length difference.

[0082] The cable length difference is the value obtained by subtracting the distance between devices from the cable outlet length.

[0083] Step S103: Determine whether the cable phase difference length is greater than a preset allowable phase difference length.

[0084] The permissible phase difference length is the maximum cable phase difference length allowed when it is determined by the staff that there is no cable entangled on an obstacle. The purpose of the judgment is to know whether the current mooring cable is entangled on an obstacle.

[0085] Step S1031: If the cable phase difference length is not greater than the permitted phase difference length, the UAV is controlled to continue moving along the preset surveying and mapping path.

[0086] When the cable difference length is not greater than the allowed difference length, it means that there is no cable entangled on an obstacle. At this time, you can continue to move according to the surveying path to carry out terrain surveying work. The surveying path is the path determined in advance by the staff for the drone to fly.

[0087] Step S1032: If the cable phase difference length is greater than the permitted phase difference length, a winding signal is output and a prompt is given.

[0088] When the cable phase difference length is greater than the allowed phase difference length, it means that the cable is entangled on an obstacle. At this time, a entanglement signal is output to prompt so that the staff can be informed of the situation in time. At this time, the staff can manually intervene in time to make the cable available for a longer time, increase the surveying and mapping range, and improve the overall surveying and mapping operation effect.

[0089] Reference Figure 2 After the entanglement signal is output, the terrain mapping method based on the tethered UAV also includes:

[0090] Step S200: define the current drone detection position as an abnormal point.

[0091] Anomaly points are defined to distinguish the drone detection locations when entanglement signals occur, which facilitates subsequent analysis.

[0092] Step S201: defining the path that has been traveled on the surveying path as a past path, and defining the position point where the cable phase difference length is less than a preset reference phase difference length in the past path as a valid point.

[0093] The past path is the path that the drone has traveled in the surveying path. The benchmark phase difference length is the maximum cable difference length allowed when the cable outlet length set by the staff is close to the distance between the equipment. Valid points are defined to distinguish different location points for subsequent analysis.

[0094] Step S202: determining the distance between points on the past path according to the abnormal points and the valid points.

[0095] The point spacing distance is the distance between the abnormal point and the valid point on the past path.

[0096] Step S203: determining the point distance with the smallest value according to a preset sorting rule, defining the valid point corresponding to the point distance as a critical point, and defining the past path before the critical point as a valid path.

[0097] The sorting rule is a method set by the staff to sort the size of values, such as the bubble method. The sorting rule can be used to determine the distance between points with smaller values, that is, the valid point is the last valid point that is not affected by obstacles. That is, starting from this valid point, the tethered cable will be affected by obstacles one after another. At this time, the critical point and the valid path are defined to distinguish different data, which is convenient for subsequent analysis.

[0098] Step S204: determining each detection point in the effective path according to the critical point and the preset unit interval distance, and determining the point detection order according to each detection point.

[0099] The unit interval distance is a fixed distance set by the staff, the detection point is a point determined by the unit interval distance in the effective path with the critical point as the starting point, and the point detection order is the order of detection and analysis of each detection point, wherein the point detection order can be determined by the distance from the critical point, and can also be determined by the method of steps S300-S303, which will not be described here.

[0100] Step S205: Control the drone to move to the abnormal points in sequence according to the point detection sequence, and determine in real time whether the cable phase difference lengths are all less than the reference phase difference lengths.

[0101] For example, if there are three detection points ABC, and the corresponding point detection order is CBA, the movement of the drone is first from C to the abnormal point, then from B to the abnormal point, and finally from A to the abnormal point; the purpose of the judgment is to know whether the drone is still affected by obstacles during the movement.

[0102] Step S2051: If the cable phase difference lengths are all less than the reference phase difference length, the UAV is controlled to continue moving along the surveying path at the abnormal point.

[0103] When the cable phase difference lengths are all less than the reference phase difference lengths, it means that the current movement will not be affected by obstacles. At this time, there is no need for the drone to continue to try to move to the abnormal point according to the point detection sequence. At this time, the drone can be controlled to continue to move according to the surveying and mapping path at the abnormal point to complete the remaining surveying and mapping work.

[0104] Step S2052: If the cable phase difference lengths are not all less than the reference phase difference lengths, the drone is controlled to return to the current detection point, and the drone is controlled to move to the next detection point on the past path according to the point detection sequence and continue to move toward the abnormal point until the cable phase difference lengths are all less than the reference phase difference lengths.

[0105] When the cable phase difference length is not less than the reference phase difference length, it means that there are points that will be affected by obstacles, that is, the current drone can no longer move to the abnormal point without being affected by obstacles. At this time, the drone is controlled to return to the current detection point to eliminate the impact of this movement, and then the drone is controlled to move to the next detection point to continue moving towards the abnormal point until the drone can move to the abnormal point without being affected by obstacles, thereby ensuring that the cable will not be entangled on obstacles during operation.

[0106] Reference Figure 3 , the steps of determining the point detection order according to each detection point include:

[0107] Step S300: The flight direction of the UAV when the abnormal point exists is defined as the abnormal direction.

[0108] Define abnormal directions to distinguish different directions for subsequent analysis.

[0109] Step S301: determine the detection direction with the detection point as the starting point and the abnormal point as the penetration point, and determine the direction angle according to the detection direction and the abnormal direction.

[0110] The detection direction is the direction from the detection point to the abnormal point, and the direction angle is the angle between the detection direction and the abnormal direction.

[0111] Step S302: Determine the backoff distance on the surveying path according to the detection points and the abnormal points, and calculate according to the backoff distance and the direction angle to determine the point selection parameters.

[0112] The fallback distance is the distance between the detection point and the abnormal point on the surveying path. The point selection parameter is a parameter that reflects the order of the detection point in the point detection sequence. The larger the parameter, the earlier the detection point is in the point detection sequence, that is, the detection point is detected and used first. The calculation formula of the point selection parameter is: Among them, ρ is the point selection parameter, A is the fixed parameter used for calculation, α is the direction angle, and L is the back-off distance. The larger α is, the greater the deviation between the current moving path and the previous moving path is, that is, the smaller the possibility of being affected by the same obstacle is, and the higher the possibility of being able to move from the detection point to the abnormal point without being affected by the obstacle.

[0113] Step S303: Sort the detection points in descending order according to the point selection parameters to determine the point detection order.

[0114] The point selection parameters are sorted from large to small to determine the point detection order, so that the drone can operate first at the detection points that are closer and have a higher probability of passing, thereby improving the overall efficiency.

[0115] Reference Figure 4After the point selection parameters are determined, the terrain mapping method based on the tethered drone also includes:

[0116] Step S400: Determine whether there are at least two detection points with the same point selection parameters.

[0117] The purpose of the judgment is to find out whether the detection points can be sorted in order.

[0118] Step S4001: If there are not at least two detection points with the same point selection parameters, the point detection order is determined according to the point selection parameters of each detection point.

[0119] When there are not at least two detection points with the same point selection parameters, it means that the detection points can be sorted in sequence. At this time, the point detection order can be determined normally according to the point selection parameters.

[0120] Step S4002: If there are at least two detection points with the same point selection parameters, the detection points with the same point selection parameters are defined as comparison points.

[0121] When there are at least two detection points with the same point selection parameters, it means that the detection points with the same point selection parameters cannot be sorted in order and need further analysis; comparison points are defined to distinguish different detection points for subsequent analysis.

[0122] Step S401: In the point detection sequence, a detection point that is before the comparison point and closest to each comparison point is defined as a standard point.

[0123] Define standard points to determine the detection points to be used by the drone before each comparison point to facilitate subsequent analysis.

[0124] Step S402: determining a standard spacing distance according to the comparison point and the standard point.

[0125] The standard separation distance is the distance between the comparison point and the standard point on the surveying path.

[0126] Step S403: Sort the comparison points in ascending order according to the standard interval distance, and determine the point detection order according to the sorting.

[0127] The order of each inspection point is determined by sorting them from small to large by standard distance, so that the drone can move to the closer inspection point first to perform operations, reducing the overall flight distance required.

[0128] Reference Figure 5 , the terrain mapping method based on tethered drone also includes:

[0129] Step S500: Determine whether there is a standard point.

[0130] The purpose of the judgment is to find out whether the comparison points can be sorted in order by the standard point.

[0131] Step S5001: If there is a standard point, sort the comparison points according to the standard point.

[0132] When a standard point exists, it means that the comparison points can be sorted in order according to the standard point, and the sorting process can be performed normally.

[0133] Step S5002: If there is no standard point, then in the point detection sequence, the detection point that is after the comparison point and closest to each comparison point is defined as the end point.

[0134] When there is no standard point, it means that the comparison points cannot be sorted by the standard point and further analysis is needed; define the end point to distinguish different detection points for subsequent analysis.

[0135] Step S501: Determine the distance between the ends according to the comparison point and the end point.

[0136] The end-to-end distance is the distance between the comparison point and the end point on the survey path.

[0137] Step S502: Sort the comparison points in descending order according to the distance between the ends, and determine the point detection order according to the sorting.

[0138] The order of each detection point is determined by sorting the distance between the ends from large to small so that the drone can move to the end point more conveniently after the comparison point is completely moved, which is convenient for the drone flight operation.

[0139] Reference Figure 6 When the UAV moves back to the abnormal point, the terrain mapping method based on the tethered UAV also includes:

[0140] Step S600: The path of the drone moving from the detection point to the outlier point is defined as a first boundary path, and the path from the detection point to the outlier point on the surveying path is defined as a second boundary path.

[0141] Define the first boundary path and the second boundary path to determine the location of the obstacle for subsequent analysis.

[0142] Step S601: define the area enclosed by the first boundary path and the second boundary path as an obstacle area, and obtain the overall area of ​​the area according to the obstacle area.

[0143] The obstacle area is the area where the obstacle is located, and the overall area of ​​the area is the area of ​​the obstacle area.

[0144] Step S602: Determine whether the overall area of ​​the region is greater than a preset upper limit area.

[0145] The upper limit setting area is the maximum overall area allowed when the staff determines that there is an obstacle that blocks the cable. The purpose of the judgment is to know whether the current determination of the obstacle is accurate.

[0146] Step S6021: If the overall area of ​​the region is not greater than the upper limit set area, an obstacle signal is output and the obstacle area is marked in the preset surveying area.

[0147] When the overall area of ​​the region is not greater than the upper limit set area, it means that the current determination of the obstacle is relatively accurate. At this time, an obstacle signal can be output to identify the situation; at the same time, the obstacle area is marked in the surveying area to assist in subsequent terrain surveying, where the surveying area is the area that requires terrain surveying.

[0148] Step S6022: If the overall area of ​​the region is larger than the upper limit set area, a detection abnormality signal is output.

[0149] When the overall area of ​​the region is larger than the upper limit set area, it means that there is an abnormality in the currently determined obstacle, that is, the drone equipment may be damaged or the meter may be damaged, resulting in abnormal detection. At this time, a detection abnormality signal is output to identify the situation, so that the staff can intervene in time to deal with it.

[0150] Reference Figure 7 After the UAV has completely moved on the mapping path, the terrain mapping method based on the tethered UAV also includes:

[0151] Step S700: Counting according to the obstacle signal to determine the number of obstacles.

[0152] The number of obstacles is the total number of obstacle signals output by the UAV after it has completely moved on the surveying path, that is, the total number of obstacle areas identified in the surveying area.

[0153] Step S701: Calculate the unit obstacle value based on the number of obstacles and the preset surveying area.

[0154] The survey area is the total area of ​​the survey region, and the unit obstacle value is determined by dividing the number of obstacles by the survey area.

[0155] Step S702: Outputting an obstacle-too-many signal when the unit obstacle value is greater than a preset upper obstacle value.

[0156] The upper obstacle value is the minimum unit obstacle value set by the staff to determine that the obstacles in the surveying and mapping area are too dense. When the unit obstacle value is greater than the upper obstacle value, it means that the obstacles in the current surveying and mapping area are too dense. At this time, an excessive obstacle signal is output to identify the situation, so as to assist the terrain surveying and mapping operation.

[0157] Reference Figure 8 Based on the same inventive concept, an embodiment of the present invention provides a terrain surveying and mapping system based on a tethered drone, comprising:

[0158] An acquisition module is used to obtain the detection position of the drone and the cable outlet length of the tethered cable;

[0159] A processing module, connected to the acquisition module and the judgment module, for storing and processing information;

[0160] A judgment module, connected with the acquisition module and the processing module, for judging the information;

[0161] The processing module calculates the distance between the devices based on the preset ground initial position and the drone detection position;

[0162] The processing module performs difference calculation based on the cable outlet length and the distance between the devices to determine the cable length difference;

[0163] The judging module judges whether the phase difference length of the cable is greater than the preset permissible phase difference length;

[0164] If the judging module judges that the cable phase difference length is not greater than the permitted phase difference length, the processing module controls the UAV to continue moving along the preset surveying and mapping path;

[0165] If the judging module judges that the cable phase difference length is greater than the permitted phase difference length, the processing module outputs a winding signal and prompts;

[0166] The entanglement avoidance control method performs back-off avoidance processing when there is a cable entangled in an obstacle, so that the UAV can effectively perform terrain mapping operations;

[0167] A point detection sequence determination module is used to determine a more appropriate point detection sequence;

[0168] The detection point sorting module sorts the detection points with the same point selection parameters in order;

[0169] The terminal situation sorting module sorts the test points with the same point selection parameters in order when there are only terminal points but no standard points;

[0170] The detection situation analysis module is used to analyze the obstacle area to determine whether there is any abnormality in the current detection situation;

[0171] The excessive obstacle marking module is used to mark the situation where there are too many obstacles.

[0172] Those skilled in the art can clearly understand that for the convenience and simplicity of description, only the division of the above-mentioned functional modules is used as an example. In actual applications, the above-mentioned functions can be assigned to different functional modules as needed, that is, the internal structure of the device is divided into different functional modules to complete all or part of the functions described above. The specific working process of the system, device and unit described above can refer to the corresponding process in the aforementioned method embodiment, and will not be repeated here.

Claims

1. A terrain surveying and mapping method based on a tethered drone, characterized in that: include: Get the detection position of the drone and the cable outlet length of the tethered cable; Calculate the distance between devices based on the preset initial ground position and the drone detection position; Calculate the difference based on the cable outlet length and the distance between devices to determine the cable length difference; Determine whether the cable phase difference length is greater than a preset allowable phase difference length; If the cable phase difference length is not greater than the permitted phase difference length, the UAV is controlled to continue moving along the preset mapping path; If the cable phase difference length is greater than the allowable phase difference length, a winding signal is output and a prompt is given.

2. The terrain surveying and mapping method based on a tethered drone according to claim 1, characterized in that: After the entanglement signal is output, the terrain mapping method based on the tethered drone also includes: Define the current drone detection location as an outlier; The paths that have been traveled on the surveying route are defined as past paths, and the positions where the cable phase difference length is less than the preset reference phase difference length in the past paths are defined as valid points; Determine the distance between points on the past path based on abnormal points and valid points; According to the preset sorting rules, the distance between points with the smallest value is determined, and the valid point corresponding to the distance between points is defined as the critical point, and the past path before the critical point is defined as the valid path; Determine each detection point in the effective path according to the critical point and the preset unit interval distance, and determine the point detection order according to each detection point; According to the point detection sequence, the drone is controlled to move to the abnormal points one after another, and it is judged in real time whether the cable phase difference length is less than the reference phase difference length; If the cable phase difference lengths are all less than the reference phase difference length, the drone is controlled to continue moving along the surveying path at the abnormal point; If the cable phase difference lengths are not all less than the reference phase difference lengths, the drone is controlled to retreat to the current detection point, and the drone is controlled to move to the next detection point on the past path according to the point detection sequence and continue to move toward the abnormal point until the cable phase difference lengths are all less than the reference phase difference lengths.

3. The terrain surveying and mapping method based on a tethered drone according to claim 2 is characterized in that: The steps of determining the point detection order according to each detection point include: The flight direction of the UAV when the abnormal point exists is defined as the abnormal direction; The detection direction is determined with the detection point as the starting point and the abnormal point as the penetration point, and the direction angle is determined according to the detection direction and the abnormal direction; Determine the backoff distance on the surveying path based on the detection points and abnormal points, and calculate the point selection parameters based on the backoff distance and the direction angle; According to the point selection parameters, the detection points are sorted from large to small to determine the point detection order.

4. The terrain surveying and mapping method based on a tethered drone according to claim 3 is characterized in that: After the point selection parameters are determined, the terrain mapping method based on the tethered drone also includes: Determine whether there are at least two detection points with the same point selection parameters; If there are not at least two detection points with the same point selection parameters, the point detection order is determined according to the point selection parameters of each detection point; If there are at least two detection points with the same point selection parameters, the detection points with the same point selection parameters are mutually defined as comparison points; In the point detection sequence, the detection point that is before the comparison point and closest to each comparison point is defined as the standard point; Determine the standard distance based on the comparison point and the standard point; The comparison points are sorted from small to large according to the standard distance, and the point detection order is determined according to the sorting.

5. The terrain surveying and mapping method based on a tethered drone according to claim 4, characterized in that: Also includes: Determine whether there is a standard point; If there is a standard point, the comparison points are sorted according to the standard point; If there is no standard point, the detection point after the comparison point and closest to each comparison point in the point detection sequence is defined as the end point; Determine the distance between the ends based on the comparison point and the end point; The comparison points are sorted from large to small according to the distance between the ends, and the point detection order is determined according to the sorting.

6. The terrain surveying and mapping method based on a tethered drone according to claim 2, characterized in that: When the UAV moves back to the abnormal point, the terrain mapping method based on the tethered UAV also includes: The path of the UAV moving from the detection point to the outlier point is defined as the first boundary path, and the path from the detection point to the outlier point on the surveying path is defined as the second boundary path; The area enclosed by the first boundary path and the second boundary path is defined as an obstacle area, and the overall area of ​​the area is obtained according to the obstacle area; Determine whether the overall area of ​​the region is greater than a preset upper limit area; If the overall area of ​​the region is not larger than the upper limit set area, an obstacle signal is output and the obstacle area is marked in the preset mapping area; If the overall area of ​​the region is larger than the upper limit setting area, a detection abnormality signal is output.

7. The terrain surveying and mapping method based on a tethered drone according to claim 6, characterized in that: After the UAV has completely moved on the mapping path, the terrain mapping method based on the tethered UAV also includes: Counting obstacle signals to determine the number of obstacles; Calculate the unit obstacle value based on the number of obstacles and the preset survey area; When the unit obstacle value is greater than the preset upper obstacle value, an obstacle excessive signal is output.

8. A terrain mapping system based on a tethered drone, characterized in that: include: An acquisition module is used to obtain the detection position of the drone and the cable outlet length of the tethered cable; A processing module, connected to the acquisition module and the judgment module, for storing and processing information; A judgment module, connected with the acquisition module and the processing module, for judging the information; The processing module calculates the distance between the devices based on the preset ground initial position and the drone detection position; The processing module performs difference calculation based on the cable outlet length and the distance between the devices to determine the cable length difference; The judging module judges whether the phase difference length of the cable is greater than the preset permissible phase difference length; If the judging module judges that the cable phase difference length is not greater than the permitted phase difference length, the processing module controls the UAV to continue moving along the preset surveying and mapping path; If the judging module judges that the cable phase difference length is greater than the permitted phase difference length, the processing module outputs a winding signal and prompts.