A robot trajectory restoration control method based on online planning and adjustment

Through the hierarchical control framework of online planning and adjustment, the robot trajectory recovery control method solves the trajectory recovery problem of the robot under instantaneous violent disturbance, realizes fast trajectory recovery and low energy loss, and improves trajectory tracking performance and system stability.

CN117950317BActive Publication Date: 2024-11-26NANKAI UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410003294.7
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-01-02
Publication Date
2024-11-26
Estimated Expiration
2044-01-02

AI Technical Summary

Technical Problem

When robots face instantaneous violent disturbances, it is difficult to quickly restore the desired trajectory, resulting in increased motion tracking errors. Traditional controllers may lead to controller saturation and instability. The existing anti-saturation control algorithms ignore the optimization of drive constraints and trajectory recovery time. .

Method used

A robot trajectory recovery control method based on online planning adjustment is designed. Through a layered adjustment control framework, including the nonlinear adaptive robust motion controller of the inner ring and the shortest time trajectory recovery algorithm of the outer ring, it detects instantaneous violent perturbation in real time. , perform double-ring processing and state rematch, and generate reference trajectory to plan trajectory recovery online.

Benefits of technology

The robot is rapidly recovered from trajectory, reduces the energy loss of control torque, improves trajectory tracking performance and convergence efficiency, avoids controller saturation, and shortens trajectory recovery time.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN117950317B_ABST
    Figure CN117950317B_ABST
Patent Text Reader

Abstract

The present invention relates to the field of robot trajectory restoration control, and in particular to a robot trajectory restoration control method based on online planning and adjustment, comprising: detecting the instantaneous severe disturbance state of the robot; performing double-loop processing on the robot trajectory restoration according to the instantaneous severe disturbance state to obtain an initial processing result of the robot trajectory restoration; performing trajectory restoration based on the robot driving constraint according to the instantaneous severe disturbance state to obtain a robot state rematching outer loop reference trajectory; performing tracking control using the robot state rematching outer loop reference trajectory to obtain a robot state planning inner loop constraint trajectory; and obtaining a robot trajectory restoration control result using the robot trajectory restoration initial processing result. A hierarchical double-loop trajectory restoration control method is innovatively proposed, instantaneous severe disturbance signals are identified online and then state rematching is performed, the influence of system modeling uncertainty is weakened by feedforward, feedback and adaptive technologies, and trajectory tracking performance is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robot trajectory restoration control, and in particular to a robot trajectory restoration control method based on online planning and adjustment. Background Art

[0002] In industrial applications such as welding and assembly, high-performance motion control is a key technology to ensure that robots can perform complex operations. However, in these application scenarios, robots often face problems such as modeling uncertainty and external disturbances, which significantly affect the performance of motion control. In order to mitigate the above adverse effects, a common technique is to treat external disturbances and modeling uncertainties as lumped disturbances and weaken or compensate them through various control algorithms.

[0003] The methods for solving trajectory tracking problems under the influence of modeling uncertainty and external disturbances on robots can be roughly divided into two categories. The first one is disturbance estimation and suppression control. In this framework, there are two widely studied methods. One of them is the robust control strategy, which uses boundary information and feedback techniques to weaken the lumped disturbance. The other is the disturbance observer-based method, which estimates the lumped disturbance and performs feedforward compensation based on the estimated value. Some control algorithms, such as extended state observer, extended Kalman filter and active disturbance rejection control, also follow the idea of ​​disturbance estimation and compensation, and therefore belong to the category of disturbance observer-based methods.

[0004] Compared with robust control methods and disturbance observer-based methods, another strategy to deal with external disturbances and modeling uncertainties is to perform a more comprehensive analysis of the modeling information and classify these uncertainties into structural uncertainties and unstructured uncertainties. Structural uncertainty mainly refers to the fact that the parameters of the system parameters are uncertain or slowly varying, while unstructured uncertainty includes disturbances and unmodeled dynamic parts. Therefore, structural uncertainty can be handled by adaptive control, which estimates the unknown parameters in real time, while robust feedback techniques or disturbance observer-based methods are widely used to weaken the adverse effects of unstructured uncertainties. Based on this idea, various control algorithms have been designed, including adaptive robust control, adaptive sliding mode control, adaptive sliding mode disturbance observer, and adaptive control based on extended state observer. All of the above methods have demonstrated that high-precision steady-state tracking performance can be achieved in the presence of structural uncertainty and unstructured uncertainty.

[0005] Typically, the actual trajectory of a robot tends to deviate significantly from the desired trajectory when faced with instantaneous and violent disturbances, resulting in a sharp increase in motion tracking errors. Therefore, traditional motion controllers driven by tracking errors tend to calculate larger control inputs to reduce tracking errors, which may violate the robot drive constraints, leading to controller saturation or even instability. On the other hand, existing anti-saturation control algorithms mainly emphasize ensuring system stability under input or state constraints, while ignoring the problem of converging the deviated trajectory to the desired trajectory in the shortest time while considering drive constraints.

[0006] Therefore, in the presence of various system constraints and modeling uncertainties, when the robot is subjected to instantaneous violent disturbances and deviates from the desired trajectory, how to complete trajectory recovery in a shorter time remains a very challenging problem. In view of this, we propose a control framework based on constrained constraint trajectory planning. The framework consists of a nonlinear adaptive robust motion controller in the inner loop and a shortest time trajectory recovery algorithm in the outer loop. The adaptive robust motion controller effectively handles structural uncertainty and unstructured uncertainty under normal working conditions to ensure accurate motion tracking. In the outer loop, trajectory recovery is described as a trajectory planning problem that integrates constrained constraints, online identification of instantaneous violent disturbances, and state rematching, and is solved online. Summary of the invention

[0007] In view of the shortcomings of the prior art, the present invention provides a robot trajectory restoration control method based on online planning and adjustment, and designs a hierarchical adjustment control framework from the trajectory planning perspective. The robot trajectory restoration control method based on online planning and adjustment ensures that the robot can quickly complete trajectory restoration and reduce control torque energy loss.

[0008] To achieve the above object, the present invention provides a robot trajectory restoration control method based on online planning and adjustment, comprising:

[0009] S1, detect the instantaneous severe disturbance state of the robot;

[0010] S2, performing double-loop processing on the robot trajectory restoration according to the instantaneous severe disturbance state to obtain an initial processing result of the robot trajectory restoration;

[0011] S3. Obtaining a robot trajectory restoration control result by using the robot trajectory restoration initial processing result.

[0012] Preferably, the detecting the instantaneous severe disturbance state of the robot comprises:

[0013] S1-1, judging whether the robot has instantaneous severe disturbance, if so, executing S1-2, otherwise, no processing;

[0014] S1-2, obtaining the real-time sampled joint data and the corresponding expected joint data of the robot;

[0015] S1-3, using the real-time sampled joint data and the corresponding expected joint data to establish a state screening threshold range;

[0016] S1-4, obtaining the robot's instantaneous severe disturbance state according to the state screening threshold range to complete the detection.

[0017] Furthermore, the calculation formula for establishing the state screening threshold range using the real-time sampled joint data and the corresponding expected joint data is as follows:

[0018]

[0019] |e k |≥e h &&(e k-1 -e k-2 )*(e k -e k-1 )<0

[0020] Among them, q k is the actual joint position of the robot in the kth sampling period, is the expected joint position of the robot in the kth sampling period, e k 、e k-1 、e k-2 are the tracking errors of the robot in the kth, k-1th, and k-2th sampling periods, respectively, and e h is the robot joint position tracking error threshold.

[0021] Preferably, performing double-loop processing on the robot trajectory restoration according to the instantaneous severe disturbance state to obtain the initial processing result of the robot trajectory restoration includes:

[0022] According to the instantaneous severe disturbance state, the trajectory is restored based on the robot driving constraint to obtain the robot state rematch outer loop reference trajectory;

[0023] The robot state is used to re-match the outer loop reference trajectory for tracking control to obtain the robot state planning inner loop constraint trajectory;

[0024] The inner loop constraint trajectory of the robot state planning is used as the initial processing result of the robot trajectory restoration.

[0025] Furthermore, according to the instantaneous severe disturbance state, the trajectory restoration is performed based on the robot driving constraint to obtain the calculation formula for the robot state rematch outer loop reference trajectory as follows:

[0026] q r (t0) = q(t0)

[0027]

[0028] Among them, q r (t0), q(t0) and They are the robot reference trajectory joint position, reference trajectory joint velocity, actual joint position and actual joint velocity at the starting moment of the trajectory recovery process.

[0029] Furthermore, the calculation formula for obtaining the inner loop constraint trajectory of the robot state planning by using the robot state rematching outer loop reference trajectory for tracking control is as follows:

[0030] min{t f}

[0031] subject to

[0032]

[0033]

[0034]

[0035] Among them, t f is the trajectory recovery time e p =q r -q d ,

[0036] Furthermore, obtaining a robot trajectory restoration control result using the robot trajectory restoration initial processing result includes:

[0037] Calculating a robot trajectory restoration control structure using the robot trajectory restoration initial processing result;

[0038] The robot trajectory restoration control result is obtained by performing performance evaluation according to the robot trajectory restoration control structure.

[0039] Furthermore, the calculation formula for calculating the robot trajectory restoration control structure using the robot trajectory restoration initial processing result is as follows:

[0040] u=u a +u m +u s ,u s =u s1 +u s2

[0041]

[0042]

[0043] u s1 =-K1ε-K2e r -K3||e r || 2 ε

[0044]

[0045] Among them, W Rqr and W Eqr are the robot linear parameterized model regression observation matrix and the friction and interference regression observation matrix, β R and β E is the parameter corresponding to the regression matrix, Is β E The estimated value of K2, K2, K3 are gain matrices, μ is an arbitrarily small positive number, and ρ is the upper bound of uncertainty.

[0046] Furthermore, the calculation formula for obtaining the robot trajectory restoration control result by performing performance evaluation according to the robot trajectory restoration control structure is as follows:

[0047]

[0048] Among them, Uc is the robot trajectory restoration control result, u is the robot joint control torque, t0 and t f are the starting time and the final restoration time of the trajectory restoration process respectively.

[0049] Compared with the closest prior art, the present invention has the following beneficial effects:

[0050] An innovative hierarchical dual-loop trajectory restoration control method is proposed. It identifies instantaneous severe disturbance signals online and then performs state rematching to avoid the large initial error of the upper-level planned reference trajectory, which leads to saturation of the lower-level adaptive robust motion controller and thus system instability. Considering the robot drive constraints, the upper-level time optimal trajectory planning module is used to generate the reference trajectory online, and the reference trajectory is adjusted to converge to the desired trajectory in the shortest possible time to improve the trajectory restoration efficiency. The lower-level adaptive robust motion controller uses the upper-level planned trajectory signal as input, and weakens the influence of system modeling uncertainty through feedforward, feedback and adaptive techniques to improve trajectory tracking performance. The designed robot trajectory restoration control method based on planned online trajectory adjustment has been greatly improved in terms of convergence efficiency and energy loss. BRIEF DESCRIPTION OF THE DRAWINGS

[0051] Figure 1 It is a flow chart of a robot trajectory restoration control method based on online planning and adjustment provided by the present invention;

[0052] Figure 2A comparative experimental tracking error curve of a robot trajectory restoration control method based on online planning and adjustment provided by the present invention;

[0053] Figure 3 A comparative experimental control torque input curve of a robot trajectory restoration control method based on online planning and adjustment provided by the present invention;

[0054] Figure 4 The invention provides an experimental control torque input curve of a robot trajectory restoration control method based on online planning and adjustment. DETAILED DESCRIPTION

[0055] The specific implementation modes of the present invention will be further described in detail below in conjunction with the accompanying drawings.

[0056] In order to make the purpose, technical solution and advantages of the embodiments of the present invention clearer, the technical solution in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0057] Embodiment 1:

[0058] The present invention provides a robot trajectory restoration control method based on online planning and adjustment, such as Figure 1 As shown, including:

[0059] S1, detect the instantaneous severe disturbance state of the robot;

[0060] S2, performing double-loop processing on the robot trajectory restoration according to the instantaneous severe disturbance state to obtain an initial processing result of the robot trajectory restoration;

[0061] S3. Obtaining a robot trajectory restoration control result by using the robot trajectory restoration initial processing result.

[0062] S1 specifically includes:

[0063] S1-1, judging whether the robot has instantaneous severe disturbance, if so, executing S1-2, otherwise, no processing;

[0064] S1-2, obtaining the real-time sampled joint data and the corresponding expected joint data of the robot;

[0065] S1-3, using the real-time sampled joint data and the corresponding expected joint data to establish a state screening threshold range;

[0066] S1-4, obtaining the robot's instantaneous severe disturbance state according to the state screening threshold range to complete the detection.

[0067] The calculation formula for S1-3 is as follows:

[0068]

[0069] |e k |≥e h &&(e k-1 -e k-2 )*(e k -e k-1 )<0

[0070] Among them, q k is the actual joint position of the robot in the kth sampling period, is the expected joint position of the robot in the kth sampling period, e k 、e k-1 、e k-2 are the tracking errors of the robot in the kth, k-1th, and k-2th sampling periods, respectively, and e h is the robot joint position tracking error threshold.

[0071] In this embodiment, a robot trajectory restoration control method based on online planning and adjustment can determine that the robot is in an instantaneous severe disturbance state when it is within a state screening threshold range.

[0072] S2 specifically includes:

[0073] S2-1, performing trajectory restoration based on the instantaneous severe disturbance state and the robot driving constraint to obtain a robot state rematch outer loop reference trajectory;

[0074] S2-2, using the robot state to re-match the outer loop reference trajectory for tracking control to obtain the robot state planning inner loop constraint trajectory;

[0075] S2-3. Use the robot state to plan the inner loop constraint trajectory as the initial processing result of the robot trajectory restoration.

[0076] The calculation formula of S2-1 is as follows:

[0077] q r (t0) = q(t0)

[0078]

[0079] Among them, q r (t0), q(t0) and They are the robot reference trajectory joint position, reference trajectory joint velocity, actual joint position and actual joint velocity at the starting moment of the trajectory recovery process.

[0080] The calculation formula of S2-2 is as follows:

[0081] min{t f}

[0082] subject to

[0083]

[0084]

[0085]

[0086] Among them, t f is the trajectory recovery time e p =q r -q d ,

[0087] S3 specifically includes:

[0088] S3-1, calculating the robot trajectory restoration control structure using the robot trajectory restoration initial processing result;

[0089] S3-2. Perform performance evaluation according to the robot trajectory restoration control structure to obtain a robot trajectory restoration control result.

[0090] The calculation formula of S3-1 is as follows:

[0091] u=u a +u m +u s ,u s =u s1 +u s2

[0092]

[0093]

[0094] u s1 =-K1ε-K2e r -K3||e r || 2 ε

[0095]

[0096] Among them, W Rqr and W Eqrare the robot linear parameterized model regression observation matrix and the friction and interference regression observation matrix, β R and β E is the parameter corresponding to the regression matrix, Is β E The estimated value of K2, K2, K3 are gain matrices, μ is an arbitrarily small positive number, and ρ is the upper bound of uncertainty.

[0097] The calculation formula of S3-2 is as follows:

[0098]

[0099] Among them, Uc is the robot trajectory restoration control result, u is the robot joint control torque, t0 and t f are the starting time and the final restoration time of the trajectory restoration process respectively.

[0100] In this embodiment, a robot trajectory restoration control method based on online planning and adjustment is provided. Figure 2 As shown, including:

[0101] 1. Design of the upper layer trajectory planner based on time optimization;

[0102] 2. Design of the lower layer robust motion tracking controller based on adaptive parameter estimation;

[0103] An evaluation function for torque energy loss in the trajectory restoration process is proposed, and the proposed method is quantitatively evaluated. The superiority of the invention is verified through comparative experiments.

[0104] Specifically, during implementation, we first design an upper-layer time-optimal trajectory planner, including:

[0105] (1) Identification of transient severe disturbances

[0106] External instantaneous severe disturbance signals are characterized by large disturbance amplitude and short duration. Specifically, the amplitude of the external disturbance exceeds the input amplitude of the robot joint torque control and lasts for less than 1 second. By detecting the amplitude of the robot tracking error and identifying the occurrence of such characteristic disturbance signals online according to the following judgment conditions:

[0107]

[0108] |e k |≥e h &&(e k-1 -e k-2 )*(e k -e k-1 )<0

[0109] Among them, q kis the actual joint position of the robot in the kth sampling period, is the expected joint position of the robot in the kth sampling period, e k 、e k-1 、e k-2 are the tracking errors of the robot in the kth, k-1th, and k-2th sampling periods, respectively. The sampling period is 1 millisecond, and e h =[0.1,0.1,0.1,0.1,0.1,0.1,0.1] T is the robot joint position tracking error threshold.

[0110] (2) Robot status rematch:

[0111] If the planned reference trajectory q r There is a tracking error at the initial moment. The reference trajectory planned by the upper layer will cause serious controller saturation when it is sent to the lower layer controller driven by the error for tracking. Therefore, the upper-level planner must rematch the robot state before generating the reference trajectory, matching the actual joint state of the robot to the initial state of the planned trajectory. The formula is:

[0112] q r (t0) = q(t0)

[0113]

[0114] where q r (t0), q(t0) and They are the robot reference trajectory joint position, reference trajectory joint velocity, actual joint position and actual joint velocity at the starting moment of the trajectory recovery process.

[0115] (3) Mathematical description and optimization solution of trajectory restoration problem

[0116] Next, the robot trajectory restoration can be described as a constrained trajectory planning problem and solved online. Its mathematical description is:

[0117] min{t f}

[0118] subject to

[0119]

[0120]

[0121]

[0122] where t f is the trajectory recovery time e p =q r -qd ,

[0123] Then the lower layer robust motion tracking controller based on adaptive parameter estimation is designed, including: model feedforward compensation u a , linear feedback u s1 , nonlinear robust feedback u s2 , online adaptive compensation u m Four parts to ensure that the robot can accurately track the reference trajectory q r , note that the control input of the lower adaptive robust motion controller is the planned reference trajectory q r Instead of the expected trajectory q d . Define the reference trajectory tracking error e r =q r -q, the designed control law structure is as follows:

[0124] u=u a +u m +u s ,u s =u s1 +u s2

[0125]

[0126]

[0127] u s1 =-K1ε-K2e r -K3||e r || 2 ε

[0128]

[0129] Where W Rqr and W Eqr are the robot linear parameterized model regression observation matrix and the friction and interference regression observation matrix, β R and β E is the parameter corresponding to the regression matrix, Is β E The estimated value of K1, K2, K3 are gain matrices, μ = 0.001, ρ = 10 are the upper bounds of uncertainty.

[0130] Finally, the torque energy loss evaluation function in the trajectory restoration process is proposed to quantitatively evaluate the proposed method. The formula is:

[0131]

[0132] Where u is the robot joint control torque, t0 and tf are the starting time and the final restoration time of the trajectory restoration process respectively.

[0133] The present invention provides a robot trajectory recovery control method based on online planning and adjustment under instantaneous severe disturbance. Aiming at the problem of rapid trajectory recovery of the robot subjected to instantaneous severe disturbance, a hierarchical adjustment control framework is designed from the perspective of trajectory planning. The upper-level planner performs robot state rematching after detecting the instantaneous severe disturbance signal, which can eliminate the tracking error at the initial moment of trajectory recovery, thereby avoiding the lower-level motion controller. The planned reference trajectory can adjust the robot to converge to the desired trajectory, while shortening the trajectory recovery time and reducing the robot jitter; the lower-level motion controller receives the upper-level planned trajectory signal, and linear feedback, nonlinear robust feedback and adaptive parameter estimator ensure the robot's high-performance trajectory tracking and robustness. In summary, compared with the existing methods, the present invention can save the system trajectory recovery time, reduce the system oscillation during the trajectory recovery process, and reduce the system's joint torque energy loss in solving trajectory recovery.

[0134] Optionally, the specific examples in this embodiment may refer to the examples described in the above embodiments and optional implementation modes, and this embodiment will not be described in detail here.

[0135] The serial numbers of the above-mentioned embodiments of the present application are for description only and do not represent the advantages or disadvantages of the embodiments.

[0136] In the above embodiments of the present application, the description of each embodiment has its own emphasis. For parts that are not described in detail in a certain embodiment, please refer to the relevant description of other embodiments.

[0137] In the several embodiments provided in this application, it should be understood that the disclosed technical content can be implemented in other ways. Among them, the device embodiments described above are only schematic. For example, the division of the units is only a logical function division. There may be other division methods in actual implementation. For example, multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of units or modules, which can be electrical or other forms.

[0138] The above is only a preferred implementation of the present application. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principles of the present application. These improvements and modifications should also be regarded as the scope of protection of the present application.

[0139] Experimental results and description:

[0140] In the experiment, the first and fourth joints were subjected to instantaneous and severe disturbances at 8 seconds, and the duration was 0.3 seconds. The specific experimental parameter settings are shown in Table 1. Experiment and its comparison method: C1 represents the traditional adaptive robust control method, C2 represents the adaptive robust control plus ordinary smoothing method, and C3 represents the method proposed by the present invention. The detailed results of the comparative experiment are shown in Table 2. According to Table 2 and the attached Figure 3 and attached Figure 4 The trajectory restoration method proposed in the present invention saves the time of system trajectory restoration, reduces the system oscillation during the trajectory restoration process, and reduces the joint torque energy loss of the system.

[0141] Table 1 Experimental parameter settings

[0142]

[0143] Table 2 Experimental results

[0144]

[0145]

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

[0147] The present invention 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 block in the flowchart and / or block diagram, as well as the combination of the processes and / or blocks 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.

[0148] 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 1A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.

[0149] 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.

[0150] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention rather than to limit it. Although the present invention has been described in detail with reference to the above embodiments, ordinary technicians in the relevant field should understand that the specific implementation methods of the present invention can still be modified or replaced by equivalents. Any modification or equivalent replacement that does not depart from the spirit and scope of the present invention should be covered within the scope of protection of the claims of the present invention.

Claims

1. A robot trajectory restoration control method based on online planning and adjustment, characterized in that: include: S1, detect the instantaneous severe disturbance state of the robot; S2, performing double-loop processing on the robot trajectory restoration according to the instantaneous severe disturbance state to obtain an initial processing result of the robot trajectory restoration; S2-1, performing trajectory restoration based on the instantaneous severe disturbance state and the robot driving constraint to obtain a robot state rematch outer loop reference trajectory; The calculation formula of S2-1 is as follows: q r (t0)=q(t0) Among them, q r (t0), q(t0) and They are the robot reference trajectory joint position, reference trajectory joint velocity, actual joint position and actual joint velocity at the start of the trajectory recovery process; S2-2, using the robot state to re-match the outer loop reference trajectory for tracking control to obtain the robot state planning inner loop constraint trajectory; The calculation formula of S2-2 is as follows: min{t f } subjectto Among them, t f is the trajectory recovery time, e p =q r -q d , S2-3, using the robot state planning inner loop constraint trajectory as the robot trajectory restoration initial processing result; S3. Obtaining a robot trajectory restoration control result by using the robot trajectory restoration initial processing result.

2. A robot trajectory restoration control method based on online planning and adjustment as claimed in claim 1, characterized in that: The detection of the instantaneous severe disturbance state of the robot includes: S1-1, judging whether the robot has instantaneous severe disturbance, if so, executing S1-2, otherwise, no processing; S1-2, obtaining the real-time sampled joint data and the corresponding expected joint data of the robot; S1-3, using the real-time sampled joint data and the corresponding expected joint data to establish a state screening threshold range; S1-4, obtaining the robot's instantaneous severe disturbance state according to the state screening threshold range to complete the detection.

3. A robot trajectory restoration control method based on online planning and adjustment as claimed in claim 2, characterized in that: The calculation formula for establishing the state screening threshold range using the real-time sampled joint data and the corresponding expected joint data is as follows: |and k |≥e h &&(And k-1 -And k-2 )*(And k -And k-1 )<0 Among them, q k is the actual joint position of the robot in the kth sampling period, is the expected joint position of the robot in the kth sampling period, e k 、e k-1 、e k-2 are the tracking errors of the robot in the kth, k-1th, and k-2th sampling periods, respectively, and e h is the robot joint position tracking error threshold.

4. A robot trajectory restoration control method based on online planning and adjustment as claimed in claim 1, characterized in that: The robot trajectory restoration control result obtained by using the robot trajectory restoration initial processing result includes: Calculating a robot trajectory restoration control structure using the robot trajectory restoration initial processing result; The robot trajectory restoration control result is obtained by performing performance evaluation according to the robot trajectory restoration control structure.

5. A robot trajectory restoration control method based on online planning and adjustment as claimed in claim 4, characterized in that: The calculation formula for calculating the robot trajectory restoration control structure using the robot trajectory restoration initial processing result is as follows: in=in a +in m +in s ,in s =in s1 +in s2 the s1 =-K1ε-K2e r -K3||e r || 2 ε Among them, W Rqr and W Eqr are the robot linear parameterized model regression observation matrix and the friction and interference regression observation matrix, β R and β E is the parameter corresponding to the regression matrix, Is β E The estimated value of K2, K2, K3 are gain matrices, μ is an arbitrarily small positive number, ρ is the upper bound of uncertainty, e p =q r -q d , 6. A robot trajectory restoration control method based on online planning and adjustment as claimed in claim 4, characterized in that: The calculation formula for obtaining the robot trajectory restoration control result by performing performance evaluation according to the robot trajectory restoration control structure is as follows: Among them, Uc is the robot trajectory restoration control result, u is the robot joint control torque, t0 and t f are the starting time and the final restoration time of the trajectory restoration process respectively.