Unmanned aerial vehicle path automatic planning method for power transmission line inspection

Through the automated planning method of drone paths based on PID algorithm, the problem of blurred picture shooting and precise hovering during power transmission line inspection is solved, and efficient and safe patrol path planning and execution is achieved.

CN119668294APending Publication Date: 2025-03-21QUANZHOU ELECTRIC POWER TECH INST OF FUJIAN ELECTRIC POWER +2
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202411533223.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-10-30
Publication Date
2025-03-21

AI Technical Summary

Technical Problem

Existing drones face the problems of blurred picture shooting and precise hovering during transmission line inspection, which leads to low patrol efficiency and safety threatened.

Method used

The automated planning method of drone paths based on PID algorithm is adopted. By obtaining the position information of patrol mark points, building a dynamic model of the drone's height and attitude, designing a path planning tracking controller, and completing path planning through a coordinate transformation matrix, ensuring that the drone can accurately hover within a safe distance and take clear images.

Benefits of technology

It has realized that the drone has shortened the total range and has excellent obstacle avoidance capabilities during the inspection of transmission lines, significantly improved the inspection efficiency, and ensured the stable flight and precise hover of the drone, meeting the efficient completion and safety requirements of the inspection tasks.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119668294A_ABST
    Figure CN119668294A_ABST
Patent Text Reader

Abstract

The invention relates to an unmanned aerial vehicle path automatic planning method for power transmission line inspection, and belongs to the technical field of unmanned aerial vehicle inspection. The method comprises the following steps: acquiring position information of a mark point required by unmanned aerial vehicle inspection of a power transmission line, and accurately calculating coordinates according to the position information; based on the PID parameters, dynamic models of the unmanned aerial vehicle in two aspects of height and attitude are constructed; designing a path planning tracking controller based on a PID algorithm; the safety distance of the unmanned aerial vehicle in any flight direction is determined by analyzing the center position of the unmanned aerial vehicle and the relative distance between the unmanned aerial vehicle and the obstacle, and therefore planning of the inspection path is completed; in the inspection process, the current height and posture of the unmanned aerial vehicle are solved in real time, and the position and angle deviation between the unmanned aerial vehicle and a preset task point are measured; setting a deviation threshold value, and timely adjusting the height and attitude of the unmanned aerial vehicle according to the deviation threshold value after the unmanned aerial vehicle arrives at the task point. The method is especially suitable for inspection work of the power transmission line.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the technical field of unmanned aerial vehicle inspection, and in particular relates to an automatic unmanned aerial vehicle path planning method for power transmission line inspection. Background Art

[0002] As drone technology becomes more and more sophisticated, drones have shown extensive application potential in the field of power inspection. At present, this process mainly relies on ground operators to analyze the image data and GPS information sent back by the visual camera on the drone to command the flight trajectory and shooting tasks of the drone during the inspection operation. However, this inspection mode is highly dependent on operators, and is accompanied by a high workload and low efficiency, which can no longer fully meet the actual needs of my country's power maintenance and supervision. Therefore, the development of drone inspection systems with autonomous flight capabilities has become a new development trend.

[0003] In the existing transmission line UAV automated inspection technology framework, the setting of waypoints in the route planning stage often relies on manual input, which is a complex and time-consuming process. In particular, the precise latitude and longitude coordinates and altitude information of each waypoint need to be collected one by one in advance, and any slight error may pose a serious threat to flight safety. At the same time, when fixed-wing UAVs perform transmission line inspection tasks, the planning of their working paths needs to comprehensively consider multiple limiting factors such as the inspection task requirements and the performance parameters of the UAV itself, which makes it extremely difficult to find a safe, suitable and efficient automatic inspection path.

[0004] In addition, when performing power line inspection tasks, drones must be able to accurately focus on the target to ensure that the operating status of each component of the power line can be accurately identified. This is a key prerequisite for achieving effective inspections and ensuring the accuracy and efficiency of inspection work. Therefore, in order to obtain clear and accurate transmission line image data, inspection drones are required to be able to accurately hover at preset positioning points and perform image capture operations. Summary of the invention

[0005] The purpose of the present invention is to solve the problems faced by current drones when performing power line inspection tasks, such as blurry images and difficulty in achieving precise hovering, and to provide an automated drone path planning method for power line inspection.

[0006] To achieve the above object, the technical solution of the present invention is: a method for automatic planning of drone paths for power transmission line inspection, comprising:

[0007] Step 1: Obtain the location information of each inspection mark point during the transmission line drone inspection process and transmit it to the receiver in the mobile receiving station deployed at the corresponding inspection mark point; the mobile receiving station uses differential positioning technology based on the received observation data to calculate the coordinate position of the corresponding inspection mark point relative to the reference station to deduce the precise coordinates of each inspection mark point;

[0008] Step 2: Construct the dynamic model of the altitude and attitude of the UAV according to the PID algorithm parameters;

[0009] Step 3: Design a path planning and tracking controller based on PID algorithm;

[0010] Step 4: The safe distance for the drone inspection flight in any direction is obtained by the center position of the drone and its distance from obstacles, and then the transmission line drone inspection path planning is completed using the coordinate transformation matrix;

[0011] Step 5: Calculate the current altitude and attitude of the drone, and measure the position and angle deviation between the current drone and the corresponding mission point;

[0012] Step 6: Set the deviation threshold. After the UAV reaches the mission point, it will measure the relative position deviation and angle deviation, and adjust the UAV height and posture according to the deviation threshold. If it is less than the deviation threshold, the UAV will hover to the mission point to perform the mission; otherwise, the UAV will continue to adjust the speed and change the posture until the relative deviation is less than the deviation threshold, and then hover accurately at a fixed position to perform the mission, and then iterate steps 5 and 6 to complete the automatic inspection task.

[0013] In one embodiment of the present invention, in step 1, the calculation process of the coordinates of the inspection mark points includes: using a linear combination model to resolve the carrier integer ambiguity of the drone inspection mark points; using the least squares adjustment method to solve the correlation coefficient to achieve accurate observation of the carrier side phase pseudorange; using the three-sided positioning method to complete the coordinate positioning of each inspection mark point; specifically as follows:

[0014] The linear combination model expressed by formula (1) is used to calculate the carrier integer ambiguity of all inspection mark points set on the transmission line:

[0015]

[0016] In the above formula: n represents the number of inspection points, N 1,n, N n-1,n is the carrier ambiguity after linear combination, ΔX 1,n ,ΔX n-1,n is the real-time position of the inspection mark point, ΔY 1,n ,ΔY n-1,nis the deviation between the inspection mark point and the reference station, and their coefficients are represented by a and b respectively. By calculating the two coefficients by the least squares adjustment method, the carrier integer ambiguity of the inspection mark point can be obtained, which is substituted into formula (2) to obtain the carrier side phase pseudorange:

[0017] λφ i (t) = ρ i (t)-I+e i (t)+T i (t)+C[dt i (t)-dt i-1 (t)]-λN i +M i (t)+ε i (t) (2);

[0018] In the above formula: λ represents the phase wavelength, φ i (t) represents the fuzzy position of the phase observation landmark, ρ i (t) represents the geometric distance between the marker points, I represents the ionospheric error, e i (t) represents the fuzzy error, T i (t) represents the tropospheric error, C represents the speed of light, dt i (t) represents the clock error of the mobile receiver, N i Indicates the integer ambiguity on the carrier side, M i (t) represents the multipath effect error, ε i (t) represents the noise of the mobile receiver, where the subscript i represents the i-th inspection mark point;

[0019] Formula (2) is used to obtain the fuzzy data of the positioning of the transmission line UAV inspection mark point, and the coordinate positioning of the mark point is completed by the three-side positioning method shown in formula (3):

[0020]

[0021] In the above formula: (x, y) represents the position of node A, node A is the unknown inspection mark point position coordinate of the drone, (x1, y1), (x2, y2) and (x3, y3) represent the position coordinates of nodes B, C and D respectively, the distances between node A and nodes B, C and D are λ1, λ2, λ3 respectively, where nodes B, C and D represent any three known inspection mark points around node A respectively;

[0022] Convert equation (3) into the linear matrix equation shown in equation (4) and solve it. The result is the location information of the transmission line UAV inspection mark point:

[0023]

[0024] In one embodiment of the present invention, the UAV altitude dynamics model constructed in step 2 is a UAV altitude control model, and its expression is as follows:

[0025]

[0026] In the above formula, s represents a complex variable in the complex frequency domain, Z(s) represents the actual hovering height of the drone after Laplace transform, K1 is a constant, K represents the gain, and T s represents the time constant;

[0027] The expression of the PID transfer function L(s) of the UAV altitude control model is as follows:

[0028] L(s)=ρ T γ(s);

[0029] In the above formula: T =[K p , K i , K d ], where K p , K i , K d These are PID algorithm parameters.

[0030] In one embodiment of the present invention, the UAV attitude dynamics model constructed in step 2 is a UAV attitude control model, including the transfer functions of the three attitude angles of the UAV yaw angle, pitch angle, and roll angle, and the expression thereof is:

[0031]

[0032] s represents a complex variable in the complex frequency domain, θ(s) is the pitch angle transfer function, φ(s) is the roll angle transfer function, is the yaw angle transfer function, U2(s) is the pitch torque transfer function of the UAV, U3(s) is the roll torque transfer function of the UAV, U4(s) is the yaw torque transfer function of the UAV, L is the distance between the center of mass of the UAV and the center of the rotor, I xx ,I yy , Izz represent the moment of inertia about the x, y, and z axes respectively;

[0033] The error calculation process of the PID algorithm to control each attitude angle is shown in the following formula:

[0034]

[0035] In the above formula: θ ref , Respectively represent the ideal value of each attitude angle control, θ, Represent the input value of each attitude angle respectively, then the expression of the closed-loop transfer function of each attitude angle is as follows:

[0036]

[0037] In the above formula: T s Represents the time constant.

[0038] In one embodiment of the present invention, the expression of the path planning tracking controller based on the PID algorithm in step 3 is as follows:

[0039]

[0040] In the above formula: the input and output of the PID tracking controller are represented by e and u respectively, and k P , k I , k D Respectively represent the proportional, integral and differential coefficients, T1, T D represent the integral and differential time constants respectively.

[0041] In one embodiment of the present invention, the specific implementation process of step 4 is as follows:

[0042] Step 4-1, divide the distance between the starting point and the target point of the drone into several segments, use the coordinate transformation matrix shown in the following formula, take the y-axis as the rotation center, rotate the coordinate system to the specified angle, and rotate the x-axis to the direction of the connection line to obtain the transformed coordinate system x'y'z', and calculate the step length of each segment according to the specified transmission line drone inspection path planning accuracy standard and drone performance constraints;

[0043]

[0044] In the above formula: α represents the X-axis and The angle between in Indicates the distance between the starting point and the target point of the drone, Z t ,Z s Represents the components of the starting point and target point of the drone on the Z axis. The initial coordinate system coordinates are represented by (x, y, z), and the transformed coordinate system coordinates are (x', y', z');

[0045] Step 4-2: The starting point and target point of the drone are respectively s , P t Said, yes Divide, the number of parts is represented by n, and each segment is The straight line perpendicular and parallel to the Z' axis is denoted by l k It means that through path smoothing and path pruning, l is obtained. k The best path point p onk (x k , z k ), connect the best path points of each section, that is, the expression of the planned transmission line UAV inspection path P is as follows:

[0046] P={P s ,p1(x1,z1),p2(x1,z1),...,p n-1 (x n-1 , z n-1 ), P t}.

[0047] In one embodiment of the present invention, the specific implementation process of step 6 is as follows:

[0048] (1) When the drone takes off, the image to be taken is uploaded to the drone's flight controller. The inspection drone is equipped with a camera to identify the towers, pole number plates, insulators and assembly hardware on the transmission line and obtain their relative position information, that is, to obtain the drone's relative position information to the shooting target;

[0049] (2) The acquired position information is compared with the image data uploaded to the flight controller. If the deviation is greater than the deviation threshold, the deviation is sent to the flight controller of the hovering UAV, and then the flight controller outputs it to the actuator. This inspection iterative process is repeated to ensure that the inspection UAV reaches the optimal hovering position for shooting;

[0050] (3) The variable parameter PID algorithm is used to control the UAV to hover precisely at the optimal shooting position.

[0051] In one embodiment of the present invention, the inspection iteration process refers to that after the drone completes the relevant operations of the current task point along the automatic inspection route, the task is updated to the current point of the drone, the next task point is obtained as the expected point, and compared with the set deviation threshold, the height and posture of the drone are adjusted, and steps 5 and 6 are iterated until all task points are inspected and tasks are completed, and the drone returns and the inspection task is successfully completed.

[0052] In one embodiment of the present invention, the precise hovering control of the inspection drone adopts a piecewise linear variable parameter PID algorithm. By fitting the platform response curve under different speeds / accelerations, a control parameter iteration model is established to achieve the adaptability of the algorithm.

[0053] In one embodiment of the present invention, the expression of the safe distance S of the drone inspection flight in any direction in step 4 is as follows:

[0054]

[0055] In the above formula: η, 2σ represent the freedom of the UAV, λ represents the maximum coefficient of the safe distance between the UAV and obstacles, lOA represents the center position of the drone, l OD Indicates the distance between the center position of the drone and the obstacle.

[0056] The present invention also provides a computer-readable storage medium, on which computer program instructions that can be executed by a processor are stored. When the processor executes the computer program instructions, the method steps described above can be implemented.

[0057] Compared with the prior art, the present invention has the following beneficial effects: Based on the PID algorithm, the present invention can generate an inspection path that shortens the total flight distance and has excellent obstacle avoidance capabilities, thereby significantly improving the efficiency of the drone in performing inspection tasks. In addition, by integrating the PID algorithm, the present invention not only ensures the stability of the drone's flight, but also ensures that the drone can accurately follow the predetermined path to fly, smoothly reach the target location, and successfully achieve all inspection goals. In this process, the present invention successfully broke through the constraints of multiple restrictive conditions such as inspection task characteristics and drone performance parameters, laying a solid foundation for the safe operation of drones and the smooth completion of predetermined tasks. BRIEF DESCRIPTION OF THE DRAWINGS

[0058] Figure 1 The present invention is a flow chart of a method for automated planning of UAV paths for power transmission line inspection.

[0059] Figure 2 This is the block diagram of the PID tracking controller.

[0060] Figure 3 Block diagram for precise hover control.

[0061] Figure 4 This is the block diagram of variable parameter PID control. DETAILED DESCRIPTION

[0062] The technical solution of the present invention is described in detail below in conjunction with the accompanying drawings.

[0063] It should be noted that the following detailed descriptions are exemplary and are intended to provide further explanation of the present application. Unless otherwise specified, all technical and scientific terms used herein have the same meanings as those commonly understood by those skilled in the art to which the present application belongs.

[0064] It should be noted that the terms used herein are only for describing specific embodiments and are not intended to limit the exemplary embodiments according to the present application. As used herein, unless the context clearly indicates otherwise, the singular form is also intended to include the plural form. In addition, it should be understood that when the terms "comprise" and / or "include" are used in this specification, it indicates the presence of features, steps, operations, devices, components and / or combinations thereof.

[0065] like Figures 1 to 4 As shown, the embodiment of the present invention provides a method for automatic planning of drone paths for power transmission line inspection. Based on the PID algorithm, a reasonable and short inspection path with excellent obstacle avoidance and precise hovering control is planned. The specific implementation steps are as follows: In the following steps of the method for intelligent automatic planning of transmission line drone inspection paths, step 1 is landmark point positioning, steps 2 to 4 are intelligent planning of inspection paths, and steps 5 and 6 are the inspection process.

[0066] Step 1: Set up drone inspection markers along the transmission line and deploy mobile receiving stations at each marker point. The function of these mobile receiving stations is to capture the location information of the marker points and work in conjunction with the base station. Next, the location information of the transmission line drone inspection marker points is transmitted to the receiver of the mobile receiving station through the data transmission link. The mobile receiving station uses differential positioning technology based on the received observation data to calculate the coordinates of each marker point relative to the base station, and then combines the known coordinates of the base station to further deduce the precise coordinates of the marker point.

[0067] The calculation process of the coordinates of the marker points includes: using the linear combination model to resolve the carrier integer ambiguity of the drone inspection marker points; using the least squares adjustment method to solve the correlation coefficient to achieve accurate observation of the carrier side phase pseudorange; and using the three-sided positioning method to complete the coordinate positioning of each inspection marker point.

[0068] Specifically, the linear combination model represented by formula (1) is used to calculate the carrier integer ambiguity of all inspection mark points set on the transmission line:

[0069]

[0070] In the above formula: n represents the number of inspection points, N 1,n , N n-1,n is the carrier ambiguity after linear combination, ΔX 1,n ,ΔX n-1,n is the real-time position of the inspection mark point, ΔY 1,n ,ΔY n-1,n is the deviation between the inspection mark point and the reference station, and their coefficients are represented by a and b respectively. By calculating the two coefficients by the least squares adjustment method, the carrier integer ambiguity of the inspection mark point can be obtained, which is substituted into formula (2) to obtain the carrier side phase pseudorange.

[0071] λφ i (t) = ρ i (t)-I+e i (t)+T i (t)+C[dt i (t)-dt i-1 (t)]-λNi +M i (t)+ε i (t) (2);

[0072] In the above formula: λ represents the phase wavelength, φ i (t) represents the fuzzy position of the phase observation landmark, ρ i (t) represents the geometric distance between the marker points, I represents the ionospheric error, e i (t) represents the fuzzy error, T i (t) represents the tropospheric error, C represents the speed of light, dt i (t) represents the clock error of the mobile receiver, N i Indicates the integer ambiguity on the carrier side, M i (t) represents the multipath effect error, ε i (t) represents the noise of the mobile receiver.

[0073] The above formula is used to obtain the fuzzy data of the positioning of the transmission line UAV inspection mark point. Based on the fuzzy data, the coordinate positioning of the mark point is completed by the three-side positioning method shown in formula (3):

[0074]

[0075] In the above formula: (x, y) represents the position of node A, node A is the unknown inspection mark point position coordinate of the drone, (x1, y1), (x2, y2) and (x3, y3) represent the position coordinates of nodes B, C and D respectively, the distances between node A and nodes B, C and D are λ1, λ2, λ3 respectively, where nodes B, C, D represent any three known inspection mark points around node A respectively.

[0076] Convert equation (3) into the linear matrix equation shown in equation (4), and solve it. The result is the location information of the transmission line UAV inspection mark point.

[0077]

[0078] Step 2: Based on the PID parameters, the dynamic models of the UAV height and attitude are constructed to clearly reflect the UAV motion state. The motion law of the UAV on the transmission line shown in formula (5) is obtained through the Newton-Euler theory.

[0079]

[0080] In the above formula: θ and φ represent the three attitude angles of the drone, namely the yaw angle, pitch angle and roll angle. Respectively represent the angular acceleration of the UAV in the yaw, pitch and roll directions, I xx ,Iyy , Izz represent the moment of inertia of x, y, and z axes respectively, Respectively represent the acceleration of the x, y, and z axes, b represents the lift coefficient, d represents the drag coefficient, U1 represents the upward pull, U2, U3, and U4 represent the moments of the pitch, roll, and yaw motions of the drone, g represents the acceleration of gravity, m represents the mass of the drone, ω1, ω2, ω3, and ω4 represent the angular velocities of the four rotors of the drone, and the rotor transfer function G(s) is shown in formula (6):

[0081] G(s)=K / (T s +1) (6);

[0082] In the above formula: K represents the gain, which is obtained by testing the propeller lift of the drone, T s Represents the time constant. When the speed step response reaches 0.63 times the steady-state value, the corresponding time is T s , then the transfer function of the UAV motor rotor is obtained by subtracting the obtained T s Substitute , K into formula (6) to obtain the result.

[0083] The dynamic model of the drone altitude is the drone altitude control model, and its construction steps are as follows:

[0084] Let the x and y axes remain unchanged and only consider the change of the z axis. According to formula (5), the z axis error value e can be obtained as shown in the following formula: Z Calculation process:

[0085] e Z =Z ref -Z>0(7);

[0086] In the above formula: Z ref - represents the ideal height of the drone, and Z represents the actual height of the drone. When the drone is hovering at a specified height, the constant K1 can be used to replace By Laplace transform processing formula (5) The expression of can obtain the result of formula (8):

[0087]

[0088] At the same time, the PID transfer function shown in formula (9) is obtained:

[0089] L(s)=ρ T γ(s) (9);

[0090] In the above formula: T =[K p , K i , K d ], where K p , Ki , K d These are PID algorithm parameters.

[0091] The dynamic model of the UAV attitude is the UAV attitude control model. The yaw angle, pitch angle and roll angle have a great influence on it. According to formula (5), the transfer function of each attitude angle described by the following formula can be obtained by using Laplace transform:

[0092]

[0093] In the above formula: L represents the distance between the center of mass of the drone and the center of the rotor.

[0094] The error calculation process of the PID algorithm to control each attitude angle is shown in formula (11):

[0095]

[0096] In the above formula: θ ref , Respectively represent the ideal value of each attitude angle control, θ, Respectively represent the input values ​​of each attitude angle, then the closed-loop transfer function of each attitude angle is shown in formula (12):

[0097]

[0098] Step 3: Design a path planning and tracking controller based on the PID algorithm, and use the inner and outer loop control method to obtain the PID tracking controller block diagram of the drone. The PID algorithm can effectively suppress the impact of external interference on the drone by adjusting the proportional, integral and differential coefficients, so that the transmission line drone inspection motion tracking control can achieve better stability. According to the transmission line drone dynamics model created in step 2, the inner and outer loop control scheme is adopted to obtain the following: Figure 2 The block diagram of the UAV PID tracking controller is shown.

[0099] Figure 2 In, Z ref represents the ideal height of the input drone, Ω c,i represents the desired propeller speed, σ c,i Indicates the throttle command, P, d v represents the three-dimensional coordinates and speed measured by the drone, Θ, b ω Represents the attitude angle and angular velocity measured by the drone, b T c represents the desired tension, τ c Indicates the desired three-axis torque. In the PID tracking controller, the inner loop is used to control the drone attitude, and the outer loop is used to control the drone position. The following formula is used to describe the PID tracking controller structure:

[0100]

[0101] In the above formula: the input and output of the PID tracking controller are represented by e and u respectively, and k P , k I , k D Represent the proportional, integral and differential coefficients respectively, T I , T D represent the integral and differential time constants respectively.

[0102] Step 4: Assume that the center position of the drone and its distance from the obstacle are l OA , l OD If , the following formula is used to describe the safe distance S of the drone inspection flight in any direction:

[0103]

[0104] In the above formula, η and 2σ represent the degrees of freedom of the drone, and λ represents the maximum coefficient of the safe distance between the drone and obstacles. OA , l OD Finally, the following process is used to complete the transmission line UAV inspection path planning.

[0105] Step 4-1: When planning the transmission line UAV inspection path, the acceleration and speed of the UAV cannot exceed the maximum capacity of the UAV. Divide the distance between the starting point and the target point of the UAV into several segments. Use the coordinate transformation matrix shown in formula (15) to rotate the coordinate system to the specified angle with the y-axis as the rotation center, and rotate the x-axis to the direction of the connection line to obtain the transformed coordinate system x'y'z'. Calculate the step length of each segment according to the specified transmission line UAV inspection path planning accuracy standard and UAV performance constraints.

[0106]

[0107] In the above formula: α represents the X-axis and The angle between in Indicates the distance between the starting point and the target point of the drone. The initial coordinate system coordinates are represented by (x, y, z), and the transformed coordinate system coordinates are (x', y', z').

[0108] Step 4-2: The starting point and target point of the drone are respectively s , P t Said, yes Divide, the number of parts is represented by n, and each segment is The straight line perpendicular and parallel to the Z' axis is denoted by l k Represents. Through path smoothing and path pruning, we can obtain lk The best path point p on k (x k , z k ), connecting the best path points of each section, that is, the planned transmission line UAV inspection path, which is specifically described by formula (16):

[0109] P={P s ,p1(x1,z1),p2(x1,z1),...,p n-1 (x n-1 , z n-1 ), P t} (16).

[0110] Step 5. Get the current altitude and posture information of the drone. Determine the current position and posture parameters of the drone through IMU, relative position, quaternion and other information. Upload the expected position of the first mission point of the drone, and calculate the position and angle deviation between the current drone and the first mission point.

[0111] Specifically, the current position and attitude parameters of the drone are determined by subscribing to GPS, IMU, relative position, quaternion, Euler angle and other information through the ROS node. Fly to the first mission point. Upload the expected height and attitude information of the first mission point, and calculate the position and angle deviation between the current drone and the first mission point. The drone sets the flight speed according to the measured relative position deviation and angle deviation, and flies to the first mission point.

[0112] Step 6: Set the deviation threshold. After the drone reaches the mission point, it will measure the relative position deviation and angle deviation, and adjust the drone's height and posture according to the deviation threshold. If it is less than the deviation threshold, the drone will hover at the mission point to perform tasks such as taking photos. Otherwise, the drone will continue to adjust its speed and change its posture until the relative deviation is less than the threshold, and then hover accurately at a fixed position to perform the task, and then iterate steps 5 and 6 to complete the automatic inspection task. The specific implementation steps are as follows:

[0113] Step 6-1: After the inspection route of the drone is automatically planned, the operation task is carried out and the precise hovering control of the drone is completed through visual servoing. Specifically, it includes:

[0114] (1) When the drone takes off, the image to be taken is uploaded to the controller. The inspection drone is equipped with a camera and uses machine vision technology to identify the towers, pole number plates, insulators and assembly hardware on the transmission line and obtain their relative position information of the drone, that is, the relative position information of the drone is obtained.

[0115] (2) The acquired position information is compared with the image data uploaded to the controller. If the deviation is large, the deviation is sent to the flight controller of the hovering drone, and then the controller outputs it to the actuator. This process is repeated to ensure that the inspection drone reaches the optimal hovering position for shooting.

[0116] (3) The variable parameter PID control algorithm is used to control the drone to hover precisely at the optimal shooting position. The implementation process is as follows: Figure 3 shown.

[0117] For the precise hovering control of the inspection drone, a piecewise linear variable parameter PID algorithm is used to solve the contradiction between global nonlinearity and local linearity. Figure 4 As shown in the figure. By fitting the platform response curves under different speeds / accelerations, the control parameter iteration model is established to achieve the adaptability of the algorithm. This fundamentally improves the dynamic characteristics of the control system, increases the system response frequency, and achieves precise hovering of the inspection drone.

[0118] Step 6-2, the inspection iteration process means that after the drone completes the relevant operations of the current task point along the automatic inspection route, it updates this task to the current point of the drone, obtains the next task point as the expected point, compares it with the set deviation threshold, adjusts the drone's height and posture, and iterates steps 5 and 6 until all task points are inspected and tasks are completed, the drone returns, and the inspection task is successfully completed.

[0119] Aiming at the refined inspection of transmission lines, the present invention mainly involves the sub-item shooting and inspection of key components such as the panoramic view of the line tower, the tower head, the pole number plate, the basic structure, the insulator and its assembly hardware, the ground wire, and the large and small side channels of the optical cable. During the shooting process, the camera parameters need to be properly configured to ensure accurate focus, appropriate exposure, and clear and unblurred images. At the same time, the photographed object should be located in the center of the picture. In addition, the present invention also proposes an accurate hovering control method, which can meet the high-precision and clarity requirements of transmission line image shooting, and achieve accurate hovering at a predetermined position, thereby ensuring that the inspection drone can efficiently and effectively inspect the transmission lines. This automatic path planning strategy and fixed-point precise hovering control technology are generally applicable to the path planning requirements of all transmission lines.

[0120] The present invention also provides a computer-readable storage medium, on which computer program instructions that can be executed by a processor are stored. When the processor executes the computer program instructions, the method steps described above can be implemented.

[0121] Those skilled in the art will appreciate that the embodiments of the present application may be provided as methods, systems, or computer program products. Therefore, the present application may adopt the form of a complete hardware embodiment, a complete software embodiment, or an embodiment in combination with software and hardware. Moreover, the present application may adopt the form of a computer program product implemented in one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) that include computer-usable program code.

[0122] The present application is described with reference to the flowcharts and / or block diagrams of the methods, devices (systems), and computer program products according to the embodiments of the present application. It should be understood that each process and / or box in the flowchart and / or block diagram, as well as the combination of the processes and / or boxes in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to generate a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.

[0123] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.

[0124] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.

[0125] The above is only a preferred embodiment of the present invention, and does not limit the present invention in other forms. Any technician familiar with the profession may use the above disclosed technical content to change or modify it into an equivalent embodiment with equivalent changes. However, any simple modification, equivalent change and modification made to the above embodiment according to the technical essence of the present invention without departing from the technical solution of the present invention still belongs to the protection scope of the technical solution of the present invention.

Claims

1. A method for automatic planning of drone paths for power transmission line inspection, characterized in that: include Step 1: Obtain the location information of each inspection mark point during the UAV inspection of the transmission line, and transmit it to the receiver in the mobile receiving station deployed at the corresponding inspection mark point; The mobile receiving station uses differential positioning technology based on the received observation data to calculate the coordinates of the corresponding inspection mark points relative to the reference station, so as to deduce the precise coordinates of each inspection mark point; Step 2: Construct the dynamic model of the altitude and attitude of the UAV according to the PID algorithm parameters; Step 3: Design a path planning and tracking controller based on PID algorithm; Step 4: The safe distance for the drone inspection flight in any direction is obtained by the center position of the drone and its distance from obstacles, and then the transmission line drone inspection path planning is completed using the coordinate transformation matrix; Step 5: Calculate the current altitude and attitude of the drone, and measure the position and angle deviation between the current drone and the corresponding mission point; Step 6: Set the deviation threshold. After the UAV reaches the mission point, it will measure the relative position deviation and angle deviation, and adjust the UAV height and posture according to the deviation threshold. If it is less than the deviation threshold, the UAV will hover to the mission point to perform the mission; otherwise, the UAV will continue to adjust the speed and change the posture until the relative deviation is less than the deviation threshold, and then hover accurately at a fixed position to perform the mission, and then iterate steps 5 and 6 to complete the automatic inspection task.

2. The method for automatic planning of drone paths for power transmission line inspection according to claim 1 is characterized in that: In step 1, the calculation process of the inspection mark point coordinates includes: using the linear combination model to resolve the carrier integer ambiguity of the drone inspection mark point; using the least squares adjustment method to solve the correlation coefficient to achieve accurate observation of the carrier side phase pseudorange; using the three-sided positioning method to complete the coordinate positioning of each inspection mark point; the details are as follows: The linear combination model expressed by formula (1) is used to calculate the carrier integer ambiguity of all inspection mark points set on the transmission line: In the above formula: n represents the number of inspection mark points, N 1,n , N n-1,n is the carrier ambiguity after linear combination, ΔX 1,n , ΔX n-1,n is the real-time position of the inspection mark point, ΔY 1,n , ΔY n-1,n is the deviation between the inspection mark point and the reference station, and their coefficients are represented by a and b respectively. By calculating the two coefficients by the least squares adjustment method, the carrier integer ambiguity of the inspection mark point can be obtained, which is substituted into formula (2) to obtain the carrier side phase pseudorange: λφ i (t)=ρ i (t)-I+e i (t)+T i (t)+C[dt i (t)-dt i-1 (t)]-λN i +M i (t)+ε i (t) (2); In the above formula: λ represents the phase wavelength, φ i (t) represents the fuzzy position of the phase observation landmark, ρ i (t) represents the geometric distance between the marker points, I represents the ionospheric error, e i (t) represents the fuzzy error, T i (t) represents the tropospheric error, C represents the speed of light, dt i (t) represents the clock error of the mobile receiver, N i Indicates the integer ambiguity on the carrier side, M i (t) represents the multipath effect error, ε i (t) represents the noise of the mobile receiver, where the subscript i represents the i-th inspection mark point; Formula (2) is used to obtain the fuzzy data of the positioning of the transmission line UAV inspection mark point, and the coordinate positioning of the mark point is completed by the three-side positioning method shown in formula (3): In the above formula: (x, y) represents the position of node A, node A is the unknown inspection mark point position coordinate of the drone, (x1, y1), (x2, y2) and (x3, y3) represent the position coordinates of nodes B, C and D respectively, the distances between node A and nodes B, C and D are λ1, λ2, λ3 respectively, where nodes B, C and D represent any three known inspection mark points around node A respectively; Convert equation (3) into the linear matrix equation shown in equation (4) and solve it. The result is the location information of the transmission line UAV inspection mark point:

3. The method for automatic planning of drone paths for power transmission line inspection according to claim 1 is characterized in that: The UAV altitude dynamics model constructed in step 2 is the UAV altitude control model, and its expression is as follows: In the above formula, s represents a complex variable in the complex frequency domain, Z(s) represents the actual hovering height of the drone after Laplace transform, K1 is a constant, K represents the gain, and T s represents the time constant; The expression of the PID transfer function L(s) of the UAV altitude control model is as follows: L(s)=ρ T c(s); In the above formula: T =[K p , K i , K d ], where K p , K i , Kd are PID algorithm parameters, 4. The method for automatic planning of drone paths for power transmission line inspection according to claim 1 is characterized in that: The UAV attitude dynamics model constructed in step 2 is the UAV attitude control model, which includes the transfer functions of the three attitude angles of the UAV yaw angle, pitch angle, and roll angle, and its expression is: In the above formula: s represents a complex variable in the complex frequency domain, θ(s) is the pitch angle transfer function, φ(s) is the roll angle transfer function, is the yaw angle transfer function, U2(s) is the pitch torque transfer function of the UAV, U3(s) is the roll torque transfer function of the UAV, U4(s) is the yaw torque transfer function of the UAV, L is the distance between the center of mass of the UAV and the center of the rotor, I xx ,I yy ,I zz Respectively represent the moment of inertia of the x, y, and z axes; The error calculation process of the PID algorithm to control each attitude angle is shown in the following formula: In the above formula: θ ref , Respectively represent the ideal value of each attitude angle control, θ, Represent the input value of each attitude angle respectively, then the expression of the closed-loop transfer function of each attitude angle is as follows: In the above formula: T s Represents the time constant.

5. The method for automatic planning of drone paths for power transmission line inspection according to claim 1 is characterized in that: The expression of the path planning tracking controller based on the PID algorithm in step 3 is as follows: In the above formula: the input and output of the PID tracking controller are represented by e and u respectively, and k P , k I , k D Respectively represent the proportional, integral and differential coefficients, T1, T D represent the integral and differential time constants respectively.

6. The method for automatic planning of drone paths for power transmission line inspection according to claim 1, characterized in that: The specific implementation process of step 4 is as follows: Step 4-1, divide the distance between the starting point and the target point of the drone into several segments, use the coordinate transformation matrix shown in the following formula, take the y-axis as the rotation center, rotate the coordinate system to the specified angle, and rotate the x-axis to the direction of the connection line to obtain the transformed coordinate system x'y'z', and calculate the step length of each segment according to the specified transmission line drone inspection path planning accuracy standard and drone performance constraints; In the above formula: α represents the X-axis and The angle between in Indicates the distance between the starting point and the target point of the drone, Z t ,Z s Represents the components of the starting point and target point of the drone on the Z axis. The initial coordinate system coordinates are represented by (x, y, z), and the transformed coordinate system coordinates are (x', y', z'); Step 4-2: The starting point and target point of the drone are respectively s , P t Said, yes Divide, the number of parts is represented by n, and each segment is The straight line perpendicular and parallel to the Z' axis is denoted by l k It means that through path smoothing and path pruning, l is obtained. k The best path point p on k (x k , z k ), connect the best path points of each section, that is, the expression of the planned transmission line UAV inspection path P is as follows: P={P s ,p1(x1,z1),p2(x1,z1),...,p n-1 (x n-1 ,z n-1 ),P t }。 7. The method for automatic planning of drone paths for power transmission line inspection according to claim 1, characterized in that: The specific implementation process of step 6 is as follows: (1) When the drone takes off, the image to be taken is uploaded to the drone's flight controller. The inspection drone is equipped with a camera to identify the towers, pole number plates, insulators and assembly hardware on the transmission line and obtain their relative position information, that is, to obtain the drone's relative position information to the shooting target; (2) The acquired position information is compared with the image data uploaded to the flight controller. If the deviation is greater than the deviation threshold, the deviation is sent to the flight controller of the hovering UAV, and then the flight controller outputs it to the actuator. This inspection iterative process is repeated to ensure that the inspection UAV reaches the optimal hovering position for shooting; (3) The variable parameter PID algorithm is used to control the UAV to hover precisely at the optimal shooting position.

8. The method for automatic planning of drone paths for power transmission line inspection according to claim 7, characterized in that: The inspection iteration process means that after the UAV completes the relevant operations of the current task point along the automatic inspection route, it updates this task to the current point of the UAV, obtains the next task point as the expected point, compares it with the set deviation threshold, adjusts the height and posture of the UAV, and iterates steps 5 and 6 until all task points are inspected and tasks are completed. The UAV returns and the inspection task is successfully completed.

9. The method for automatic planning of drone paths for power transmission line inspection according to claim 7, characterized in that: The precise hovering control of the inspection UAV adopts a piecewise linear variable parameter PID algorithm. By fitting the platform response curve under different speeds / accelerations, a control parameter iteration model is established to achieve the adaptability of the algorithm.

10. The method for automatic planning of drone paths for power transmission line inspection according to claim 1, characterized in that: The expression of the safe distance S of the drone inspection flight in any direction in step 4 is as follows: In the above formula: η, 2σ represent the freedom of the UAV, λ represents the maximum coefficient of the safe distance between the UAV and obstacles, l OA represents the center position of the drone, l OD Indicates the distance between the center position of the drone and the obstacle.

Citation Information

Cited By

  • Intelligent agricultural weeding track control system and method thereof

    CN119556700A

  • Control method and device of indoor inspection unmanned aerial vehicle, medium and equipment

    CN119960474A