Robot path tracking method based on time delay compensation and input saturation control

By constructing a mathematical model of the mobile robot and a time-varying gain distributed observer, and designing a virtual controller and a dynamic compensator, the problems of input time delay and saturation in robot path tracking were solved, and the system's stability and high-precision trajectory tracking were achieved.

CN119045321AActive Publication Date: 2024-11-29CHINA UNIV OF GEOSCIENCES (WUHAN) +1

Patent Information

Application Number
CN202410958995.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-17
Publication Date
2024-11-29
Estimated Expiration
2044-07-17

AI Technical Summary

Technical Problem

Existing control methods are unable to effectively compensate for input delay and input saturation simultaneously in robot path tracking, resulting in slower system response, reduced tracking accuracy, and even system instability.

Method used

A mathematical model system for a mobile robot is constructed. The leader's state information is obtained by using time-varying gain and distributed observers. A virtual controller and dynamic compensator are designed. Input time delay and saturation are handled by adaptive law and auxiliary compensation system to achieve stable and high-precision trajectory tracking.

Benefits of technology

When input time delay and input saturation coexist, improve the stability and path tracking accuracy of the system, ensure the fast response and boundedness of the closed-loop signal of the control system, and avoid the degradation of system performance due to input saturation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119045321A_ABST
    Figure CN119045321A_ABST
Patent Text Reader

Abstract

The invention discloses a robot path tracking method based on time delay compensation and input saturation control, a medium and equipment, and relates to the field of robot control, and the robot path tracking method based on time delay compensation and input saturation control mainly comprises the steps: constructing a time-varying distributed observer by using a time-varying gain, and constructing a time-varying distributed observer by using a virtual controller parameter; a full-drive model is obtained, and three-dimensional state information of the leader is obtained by using a time-varying distributed observer; constructing a local tracking error and a virtual controller, and obtaining an adaptive rate and a control torque by using an auxiliary compensation system; obtaining a dynamic compensator and a controller according to the adaptive rate and the control torque; according to the three-dimensional state information of the leader, the controller is utilized to control the follower and monitor and track the leader in real time, and the robot path tracking method, medium and device based on time delay compensation and input saturation control can improve the control performance of the robot when input time delay and input saturation exist at the same time.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robot control, and more specifically, to a robot path tracking method, medium and device based on time-delay compensation and input saturation control. Background Art

[0002] With the rapid development of robotics technology, mobile robot path tracking control has been widely used in the fields of industry, logistics, medical care, services, etc. For these application scenarios, accurate path tracking is crucial to improve the efficiency and safety of robot work. In the process of implementing path tracking control, input lag and input saturation are two common problems that cannot be ignored.

[0003] Input lag refers to the time delay between the generation of a control command and its actual effect on the system. In practical applications, due to delays in sensors, processors, and actuators, the system will inevitably have input lag. This lag will lead to a decrease in control performance, and in severe cases, it may even cause system instability. How to ensure system stability and trajectory tracking accuracy in the presence of input lag is an important research topic.

[0004] Input saturation refers to the input signal of the control system exceeding the physical limit range of the actuator. In practical applications, the actuator has saturation characteristics. Exceeding its maximum or minimum input limit will cause system response distortion, overshoot or oscillation, and even cause system instability. Input saturation limits the effective range of the control input, resulting in a decrease in control performance and affecting the precise control of the system. How to design an effective control strategy to ensure the stability and path tracking accuracy of the system in the presence of input saturation is an important research topic. In practical applications, the impact of input saturation cannot be ignored because the actuator is subject to physical limitations when working, such as maximum voltage, current or torque constraints. When the control input exceeds these limits, the actuator cannot operate as expected, causing the actual output to deviate from the target value. This deviation will not only reduce the response speed and control accuracy of the system, but may also cause severe oscillation or instability, endangering the safety of the system. Therefore, the control strategy for the input saturation problem must consider how to ensure the stability of the system and high-precision path tracking capability when the control input is limited.

[0005] In the process of robot path tracking control, when the two problems of input lag and input saturation exist at the same time, it is difficult for the existing technology to effectively solve the following technical defects: the existing control method is difficult to effectively compensate for the input lag, resulting in a slower system response speed, reduced tracking accuracy, and even causing system instability. The existing control method cannot effectively handle the input saturation, which can easily lead to system response distortion, overshoot or oscillation. In severe cases, it may cause system instability and affect the overall system performance. When these two problems exist at the same time, the traditional control strategy cannot take into account both compensating for input lag and limiting input saturation, resulting in further degradation of system performance. Therefore, how to ensure the stability of the system and path tracking accuracy when input lag and input saturation exist at the same time is an important technical problem that needs to be solved urgently.

[0006] There are many deficiencies in the existing control schemes. The existing control schemes and their defects are as follows:

[0007] (1) Traditional PID control method: The traditional proportional-integral-derivative (PID) controller is widely used in various control systems. The PID controller has the advantages of simple design and easy implementation. However, the PID control method performs poorly when dealing with input lag and input saturation problems. For input lag, the PID controller cannot effectively compensate, resulting in slower system response speed and reduced tracking accuracy. For input saturation, the PID controller is prone to overshoot or oscillation, and cannot guarantee the stability of the system.

[0008] (2) Methods based on predictive control: Model Predictive Control (MPC) designs control inputs by predicting the future behavior of the system, which can effectively deal with input lag problems. However, the MPC method has high computational complexity and poor real-time performance, and is difficult to apply, especially in mobile robot systems with limited computing resources. In addition, when dealing with input saturation, the MPC method needs to introduce complex constraints, which increases the complexity of the algorithm and has limited effect in practical applications.

[0009] (3) Adaptive control method: The adaptive control method can automatically adjust the control law according to the changes in system parameters and has a good effect on dealing with uncertainty. However, the adaptive control method has certain limitations when dealing with input lag and input saturation. For input lag, the adaptive control method cannot provide an effective compensation strategy and still relies on delayed feedback information. For input saturation, it is difficult for the adaptive control method to maintain system performance when the control input is limited.

[0010] (4) Robust control method: Robust control method can ensure the stability and performance of the system when there are uncertainties and disturbances in the system. However, robust control methods are usually complex in design and conservative. For input time lag, robust control methods need to introduce conservative compensation strategies, resulting in slower system response. For input saturation, robust control methods are prone to introduce large control inputs when processing, making it difficult to ensure the stability of the system. Summary of the invention

[0011] The object of the present invention is to provide a robot path tracking method, medium and device based on time lag compensation and input saturation control, which can improve the control performance of the robot when input time lag and input saturation exist at the same time.

[0012] The present invention provides a robot path tracking method based on time-delay compensation and input saturation control, comprising:

[0013] S1: Construct a mathematical model system of a mobile robot, which includes a leader and a follower;

[0014] S2: Using the time-varying gain, a time-varying distributed observer is constructed. The time-varying distributed observer is used to obtain the three-dimensional state information of the leader, which includes position information and direction information.

[0015] S3: According to the mathematical model system of the mobile robot, the full drive model is obtained using the virtual controller parameters;

[0016] S4: Based on the full drive model, the three-dimensional state information of the leader is obtained using the time-varying distributed observer; based on the three-dimensional state information, the local tracking error and virtual controller are constructed using the time-varying distributed observer;

[0017] S5: According to the virtual controller, the adaptive rate and the control torque are obtained by using the auxiliary compensation system;

[0018] S6: obtaining a dynamic compensator according to the adaptive rate and the control torque;

[0019] S7: Using the dynamic compensator, a controller is obtained; according to the three-dimensional state information of the leader, the controller is used to control the follower and monitor and track the leader in real time.

[0020] Furthermore, step S1 of the robot path tracking method based on time-delay compensation and input saturation control specifically includes: constructing a mobile robot mathematical model system, the mobile robot mathematical model system includes a leader and a follower, such as formula:

[0021]

[0022]

[0023]

[0024]

[0025] Ω i =[Ω i,1 Ω i,2 ] T

[0026]

[0027] V={1 2 … N},(i,j)∈ε

[0028]

[0029] L=DA

[0030] D=diag(υ1,υ2,...,υ N )

[0031]

[0032] N i ={j|j∈V|(j,i)∈ε}

[0033]

[0034] in, is the rate of change of the robot's position and orientation, υ i and ω i Respectively represent linear velocity and angular velocity; η i is the position and orientation matrix of the robot in the global coordinate system, Indicates location; Indicates direction; Ω i is the state matrix of the robot's left and right wheel rotation speed, Ω i,1 and Ω i,2 Respectively represent the rotation speed of the left and right wheels; τ i (t) is the control torque, d(t) is a bounded time-varying lag, is a positive constant; M is the mass matrix, C is the Coriolis force matrix, D is the damping matrix, m1, m2, c, d1 and d2 are all predefined constants, M is a positive definite matrix, b i is half the width of the ith robot, r i is the wheel radius of the i-th robot individual. The communication in the multi-agent formation can be represented by a directed graph G. Define a directed graph It consists of a directed graph G, node 0, and directed edges from leader 0 to G. Assume is contained in a spanning tree with a leader; N is the number of followers, ε is the edge set, which represents the communication between each pair of agents. If (i, j)∈ε, it means that the jth follower can receive the data of the ith follower; L is the Laplace matrix, which represents the communication relationship between the leader and the followers, N i represents the neighbors of the ith agent.

[0035] Furthermore, step S2 of the robot path tracking method based on time-delay compensation and input saturation control specifically includes: using time-varying gain to construct a time-varying distributed observer, such as formula:

[0036]

[0037]

[0038]

[0039]

[0040]

[0041] in, and is the rate of change of the state of the time-varying distributed observer, and is the state of the time-varying distributed observer, r and β1 are design parameters; is the β1 power of the time-varying gain, N is the number of robots, is the observation position of the jth robot, is the observed velocity of the jth robot, μ(t) is the time-varying gain, T is the specified finite time, is the expected speed of the ith robot, q i,2,* is the expected speed of the ith robot, is the input, u i,* (t) is the input, q i,1,* is the expected trajectory of the ith robot, * can be viewed as x, y and ψ; and It is the state of the observer, which is used to estimate the information of the leader within a specified limited time; the time-varying distributed observer is used to obtain the three-dimensional state information of the leader, which includes position information and direction information.

[0042] Furthermore, step S3 of the robot path tracking method based on time lag compensation and input saturation control specifically includes: according to the mathematical model system of the mobile robot, using the virtual controller parameters, obtaining a full drive model, such as formula:

[0043]

[0044]

[0045]

[0046]

[0047] Among them, x i (t) and y i (t) is the position of the ith robot, and is the expected position of the ith robot, R(ψ i (t)) is the rotation matrix, which represents the rotation transformation of the robot at time t, ψ i (t) is the direction of the ith robot, f 1i (ξ i ) is the deviation function of the ith robot in the x direction, f 2i (ξ i ) is the deviation function of the ith robot in the y direction, ξ i are virtual controller parameters, is the desired direction of the ith robot, f 3i (ξ i ) is the deviation function of the ith robot in terms of direction angle, f 1i is the deviation of the ith robot in the x direction, f 2i is the deviation of the ith robot in the y direction, f 3i is the deviation of the ith robot in the direction angle, ε 1i and ε 2i Is a normal number.

[0048] Furthermore, step S4 of the robot path tracking method based on time-delay compensation and input saturation control specifically includes: according to the full drive model, using the time-varying distributed observer, estimating the information of the leader within the specified finite time T, observing and updating the observation state of the leader in real time, and obtaining the three-dimensional state information of the leader; according to the three-dimensional state information, using the time-varying distributed observer, constructing the local tracking error and the virtual controller, such as the formula:

[0049]

[0050]

[0051]

[0052]

[0053]

[0054]

[0055]

[0056] Among them, e ix is the tracking error of the ith robot in the x direction, x i is the expected trajectory of the ith robot in the x direction, is the observed trajectory of the ith robot in the x direction, e iy is the tracking error of the ith robot in the y direction, y i is the expected trajectory of the ith robot in the y direction, is the observed trajectory of the i-th robot in the y direction, e iψ is the tracking error of the ith robot in terms of direction angle, ψ i is the expected trajectory of the ith robot in terms of direction angle, is the observed trajectory of the ith robot in terms of direction angle, is the linear velocity error of the ith robot, υ i is the expected linear velocity of the ith robot, υ ic is the linear velocity of the ith robot of the virtual controller, is the angular velocity error of the i-th robot, ω i is the expected angular velocity of the ith robot, ω ic is the angular velocity of the ith robot of the virtual controller, is the tracking error change rate of the ith robot in the x direction, is the tracking error change rate of the ith robot in the y direction, Q i is the position vector of the robot in the global coordinate system, is the update rate, R(ψ i ) is the rotation matrix, which represents the rotation transformation of the robot at time t, f 1i is the deviation of the ith robot in the x direction, f 2i is the deviation of the ith robot in the y direction, is the direction change rate of the ith robot, is the observed velocity of the ith robot in the x direction, is the observed velocity of the ith robot in the y direction, is the tracking error change rate of the ith robot in terms of direction angle, f 3i is the deviation of the angular direction of the ith robot, ξ i is the control variable, is the update rate, is the velocity observation value of the ith robot in the direction angle, is the direction of the i-th robot, k i,1 and k i,2 is a normal number, is the velocity input of the ith robot in terms of direction angle, f 3i is the deviation of the direction angle of the ith robot.

[0057] Furthermore, step S5 of the robot path tracking method based on time-delay compensation and input saturation control specifically includes: according to the virtual controller, using the auxiliary compensation system, obtaining the adaptive rate and the control torque, such as the formula:

[0058]

[0059] Θ i =[c d1 d2 m1 m2]

[0060]

[0061]

[0062]

[0063]

[0064] in, is the transpose of the variable matrix defined after simplification, Ω i2 is the speed of the right wheel of the i-th robot, ω i is the angular velocity of the ith robot, Ω i1 is the rotation speed of the left wheel of the ith robot, is the rate of change of the expected angular velocity of the left wheel of the ith robot, is the expected rate of change of the angular velocity of the right wheel of the i-th robot, Θ i is the variable matrix defined after simplification, c is the department force, d1 and d2 are the damping coefficients, m1 and m2 are the mass of the robot, is the rate of change of the compensation function of the auxiliary compensation system, M is the mass matrix, τ i (t) is the control torque, τ i (td) is the control torque at time td, d is the time lag, Ω i1c is the expected angular velocity of the left wheel of the ith robot, Ω i2c is the expected angular velocity of the right wheel of the ith robot, is the inverse of the defined known matrix, υ ic is the linear velocity of the ith robot of the virtual controller, ω ic is the angular velocity of the ith robot of the virtual controller, eiΩ is the tracking error of the wheel speed of the ith robot, η1 is the compensation function, M i is the mass matrix of the ith robot, is the rate of change of the tracking error of the wheel speed of the i-th robot, is the jth row in the transposed variable matrix defined after simplification, Θ ij is the jth element of the variable matrix defined after simplification, τ i1 (t) is the left wheel control torque of the ith robot, τ i2 (t) is the right wheel control torque of the ith robot, k i,3 is a normal number, is the adaptation rate, is the transpose of the known matrix defined, π i1 is a positive constant, ij is the jth row in the variable matrix defined after simplification, γ ij , κ ij and θ ij0 Is a normal number.

[0065] Furthermore, step S6 of the robot path tracking method based on time-delay compensation and input saturation control specifically includes: obtaining a dynamic compensator according to the adaptive rate and the control torque, such as the formula:

[0066] Δv sat =sat(v(td(t))-v(td(t))

[0067] Δv delay =v(td(t))-v(t)

[0068] Among them, τ i (t) is the control torque of the ith robot, sat(·) is the saturation function of the input constraint B, sat(v(t)) is the final control torque applied to the robot, v(t) is the control input, sign(v(t)) is the maximum value that the saturation function can take, u(t) is the maximum input, B is a positive constant generated by the controller design program, u M is the limit value of u(t), Δv sat and v delay is a dynamic compensator and d(t) is the time lag.

[0069] Furthermore, step S7 of the robot path tracking method based on time-delay compensation and input saturation control specifically includes: using a dynamic compensator to obtain a controller; using the controller to control the follower and monitor and track the leader in real time according to the three-dimensional state information of the leader, as shown in the formula:

[0070]

[0071]

[0072] Among them, τ i (t) is the control torque, τ i1 (t) is the left wheel control torque of the ith robot, τ i2 (t) is the right wheel control torque of the ith robot, k i,3 is a normal number, is the transpose of the variable matrix defined after simplification, is the adaptation rate, is the transpose of the known matrix defined, π i1 is a positive constant, sat(v(t)) is the final control torque applied to the robot, v(t) is the control input, sign(v(t)) is the maximum value of the saturation function, u(t) is the maximum input, B is a positive constant generated by the controller design program, u M is the boundary value of u(t).

[0073] The present invention also provides a computer-readable storage medium on which a computer program is stored. When the computer program is executed by a processor, the steps of the robot path tracking method based on time-delay compensation and input saturation control are implemented.

[0074] The present invention also provides a computer device, including a memory, a processor, and a computer program stored in the memory and executable on the processor. When the processor executes the program, the steps of the robot path tracking method based on time lag compensation and input saturation control are implemented.

[0075] The robot path tracking method, medium and device based on time delay compensation and input saturation control provided by the present invention have the following beneficial effects:

[0076] First, the present invention introduces an auxiliary compensator to deal with the input time lag problem, ensuring that the system can maintain stability and high-precision trajectory tracking in the presence of input time lag, ensuring the boundedness of the closed-loop signal, thereby improving the stability of the system and trajectory tracking accuracy. This compensation strategy can effectively eliminate the negative impact of input time lag on the system and ensure the rapid response of the control system;

[0077] Secondly, the present invention takes the input saturation constraint into consideration, designs an appropriate saturation function, limits the amplitude of the control input, and prevents the potential risk caused by excessive control input; by designing the Lyapunov function, the control input is ensured to be within the allowable range, thereby improving the stability of the system, avoiding the degradation of system performance due to input saturation, and ensuring the stability and performance of the system under input saturation;

[0078] Finally, a dynamic compensator is proposed by combining the two factors of input lag and input saturation, and the virtual controller, virtual control law and adaptive law are recursively designed using the adaptive backstepping method. This method ensures that the controller tracking error approaches an acceptable range of a small area near zero within a specified finite time by specifying a time performance function, thereby eliminating the influence of uncertainty and further improving the stability and tracking accuracy of the system. BRIEF DESCRIPTION OF THE DRAWINGS

[0079] The present invention will be further described below with reference to the accompanying drawings and embodiments, in which:

[0080] Figure 1 is a flow chart of a robot path tracking method based on time-delay compensation and input saturation control provided by the present invention;

[0081] Figure 2 It is a schematic diagram of a robot path tracking method based on time-delay compensation and input saturation control provided by the present invention;

[0082] Figure 3 It is a schematic diagram of the time lag function provided by the present invention;

[0083] Figure 4 is a schematic diagram of a saturation function provided by the present invention;

[0084] Figure 5 It is a structural block diagram of the computer device provided by the present invention. DETAILED DESCRIPTION

[0085] In order to have a clearer understanding of the technical features, purposes and effects of the present invention, specific embodiments of the present invention are now described in detail with reference to the accompanying drawings.

[0086] Figure 1 A schematic diagram of a robot path tracking method based on time lag compensation and input saturation control in this embodiment is shown. In this embodiment, the robot path tracking method based on time lag compensation and input saturation control includes:

[0087] S1: Construct a mathematical model system of a mobile robot, which includes a leader and a follower;

[0088] Specifically, step S1 of the robot path tracking method based on time-delay compensation and input saturation control specifically includes: constructing a mobile robot mathematical model system, the mobile robot mathematical model system includes a leader and a follower, such as formula:

[0089]

[0090]

[0091]

[0092]

[0093] Ω i =[Ω i,1 Ω i,2 ] T

[0094]

[0095] V={1 2 … N},(i,j)∈ε

[0096]

[0097] L=DA

[0098] D=diag(υ1,υ2,...,υ N )

[0099]

[0100] N i ={j|j∈V|(j,i)∈ε}

[0101]

[0102] in, is the rate of change of the robot's position and orientation, υ i and ω i Respectively represent linear velocity and angular velocity; η i is the position and orientation matrix of the robot in the global coordinate system, Indicates location; Indicates direction; Ω i is the state matrix of the robot's left and right wheel rotation speed, Ω i,1 and Ω i,2 Respectively represent the rotation speed of the left and right wheels; τ i (t) is the control torque, d(t) is a bounded time-varying lag, is a positive constant; M is the mass matrix, C is the Coriolis force matrix, D is the damping matrix, m1, m2, c, d1 and d2 are all predefined constants, M is a positive definite matrix, b i is half the width of the ith robot, r i is the wheel radius of the i-th robot individual. The communication in the multi-agent formation can be represented by a directed graph G. Define a directed graph It consists of a directed graph G, node 0, and directed edges from leader 0 to G. Assume is contained in a spanning tree with a leader; N is the number of followers, ε is the edge set, which represents the communication between each pair of agents. If (i, j)∈ε, it means that the jth follower can receive the data of the ith follower; L is the Laplace matrix, which represents the communication relationship between the leader and the followers, N i represents the neighbors of the i-th agent;

[0103] S2: Using the time-varying gain, a time-varying distributed observer is constructed. The time-varying distributed observer is used to obtain the three-dimensional state information of the leader, which includes position information and direction information.

[0104] Specifically, step S2 of the robot path tracking method based on time-delay compensation and input saturation control specifically includes: using time-varying gain to construct a time-varying distributed observer, such as formula:

[0105]

[0106]

[0107]

[0108]

[0109]

[0110] in, and is the rate of change of the state of the time-varying distributed observer, and is the state of the time-varying distributed observer, r and β1 are design parameters; is the β1 power of the time-varying gain, N is the number of robots, is the observation position of the jth robot, is the observed velocity of the jth robot, μ(t) is the time-varying gain, T is the specified finite time, is the expected speed of the ith robot, q i,2,* is the expected speed of the ith robot, is the input, u i,* (t) is the input, q i,1,* is the expected trajectory of the ith robot, * can be viewed as x, y and ψ; and is the state of the observer, which is used to estimate the information of the leader within a specified finite time; the time-varying distributed observer is used to obtain the three-dimensional state information of the leader, which includes position information and direction information;

[0111] S3: According to the mathematical model system of the mobile robot, the full drive model is obtained using the virtual controller parameters;

[0112] Specifically, step S3 of the robot path tracking method based on time lag compensation and input saturation control specifically includes: according to the mathematical model system of the mobile robot, using the virtual controller parameters, obtaining the full drive model, such as formula:

[0113]

[0114]

[0115]

[0116]

[0117] Among them, x i (t) and y i (t) is the position of the ith robot, and is the expected position of the ith robot, R(ψ i (t)) is the rotation matrix, which represents the rotation transformation of the robot at time t, ψ i (t) is the direction of the ith robot, f 1i (ξ i ) is the deviation function of the ith robot in the x direction, f 2i (ξ i ) is the deviation function of the ith robot in the y direction, ξ i are virtual controller parameters, is the desired direction of the ith robot, f 3i (ξ i ) is the deviation function of the ith robot in terms of direction angle, f 1i is the deviation of the ith robot in the x direction, f 2i is the deviation of the ith robot in the y direction, f 3i is the deviation of the ith robot in the direction angle, ε 1i and ε 2i is a positive constant;

[0118] S4: Based on the full drive model, the three-dimensional state information of the leader is obtained using the time-varying distributed observer; based on the three-dimensional state information, the local tracking error and virtual controller are constructed using the time-varying distributed observer;

[0119] Specifically, step S4 of the robot path tracking method based on time-delay compensation and input saturation control specifically includes: according to the full drive model, using the time-varying distributed observer, estimating the information of the leader within the specified finite time T, observing and updating the observation state of the leader in real time, and obtaining the three-dimensional state information of the leader; according to the three-dimensional state information, using the time-varying distributed observer, constructing the local tracking error and the virtual controller, as shown in the formula:

[0120]

[0121]

[0122]

[0123]

[0124]

[0125]

[0126]

[0127] Among them, e ix is the tracking error of the ith robot in the x direction, x i is the expected trajectory of the ith robot in the x direction, is the observed trajectory of the ith robot in the x direction, e iy is the tracking error of the ith robot in the y direction, y i is the expected trajectory of the ith robot in the y direction, is the observed trajectory of the i-th robot in the y direction, e iψ is the tracking error of the ith robot in terms of direction angle, ψ i is the expected trajectory of the ith robot in terms of direction angle, is the observed trajectory of the ith robot in terms of direction angle, is the linear velocity error of the ith robot, υ i is the expected linear velocity of the ith robot, υ ic is the linear velocity of the ith robot of the virtual controller, is the angular velocity error of the i-th robot, ω i is the expected angular velocity of the ith robot, ω ic is the angular velocity of the ith robot of the virtual controller, is the tracking error change rate of the ith robot in the x direction, is the tracking error change rate of the ith robot in the y direction, Q i is the position vector of the robot in the global coordinate system, is the update rate, R(ψ i ) is the rotation matrix, which represents the rotation transformation of the robot at time t, f 1i is the deviation of the ith robot in the x direction, f 2i is the deviation of the ith robot in the y direction, is the direction change rate of the ith robot, is the observed velocity of the ith robot in the x direction, is the observed velocity of the ith robot in the y direction, is the tracking error change rate of the ith robot in terms of direction angle, f 3i is the deviation of the ith robot in the direction angle, ξ i is the control variable, is the update rate, is the velocity observation value of the ith robot in the direction angle, is the direction of the i-th robot, k i,1 and k i,2 is a positive constant, is the velocity input of the ith robot in terms of direction angle, f 3i is the deviation of the direction angle of the i-th robot;

[0128] S5: According to the virtual controller, the adaptive rate and the control torque are obtained by using the auxiliary compensation system;

[0129] Specifically, step S5 of the robot path tracking method based on time-delay compensation and input saturation control specifically includes: according to the virtual controller, using the auxiliary compensation system, obtaining the adaptive rate and the control torque, such as the formula:

[0130]

[0131] Θ i =[c d1 d2 m1 m2]

[0132]

[0133]

[0134]

[0135]

[0136] in, is the transpose of the variable matrix defined after simplification, Ω i2 is the speed of the right wheel of the i-th robot, ω i is the angular velocity of the ith robot, Ω i1is the rotation speed of the left wheel of the ith robot, is the rate of change of the expected angular velocity of the left wheel of the ith robot, is the expected rate of change of the angular velocity of the right wheel of the i-th robot, Θ i is the variable matrix defined after simplification, c is the department force, d1 and d2 are the damping coefficients, m1 and m2 are the mass of the robot, is the rate of change of the compensation function of the auxiliary compensation system, M is the mass matrix, τ i (t) is the control torque, τ i (td) is the control torque at time td, d is the time lag, Ω i1c is the expected angular velocity of the left wheel of the ith robot, Ω i2c is the expected angular velocity of the right wheel of the ith robot, is the inverse of the defined known matrix, υ ic is the linear velocity of the ith robot of the virtual controller, ω ic is the angular velocity of the ith robot of the virtual controller, e iΩ is the tracking error of the wheel speed of the ith robot, η1 is the compensation function, M i is the mass matrix of the ith robot, is the rate of change of the tracking error of the wheel speed of the i-th robot, is the jth row in the transposed variable matrix defined after simplification, Θ ij is the jth element of the variable matrix defined after simplification, τ i1 (t) is the left wheel control torque of the ith robot, τ i2 (t) is the right wheel control torque of the ith robot, k i,3 is a normal number, is the adaptation rate, is the transpose of the known matrix defined, π i1 is a positive constant, ij is the jth row in the variable matrix defined after simplification, γ ij , κ ij and θ ij0 is a positive constant;

[0137] S6: obtaining a dynamic compensator according to the adaptive rate and the control torque;

[0138] Specifically, step S6 of the robot path tracking method based on time-delay compensation and input saturation control specifically includes: obtaining a dynamic compensator according to the adaptive rate and the control torque, such as the formula:

[0139]

[0140] Δv sat=sat(v(td(t))-v(td(t))

[0141] Δv delay =v(td(t))-v(t)

[0142] Among them, τ i (t) is the control torque of the ith robot, sat(·) is the saturation function of the input constraint B, sat(v(t)) is the final control torque applied to the robot, v(t) is the control input, sign(v(t)) is the maximum value that the saturation function can take, u(t) is the maximum input, B is a positive constant generated by the controller design program, u M is the limit value of u(t), Δv sat and Δv delay is a dynamic compensator, d(t) is the time lag;

[0143] S7: using the dynamic compensator to obtain a controller; using the controller to control the follower and monitor and track the leader in real time according to the three-dimensional state information of the leader;

[0144] Specifically, step S7 of the robot path tracking method based on time-delay compensation and input saturation control specifically includes: using a dynamic compensator to obtain a controller; using the controller to control the follower and monitor and track the leader in real time according to the three-dimensional state information of the leader, as shown in the formula:

[0145]

[0146]

[0147] Among them, τ i (t) is the control torque, τ i1 (t) is the left wheel control torque of the ith robot, τ i2 (t) is the right wheel control torque of the ith robot, k i,3 is a normal number, is the transpose of the variable matrix defined after simplification, is the adaptation rate, is the transpose of the known matrix defined, π i1 is a positive constant, sat(v(t)) is the final control torque applied to the robot, v(t) is the control input, sign(v(t)) is the maximum value of the saturation function, u(t) is the maximum input, B is a positive constant generated by the controller design program, u M is the boundary value of u(t).

[0148] In some embodiments, the above-mentioned robot path tracking method based on time-delay compensation and input saturation control can also be implemented in the following manner.

[0149] The overall flow chart of this embodiment is as follows: Figure 2 As shown in FIG. 1 , the robot path tracking method based on time-delay compensation and input saturation control mainly includes the following steps:

[0150] S01: Establishing a mathematical model system of mobile robots: The robots in the mathematical model system of mobile robots include: leaders and followers;

[0151] S02: Introduce time-varying gain and design a time-varying distributed observer to obtain the three-dimensional state information of the leader. The three-dimensional state information includes: position information and direction information;

[0152] S03: According to the mathematical model, the under-actuated mathematical model is converted into a fully-actuated mathematical model, and the information of the leader within a specified finite time T is estimated through a time-varying distributed observer to determine the observation state of the leader;

[0153] S04: Using the information observed by the observer, define the local tracking error and design the virtual controller in combination with the finite time function;

[0154] S05: Introduce an auxiliary compensation system to handle the input lag in the controller and obtain the adaptive law and control torque;

[0155] S06: Combine the adaptive law and control torque, consider the input constraints, and design the dynamic compensator;

[0156] S07: Complete the controller design through the dynamic compensator, combine the leader's observation state, and control the followers to monitor and track the leader's state in real time when input delay and input saturation exist at the same time, so as to achieve the formation control goal;

[0157] Among them, the design process of the mathematical model of the mobile robot is as follows: Consider the mathematical model system of the mobile robot, which is described as follows:

[0158]

[0159]

[0160] Let i = 1, ..., N, where υ i and ω i denote linear velocity and angular velocity respectively; and Respectively represent position and direction; Ω i =[Ω i,1 Ω i,2 ] T ,Ω i,1 and Ω i,2Respectively represent the rotation speed of the left and right wheels; τ i (t) is the control torque, d(t) is a bounded time-varying lag, satisfying is a positive constant; the definitions of M, C and D are as follows:

[0161]

[0162] where m1, m2, c, d1 and d2 are all predefined constants; moreover, M is a positive definite matrix; in addition, υ i ,ω i and Ω i satisfy

[0163]

[0164] where b i is half the width of the ith robot, r i is the wheel radius of the ith robot. It can be shown that E i It is reversible;

[0165] The communication in a multi-agent formation can be represented by a directed graph G, where V = {1 2 ... N} represents N followers and the edge set ε represents the communication between each pair of agents. If (i, j) ∈ ε, then the jth follower can receive data from the ith follower. Define the matrix If (i,j)∈ε then a ij =1, if Then a ij = 0; define the Laplace matrix L = DA, where D = diag (υ1,υ2, ...,υ N ), N i represents the neighbors of the ith agent, that is, N i ={j|j∈V|(j,i)∈ε}; define a i0 (i∈V), if the ith agent is connected to the leader, then a i0 =1, otherwise a i0 =0, let a 0i =0; define a directed graph It consists of a directed graph G, node 0, and directed edges from leader 0 to G. Assume Contained in a spanning tree with a leader; based on this, the control problem is designed and solved;

[0166] The above description is an under-actuated model. In order to facilitate control, the under-actuated model needs to be converted into a fully-actuated model, which is described as follows:

[0167]

[0168]

[0169] in,

[0170]

[0171]

[0172] ε 1i and ε 2i is a positive constant, and

[0173] The design process of the observer is as follows: r (t), y r (t) and ψ r (t), design the following leader information:

[0174]

[0175]

[0176] Let q i,1,* is the expected trajectory of the ith robot, * can be viewed as x, y and ψ;

[0177] A distributed estimator is designed for each robot to estimate the leader information in a specified finite time T, and the observer is shown as follows:

[0178]

[0179] in, and is the state of the observer; r>0 and β1∈(1,+∞) are both designed parameters; is a time-varying gain used to estimate the leader’s information within a specified finite time;

[0180] Based on this step, an adaptive tracking controller is designed for each robot;

[0181] The controller design process is as follows: First, the local tracking error is defined as:

[0182]

[0183]

[0184] where υ ic and ω ic is a virtual controller, then the derivative of the local tracking error can be calculated as:

[0185]

[0186]

[0187] in Known Q i is full rank;

[0188] Then, design the virtual controller and virtual update rate as:

[0189]

[0190]

[0191] Among them, k i,1 and k i,2 They are all normal numbers;

[0192] Proof: Consider the following Lyapunov function:

[0193]

[0194] Taking its derivative and substituting it into the above expression, we can get:

[0195]

[0196] where a1 = min{2k 1,1 ,2k 1,2 ,...,2k N,1 ,2k N,2}and

[0197]

[0198]

[0199] Can get Me iΩ The derivative of is:

[0200]

[0201] Define two variables:

[0202]

[0203] Θ i =[c d1 d2 m1 m2]

[0204] On the other hand, an auxiliary compensation system is introduced to deal with input lag, which is defined as:

[0205]

[0206] Where d is the lag time, and the lag function diagram is as follows: Figure 3 As shown:

[0207] At this time, the local error can be obtained:

[0208]

[0209]

[0210] Ξ ij Indicates Ξ i The jth row of ij Represents Θ i The jth element of ;

[0211] The control torque is designed as:

[0212]

[0213] where k i,3 is a normal number, is Θ ij Estimates.

[0214] Adaptive rate Designed for:

[0215]

[0216] where γ ij , κ ij and θ ij0 All are normal numbers;

[0217] In order to solve the problem of input constraints, the following dynamic compensator is proposed. First, let:

[0218]

[0219] If both input constraints and state constraints need to be satisfied, that is, ||u(t)|| ∞ <B, B is a positive constant, where sat(·) is the saturation function of the input constraint B, v(t) is the control input, which is generated by the controller design procedure, and there exists |v(t)|<u M ,u M is an unknown boundary value of u(t), controlling the torque τ i The relationship between (t) and the control input v(t) is as follows Figure 3 As shown; sat(v(t)) is the final control torque applied to the robot, which means that the control torque cannot be very large and is subject to input constraints;

[0220] Finally, we can get:

[0221] Δv sat=sat(v(td(t))-v(td(t))

[0222] Δv delay =v(td(t))-v(t)

[0223] Proof: Consider the following Lyapunov function:

[0224]

[0225] in available for:

[0226]

[0227] According to Young's inequality, we can get:

[0228]

[0229] So we can get:

[0230]

[0231] in

[0232]

[0233]

[0234] Integrating both sides gives:

[0235]

[0236] Indicates e ix , e iy and e iψ Bounded;

[0237] The formation error is defined as: definition:

[0238]

[0239] Where p = 1, 2, it can be proved that:

[0240] s 1,* =(L+B)e 1,* ,s 2,* =(L+B)e 2,*

[0241] Define z i,* =γ1s i,1,* +s i,2,* , and z * =[z 1,*,...,z N,* ] T , for z * Differentiating it yields:

[0242]

[0243] Consider the following Lyapunov function:

[0244]

[0245] Based on u i,* and Young's inequality, we can calculate

[0246]

[0247] in d1=||P(L+B)|| 2 ;

[0248] Next, consider the following Lyapunov function:

[0249] V=V2+V 3,x +V 3,y +V 3,ψ

[0250] It can be calculated that:

[0251]

[0252] in,

[0253]

[0254]

[0255]

[0256] c1=c x +c y +c ψ

[0257] Integrating both sides in t∈[t1,t2) yields:

[0258]

[0259] This embodiment provides a computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, the steps of the robot path tracking method based on time delay compensation and input saturation control are implemented. The storage medium may be a disk, an optical disk, a read-only memory (ROM), a random access memory (RAM), a flash memory, a hard disk drive (HDD) or a solid-state drive (SSD), etc.; the storage medium may also include a combination of the above-mentioned types of memory.

[0260] This embodiment provides a computer device, including a memory, a processor, and a computer program stored in the memory and executable on the processor. When the processor executes the program, the steps of the robot path tracking method based on time-delay compensation and input saturation control are implemented.

[0261] like Figure 5 As shown, the computer device may include: at least one processor 121, such as a CPU (Central Processing Unit), at least one communication interface 123, a memory 124, and at least one communication bus 122. Among them, the communication bus 122 is used to realize the connection and communication between these components. Among them, the communication interface 123 may include a display screen (Display), a keyboard (Keyboard), and the optional communication interface 123 may also include a standard wired interface and a wireless interface. The memory 124 may be a high-speed RAM memory (Random Access Memory, volatile random access memory) or a non-volatile memory (non-volatile memory), such as at least one disk memory. The memory 124 may also be at least one storage device located away from the aforementioned processor 121. Among them, the memory 124 stores an application program, and the processor 121 calls the program code stored in the memory 124 to perform any of the above method steps. Among them, the communication bus 122 may be a peripheral component interconnect (PCI) bus or an extended industry standard architecture (EISA) bus, etc. The communication bus 122 can be divided into an address bus, a data bus, a control bus, etc. For ease of representation, Figure 5Only one line is used to represent it, but it does not mean that there is only one bus or one type of bus. Among them, the memory 124 may include a volatile memory (English: volatile memory), such as a random access memory (English: random-access memory, abbreviated: RAM); the memory may also include a non-volatile memory (English: non-volatile memory), such as a flash memory (English: flash memory), a hard disk drive (English: hard disk drive, abbreviated: HDD) or a solid-state drive (English: solid-state drive, abbreviated: SSD); the memory 124 may also include a combination of the above-mentioned types of memory. Among them, the processor 121 may be a central processing unit (English: central processing unit, abbreviated: CPU), a network processor (English: network processor, abbreviated: NP) or a combination of CPU and NP. Among them, the processor 121 may further include a hardware chip. The above-mentioned hardware chip may be an application-specific integrated circuit (English: application-specific integrated circuit, abbreviated: ASIC), a programmable logic device (English: programmable logic device, abbreviated: PLD) or a combination thereof. The PLD can be a complex programmable logic device (CPLD), a field-programmable gate array (FPGA), a generic array logic (GAL), or any combination thereof. Optionally, the memory 124 is also used to store program instructions. The processor 121 can call the program instructions to implement the robot path tracking method based on time delay compensation and input saturation control as in the present embodiment.

[0262] The embodiments of the present invention are described above in conjunction with the accompanying drawings, but the present invention is not limited to the above-mentioned specific implementation modes, which are merely illustrative rather than restrictive. Under the guidance of the present invention, ordinary technicians in this field can also make many forms without departing from the scope of protection of the present invention and the claims, all of which are within the protection of the present invention.

Claims

1. A robot path tracking method based on time-delay compensation and input saturation control, characterized in that: The following steps are involved: S1: constructing a mobile robot mathematical model system, wherein the mobile robot mathematical model system includes a leader and a follower; S2: using the time-varying gain, constructing a time-varying distributed observer, wherein the time-varying distributed observer is used to obtain the three-dimensional state information of the leader, wherein the three-dimensional state information includes position information and direction information; S3: According to the mobile robot mathematical model system, using virtual controller parameters, a full drive model is obtained; S4: according to the full drive model, using the time-varying distributed observer, obtaining the three-dimensional state information of the leader; according to the three-dimensional state information, using the time-varying distributed observer, constructing a local tracking error and a virtual controller; S5: according to the virtual controller, using the auxiliary compensation system, obtaining an adaptive rate and a control torque; S6: obtaining a dynamic compensator according to the adaptive rate and the control torque; S7: using the dynamic compensator to obtain a controller; and using the controller to control the follower and monitor and track the leader in real time according to the three-dimensional state information of the leader.

2. The robot path tracking method based on time-delay compensation and input saturation control according to claim 1, characterized in that: Step S1 specifically includes: constructing a mobile robot mathematical model system, wherein the mobile robot mathematical model system includes a leader and a follower, such as the formula: Oh i =[Ω i,1 Oh i,2 ] T V = {1 2...N}, (i, j)∈ε L=DA D=diag(υ1,υ2,...,υ N ) N i ={j|j∈V|(j,i)∈ε} in, is the rate of change of the robot's position and orientation, υ i and ω i Respectively represent linear velocity and angular velocity; η i is the position and orientation matrix of the robot in the global coordinate system, Indicates location; Indicates direction; Ω i is the state matrix of the robot's left and right wheel rotation speed, Ω i,1 and Ω i,2 Respectively represent the rotation speed of the left and right wheels; τ i (t) is the control torque, d(t) is a bounded time-varying lag, is a positive constant; M is the mass matrix, C is the Coriolis force matrix, D is the damping matrix, m1, m2, c, d1 and d2 are all predefined constants, M is a positive definite matrix, b i is half the width of the ith robot, r i is the wheel radius of the i-th robot individual. The communication in the multi-agent formation can be represented by a directed graph G. Define a directed graph It consists of a directed graph G, node 0, and directed edges from leader 0 to G. Assume is contained in a spanning tree with a leader; N is the number of followers, ε is the edge set, which represents the communication between each pair of agents. If (i, j)∈ε, it means that the jth follower can receive the data of the ith follower; L is the Laplace matrix, which represents the communication relationship between the leader and the followers, N i represents the neighbors of the ith agent.

3. The robot path tracking method based on time-delay compensation and input saturation control according to claim 1, characterized in that: Step S2 specifically includes: using the time-varying gain to construct a time-varying distributed observer, such as the formula: in, and is the rate of change of the state of the time-varying distributed observer, and is the state of the time-varying distributed observer, r and β1 are design parameters; is the β1 power of the time-varying gain, N is the number of robots, is the observation position of the jth robot, is the observed velocity of the jth robot, μ(t) is the time-varying gain, T is the specified finite time, is the expected speed of the ith robot, q i,2,* is the expected speed of the ith robot, is the input, u i,* (t) is the input, q i,1,* is the expected trajectory of the ith robot, * can be viewed as x, y and ψ; and It is the state of the observer, which is used to estimate the information of the leader within a specified limited time; the time-varying distributed observer is used to obtain the three-dimensional state information of the leader, which includes position information and direction information.

4. The robot path tracking method based on time-delay compensation and input saturation control according to claim 1, characterized in that: Step S3 specifically includes: according to the mobile robot mathematical model system, using the virtual controller parameters, obtaining a full drive model, such as formula: Among them, x i (t) and y i (t) is the position of the ith robot, and is the expected position of the ith robot, R(ψ i (t)) is the rotation matrix, which represents the rotation transformation of the robot at time t, ψ i (t) is the direction of the ith robot, f 1i (ξ i ) is the deviation function of the ith robot in the x direction, f 2i (ξ i ) is the deviation function of the ith robot in the y direction, ξ i are virtual controller parameters, is the desired direction of the ith robot, f 3i (ξ i ) is the deviation function of the ith robot in terms of direction angle, f 1i is the deviation of the ith robot in the x direction, f 2i is the deviation of the ith robot in the y direction, f 3i is the deviation of the ith robot in the direction angle, ε 1i and ε 2i Is a normal number.

5. The robot path tracking method based on time-delay compensation and input saturation control according to claim 1, characterized in that: Step S4 specifically includes: according to the full drive model, using the time-varying distributed observer, estimating the information of the leader within a specified finite time T, observing and updating the observation state of the leader in real time, and obtaining the three-dimensional state information of the leader; according to the three-dimensional state information, using the time-varying distributed observer, constructing a local tracking error and a virtual controller, such as the formula: Among them, e ix is the tracking error of the ith robot in the x direction, x i is the expected trajectory of the ith robot in the x direction, is the observed trajectory of the ith robot in the x direction, e iy is the tracking error of the ith robot in the y direction, y i is the expected trajectory of the ith robot in the y direction, is the observed trajectory of the i-th robot in the y direction, e iψ is the tracking error of the ith robot in terms of direction angle, ψ i is the expected trajectory of the ith robot in terms of direction angle, is the observed trajectory of the ith robot in terms of direction angle, is the linear velocity error of the ith robot, υ i is the expected linear velocity of the ith robot, υ ic is the linear velocity of the ith robot of the virtual controller, is the angular velocity error of the i-th robot, ω i is the expected angular velocity of the ith robot, ω ic is the angular velocity of the ith robot of the virtual controller, is the tracking error change rate of the ith robot in the x direction, is the tracking error change rate of the ith robot in the y direction, Q i is the position vector of the robot in the global coordinate system, is the update rate, R(ψ i ) is the rotation matrix, which represents the rotation transformation of the robot at time t, f 1i is the deviation of the ith robot in the x direction, f 2i is the deviation of the ith robot in the y direction, is the direction change rate of the ith robot, is the observed velocity of the ith robot in the x direction, is the observed velocity of the ith robot in the y direction, is the tracking error change rate of the ith robot in terms of direction angle, f 3i is the deviation of the angular direction of the ith robot, ξ i is the control variable, is the update rate, is the velocity observation value of the ith robot in the direction angle, is the direction of the i-th robot, k i,1 and k i,2 is a positive constant, is the velocity input of the ith robot in terms of direction angle, f 3i is the deviation of the direction angle of the ith robot.

6. The robot path tracking method based on time-delay compensation and input saturation control according to claim 1, characterized in that: Step S5 specifically includes: according to the virtual controller, using the auxiliary compensation system, obtaining the adaptive rate and the control torque, such as the formula: Θ i =[c d1 d2 m1 m2] in, is the transpose of the variable matrix defined after simplification, Ω i2 is the speed of the right wheel of the i-th robot, ω i is the angular velocity of the ith robot, Ω i1 is the rotation speed of the left wheel of the ith robot, is the rate of change of the expected angular velocity of the left wheel of the ith robot, is the expected rate of change of the angular velocity of the right wheel of the i-th robot, Θ i is the variable matrix defined after simplification, c is the department force, d1 and d2 are the damping coefficients, m1 and m2 are the mass of the robot, is the rate of change of the compensation function of the auxiliary compensation system, M is the mass matrix, τ i (t) is the control torque, τ i (td) is the control torque at time td, d is the time lag, Ω i1c is the expected angular velocity of the left wheel of the ith robot, Ω i2c is the expected angular velocity of the right wheel of the ith robot, is the inverse of the defined known matrix, υ ic is the linear velocity of the ith robot of the virtual controller, ω ic is the angular velocity of the ith robot of the virtual controller, e iΩ is the tracking error of the wheel speed of the ith robot, η1 is the compensation function, M i is the mass matrix of the ith robot, is the rate of change of the tracking error of the wheel speed of the i-th robot, is the jth row in the transposed variable matrix defined after simplification, Θ ij is the jth element of the variable matrix defined after simplification, τ i1 (t) is the left wheel control torque of the ith robot, τ i2 (t) is the right wheel control torque of the ith robot, k i,3 is a normal number, is the adaptation rate, is the transpose of the known matrix defined, π i1 is a positive constant, ij is the jth row in the variable matrix defined after simplification, γ ij , κ ij and θ ij0 Is a normal number.

7. The robot path tracking method based on time-delay compensation and input saturation control according to claim 1, characterized in that: Step S6 specifically includes: obtaining a dynamic compensator according to the adaptive rate and the control torque, such as the formula: Δv sat =sat(v(t-d(t))-v(t-d(t)) Δv delay =v(t-d(t))-v(t) Among them, τ i (t) is the control torque of the ith robot, sat(·) is the saturation function of the input constraint B, sat(v(t)) is the final control torque applied to the robot, v(t) is the control input, sign(v(t)) is the maximum value that the saturation function can take, u(t) is the maximum input, B is a positive constant generated by the controller design program, u M is the limit value of u(t), Δv sat and Δv delay is a dynamic compensator and d(t) is the time lag.

8. The robot path tracking method based on time-delay compensation and input saturation control according to claim 1, characterized in that: Step S7 specifically includes: using the dynamic compensator to obtain a controller; and using the controller to control the follower and monitor and track the leader in real time according to the three-dimensional state information of the leader, as shown in the formula: Among them, τ i (t) is the control torque, τ i1 (t) is the left wheel control torque of the ith robot, τ i2 (t) is the right wheel control torque of the ith robot, k i,3 is a normal number, is the transpose of the variable matrix defined after simplification, is the adaptation rate, is the transpose of the known matrix defined, π i1 is a positive constant, sat(v(t)) is the final control torque applied to the robot, v(t) is the control input, sign(v(t)) is the maximum value of the saturation function, u(t) is the maximum input, B is a positive constant generated by the controller design program, u M is the boundary value of u(t).

9. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the steps of the robot path tracking method based on time-delay compensation and input saturation control as claimed in any one of claims 1 to 8 are implemented.

10. A computer device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the program, the steps of the robot path tracking method based on time-delay compensation and input saturation control as claimed in any one of claims 1 to 8 are implemented.

Citation Information

Patent Citations

  • Control method of nonlinear chemical reaction circulation indeterminate time delay system with controller input saturation

    CN103558761A

  • Electro-hydraulic servo system position tracking control method considering input delay constraints

    CN108345268A

  • Method and system for schedule predictive lead compensation

    US20180371936A1

Cited By

  • Underactuated ship motion adaptive control method and device based on meta learning

    CN120010251A

  • Meta-learning-based underactuated ship motion adaptive control method and device

    CN120010251B