Uncertain textile mechanical arm system fixed time impedance control method and system based on disturbance observer

Through the fixed-time impedance control method of the uncertain textile robot system based on disturbance observer, the problems of unknown nonlinear interference and input saturation in the textile robot system are solved, and the stable and efficient impedance tracking control of the system is achieved.

CN120645213APending Publication Date: 2025-09-16QINGDAO UNIV
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202510797859.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2025-06-16
Publication Date
2025-09-16

AI Technical Summary

Technical Problem

When processing flexible materials, textile robotic arm systems face unknown nonlinear interference, unknown friction, input saturation and uncertainty in system model parameters, which can lead to decreased control performance and even hardware failures and safety hazards.

Method used

A fixed-time impedance control method for an uncertain textile robot system based on a disturbance observer is adopted. By establishing an impedance model, a fixed-time fuzzy adaptive impedance controller is designed. The fuzzy logic system is combined to handle unknown friction and uncertain dynamics, and a fixed-time disturbance observer and anti-saturation device are constructed to eliminate the influence of unknown nonlinear disturbances and input saturation.

Benefits of technology

Effectively estimate and compensate for unknown nonlinear interference, improve the system's anti-interference ability and robustness, ensure the control system is stable within a fixed time, reduce tracking errors, and realize impedance tracking control of the robotic arm system.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN120645213A_ABST
    Figure CN120645213A_ABST
Patent Text Reader

Abstract

The invention belongs to the technical field of textile mechanical arm impedance control, and particularly discloses an uncertain textile mechanical arm system fixed time impedance control method and system based on a disturbance observer. The fixed time interference observer designed by the method can effectively estimate and compensate external unknown nonlinear interference signals. Besides, an anti-saturation auxiliary system is further designed to solve the controller design problem caused by input saturation, when the control input does not have a saturation phenomenon, the state of the anti-saturation system is converged to zero, and the influence of the anti-saturation system on the control performance is reduced. In addition, instruction filtering and fuzzy self-adaption technologies are further introduced in the method, and the problems of calculation explosion in backstepping design and unmodeled dynamics and unknown friction existing in a mechanical arm system are solved. According to the method, the influence caused by external unknown nonlinear interference and saturation can be effectively overcome, it is guaranteed that all signals in a closed-loop system are converged within fixed time, and meanwhile a good position tracking effect is achieved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the technical field of textile robot arm impedance control, and in particular relates to a fixed-time impedance control method and system for an uncertain textile robot arm system based on an interference observer. Background Art

[0002] As an important pillar industry of the national economy, the textile industry's production process is highly dependent on the precise manipulation of flexible materials such as yarn, cloth, and fiber. Although the automation transformation of traditional textile machinery such as spinning machines, looms, and sewing machines has achieved mechanization of basic processes, it still faces significant challenges in handling complex flexible materials. For example, insufficient tension control accuracy of yarns will lead to an increased breakage rate, rigid contact when grabbing cloth can easily cause surface wear or wrinkles, and force control deviation of the robot arm during sewing may cause sewing quality defects. The core of these problems lies in the fact that the existing robot arm control system lacks the ability to adapt to the dynamic characteristics of flexible materials, making it difficult to balance material protection and process accuracy while ensuring efficiency.

[0003] In recent years, the development of compliant control technology has provided a new path for the intelligent upgrade of textile manipulators. Through strategies such as force / position hybrid control, impedance control, and adaptive algorithms, compliant control enables the manipulator to dynamically adjust parameters such as stiffness and damping based on environmental feedback, thereby achieving human-like manipulation of flexible materials. For example, impedance control based on force sensors can compensate for the contact force between the manipulator end and the material in real time, preventing damage caused by excessive force. In combination with fuzzy adaptive control strategies, it can identify material properties online and optimize control parameters to meet the needs of different textile processes.

[0004] In response to the core pain points of flexible material processing in the textile industry, and in order to simultaneously achieve the control of the force and position of the end of the robotic arm, an impedance control method is proposed in the existing technology. By establishing an impedance control model and designing the impedance control model parameters, the desired impedance relationship between the position error and the contact force with the environment is obtained. The Kalman filter algorithm is used to optimize the traditional impedance controller to achieve the desired constant force control effect.

[0005] The impedance control method described above is effective for controlling a robotic arm system when the model parameters are precisely known. However, in practical applications, a robotic arm is a nonlinear system, making it difficult to obtain precise mathematical model parameters. Uncertainties often exist in practical robotic arm systems, which can degrade the performance of traditional control methods.

[0006] In engineering practice, robotic arm systems are often affected by unknown nonlinear interference. Such interference usually includes multi-source uncertainties such as complex time-varying friction characteristics and external environmental disturbances. Its nonlinear coupling characteristics significantly increase the difficulty of accurately modeling the robotic arm. This can lead to a decline in control performance and, in extreme cases, may cause hardware failures and pose safety risks. Although the adverse effects of unknown external interference can be eliminated by installing physical force sensors to monitor them in real time, this method not only increases the actual application cost of the robotic arm, but also requires detailed research on its installation location and multiple experimental verifications, which greatly wastes manpower and resources, while also increasing the difficulty of designing the robotic arm control system. Summary of the Invention

[0007] Aiming at the current problems of unknown nonlinear interference, unknown friction, input saturation, and uncertainty of system model parameters affecting the control effect of the textile robot system, as well as the complex derivation of impedance tracking control at the end of the robot in the backstepping design, the present invention proposes a fixed-time impedance control method for an uncertain textile robot system based on a disturbance observer to achieve impedance tracking control of the robot system.

[0008] In order to achieve the above-mentioned purpose, the present invention adopts the following technical solutions:

[0009] A fixed-time impedance control method for an uncertain textile robot system based on a disturbance observer comprises the following steps:

[0010] Step 1. Establish a mathematical model of the dynamics system of an m-joint rigid manipulator with uncertainty. Establish an impedance model based on the impedance relationship between the manipulator end position and the environmental contact force. After coordinate transformation, obtain the dynamics model of the manipulator end in Cartesian space. Here, m is the number of joints in the manipulator system, i.e., the degrees of freedom.

[0011] Step 2. Design a control system for the rigid manipulator system and obtain a fixed-time fuzzy adaptive impedance controller for the uncertain textile manipulator system based on a disturbance observer. The design process is as follows: the rigid manipulator system is designed by combining the command filter backstepping method with a fixed time, and the fuzzy logic system is used to handle the unknown friction and uncertain dynamics of the manipulator system. A fixed-time disturbance observer is constructed to estimate and compensate for unknown nonlinear disturbances. A fixed-time anti-saturation controller is designed to eliminate the impact of saturation on system performance, and finally a true control law is designed.

[0012] Step 3. Use the designed fixed-time fuzzy adaptive impedance controller for the uncertain textile robot system based on disturbance observer to realize impedance tracking control of the robot system.

[0013] In addition, based on the fixed-time impedance control method of an uncertain textile manipulator system based on a disturbance observer, the present invention also proposes a fixed-time impedance control system of an uncertain textile manipulator system based on a disturbance observer, and its technical solution is as follows:

[0014] A fixed-time impedance control system for an uncertain textile robot system based on a disturbance observer includes the following modules:

[0015] The model building module is used to establish a mathematical model of the dynamic system of an m-joint rigid manipulator with uncertainty. The impedance model is established based on the impedance relationship between the position of the manipulator end and the environmental contact force. After coordinate transformation, the dynamic model of the manipulator end in Cartesian space is obtained. Where m is the number of joints in the manipulator system, i.e., the degree of freedom.

[0016] The controller design module is used to design the control of a rigid manipulator system. It obtains a fixed-time fuzzy adaptive impedance controller for an uncertain textile manipulator system based on a disturbance observer. The design process is as follows: the rigid manipulator system is designed by combining command filter backstepping with fixed time, and the unknown friction and uncertain dynamics of the manipulator system are handled by a fuzzy logic system. A fixed-time disturbance observer is constructed to estimate and compensate for unknown nonlinear disturbances. A fixed-time anti-saturation controller is designed to eliminate the impact of saturation on system performance, ultimately designing a true control law.

[0017] And a tracking control module is used to realize impedance tracking control of the robotic arm system by utilizing the designed fixed-time fuzzy adaptive impedance controller of the uncertain textile robotic arm system based on disturbance observer.

[0018] In addition, based on the above-mentioned fixed-time impedance control method for an uncertain textile robot system based on a disturbance observer, the present invention further proposes a computer device, which includes a memory and one or more processors.

[0019] The memory stores executable codes, and when the processor executes the executable codes, it is used to implement the steps of the above-mentioned method for controlling the fixed-time impedance of the textile robot arm system considering nonlinear interference and input saturation.

[0020] Furthermore, based on the aforementioned method for controlling a fixed-time impedance of a textile robot arm system considering nonlinear interference and input saturation, the present invention further provides a computer-readable storage medium storing a program. When executed by a processor, the program implements the steps of the aforementioned method for controlling a fixed-time impedance of a textile robot arm system based on an uncertain disturbance observer.

[0021] The present invention has the following advantages:

[0022] As described above, the present invention describes a fixed-time impedance control method for an uncertain textile manipulator system based on a disturbance observer. First, to eliminate the effects of mathematical model uncertainty and unknown friction, the present method incorporates fuzzy adaptive technology into the design of the textile manipulator controller. This method employs an adaptive fuzzy logic system and fixed-time backstepping to address the system's uncertainty and unknown friction, achieving impedance control. Furthermore, the present method employs a fixed-time disturbance observer to effectively estimate and compensate for unknown nonlinear disturbances, designing a disturbance control strategy to enhance the manipulator control system's anti-interference capability and thus improve the system's tracking performance. Furthermore, the present method incorporates an anti-saturation auxiliary system to address controller design issues caused by input saturation and construct a true control law. The present invention employs an improved smoothing function to approximate saturated inputs to obtain smooth control inputs. Furthermore, when the control input is not saturated, the anti-saturation system state converges to zero, minimizing its impact on control performance and achieving fixed-time stability. The present method effectively overcomes the effects of external unknown nonlinear disturbances and saturation, ensuring that all signals within the closed-loop system converge within a fixed time. Furthermore, the manipulator system controlled using the present method exhibits lower tracking error and better position tracking. BRIEF DESCRIPTION OF THE DRAWINGS

[0023] Figure 1 4 is a flowchart of a fixed-time impedance control method for an uncertain textile robot system based on a disturbance observer in an embodiment of the present invention.

[0024] Figure 2 4 is a control block diagram of a fixed-time impedance control method for an uncertain textile robot arm system based on a disturbance observer in an embodiment of the present invention.

[0025] Figure 3 Schematic diagram of a two-link textile robot arm model using the control method of the present invention.

[0026] Figure 4 The control input waveform of the two-link textile robot arm system using the control method of the present invention is Figure 1 .

[0027] Figure 5 The control input waveform of the two-link textile robot arm system using the control method of the present invention is Figure 2 .

[0028] Figure 6 The tracking response curve of the end position and the desired position of the two-link textile robot arm controlled by the method of the present invention Figure 1 .

[0029] Figure 7 The tracking response curve of the end position and the desired position of the two-link textile robot arm controlled by the method of the present invention Figure 2 .

[0030] Figure 8 The response curve of the tracking error between the end position and the desired position of the two-link textile robot arm using the control method of the present invention is shown in FIG. Figure 1 .

[0031] Figure 9 The response curve of the tracking error between the end position and the desired position of the two-link textile robot arm using the control method of the present invention is shown in FIG. Figure 2 .

[0032] Figure 10 Schematic diagram of the position tracking curve of the end of the robotic arm in the x-axis direction at a fixed time.

[0033] Figure 11 Schematic diagram of the position tracking curve of the end of the robotic arm in the y-axis direction at a fixed time.

[0034] Figure 12 The interference estimation error curve of the two-link textile robot arm using the control method of the present invention is shown in FIG. Figure 1 .

[0035] Figure 13 The interference estimation error curve of the two-link textile robot arm using the control method of the present invention is shown in FIG. Figure 2 . DETAILED DESCRIPTION

[0036] The present invention will be further described in detail below with reference to the accompanying drawings and specific embodiments:

[0037] Example 1

[0038] This embodiment addresses the current challenges of unknown nonlinear interference, unknown friction, input saturation, and uncertain system model parameters that can affect the control performance of a textile manipulator system, as well as the complexity of derivation of impedance tracking control at the manipulator end in backstepping design. A fixed-time impedance control method for an uncertain textile manipulator system based on a disturbance observer is proposed to achieve impedance tracking control of the manipulator system. This method employs a fixed-time disturbance observer to effectively estimate and compensate for external unknown nonlinear interference signals, improving the system's interference rejection and robustness. Furthermore, the method incorporates an anti-saturation auxiliary system to address controller design issues caused by input saturation and construct a true control law. An improved smoothing function is used to approximate the saturated input to obtain a smooth control input. When the control input is not saturated, the anti-saturation system state converges to zero, minimizing its impact on control performance. Furthermore, the method incorporates command filtering and fuzzy adaptive techniques to address computational explosion in backstepping design, as well as unmodeled dynamics and unknown friction in the manipulator system. Stability analysis demonstrates that all signals in the closed-loop system employing the control method are fixed-time bounded. Finally, the present invention also provides a simulation experiment, which verifies the effectiveness of the control method proposed in the present invention.

[0039] like Figure 1 As shown in FIG, a fixed-time impedance control method for an uncertain textile robot system based on a disturbance observer specifically includes the following steps:

[0040] Step 1. Establish a mathematical model of the dynamic system of an m-joint rigid manipulator with uncertainty. Establish an impedance model based on the impedance relationship between the position of the manipulator end and the environmental contact force. After coordinate transformation, obtain the dynamic model of the manipulator end in Cartesian space; where m is the number of joints in the manipulator system, i.e., the degree of freedom.

[0041] In step 1, the mathematical model of the dynamic system of the m-joint rigid manipulator with uncertainty is shown in formula (1):

[0042]

[0043] Where q represents the joint position vector, q∈R m ; represents the joint velocity vector, Represents the joint acceleration vector; D(q) is the positive definite inertia matrix, D(q)∈R m*m ; is the centrifugal force and Coriolis force matrix, G(q) represents the gravity vector, G(q)∈R m*1 ; u is the joint input torque vector, u∈R m*1; J(q) is the Jacobian transformation matrix, J(q)∈R n*m , n is the motion space dimension of the robotic arm system, n∈N + ; τ e is the constraint force vector imposed by the unknown environment on the end of the robotic arm, τ e ∈R n*1 ;f d is the unknown nonlinear interference vector, f d ∈R n*1 .

[0044] The impedance model established based on the impedance relationship between the end position of the manipulator and the environmental contact force is shown in formula (2):

[0045]

[0046] Where M represents the desired inertia matrix of the manipulator, M∈R n*n ; B represents the desired damping matrix of the manipulator, B∈R n *n ; K represents the desired rigidity matrix of the manipulator, K∈R n*n ; e represents the position error variable, e = x d -x,x d Indicates the command trajectory, x d =[x d1 ,x d2 ,...,x dn ] T ∈R n , where x d1 ,x d2 ,...,x dn Represents x d The command trajectory of each component in different dimensions of the motion space.

[0047] Define x, Represent the position, velocity and acceleration of the end of the manipulator in Cartesian space, where x∈R n×1 、 After coordinate transformation, x, With q, The relationship between them is:

[0048]

[0049] Further calculations reveal that:

[0050]

[0051] x、 With q, Substituting the relationship between into formula (1), we can obtain the dynamic model of the end of the manipulator in Cartesian space as shown in formula (3):

[0052]

[0053] Among them, D x =J -T (q)D(q)J -1 (q), G x =J -T (q)G(q), τ is the control input, τ=J -T (q)u.

[0054] Define x1=x=[x 11 ,...,x 1n ] T , x 11 ,...,x 1n Indicates the position of the end of the robotic arm in different dimensions of the motion space, x 21 ,...,x 2n Represents the speed of the end of the manipulator in different dimensions of the motion space, and formula (3) is rewritten as:

[0055]

[0056] Among them, S(τ)=[S(τ1),...,S(τ n )] T is the control input affected by saturation nonlinearity, S(τ1) to S(τ n ) represent the 1st to nth components of the vector S(τ) respectively.

[0057] Each component S(τ) in the vector S(τ) i ) is expressed as:

[0058]

[0059] Among them, sat(τ i ) represents the input saturation function, i=1,2,...,n; τ imax and τ imax Represent the control input signal τ i The maximum and minimum values ​​of τ imax and τ imax are all constants, τ imax >0,τ imax > 0. The above input saturation nonlinearity is not smooth and has two peaks, so the control input cannot be directly designed.

[0060] To approximate the input saturation nonlinearity, define H(τ)=[h1(τ1),...,h n (τ n )] T , h1(τ1) to h n (τ n ) represent the 1st to nth components of the vector H(τ); each component h in the vector H(τ) i (τ i ) is defined as shown in formula (6):

[0061]

[0062] Among them, μ i ∈(0,1), and u imin The definition of is shown in formula (7):

[0063]

[0064] Define the approximate error Y(τ)=[y1(τ1),...,y n (τ n )] T , y1(τ1) to y n (τ n ) represent the 1st to nth components of vector Y(τ), and each component y in vector Y(τ) i (τ i ) is defined as follows:

[0065] |y i (τ i )|=|sat(τ i )-h i (τ i )|≤max{τ imax (1-tanh(1)),τ imin (1-tanh(1))}=P i .

[0066] Among them, P i is a bounded real number.

[0067] Therefore S(τ i ) is rewritten as S(τ i )=h i (τ i )+y i (τ i ).

[0068] Since S(τ i ),h i (τ i ),yi (τ i ) are each component of the vectors S(τ), H(τ), and Y(τ), respectively. The addition and subtraction of vectors are equal to the addition and subtraction of each corresponding component. Therefore, S(τ) is written as S(τ)=H(τ)+Y(τ).

[0069] In step 1, when x accurately tracks the desired trajectory x r When x=x r ; When the end of the manipulator moves in free space, τ e =0, expected trajectory x r With command trajectory x d Consistent, that is, x r =x d .

[0070] Step 2. Control design is performed on the rigid manipulator system to obtain a fixed-time fuzzy adaptive impedance controller for the uncertain textile manipulator system based on the disturbance observer. The design process is as follows: the command filter backstepping method and fixed time are combined to design the rigid manipulator system, and the fuzzy logic system is used to deal with the unknown friction and uncertain dynamics of the manipulator system; a fixed-time disturbance observer is constructed to estimate and compensate for unknown nonlinear disturbances; a fixed-time anti-saturation device is designed to eliminate the impact of saturation on system performance, and finally a true control law is designed.

[0071] Construct a fixed-time command filter as shown in formula (8):

[0072]

[0073] Define x i,c =z i,1 is the output of the fixed time command filter; z i,2 represents the output signal of the fixed-time command filter, σ i,0 =z i,1 -α i , α i is the input of the fixed time command filter; R1, R2, r represent the fixed time command filter parameters, and sig(σ i,0 ) β =|σ i,0 | β sign(σ i,0 ),in,

[0074] When the filter input signal α i When not affected by noise, α i =a0, then after selecting parameters R1>0, R2>0, the fixed time instruction filter can reach stability in a fixed time; when the input of the filter is affected by noise, Select parameters R1>0, R2>0, and the following inequality group holds:

[0075]

[0076] Among them, z i,1 It represents the output of the fixed time command filter, a0 represents the filter input signal, represents a positive constant, and γ1 are positive constants determined by the filter; Is a positive number.

[0077] Define the tracking error variable as shown in formula (8):

[0078]

[0079] Among them, ζ1 and ζ2 represent tracking error variables, ζ 11 To 1n Respectively represent the 1st to nth components of ζ1; ζ 21 To 2n Represent the 1st to nth components of ζ2 respectively; x r represents the expected trajectory.

[0080] Define x 1,c =[x 1,c1 ,...,x 1,cn ] T The input is α1=[α 11 ,...,α 1n ] T The fixed time command filter output when α1 is the virtual control law in the backstepping design, α 11 to α 1n represents the 1st to nth components of α1, x 1,c1 to x 1,cn Represents x 1,c The 1st to nth components of ; According to the set fixed time command filter, in is a constant, to express The 1st to nth components of .

[0081] The error vector after compensation is defined as shown in formula (9):

[0082]

[0083] Among them, v1 and v2 represent compensation errors, v 11 to v 1nRepresent the 1st to nth components of v1 respectively; v 21 to v 2n Represent the 1st to nth components of v2 respectively; ξ1=[ξ 11 ,...,ξ 1n ] T and ξ2=[ξ 21 ,...,ξ 2n ] T represents the filtering error compensation signal; ξ 11 To 1n Represent the 1st to nth components of ξ1, ξ 21 To 2n represent the 1st to nth components of ξ2 respectively; It is an anti-saturation signal.

[0084] Design the virtual control law α1 and the filtered error compensation signal ξ1.

[0085] Select the Lyapunov function V1 as: Taking the derivative of V1 we get:

[0086]

[0087] Among them, x d Indicates the command trajectory.

[0088] The virtual control law α1 and the filter error compensation signal ξ1 are shown in formula (12):

[0089]

[0090] Among them, c 11 、c 12 、g 11 、g 12 is the system control gain, c 11 >0,c 12 >0,g 11 >0,g 12 >0; p and q are positive constants, 0 < p < 1, q > 1.

[0091] Substituting formula (12) into formula (11) yields:

[0092]

[0093] Select the Lyapunov function V2 as:

[0094] Where η is a positive constant, η>0; define θ=max{||W1|| 2 ,||W2|| 2 ,...,||Wn || 2}, where || W i || represents the norm of the weight vector function, the estimated error for: is an estimate of θ.

[0095] Taking the derivative of V2 we get:

[0096]

[0097] Among them, f n (q) represents the unknown friction term, C x and G x Indicates that dynamics are not modeled.

[0098] Design the anti-saturation auxiliary system as shown in formula (15), that is, the fixed-time anti-saturation device:

[0099]

[0100] in, To control the gain.

[0101] Substituting formula (15) into formula (14) yields:

[0102]

[0103] Among them, f(Z) is the unknown nonlinear term, Define the nonlinear function f(Z)=[f1(Z),...,f n (Z)] T , f1(Z) to f n (Z) represents the 1st to nth components of f(Z) respectively.

[0104] According to the universal approximation theorem, for any small constant ε i > 0, there exists a fuzzy logic function W i T S(Z),W i represents the weight vector function, S(Z) represents the basis vector function, so that f i (Z)=W i T S(Z)+δ i ; Among them, δ i is the approximation error, δ i ≤ε i .

[0105] According to Young's inequality and v2=[v 21 ,...,v 2n ] T get:

[0106]

[0107] Wherein, l is a constant and l>0.

[0108] The control input τ is the real control law, and the control input τ, the filter error compensation signal ξ2 and the adaptive law are designed. for:

[0109]

[0110] Among them, m 11 、m 12 is the correction parameter, m 11 >0,m 12 >0; is the unknown nonlinear disturbance f d The estimated value of is the interference estimation signal; Substituting formula (17) to formula (20) into formula (16) yields:

[0111]

[0112] in, is the unknown interference f d The estimation error.

[0113] Design a fixed-time disturbance observer as shown in formula (22):

[0114]

[0115] Where λ and κ are observer gains, λ>0, κ>0; k d is a positive constant, k d >0.

[0116] Select this Lyapunov function V3 as: Its derivative is:

[0117]

[0118] According to the fixed-time interference observer designed by formula (22), Rewritten as:

[0119]

[0120] At this point, the design of the fixed-time fuzzy adaptive impedance controller for the uncertain textile manipulator system based on the disturbance observer is completed, and the design of the fixed-time fuzzy adaptive impedance controller for the uncertain textile manipulator system based on the disturbance observer is obtained as follows:

[0121]

[0122] In step 2, after completing the design of the fixed-time fuzzy adaptive impedance controller for the uncertain textile robot system based on the disturbance observer, the Lyapunov function of the robot system is selected for derivation to prove that the robot system controlled by the designed fixed-time fuzzy adaptive impedance controller for the uncertain textile robot system based on the disturbance observer is Lyapunov stable.

[0123] Specifically, the process of proving the Lyapunov stability of the robotic arm system controlled by the designed fixed-time fuzzy adaptive impedance controller for the uncertain textile robotic arm system based on disturbance observer is as follows:

[0124] κ(μ,v) is a real-valued function, μ and v are the independent variables in the real-valued function κ(μ,v); when 0<p<1, q>1 and κ(μ,v)>0, the following inequality holds:

[0125]

[0126] We get the inequality shown in formula (25):

[0127]

[0128] Among them, b=1,2, j=1,...,n, m=p,q.

[0129] Because for any c>0, s≤c, w≥0, g>0, k>0, the inequality s 1+k -c 1+k ≤(cs) 1+k , Established, so The calculation of is shown in formula (26):

[0130]

[0131] Substituting formula (25) and formula (26) into formula (24), we obtain:

[0132]

[0133] Considering compensation signals ξ1, ξ2 and anti-saturation signal The Lyapunov function V3 is:

[0134]

[0135] Derivative V3 and substitute formula (12), formula (15), and formula (19) into formula (28) to obtain:

[0136]

[0137] According to the set fixed time command filter, we get: is a constant, And for any v b ∈R, b=1,2, we have:

[0138]

[0139] Among them, 0<r≤1, k l >1.

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

[0141]

[0142] Where Δτ represents the difference between the control input τ and the saturation input S(τ), Δτ = S(τ) - τ, and Δτ is a bounded constant. The Lyapunov function V is selected as:

[0143] V=V2+V3 (36)

[0144] Derivative V and substitute formula (27), formula (29) to formula (35) to obtain:

[0145]

[0146] in:

[0147]

[0148] Because the command trajectory x d is continuously bounded, and its first-order and second-order derivatives are continuously bounded. There exists a constant ω, 0<ω<1, such that v b,j ,ξ b,j 、 and Converges to a compact set:

[0149]

[0150] Formula (38) shows that the v of the robotic arm system is b,j ,ξ b,j 、 and is bounded in fixed time and converges in time T r for:

[0151]

[0152] Because z1=v1+ξ1, v1 and ξ1 are bounded, the tracking error ζ1 is bounded. By selecting parameters, ζ1 converges to a sufficiently small area near the origin within a fixed time, so that the robotic arm system is stable.

[0153] Step 3. Use the designed fixed-time fuzzy adaptive impedance controller for the uncertain textile robot system based on disturbance observer to realize impedance tracking control of the robot system.

[0154] Specifically, the preset command trajectory x d , the constraint force vector τ imposed by the unknown environment on the end of the robot arm e and the output of the end position of the manipulator x are input into the impedance model shown in formula (2), and the desired trajectory x is obtained from the impedance model r ; The output of the end position of the robot x and the expected trajectory x r The difference ζ1 is input into the fixed-time fuzzy adaptive impedance controller of the uncertain textile manipulator system based on the disturbance observer shown in formula (18), and the end position x and speed of the manipulator system are The two output quantities are input into the fixed-time fuzzy adaptive impedance controller of the uncertain textile manipulator system based on the disturbance observer to generate the control input signal τ. The control input signal τ is subjected to the input saturation limit as shown in formula (5) to obtain the saturated input signal S(τ). The saturated input signal S(τ) acts on the textile manipulator system to obtain the position x and velocity of the manipulator end. Using the fixed time anti-saturation device shown in formula (15), the required signal x, S(τ) is input to the fixed time anti-saturation device to generate the anti-saturation signal At the same time, the required signal x, S(τ), τ e 、f d Input into the fixed-time interference observer shown in formula (22) to generate the interference estimation signal Then the interference estimation signal and anti-saturation signal The signal is sent to the fixed-time fuzzy adaptive impedance controller of the uncertain textile robot system based on the disturbance observer to generate the control input signal τ. The entire control process is a closed-loop control, thereby achieving overall control of the robot system.

[0155] In addition, to verify the effectiveness of the method of the present invention, the present invention also uses the method of the present invention to simulate and verify the two-link robotic arm system in the MATLAB / Simulink environment. The connecting rod parameters are shown in Table 1.

[0156] Table 1 Connecting rod parameters

[0157]

[0158] Figure 3 The schematic diagram of the two-link robot model after the control method of the present invention is adopted. The experiment of the present invention method uses a two-joint robot arm, and the system parameter values ​​of the robot arm are shown in Table 1, where b = 1, 2, l b Represents the length of the bth connecting rod, its unit is m. cb Represents the distance from the b-1 joint to the center of mass of link b, in m. b Represents the mass of the b-th connecting rod, and its unit is kg. b Represents the moment of inertia of connecting rod b, its unit is kg·m 2 From formula (1), we can know the dynamic model of the system, the system matrix D(q), C(q, ), G(q) and Jacobian matrix J(q) are defined as:

[0159]

[0160] in,

[0161] G 11 =(m1l c2 +m2l1)gcosq1+m2l c2 gcos(q1+q2), G 21 =m2l c2 gcos(q1+q2). q1 represents the angle between the first joint and the x-axis joint, q2 represents the angle between the second joint and the first joint, and g represents the acceleration due to gravity.

[0162] The parameters of the fixed-time disturbance observer are selected as: λ = 100, k d =diag[0.1,0.1].

[0163] Select the unknown nonlinear interference as: f d =[5sin(t)cos(t)+sin(t)+1,2sin(t)cos(t)+cos(t)-1] T .

[0164] The unknown joint friction is: f n (q)=[0.1q(1),0.1q(2)] T .

[0165] The desired impedance parameters of the manipulator system are: M = diag[1,1], B = diag[15,15], K = [60,60].

[0166] The command trace is: x d=[0.7-0.2cos(t),0.7+0.2sin(t)] T .

[0167] At x = 0.8 m, there is an obstacle perpendicular to the X axis. The end of the robotic arm moves along the commanded trajectory. When it encounters a wall, it moves along the wall until it leaves the wall and continues to follow the desired trajectory.

[0168] Select the parameters of the fixed-time fuzzy adaptive impedance controller for the uncertain textile robot system based on disturbance observer:

[0169] c 11 =c 21 =diag[18,35];c 12 =c 22 =diag[8,20]; g 11 =g 21 =4.8;g 12 =g 22 =3.

[0170] The fixed time filter parameters are: R1=25; R2=10; r=1.

[0171] A fixed-time anti-saturation filter is designed to deal with the impact of input saturation, and its parameters are:

[0172] The initial state is selected as: express The initial value of .

[0173] Initial value selection: x1(0)=[0.502,0.702] T , x2(0)=[0,0.2] T , x1(0) represents the initial value of x1, and x2(0) represents the initial value of x2.

[0174] The adaptive parameters are all: l=2.

[0175] The initial value of the filter error compensation signal is selected as: ξ1(0)=ξ2(0)=[0,0] T , ξ1(0) represents the initial value of ξ1, and ξ2(0) represents the initial value of ξ2.

[0176] In order to show that the fixed time convergence is not affected by the initial value of the system, three different sets of system initial values ​​are selected:

[0177] x1(0)=[0.54,0.72] T , x1(0)=[0.46,0.66] T , x1(0)=[0.57,0.64]T .

[0178] x2(0) is always selected as x2(0)=[0,0.2] T .

[0179] The corresponding simulation results are as follows Figures 4 to 13 As shown. Among them:

[0180] Figure 4 and Figure 5 is the control input of the fixed-time anti-saturation impedance controller designed to handle the influence of input saturation, where τ1 represents the control input of the manipulator without saturation in the x-axis direction, τ2 represents the control input of the manipulator without saturation in the y-axis direction, S(τ1) represents the actual control input of the manipulator affected by saturation in the x-axis direction, and S(τ2) represents the actual control input of the manipulator affected by saturation in the y-axis direction; Figure 6 and Figure 7 For its tracking effect, where x 11 Indicates the motion trajectory of the end of the robotic arm in the x-axis direction, x 12 Indicates the motion trajectory of the end of the robot arm in the y-axis direction, x d1 Indicates the desired motion trajectory of the end of the robot arm in the x-axis direction, x d2 Indicates the desired motion trajectory of the end of the robotic arm in the y-axis direction; Figure 8 and Figure 9 Its tracking error, ζ 11 represents the tracking error of the end of the robot arm in the x-axis direction, ζ 12 Indicates the tracking error of the robot end in the y-axis direction.

[0181] Depend on Figures 4 to 9 It can be seen that although the input signal of the control system is affected by input saturation, its tracking error is still within a very small range, and saturation has little effect on the tracking effect of the system.

[0182] Figure 10 and Figure 11 The tracking effects of three sets of fixed time controllers with different initial values ​​are shown in Figure 1, namely, the tracking effects of three sets of fixed time controllers with different initial values ​​selected for the two-link textile robot arm system using the control method of the present invention. Figure 10 A schematic diagram showing the position tracking curve of the end of the robotic arm in the x-axis direction at a fixed time, x 11 (0) represents x 11 The initial value of Figure 11 Schematic diagram of the position tracking curve of the end of the robotic arm in the y-axis direction at a fixed time, 12 (0) represents x 12 The initial value of .

[0183] Depend on Figure 10 and Figure 11 It can be seen that by selecting three groups of different initial values ​​and comparing the x-axis and y-axis position tracking effects, the fixed-time fuzzy adaptive impedance controller of the uncertain textile robot system based on the disturbance observer can quickly track the desired signal.

[0184] Figure 12 and Figure 13 Interference estimation error curve of the two-link textile robot arm using the control method of the present invention, where f d1 and f d2 is the unknown nonlinear interference, f d1 The estimated value of f d2 The method of the present invention constructs a novel fixed-time disturbance observer that can efficiently estimate and compensate for unknown disturbances, successfully overcoming the limitations of previous disturbance observer design and analysis of multi-dependent linear systems. Figure 12 and Figure 13 It can be seen that the fixed-time disturbance observer of the method of the present invention can effectively observe unknown nonlinear disturbances.

[0185] The effectiveness of the proposed control method was verified through stability analysis and simulation comparison. In summary, both theoretical stability demonstration and simulation results demonstrate that the proposed method achieves the desired goal of improving control effectiveness and reducing derivation and computational complexity under the influence of nonlinear interference and input saturation. Therefore, the proposed control method can effectively overcome the effects of nonlinear interference and input saturation, achieve good position tracking, and ensure that all signals within the closed-loop system are fixed-time bounded.

[0186] Aiming at the core pain points of flexible material processing in the textile industry, this paper proposes a fixed-time impedance control method for an uncertain textile robot system based on an interference observer. This method introduces a fixed-time interference observer into the control design of the textile robot, improving the system control performance.

[0187] The method of the present invention designs a fixed-time interference observer to effectively estimate and compensate for external unknown nonlinear interference signals, thereby improving the anti-interference ability and robustness of the system. At the same time, the method of the present invention designs an anti-saturation system, solves the controller design problem caused by input saturation, and constructs a true control law. It uses an improved smooth function to approximate the saturated input to obtain a smooth control input. And when the control input does not saturate, the state of the anti-saturation system converges to zero, reducing its impact on the control performance. In addition, the method of the present invention also introduces command filtering and fuzzy adaptive technology to solve the problems of computational explosion in backstepping design and the existence of unmodeled dynamics and unknown friction in the robotic arm system. The method of the present invention can effectively overcome the influence of external unknown nonlinear interference and saturation, ensure that all signals in the closed-loop system converge at a fixed time, and have a good position tracking effect.

[0188] Example 2

[0189] This embodiment 2 describes a fixed-time impedance control system for an uncertain textile robot system based on a disturbance observer. This system is based on the same inventive concept as the fixed-time impedance control method for an uncertain textile robot system based on a disturbance observer in the above embodiment 1. The system of the present invention specifically includes the following modules:

[0190] The model building module is used to establish a mathematical model of the dynamic system of an m-joint rigid manipulator with uncertainty. The impedance model is established based on the impedance relationship between the position of the manipulator end and the environmental contact force. After coordinate transformation, the dynamic model of the manipulator end in Cartesian space is obtained; where m is the number of joints in the manipulator system, that is, the degree of freedom.

[0191] The controller design module is used to perform control design on the rigid manipulator system and obtain a fixed-time fuzzy adaptive impedance controller for the uncertain textile manipulator system based on the disturbance observer. The design process is as follows: the command filter backstepping method and fixed time are combined to design the rigid manipulator system, and the fuzzy logic system is used to handle the unknown friction and uncertain dynamics of the manipulator system; a fixed-time disturbance observer is constructed to estimate and compensate for unknown nonlinear disturbances; a fixed-time anti-saturation device is designed to eliminate the impact of saturation on system performance, and finally a true control law is designed.

[0192] And a tracking control module is used to realize impedance tracking control of the robotic arm system by utilizing the designed fixed-time fuzzy adaptive impedance controller of the uncertain textile robotic arm system based on disturbance observer.

[0193] It should be noted that the implementation process of the functions and effects of each functional module in the fixed-time impedance control system of the uncertain textile robot arm system based on the interference observer is specifically described in the implementation process of the corresponding steps in the fixed-time impedance control method of the uncertain textile robot arm system based on the interference observer in the above-mentioned Example 1, and will not be repeated here.

[0194] Example 3

[0195] This embodiment 3 describes a computer device, which is used to implement the fixed-time impedance control method for an uncertain textile robot arm system based on a disturbance observer described in the above embodiment 1.

[0196] Specifically, the computer device includes a memory and one or more processors.

[0197] The memory stores executable codes, which are used to implement the steps of the above-mentioned method for controlling the fixed-time impedance of an uncertain textile robot arm system based on a disturbance observer when the processor executes the executable codes.

[0198] In this embodiment, the computer device is any device or apparatus with data processing capability, which will not be described in detail here.

[0199] Example 4

[0200] This embodiment 4 describes a computer-readable storage medium, which is used to implement the fixed-time impedance control method for an uncertain textile robot arm system based on a disturbance observer described in the above embodiment 1.

[0201] Specifically, the computer-readable storage medium in this embodiment 4 stores a program thereon, and when the program is executed by the processor, it is used to implement the steps of the above-mentioned method for controlling the fixed-time impedance of the uncertain textile robot arm system based on the interference observer.

[0202] The computer-readable storage medium can be an internal storage unit of any device or apparatus with data processing capabilities, such as a hard disk or memory, or an external storage device of any device with data processing capabilities, such as a plug-in hard disk, smart media card (SMC), SD card, flash card, etc. equipped on the device.

[0203] Of course, the above description is only a preferred embodiment of the present invention, and the present invention is not limited to the above-mentioned embodiments. It should be noted that all equivalent substitutions and obvious deformation forms made by any technician familiar with this field under the guidance of this specification fall within the substantive scope of this specification and should be protected by the present invention.

Claims

1. A fixed-time impedance control method for an uncertain textile robot system based on a disturbance observer, characterized in that: The steps include: Step 1. Establish a mathematical model of the dynamics system of an m-joint rigid manipulator with uncertainty. Establish an impedance model based on the impedance relationship between the manipulator end position and the environmental contact force. After coordinate transformation, obtain the dynamics model of the manipulator end in Cartesian space. Here, m is the number of joints in the manipulator system, i.e., the degrees of freedom. Step 2. Design a control system for the rigid manipulator system and obtain a fixed-time fuzzy adaptive impedance controller for the uncertain textile manipulator system based on a disturbance observer. The design process is as follows: the rigid manipulator system is designed by combining the command filter backstepping method with a fixed time, and the fuzzy logic system is used to handle the unknown friction and uncertain dynamics of the manipulator system. A fixed-time disturbance observer is constructed to estimate and compensate for unknown nonlinear disturbances. A fixed-time anti-saturation controller is designed to eliminate the impact of saturation on system performance, and finally a true control law is designed. Step 3. Use the designed fixed-time fuzzy adaptive impedance controller for the uncertain textile robot system based on disturbance observer to realize impedance tracking control of the robot system.

2. The method for controlling the uncertain fixed-time impedance of a textile robot system based on a disturbance observer according to claim 1 is characterized in that: In step 1, the mathematical model of the m-joint rigid manipulator dynamics system with uncertainty is shown in formula (1): Where q represents the joint position vector, q∈R m ; represents the joint velocity vector, Represents the joint acceleration vector; D(q) is the positive definite inertia matrix, D(q)∈R m*m ; is the centrifugal force and Coriolis force matrix, G(q) represents the gravity vector, G(q)∈R m*1 ; u is the joint input torque vector, u∈R m*1 ; J(q) is the Jacobian transformation matrix, J(q)∈R n*m , n is the motion space dimension of the robotic arm system, n∈N + ; τ e is the constraint force vector imposed by the unknown environment on the end of the robotic arm, τ e ∈R n*1 ;f d is the unknown nonlinear interference vector, f d ∈R n*1 ; According to the impedance relationship between the end position of the manipulator and the environmental contact force, an impedance model as shown in formula (2) is established: Where M represents the desired inertia matrix of the manipulator, M∈R n*n ; B represents the desired damping matrix of the manipulator, B∈R n*n ; K represents the desired rigidity matrix of the manipulator, K∈R n*n ; e represents the position error variable, e = x d -x,x d Indicates the command trajectory, x d =[x d1 ,x d2 ,...,x dn ] T ∈R n , where x d1 to x dn Represents x d The command trajectory of each component of in different dimensions of motion space; Define x, Represent the position, velocity and acceleration of the end of the manipulator in Cartesian space, where x∈R n ×1 、 After coordinate transformation, x, With q, The relationship between them is: Further calculations yield: x、 With q, Substituting the relationship between into formula (1), we can obtain the dynamic model of the end of the manipulator in Cartesian space as shown in formula (3): Among them, D x =J -T (q)D(q)J -1 (q), G x =J -T (q)G(q), τ is the control input, τ=J -T (q)u; Define x1=x=[x 11 ,...,x 1n ] T , x 11 to x 1n Respectively represent the position of the end of the robotic arm in different dimensions of the motion space, x 21 to x 2n They represent the speed of the end of the manipulator in different dimensions of the motion space, and formula (3) is rewritten as: Among them, S(τ)=[S(τ1),...,S(τ n )] T is the control input affected by saturation nonlinearity, S(τ1) to S(τ n ) represent the 1st to nth components of the vector S(τ); Each component S(τ) in the vector S(τ) i ) is expressed as: Among them, sat(τ i ) represents the input saturation function, i=1,2,...,n; τ imax and τ imax Represent the control input signal τ i The maximum and minimum values ​​of τ imax and τ imax are all constants, τ imax >0,τ imax >0; To approximate the input saturation nonlinearity, define H(τ)=[h1(τ1),...,h n (τ n )] T , h1(τ1) to h n (τ n ) represent the 1st to nth components of the vector H(τ); Each component h in the vector H(τ) i (τ i ) is defined as shown in formula (6): Among them, μ i ∈(0,1), and u imin The definition of is shown in formula (7): Define the approximate error Y(τ)=[y1(τ1),…,y n (τ n )] T , y1(τ1) to y n (τ n ) represent the 1st to nth components of the vector Y(τ); Each component y in the vector Y(τ) i (τ i ) is defined as follows: |y i (t i )|=|sat(τ i )-h i (t i )|≤max{τ imax (1-tanh(1)),τ imin (1-tanh(1))}=P i ; Among them, P i is a bounded real number; S(τ i ) is rewritten as S(τ i ) = h i (τ i ) + y i (τ i ). S(τ) is written as S(τ) = H(τ) + Y(τ).

3. The method for controlling the fixed-time impedance of an uncertain textile robot system based on a disturbance observer according to claim 2 is characterized in that: In step 1, when x tracks the desired trajectory x r When x=x r ; When the end of the manipulator moves in free space, τ e =0, expected trajectory x r With command trajectory x d Consistent, that is, x r =x d .

4. The method for controlling the uncertain fixed-time impedance of a textile robot system based on a disturbance observer according to claim 2 is characterized in that: The step 2 is specifically as follows: Construct a fixed-time command filter as shown in formula (8): Define x i,c =z i,1 is the output of the fixed time command filter; z i,2 represents the output signal of the fixed-time command filter, σ i,0 =z i,1 -α i , α i is the input of the fixed time command filter; R1, R2, r represent the fixed time command filter parameters, and sig(σ i,0 ) β =|σ i,0 | β sign(σ i,0 ),in, When the filter input signal α i When not affected by noise, α i =a0, then after selecting parameters R1>0, R2>0, the fixed time instruction filter can reach stability in a fixed time; when the input of the filter is affected by noise, Select parameters R1>0, R2>0, and the following inequality group holds: Where a0 represents the filter input signal, represents a positive constant, and γ1 are positive constants determined by the filter; is a positive constant; Define the tracking error variable as shown in formula (8): Among them, ζ1 and ζ2 represent tracking error variables, ζ 11 To 1n Represent the 1st to nth components of ζ1, ζ 21 To 2n Represent the 1st to nth components of ζ2 respectively; x r represents the expected trajectory; Define x 1,c =[x 1,c1 ,...,x 1,cn ] T As input, α1=[α 11 ,...,α 1n ] T The fixed time command filter output when α1 is the virtual control law in the backstepping design, α 11 to α 1n represents the 1st to nth components of α1, x 1,c1 to x 1,cn Represents x 1,c The 1st to nth components of ; According to the set fixed time command filter, in is a constant, to express The 1st to nth components of ; The error vector after compensation is defined as shown in formula (9): Among them, v1 and v2 represent compensation errors, v 11 to v 1n Represent the 1st to nth components of v1 respectively; v 21 to v 2n Represent the 1st to nth components of v2 respectively; ξ1=[ξ 11 ,...,ξ 1n ] T and ξ2=[ξ 21 ,...,ξ 2n ] T represents the filtering error compensation signal; ξ 11 To 1n Represent the 1st to nth components of ξ1, ξ 21 To 2n represent the 1st to nth components of ξ2 respectively; It is an anti-saturation signal; Design virtual control law α1 and filter error compensation signal ξ1; Select the Lyapunov function V1 as: Taking the derivative of V1 we get: Among them, x d Indicates the command trajectory; The virtual control law α1 and the filter error compensation signal ξ1 are shown in formula (12): Among them, c 11 、c 12 、g 11 、g 12 is the system control gain, c 11 >0,c 12 >0,g 11 >0,g 12 >0; p and q are positive constants, 0 < p < 1, q > 1; Substituting formula (12) into formula (11) yields: Select the Lyapunov function V2 as: Where η is a positive constant, η>0; define θ=max{||W1|| 2 ,||W2|| 2 ,...,||W n || 2 }, where || W i || represents the norm of the weight vector function, the estimated error for: is the estimate of θ; Taking the derivative of V2 we get: Among them, f n (q) represents the unknown friction term, C x and G x represents unmodeled dynamics; Design the anti-saturation auxiliary system as shown in formula (15), that is, the fixed-time anti-saturation device: in, To control the gain; Substituting formula (15) into formula (14) yields: Among them, f(Z) is the unknown nonlinear term, Define the nonlinear function f(Z)=[f1(Z),...,f n (Z)] T , f1(Z) to f n (Z) represents the 1st to nth components of f(Z) respectively; According to the universal approximation theorem, for any small constant ε i > 0, there exists a fuzzy logic function W i T S(Z),W i represents the weight vector function, S(Z) represents the basis vector function, so that f i (Z)=W i T S(Z)+δ i ; Among them, δ i is the approximation error, δ i ≤ε i ; According to Young's inequality and v2=[v 21 ,...,v 2n ] T get: Where, l is a constant and l>0; The control input τ is the real control law, and the control input τ, the filter error compensation signal ξ2 and the adaptive law are designed. for: Among them, m 11 、m 12 is the correction parameter, m 11 >0,m 12 >0; is the unknown nonlinear disturbance f d The estimated value of is the interference estimation signal; Substituting formula (17) to formula (20) into formula (16) yields: in, is the unknown interference f d The estimation error of Design a fixed-time disturbance observer as shown in formula (22): Where λ and κ are observer gains, λ>0, κ>0; k d is a positive constant, k d >0; Select this Lyapunov function V3 as: Its derivative is: According to the fixed-time interference observer designed by formula (22), Rewritten as: The fixed-time fuzzy adaptive impedance controller for the uncertain textile robot system based on disturbance observer is designed as follows:

5. The method for controlling the uncertain fixed-time impedance of a textile robot system based on a disturbance observer according to claim 4 is characterized in that: In step 2, after completing the design of the fixed-time fuzzy adaptive impedance controller for the uncertain textile robot system based on the disturbance observer, the Lyapunov function of the robot system is selected for derivation to prove that the robot system controlled by the designed fixed-time fuzzy adaptive impedance controller for the uncertain textile robot system based on the disturbance observer is Lyapunov stable.

6. The method for controlling the uncertain fixed-time impedance of a textile robot system based on a disturbance observer according to claim 5 is characterized in that: In step 2, the process of proving the Lyapunov stability of the robotic arm system controlled by the designed fixed-time fuzzy adaptive impedance controller for the uncertain textile robotic arm system based on the disturbance observer is as follows: κ(μ,v) is a real-valued function, μ and v are the independent variables in the real-valued function κ(μ,v); when 0<p<1, q>1 and κ(μ,v)>0, the following inequality holds: We get the inequality shown in formula (25): Where b = 1, 2, j = 1, ..., n, m = p, q; Because for any c>0, s≤c, w≥0, g>0, k>0, the inequality s 1+k -c 1+k ≤(cs) 1+k , Established, so The calculation of is shown in formula (26): Substituting formula (25) and formula (26) into formula (24), we obtain: Considering compensation signals ξ1, ξ2 and anti-saturation signal The Lyapunov function V3 is: Derivative V3 and substitute formula (12), formula (15), and formula (19) into formula (28) to obtain: According to the set fixed time command filter, we get: is a constant, And for any v b ∈R, we have: Among them, 0<r≤1, k l >1; According to Young's inequality, we can get: Where Δτ represents the difference between the control input τ and the saturation input S(τ), Δτ = S(τ) - τ, and Δτ is a bounded constant. The Lyapunov function V is selected as: V=V2+V3 (36) Derivative V and substitute formula (27), formula (29) to formula (35) to obtain: in: Because the command trajectory x d is continuous and bounded, and its first-order and second-order derivatives are continuous and bounded. There exists a constant ω, 0<ω<1, such that v b,j ,ξ b,j 、 and Converges to a compact set: Formula (38) shows that the v of the robotic arm system is b,j ,ξ b,j 、 and is bounded in fixed time and converges in time T r for: Because z1=v1+ξ1, v1 and ξ1 are bounded, the tracking error ζ1 is bounded. By selecting parameters, ζ1 converges to the area at the origin within a fixed time, so that the robotic arm system is stable.

7. The method for controlling the uncertain fixed-time impedance of a textile robot system based on a disturbance observer according to claim 4 is characterized in that: The step 3 is specifically as follows: Set the preset command trajectory x d , the constraint force vector τ imposed by the unknown environment on the end of the robot arm e and the output of the end position of the manipulator x are input into the impedance model shown in formula (2), and the desired trajectory x is obtained from the impedance model r ; The output of the end position of the robot x and the expected trajectory x r The difference ζ1 is input into the fixed-time fuzzy adaptive impedance controller of the uncertain textile manipulator system based on the disturbance observer shown in formula (18), and the end position x and speed of the manipulator system are The two output quantities are input into the fixed-time fuzzy adaptive impedance controller of the uncertain textile manipulator system based on the disturbance observer to generate the control input signal τ. The control input signal τ is subjected to the input saturation limit as shown in formula (5) to obtain the saturated input signal S(τ). The saturated input signal S(τ) acts on the textile manipulator system to obtain the position x and velocity of the manipulator end. Using the fixed time anti-saturation device shown in formula (15), the signal x, S(τ) is input to the fixed time anti-saturation device to generate the anti-saturation signal At the same time, the signal x, S(τ), τ e 、f d Input into the fixed-time interference observer shown in formula (22) to generate the interference estimation signal Then the interference estimation signal and anti-saturation signal The signal is sent to the fixed-time fuzzy adaptive impedance controller of the uncertain textile robot system based on the disturbance observer to generate the control input signal τ. The entire control process is a closed-loop control, thereby achieving overall control of the robot system.

8. A fixed time impedance control system for an uncertain textile robot system based on a disturbance observer, characterized in that: Includes the following modules: The model building module is used to establish a mathematical model of the dynamic system of an m-joint rigid manipulator with uncertainty. The impedance model is established based on the impedance relationship between the position of the manipulator end and the environmental contact force. After coordinate transformation, the dynamic model of the manipulator end in Cartesian space is obtained. Where m is the number of joints in the manipulator system, i.e., the degree of freedom. The controller design module is used to design the control of a rigid manipulator system. It obtains a fixed-time fuzzy adaptive impedance controller for an uncertain textile manipulator system based on a disturbance observer. The design process is as follows: the rigid manipulator system is designed by combining command filter backstepping with fixed time, and the unknown friction and uncertain dynamics of the manipulator system are handled by a fuzzy logic system. A fixed-time disturbance observer is constructed to estimate and compensate for unknown nonlinear disturbances. A fixed-time anti-saturation controller is designed to eliminate the impact of saturation on system performance, ultimately designing a true control law. And a tracking control module is used to realize impedance tracking control of the robotic arm system by utilizing the designed fixed-time fuzzy adaptive impedance controller of the uncertain textile robotic arm system based on disturbance observer.

9. A computer device comprising a memory and one or more processors, wherein the memory stores executable code, characterized in that: When the processor executes the executable code, the steps of the method for controlling the fixed-time impedance of an uncertain textile robot arm system based on a disturbance observer are implemented as described in any one of claims 1 to 7.

10. A computer-readable storage medium having a program stored thereon, characterized in that: When the program is executed by a processor, the steps of the method for controlling the fixed-time impedance of an uncertain textile robot arm system based on a disturbance observer as claimed in any one of claims 1 to 7 are implemented.

Citation Information

Cited By

  • Mechanical arm trajectory tracking control system and method based on adaptive fuzzy PID

    CN121552364A