A method for anti-disturbance control of a rope-driven flying robot

The anti-disturbance control method for rope-towing flying robots addresses stability and precision issues by calculating disturbances and optimizing rotor speed, enhancing their performance on complex components.

CN118550313BActive Publication Date: 2024-12-06HUNAN UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411009923.3
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-07-26
Publication Date
2024-12-06
Estimated Expiration
2044-07-26

AI Technical Summary

Technical Problem

Rope-towing flying robots face challenges with stability, precision in rotor speed control, and poor anti-interference abilities due to multiple uncertainties and interferences in the flight environment, which affect their operation on large and complex components.

Method used

An anti-disturbance control method involving planning the scanning range, calculating disturbance forces and torques, establishing decoupled dynamic equations, and optimizing rotor speed distribution to enhance stability and accuracy.

Benefits of technology

The method improves the stability and accuracy of rope-towing flying robots, enabling them to perform tasks on complex components with enhanced precision and reliability.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118550313B_ABST
    Figure CN118550313B_ABST
Patent Text Reader

Abstract

A method for controlling the anti-disturbance of a rope-driven flying robot includes: 1. calculating the expected trajectory of a moving mechanism and the joint angle of a mechanical arm, the expected trajectory of the center of a UAV platform, and the initial position of the moving mechanism; 2. calculating the disturbance force and disturbance torque caused by the movement of the mechanical arm on the UAV platform, and calculating the disturbance force and disturbance torque caused by the rope, and obtaining the total disturbance equation; 3. establishing the dynamic equation of the flying robot system, performing decoupling design, obtaining the decoupled dynamic equation, and obtaining the calculation formulas of the rotor lift, rotor torque, pitch angle expected value, and roll angle expected value; 4. constructing the system state error dynamic equation, solving the rotor lift and rotor torque of the flying robot; 5. designing the rotor speed distribution matrix, calculating the rotor speed according to the rotor lift, rotor torque, and rotor speed distribution matrix, and realizing the anti-disturbance operation of the flying robot. The present invention solves the problems of stability and safety during the working process of the flying robot.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of flying robot control, and in particular to an anti-disturbance control method for a rope-driven flying robot. Background Art

[0002] Major equipment in the fields of aerospace, marine ships, rail transit, etc. is a strategic guarantee for national defense security and national economic development, and its manufacturing level represents the core competitiveness of the country's manufacturing industry. The efficient and high-quality manufacturing of large and complex components such as aircraft skins, ship cabins, and high-speed rail bodies is the foundation for the development of major equipment such as aerospace, marine ships, and rail transit. The above-mentioned large and complex components usually have the characteristics of oversized size, numerous processes, weak structural rigidity, and complex surfaces. Their manufacturing faces challenges such as large scale, multiple tasks, and high precision. These challenges put forward requirements such as large range, multi-scale, flexibility, and high precision for each process in the entire manufacturing process. There is a rope-towing flying robot system, which consists of a supporting steel frame, a guide rail, a rope drive mechanism, a travel mechanism, a drone platform, a robotic arm, and multiple ropes. Due to the multiple uncertainties and interferences of the flight environment, as well as technical limitations such as sensors, the flying robot system faces control problems during operation, such as stability, precise control of rotor speed, and anti-interference of the robotic arm. Therefore, it is necessary to design a robust anti-disturbance control method to improve its stability and accuracy during operation. Summary of the invention

[0003] The present invention provides an anti-disturbance control method for a rope-towing flying robot to solve the technical problems mentioned in the background technology.

[0004] To achieve the above object, the technical solution of the present invention is achieved as follows:

[0005] The present invention provides an anti-disturbance control method for a rope-towing flying robot, comprising:

[0006] S1. Plan the scanning range according to the environmental information, calculate the expected trajectory of the moving mechanism and the joint angle of the manipulator, the expected trajectory of the center of the UAV platform and the initial position of the moving mechanism;

[0007] S2, the moving mechanism gradually moves from the initial position to the desired trajectory of the moving mechanism. In this motion state, the disturbance force and disturbance torque caused by the movement of the manipulator on the UAV platform are calculated according to the joint angle of the manipulator, and the disturbance force and disturbance torque caused by the rope are calculated to obtain the total disturbance equation;

[0008] S3, establishing the dynamic equation of the flying robot system, and performing decoupling design considering the estimation error to obtain the decoupled dynamic equation;

[0009] S4. Construct the system state error dynamic equation according to the decoupled dynamic equation, the total disturbance equation and the expected trajectory of the center of the UAV platform, and solve the rotor lift and rotor torque of the flying robot;

[0010] S5. Design the rotor speed distribution matrix, calculate the rotor speed based on the rotor lift, rotor torque and rotor speed distribution matrix, and realize the anti-disturbance operation of the flying robot system when the manipulator arm and the travel mechanism move.

[0011] Beneficial effects of the present invention:

[0012] The patent application of this invention proposes a method for anti-disturbance control of a rope-towed flying robot in response to many challenges encountered by existing rope-towed flying robot systems in working with large and complex components, such as stability, insufficient precision in rotor speed control, and poor anti-interference ability. The invention can effectively cope with multiple uncertainties and external interferences in the flight environment, complete the workflow of the rope-towed flying robot, and thus significantly improve the stability of the work and the accuracy of the control system. By optimizing the collaborative operation of the drone platform and the robotic arm, the invention not only improves the accuracy and efficiency of the work, but also enhances the overall reliability of the system and the flexibility of operation. BRIEF DESCRIPTION OF THE DRAWINGS

[0013] Figure 1 is a flow chart of the control method of the present invention;

[0014] Figure 2 It is a schematic diagram of the structure of the entire flying robot system in the present invention;

[0015] Figure 3 It is a control principle diagram of the control method in the present invention. DETAILED DESCRIPTION

[0016] In order to facilitate the understanding of the present invention, the present invention will be described more fully below with reference to the relevant drawings. Preferred embodiments of the present invention are provided in the drawings. However, the present invention can be implemented in many other different forms and is not limited to the embodiments described herein. On the contrary, the purpose of providing these embodiments is to make the understanding of the disclosure of the present invention more thorough and comprehensive.

[0017] Reference Figure 1 and Figure 2 The embodiment of the present application provides an anti-disturbance control method for a rope-towing flying robot, comprising:

[0018] S1. Plan the scanning range according to the environmental information, calculate the expected trajectory of the moving mechanism and the joint angle of the manipulator, the expected trajectory of the center of the UAV platform and the initial position of the moving mechanism;

[0019] S2, the moving mechanism gradually moves from the initial position to the desired trajectory of the moving mechanism. In this motion state, the disturbance force and disturbance torque caused by the movement of the manipulator on the UAV platform are calculated according to the joint angle of the manipulator, and the disturbance force and disturbance torque caused by the rope are calculated to obtain the total disturbance equation;

[0020] S3. Establish the dynamic equation of the flying robot system, and perform decoupling design considering the estimation error, obtain the decoupled dynamic equation, and obtain the calculation formulas of the rotor lift, rotor moment, pitch angle expected value, and roll angle expected value;

[0021] S4. Construct the system state error dynamic equation according to the decoupled dynamic equation, the total disturbance equation and the expected trajectory of the center of the UAV platform, and solve the rotor lift and rotor torque of the flying robot;

[0022] S5. Design the rotor speed distribution matrix, calculate the rotor speed based on the rotor lift, rotor torque and rotor speed distribution matrix, and realize the anti-disturbance operation of the flying robot system when the manipulator arm and the travel mechanism move.

[0023] In some embodiments, the S1 specifically includes the following steps:

[0024] S11. First, define the north-east inertial coordinate system , UAV platform body coordinate system and the robot end coordinate system ;

[0025] S12. Plan the scanning range according to the environmental information and the scanning range of the tested object in the north-east inertial coordinate system Projection on the expected trajectory of the moving mechanism and the robot joint angle ;

[0026] S13, and according to the expected trajectory of the moving mechanism Extrapolate the desired trajectory of the center of the UAV platform and initial position of the travel mechanism ;

[0027] S14. Set the desired yaw angle of the center of the UAV platform .

[0028] In some embodiments, the S12 specifically includes the following steps:

[0029] S121. Use the camera to obtain the measured object and the environment information near the measured object, plan the required scanning range and the scanning range in the north-east inertial coordinate system projection on

[0030] S122, determining the height of the center of the UAV platform according to the scanning range and the projection of the scanning range, so that the scanning range of the scanner in the working space of the robotic arm can include the scanning range planned in S1;

[0031] S123, plan the scanning range according to the environmental information and the scanning range of the tested object in the north-east inertial coordinate system Projection on the expected trajectory of the moving mechanism P t,d , P t,d = [ x t,d , y t,d , z t,d ] T ;

[0032] in, Indicates the initial position of the moving mechanism The scanning range of the measured object is projected onto the northeast inertial coordinate system. A straight line from the end position in the X direction (the default slope is 0.1); Indicates the corresponding fixed value set according to the projection of the scanning range of the measured object; Represents a value that is always 0; T represents the transpose of the matrix;

[0033] S124, according to the desired trajectory of the moving mechanism Design the joint angle of the robot arm based on the height of the center of the UAV platform , q m,d = [ q 1,d , q 2,d , q 3,d , q 4,d , q 5,d , q 6,d ] T , so that the scanner at the end of the robot arm can cover the entire scanning range; among them, Represents the joint angles of the robot arm at different positions.

[0034] In some embodiments, the desired trajectory of the center of the drone platform is calculated in S13. The implementation is:

[0035] Design the center of the UAV platform on the coordinate axis according to the height of the center of the UAV platform Expected position on , and place the center of the UAV platform on the coordinate axis Desired position in direction And the center of the UAV platform is on the coordinate axis Desired position in direction Set to the desired trajectory of the moving mechanism In Same; get the desired trajectory of the center of the UAV platform p b,d , p b,d = [ x dr,d , y dr,d , z dr,d ] T ;

[0036] Among them, the coordinate axis and Represented by the coordinate origin The coordinate axes pointing to the nose and right side of the octorotor flying robot respectively; Represented by the coordinate origin The coordinate axis pointing in the direction of gravity of the drone platform.

[0037] In some embodiments, S2 specifically includes the following steps:

[0038] S21, the moving mechanism reaches the initial position of the moving mechanism After stabilization, the moving mechanism starts to move along the desired trajectory of the moving mechanism. Moving, while the robot arm follows the robot arm joint angle Start moving; at this time, the movement of the robotic arm and the movement of the moving mechanism will cause disturbances to the UAV platform, causing the center of the UAV to deviate from the desired position;

[0039] S22, according to the joint angle of the robot arm Calculate the disturbance force and disturbance torque caused by the movement of the robotic arm on the UAV platform, as shown in the following formula:

[0040] ;

[0041] ;

[0042] in, In the north-east inertial coordinate system The disturbance force of the mechanical arm on the UAV platform, Indicated in the UAV platform body coordinate system The disturbance torque of the middle manipulator on the UAV platform; is the total mass of the flying robot system, is the mass of the robot arm, Representation vector In the UAV platform body coordinate system Representation in; vector Indicates the coordinate system of the drone platform The origin of the coordinates The vector pointing to the center of mass of the entire flying robot system; and They are The first and second order derivatives of and For the UAV platform in the UAV platform body coordinate system The angular velocity and its derivative in is the derivative of the UAV platform velocity; is the gravitational acceleration constant, is a unit vector [0 0 1] T ;

[0043] Indicates the coordinate system of the drone platform To the North East Inertial Coordinate System The rotation matrix of is:

[0044] ;

[0045] Among them, c and s are the trigonometric functions cos and sin respectively; The pitch angle, roll angle and yaw angle of the UAV platform are represented by Euler angle representation, i.e. the attitude of the drone platform ;

[0046] and It represents the change in the moment of inertia and its derivative of the flying robot system composed of the UAV platform and the robotic arm system. The specific formula is as follows:

[0047] ;

[0048] ;

[0049] in, and Respectively represent the coordinate system of the UAV platform Middle The center of mass of each link is relative to the coordinate system of the UAV platform The origin of the coordinates position and velocity; For the coordinate system To the UAV platform body coordinate system The rotation matrix of Indicates that it is fixed to the robot arm. The coordinate system on the connecting rod; Represents the coordinate system of the UAV platform To coordinate system The rotation matrix of Indicates The moment of inertia of each connecting rod at its center of mass about the connecting rod coordinate axis; is the mapping function of the antisymmetric matrix of the vector; Indicates the robot arm The angular velocity of the connecting rod relative to the UAV platform; Indicates the robot arm The weight of the connecting rod; is the three-dimensional identity matrix;

[0050] In addition, according to the definition of the center of mass, the change in the center of mass of the flying robot system and its derivative can be obtained. The specific formula is as follows:

[0051] ;

[0052] ;

[0053] in, is the number of connecting rods of the robot arm;

[0054] S23. The disturbance caused by the movement of the travel mechanism to the UAV platform is mainly caused by the change of the rope angle. Considering that the UAV platform will follow the movement of the travel mechanism and the UAV platform has a large weight, the rope angle will not change too much. The rope tension can be set to 0.95 times the gravity in the opposite direction. In this way, the UAV platform can be regarded as a micro UAV, reducing the lift demand of the rotor. Calculate the disturbance force and disturbance torque caused by the rope. The specific formula is as follows:

[0055] ;

[0056] ;

[0057] in, is the inertial coordinate system in the north east The tension provided by the rope to the UAV platform, that is, the disturbance force caused by the rope, In the UAV platform body coordinate system The torque provided by the rope tension on the UAV platform;

[0058] The disturbance force and disturbance torque brought by the movement of the robotic arm on the UAV platform, as well as the disturbance force and disturbance torque caused by the rope, constitute the total disturbance equation.

[0059] In some embodiments, S3 specifically includes the following steps:

[0060] S31. Construct a flight robot control system. According to the momentum and angular momentum theorem of the particle system, establish the initial dynamic equation of the flight robot system. The initial dynamic equation is as follows:

[0061] ;

[0062] ;

[0063] ;

[0064] oh ̇ b B = I b −1 [t− oh b B ×( I b oh b B )+ t dis,m B + t dis,l B ] ;

[0065] in, for The first derivative of for The first derivative of and They are the UAV platform in the north and east inertial coordinate systems respectively. The absolute position and velocity in and are the rotor lift and rotor torque, Drone attitude The first derivative of , The UAV platform is at the coordinate origin The moment of inertia about the body coordinate axis in the UAV platform body coordinate system In the expression, The specific expression is as follows:

[0066] ;

[0067] Taking the estimation error into account, the updated dynamic equation can be obtained:

[0068] ;

[0069] ;

[0070] ;

[0071] ;

[0072] in, and are the estimated values ​​of the disturbance force and torque of the manipulator, and are the estimation errors of the disturbance force and torque of the manipulator, respectively; and Estimates of the tension and moment of tension provided by the rope, and are the disturbance errors of the tension and tension torque provided by the rope, respectively;

[0073] S32. According to the updated dynamic equation, the updated dynamic equation is composed of two subsystems, the position control subsystem and the attitude control subsystem, which are cascaded. The two subsystems are rotated by the matrix Coupling; through decoupling design, the dynamic equation of the system after decoupling can be obtained:

[0074] ;

[0075] ;

[0076] in, for The second-order derivative of for The second-order derivative of and For the defined position loop virtual input and attitude loop virtual input, is the posture tracking error, represents the desired attitude angle of the UAV platform, and They are the expected value of pitch angle, expected value of roll angle, and expected yaw angle respectively; is the nonlinear connection term between the inner and outer loops after decoupling through the virtual control input, is the desired rotation matrix determined by the desired attitude angle;

[0077] ;

[0078] And the calculation formulas for the expected values ​​of rotor lift, rotor torque, pitch angle and roll angle are constructed.

[0079] In some embodiments, the S32 specifically includes the following steps:

[0080] S321, define position loop virtual input ;

[0081] ;

[0082] in, Expressed as the desired attitude angle; represents the different dummy variables used for decoupling calculations;

[0083] Set the position loop virtual input Substituting the updated dynamic equation into the position control subsystem, we can obtain:

[0084] ;

[0085] ;

[0086] The rotor lift can be solved , expected value of pitch angle and the expected value of the roll angle for:

[0087] ;

[0088] ;

[0089] ;

[0090] S322, define the virtual input of the attitude ring :

[0091] ;

[0092] Without considering the disturbance term, the attitude control subsystem is and Feedback linearization can be achieved, and virtual input can be introduced into the attitude loop And the updated dynamic equation gives the rotor torque Expected input:

[0093] ;

[0094] S323, virtual input of position loop , attitude loop virtual input Substituting it into the updated dynamic equation, we can obtain the dynamic equation after the system is decoupled.

[0095] In some embodiments, the S4 specifically includes the following steps:

[0096] S41, the output of the flying robot system is the absolute position of the three axes and drone attitude ; From this, the state error of the system can be defined:

[0097] ;

[0098] ;

[0099] ;

[0100] ;

[0101] in, is the expected trajectory of the center of the UAV platform, is the expected velocity of the center of the UAV platform, is the expected attitude angle of the UAV platform, is the first-order derivative of the desired attitude angle of the UAV platform, that is, the attitude angular velocity; Represents the position error of the center of the UAV platform; Represents the velocity error of the center of the UAV platform; Represents the attitude error of the UAV platform; Indicates the attitude angular velocity error of the UAV platform; Represents the yaw angle error of the UAV platform;

[0102] S42. Considering the disturbance term, the system state error dynamic equation can be obtained:

[0103] ;

[0104] ;

[0105] Among them, A, B, C, D, and E represent the coefficients of the system state error dynamics equation;

[0106] ; ; ;

[0107] ;

[0108] in, represents the system state error, u represents The output of the controller, represents the disturbance term;

[0109] ;

[0110] ,

[0111] ;

[0112] ;

[0113] ;

[0114] in, Represents a three-dimensional identity matrix whose values ​​are all 0;

[0115] S43, according to the system state error dynamics equation, solve Controller output , output Specifically:

[0116] ;

[0117] in, represents the feedback gain matrix; represents a positive definite matrix; W represents the coefficient in the solution process;

[0118] S44. Solve the rotor lift according to the system state error dynamic equation and the calculation formulas of rotor lift and rotor torque, pitch angle expected value and roll angle expected value. and rotor torque .

[0119] In some embodiments, the S43 comprises the following steps:

[0120] S431, nonlinear connection term between inner and outer loops after decoupling through virtual control input , it can be proved that there is a constant , so that .

[0121] in, ,

[0122] S432, for linear controller , if there exists a positive definite symmetric matrix satisfy:

[0123] ;

[0124] in, is a positive constant, then for the system state error dynamics equation, from the disturbance To system output For limited Gain stable, and Gain less than or equal to , the proof process is as follows:

[0125] The closed-loop Lyapunov function of the system error dynamics equation is defined as:

[0126] ;

[0127] Then we have:

[0128]

[0129]

[0130]

[0131]

[0132] Since the positive definite symmetric matrix If the specific conditions are met, we can get

[0133]

[0134] Therefore, the system is disturbed by To system output For limited Gain stable, and Gain equal to or less than ;

[0135] S433, then the feedback gain matrix It can be obtained by solving the following linear matrix inequality:

[0136]

[0137] in, is a positive definite matrix. The solution is and back, Control rate of the controller for

[0138] .

[0139] In some embodiments, S5 specifically includes the following steps:

[0140] S51. Design a rotor speed distribution matrix according to the rotor installation method of the aircraft robot;

[0141] S52, according to the rotor lift , rotor torque And the rotor speed distribution matrix calculates the rotor speed to achieve anti-disturbance operation of the flying robot system when the manipulator and the travel mechanism move.

[0142] In some embodiments, the rotor on the UAV platform is a cross-shaped eight-rotor;

[0143] The rotor speed distribution matrix in S52 is specifically as follows:

[0144]

[0145] in, and are the thrust coefficient and torque coefficient of the propeller, is the distance between the center of the drone body and any rotor motor, It is the square of the rotation speed of each rotor in the cross-type eight-rotor.

[0146] The present invention proposes an anti-disturbance control method for a rope-towing flying robot system. The main advantages are:

[0147] 1: According to the workflow and environment of this type of flying robot when performing tasks, a rope-towing flying robot anti-disturbance control method is proposed. This method enables the flying robot to move along the desired trajectory from the parking position, ensures the smooth movement of the flying robot during the movement, reduces safety hazards, and effectively performs various tasks for a wide range of medium and large complex components.

[0148] 2: The present invention solves the problems of stability and safety during the operation of the flying robot.

[0149] The above is only a specific embodiment of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can easily think of changes or substitutions within the technical scope disclosed by the present invention, which should be covered within the protection scope of the present invention. In addition, the technical solutions between the various embodiments of the present invention can be combined with each other, but it must be based on the ability of ordinary technicians in the field to implement. When the combination of technical solutions is contradictory or cannot be implemented, it should be considered that such a combination of technical solutions does not exist and is not within the protection scope of the present invention. Therefore, the protection scope of the present invention shall be based on the protection scope of the claims.

Claims

1. A method for anti-disturbance control of a rope-driven flying robot, characterized in that: include: S1. Plan the scanning range according to the environmental information, calculate the expected trajectory of the moving mechanism and the joint angle of the manipulator, the expected trajectory of the center of the UAV platform and the initial position of the moving mechanism; S2, the moving mechanism moves from the initial position along the desired trajectory of the moving mechanism. In this motion state, the disturbance force and disturbance torque caused by the movement of the manipulator on the UAV platform are calculated according to the joint angle of the manipulator, and the disturbance force and disturbance torque caused by the rope are calculated to obtain the total disturbance equation; S3, establishing the dynamic equation of the flying robot system, and performing decoupling design considering the estimation error to obtain the decoupled dynamic equation; S4. Construct the system state error dynamic equation according to the decoupled dynamic equation, the total disturbance equation and the expected trajectory of the center of the UAV platform, and solve the rotor lift and rotor torque of the flying robot; S5. Design the rotor speed distribution matrix, calculate the rotor speed based on the rotor lift, rotor torque and rotor speed distribution matrix, and realize the anti-disturbance operation of the flying robot system when the manipulator arm and the travel mechanism move.

2. The anti-disturbance control method for a rope-driven flying robot according to claim 1, characterized in that: The S1 specifically includes the following steps: S11. First, define the north-east inertial coordinate system , UAV platform body coordinate system and the robot end coordinate system ; S12. Plan the scanning range according to the environmental information and the scanning range of the tested object in the north-east inertial coordinate system Projection on the expected trajectory of the moving mechanism and the robot joint angle ; S13, and according to the expected trajectory of the moving mechanism Extrapolate the desired trajectory of the center of the UAV platform and initial position of the travel mechanism ; S14. Set the desired yaw angle of the center of the UAV platform .

3. The anti-disturbance control method for a rope-driven flying robot according to claim 2, characterized in that: The S12 specifically includes the following steps: S121. Use the camera to obtain the measured object and the environment information near the measured object, plan the required scanning range and the scanning range in the north-east inertial coordinate system projection on; S122, determining the height of the center of the UAV platform according to the scanning range and the projection of the scanning range, so that the robotic arm can make the scanning range of the scanner include the scanning range planned in S1 in its working space; S123, plan the scanning range according to the environmental information and the scanning range of the tested object in the north-east inertial coordinate system Projection on the expected trajectory of the moving mechanism ; in, Indicates the initial position of the moving mechanism The scanning range of the measured object is projected onto the northeast inertial coordinate system. The straight line of the end position in the X direction; Indicates the corresponding fixed value set according to the projection of the scanning range of the measured object; Represents a value that is always 0; T represents the transpose of the matrix; S124, according to the desired trajectory of the moving mechanism Design the joint angle of the robot arm based on the height of the center of the UAV platform , , so that the scanner at the end of the robot arm can cover the entire scanning range; among them, Represents the joint angles of the robot arm at different positions.

4. The anti-disturbance control method for a rope-driven flying robot according to claim 3, characterized in that: The expected trajectory of the center of the UAV platform is calculated in S13 The implementation is: Design the center of the UAV platform on the coordinate axis according to the height of the center of the UAV platform Expected position on , and place the center of the UAV platform on the coordinate axis Desired position in direction And the center of the UAV platform is on the coordinate axis Desired position in direction Set to the desired trajectory of the moving mechanism In Same; get the desired trajectory of the center of the UAV platform ; Among them, the coordinate axis and Represented by the coordinate origin The coordinate axes pointing to the nose and right side of the octorotor flying robot respectively; Represented by the coordinate origin The coordinate axis pointing in the direction of gravity of the drone platform.

5. The anti-disturbance control method for a rope-driven flying robot according to claim 4, characterized in that: The S2 specifically includes the following steps: S21, the moving mechanism moves along the desired trajectory of the moving mechanism Moving, while the robot arm follows the robot arm joint angle Start moving; at this time, the movement of the robotic arm and the movement of the moving mechanism will cause disturbances to the UAV platform, causing the center of the UAV to deviate from the expected position; S22, according to the joint angle of the robot arm Calculate the disturbance force and disturbance torque caused by the movement of the robotic arm on the UAV platform, as shown in the following formula: ; ; in, In the north-east inertial coordinate system The disturbance force of the mechanical arm on the UAV platform, Indicated in the UAV platform body coordinate system The disturbance torque of the middle manipulator on the UAV platform; is the total mass of the flying robot system, is the mass of the robot arm, Representation vector In the UAV platform body coordinate system Representation in; vector Indicates the coordinate system of the drone platform The origin of the coordinates The vector pointing to the center of mass of the entire flying robot system; and They are The first and second order derivatives of and For the UAV platform in the UAV platform body coordinate system The angular velocity and its derivative in is the derivative of the UAV platform velocity; is the gravitational acceleration constant, is a unit vector ; Indicates the coordinate system of the drone platform To the North East Inertial Coordinate System The rotation matrix of is: ; Among them, c and s are the trigonometric functions cos and sin respectively; The pitch angle, roll angle and yaw angle of the UAV platform are represented by Euler angle representation, i.e. the attitude of the drone platform ; and It represents the change in the moment of inertia and its derivative of the flying robot system composed of the UAV platform and the robotic arm system. The specific formula is as follows: ; ; in, and Respectively represent the coordinate system of the UAV platform Middle The center of mass of each link is relative to the coordinate system of the UAV platform The origin of the coordinates position and velocity; For the coordinate system To the UAV platform body coordinate system The rotation matrix of Indicates that it is fixed to the robot arm. The coordinate system on the connecting rod; Represents the coordinate system of the UAV platform To coordinate system The rotation matrix of Indicates The moment of inertia of each connecting rod at its center of mass about the connecting rod coordinate axis; is the mapping function of the antisymmetric matrix of the vector; Indicates the robot arm The angular velocity of the connecting rod relative to the UAV platform; Indicates the robot arm The weight of the connecting rod; is the three-dimensional identity matrix; In addition, according to the definition of the center of mass, the change in the center of mass of the flying robot system and its derivative can be obtained. The specific formula is as follows: ; ; in, is the number of connecting rods of the robot arm; S23. Calculate the disturbance force and disturbance moment caused by the rope. The specific formula is as follows: ; ; in, is the inertial coordinate system in the north east The tension provided by the rope to the UAV platform, that is, the disturbance force caused by the rope, In the UAV platform body coordinate system The torque provided by the rope tension on the UAV platform; The disturbance force and disturbance torque brought by the movement of the robotic arm on the UAV platform, as well as the disturbance force and disturbance torque caused by the rope, constitute the total disturbance equation.

6. The anti-disturbance control method for a rope-driven flying robot according to claim 5, characterized in that: The S3 specifically includes the following steps: S31. Construct a flight robot control system. According to the momentum and angular momentum theorem of the particle system, establish the initial dynamic equation of the flight robot system. The initial dynamic equation is as follows: ; ; ; ; in, for The first derivative of for The first derivative of and They are the UAV platform in the north and east inertial coordinate systems respectively. The absolute position and velocity in and are the rotor lift and rotor torque, Drone attitude The first derivative of The UAV platform is at the coordinate origin The moment of inertia about the body coordinate axis in the UAV platform body coordinate system In the expression, The specific expression is as follows: ; Taking the estimation error into account, the updated dynamic equation can be obtained: ; ; ; ; in, and are the estimated values ​​of the disturbance force and torque of the manipulator, and are the estimation errors of the disturbance force and torque of the manipulator, respectively; and Estimates of the tension and moment of tension provided by the rope, and are the disturbance errors of the tension and tension torque provided by the rope, respectively; S32. According to the updated dynamic equation, the updated dynamic equation consists of two subsystems: the position control subsystem and the attitude control subsystem. The two subsystems are rotated by the matrix Coupling; through decoupling design, the dynamic equation of the system after decoupling can be obtained: ; ; in, for The second-order derivative of for The second-order derivative of and For the defined position loop virtual input and attitude loop virtual input, is the posture tracking error, represents the desired attitude angle of the UAV platform, and They are the expected value of pitch angle, expected value of roll angle, and expected yaw angle respectively; is the nonlinear connection term between the inner and outer loops after decoupling through the virtual control input, is the desired rotation matrix determined by the desired attitude angle; ; And the calculation formulas for the expected values ​​of rotor lift, rotor torque, pitch angle and roll angle are constructed.

7. The anti-disturbance control method for a rope-driven flying robot according to claim 6, characterized in that: The S32 specifically includes the following steps: S321, define position loop virtual input : ; in, Expressed as the desired attitude angle; represents the different dummy variables used for decoupling calculations; Set the position loop virtual input Substituting the updated dynamic equation into the position control subsystem, we can obtain: ; ; The rotor lift can be solved , expected value of pitch angle and the expected value of the roll angle for: ; ; ; S322, define the virtual input of the attitude ring : ; Without considering the disturbance term, the attitude control subsystem is and Feedback linearization can be achieved, bringing virtual input into the attitude loop And the updated dynamic equation gives the rotor torque Expected input: ; S323, virtual input of position loop , attitude loop virtual input Substituting it into the updated dynamic equation, we can obtain the dynamic equation after the system is decoupled.

8. The anti-disturbance control method for a rope-driven flying robot according to claim 7, characterized in that: The S4 specifically includes the following steps: S41, the output of the flying robot system is the absolute position of the three axes and drone attitude ; The state error of the system can be defined as: ; ; ; ; in, is the expected trajectory of the center of the UAV platform, is the expected velocity of the center of the UAV platform, is the expected attitude angle of the UAV platform, is the first-order derivative of the desired attitude angle of the UAV platform, that is, the attitude angular velocity; Represents the position error of the center of the UAV platform; Represents the velocity error of the center of the UAV platform; Represents the attitude error of the UAV platform; Indicates the attitude angular velocity error of the UAV platform; Represents the yaw angle error of the UAV platform; S42. Considering the disturbance term, the system state error dynamic equation can be obtained: ; ; Among them, A, B, C, D, and E represent the coefficients of the system state error dynamics equation; , , ; ; in, represents the system state error, u represents The output of the controller, represents the disturbance term; ; , ; ; ; ; in, Represents a three-dimensional identity matrix whose values ​​are all 0; S43, according to the system state error dynamics equation, solve Controller output , output Specifically: ; in, represents the feedback gain matrix; represents a positive definite matrix; W represents the coefficient in the solution process; S44. Solve the rotor lift according to the system state error dynamics equation and rotor torque .

9. The anti-disturbance control method for a rope-driven flying robot according to claim 8, characterized in that: The S5 specifically includes the following steps: S51. Design a rotor speed distribution matrix according to the rotor installation method of the aircraft robot; S52, according to the rotor lift , rotor torque And the rotor speed distribution matrix calculates the rotor speed to achieve anti-disturbance operation of the flying robot system when the manipulator and the travel mechanism move.

10. The anti-disturbance control method for a rope-driven flying robot according to claim 9, characterized in that: The rotor on the UAV platform is a cross-shaped eight-rotor; The rotor speed distribution matrix in S52 is specifically as follows: ; in, and are the thrust coefficient and torque coefficient of the propeller, is the distance between the center of the drone body and any rotor motor, , , , , , and It is the square of the rotation speed of each rotor in the cross-type eight-rotor.