A force feedback robot control method based on fuzzy PID

By using a fuzzy PID control algorithm to adjust the control parameters of the force feedback manipulator online, the problem of poor motor coordination in patients with hand dysfunction is solved, and real-time prediction and suppression of environmental disturbances are achieved, resulting in precise control.

CN117140520BActive Publication Date: 2026-11-17CHINA SHIP SCIENTIFIC RESEARCH CENTER +1
View PDF 2 Cites 0 Cited by

Patent Information

Application Number
CN202311207851.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2023-09-19
Publication Date
2026-11-17
Estimated Expiration
2043-09-19

AI Technical Summary

Technical Problem

Traditional rehabilitation methods result in poor motor coordination in patients with hand dysfunction, and force feedback robotic hands are not precise enough in controlling external environmental disturbances.

Method used

By employing a fuzzy PID control algorithm and adjusting the control system parameters online, combined with the actual position information of the force feedback manipulator, real-time prediction and suppression of environmental interference are achieved, thereby enhancing anti-interference capabilities.

Benefits of technology

Precise control of the force feedback manipulator was achieved, improving the system's adaptability and anti-interference ability, and enhancing the control effect on the patient's motor coordination.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN117140520B_ABST
    Figure CN117140520B_ABST
Patent Text Reader

Abstract

This invention discloses a force feedback manipulator control method based on fuzzy PID control. The three parameters of the PID can automatically adjust to adapt to the external environment, solving the problem of jitter and instability in force feedback manipulators due to external interference. The invention mainly includes the following steps: Step 1: Using a slider on the guide rail of the force feedback manipulator platform as the controlled object, the actual position information of the slider is obtained through a displacement sensor and used as the input for the system feedback loop; Step 2: The preset position information of the slider is set through a controller; Step 3: The control output is calculated using a fuzzy PID control algorithm. This invention is designed for force feedback manipulators. Through the fuzzy PID control algorithm, the control system parameters can be automatically adjusted online to achieve precise control, solving the problem of poor coordination during movement in patients with hand dysfunction and enhancing anti-interference capabilities.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to the field of force feedback manipulator control technology, and more specifically, to a force feedback manipulator control method based on fuzzy PID. Background Technology

[0002] With an aging population and an increase in chronic diseases, the demand for rehabilitation is also growing. Many patients facing neurological diseases such as stroke, spinal cord injury, Parkinson's disease, and multiple sclerosis inevitably experience problems such as muscle weakness and decreased motor coordination. However, traditional rehabilitation methods, such as physical therapy and drug treatment, have certain limitations. Prolonged inactivity of the hand can lead to a decline in the function of the hand muscles and joints. Force feedback robotic hands can serve as an auxiliary medical device for rehabilitation treatment. The development of force feedback robotic hands is not only significant for rehabilitation treatment but also has multiple implications for promoting the development of robotics technology.

[0003] The purpose of this invention is to develop a fuzzy PID-based control method for force feedback manipulators, used for precise control of the manipulator to reduce uncertain interference from external environments such as collisions, compression, and friction, and to exhibit strong anti-interference capabilities. The fuzzy PID control method introduces fuzzy control into PID parameter adjustment to provide the control system with adaptability. The system can automatically adjust control system parameters online according to environmental changes, and can predict, estimate, and suppress environmental interference in the force feedback manipulator system in real time, reducing the impact of interference on the system and achieving precise control. Summary of the Invention

[0004] The purpose of this invention is to address the shortcomings of existing technologies by providing a force feedback manipulator control method based on fuzzy PID. This control method introduces the concept of fuzzy control, which can automatically adjust the control system parameters online to achieve precise control, solve the problem of poor coordination during movement in patients with hand dysfunction, and enhance the anti-interference ability.

[0005] The above-mentioned technical objective of the present invention is achieved through the following technical solution: a force feedback manipulator control method based on fuzzy PID, comprising the following steps:

[0006] Step 1: Using the slider on the guide rail in the force feedback manipulator platform as the controlled object, the actual position information of the slider is obtained through the displacement sensor and used as the input of the system feedback loop;

[0007] Step 2: Set the preset position information of the slider through the controller, calculate the deviation value and the rate of change of the deviation value between the preset position and the actual position, and use them as the input of the system;

[0008] Step 3: Calculate the control output using a fuzzy PID control algorithm, and input the control output into the force feedback control system to control the movement of the slider on the guide rail.

[0009] The specific steps for calculating the control output using the fuzzy PID control algorithm are as follows:

[0010] A control model for the slider is established using state-space expressions, and an initial PID control algorithm is designed based on this control model.

[0011] Based on the initial PID control algorithm, a fuzzy PID control algorithm is designed by introducing the concept of fuzzy control, which automatically adjusts the control system parameters online to obtain the control output.

[0012] The state-space expression is:

[0013]

[0014] In the formula, x1 is the displacement of the slider (mm), x2 is the sliding speed of the slider (mm / s), c is the spring damping coefficient (N*s / mm), k is the spring elastic coefficient (N / mm), m is the mass including the slider (kg), T is the motor output torque (N / mm), n is the motor reduction ratio, R is the radius of the synchronous pulley (mm), and c0 is the slider friction resistance coefficient (N / kg), which is generally between 0.01 and 0.05.

[0015] The initial PID control algorithm is as follows:

[0016]

[0017] In the formula, e(t) is the deviation between the preset position and the actual position.

[0018] Preferably, the steps of the fuzzy PID algorithm mainly include:

[0019] 1) The positional deviation and rate of change of the slider are fuzzified by a fuzzification component, that is, several fuzzy subsets are defined on the universe of discourse and their membership functions are specified, thereby converting the clear input quantity into a fuzzy input quantity;

[0020] 2) Define a set of fuzzy control rule tables to describe the fuzzy input quantity, i.e., the position deviation E of the slider and its rate of change E. c And the fuzzy output quantity, i.e., Δk p Δk i Δk d A set of "if-then" conditional statements are used to determine the fuzzy subset to which the fuzzy output belongs and its corresponding membership degree.

[0021] 3) The centroid method is used to defuzzify the output by calculating Δk based on the fuzzy subset to which the output belongs and its corresponding membership degree. p Δk i Δk d The clarity of the quantity is then used to control the output quantity.

[0022] Preferably, the control parameters of the fuzzy PID control algorithm are calculated in real time according to the following formula:

[0023]

[0024] In the formula, k p0 k i0 and k d0 These are the initial proportional coefficient, integral coefficient, and derivative coefficient of the PID controller.

[0025] Preferably, in the fuzzy PID algorithm, the linguistic subset of the fuzzy input quantity is defined as {NB, NM, NS, ZO, PS, PM, PB}, where NB represents negative large, NM represents negative medium, NS represents negative small, ZO represents zero, PS represents positive small, PM represents positive medium, and PB represents positive large. Each linguistic value corresponds to a membership function. Specifically, the linguistic value NB uses a Z-type membership function, the linguistic value PB uses an S-type membership function, and the linguistic values ​​NM, NS, ZO, PS, and PM use triangular membership functions.

[0026] The expression for the Z-type membership function is as follows:

[0027]

[0028] The expression for the S-type membership function is as follows:

[0029]

[0030] The expression for the membership function of the triangle is as follows:

[0031]

[0032] Preferably, in the fuzzy PID algorithm, the fuzzy subset language value of the fuzzy output is {NB, NM, NS, ZO, PS, PM, PB}, where NB represents negative large, NM represents negative medium, NS represents negative small, ZO represents zero, PS represents positive small, PM represents positive medium, and PB represents positive large, and the membership degree of its fuzzy output is determined by the fuzzy control rule table.

[0033] Preferably, the centroid method is a deblurring method that converts fuzzy output values ​​into sharp values, wherein:

[0034] The deblurring formula is as follows:

[0035] in, It is the precise value after the defuzzification process, x is the value in the domain of the fuzzy control quantity, μ(x) is the membership value, and s represents the support of μ(x).

[0036] Preferably, the control output of the fuzzy PID is as follows:

[0037]

[0038] In the formula, e(t) is the deviation between the preset position and the actual position.

[0039] According to the above plan,

[0040] The advantages compared to existing technologies are as follows:

[0041] 1. This invention introduces fuzzy control into PID parameter adjustment to provide the adaptiveness of the control system. The system can automatically adjust the control system parameters online according to changes in the environment. It can predict, estimate and suppress environmental disturbances in the force feedback manipulator system in real time, reduce the impact of disturbances on the system, and achieve the effect of precise control.

[0042] 2. This invention employs different membership functions for different linguistic values ​​of fuzzy variables, achieving both good controllability and high control precision. Higher resolution membership functions are used for high-sensitivity control in areas with smaller errors, while lower resolution membership functions are used in areas with larger errors, resulting in relatively smooth control characteristics and better stability.

[0043] 3. This invention uses force feedback to control the force feedback robot, and at the same time uses a fuzzy PID control algorithm for precise control. No literature or patents have been found to have this application. Attached Figure Description

[0044] Figure 1 This is a system framework diagram of a fuzzy controller according to an embodiment of the present invention;

[0045] Figure 2 This is a control flowchart of the fuzzy PID control algorithm according to an embodiment of the present invention;

[0046] Figure 3 This is a schematic diagram of the membership function of the fuzzy input quantity in an embodiment of the present invention;

[0047] Figure 4 This is a schematic diagram of the membership function of the fuzzy input quantity in an embodiment of the present invention. Detailed Implementation

[0048] The invention will be further described in detail below with reference to the accompanying drawings and specific embodiments. The following embodiments are merely descriptive and are not intended to limit the scope of protection of the present invention.

[0049] One method for controlling a force feedback robotic arm based on fuzzy PID includes the following steps:

[0050] Step 1: Using the slider on the guide rail in the force feedback manipulator platform as the controlled object, the actual position information of the slider is obtained through the displacement sensor and used as the input of the system feedback loop;

[0051] Step 2: Set the preset position information of the slider through the controller, calculate the deviation value and the rate of change of the deviation value between the preset position and the actual position, and use them as the input of the system;

[0052] Step 3: Calculate the control output using a fuzzy PID control algorithm, and input the control output into the force feedback control system to control the movement of the slider on the guide rail.

[0053] The specific steps for calculating the control output using the fuzzy PID control algorithm are as follows:

[0054] A control model for the slider is established using state-space expressions, and an initial PID control algorithm is designed based on this control model.

[0055] Based on the initial PID control algorithm, a fuzzy PID control algorithm is designed by introducing the concept of fuzzy control, which automatically adjusts the control system parameters online to obtain the control output.

[0056] The state-space expression is:

[0057]

[0058] In the formula, x1 is the displacement of the slider (mm), x2 is the sliding speed of the slider (mm / s), c is the spring damping coefficient (N*s / mm), k is the spring elastic coefficient (N / mm), m is the mass including the slider (kg), T is the motor output torque (N / mm), n is the motor reduction ratio, R is the radius of the synchronous pulley (mm), and c0 is the slider friction resistance coefficient (N / kg), which is generally between 0.01 and 0.05.

[0059] The initial PID control algorithm is as follows:

[0060]

[0061] In the formula, e(t) is the deviation between the preset position and the actual position.

[0062] Preferably, the steps of the fuzzy PID algorithm mainly include:

[0063] 1) The positional deviation and rate of change of the slider are fuzzified by a fuzzification component, that is, several fuzzy subsets are defined on the universe of discourse and their membership functions are specified, thereby converting the clear input quantity into a fuzzy input quantity;

[0064] 2) Define a set of fuzzy control rule tables to describe the fuzzy input quantity, i.e., the position deviation E of the slider and its rate of change E. c And the fuzzy output quantity, i.e., Δk p Δk i Δk d A set of "if-then" conditional statements are used to determine the fuzzy subset to which the fuzzy output belongs and its corresponding membership degree.

[0065] 3) The centroid method is used to defuzzify the output by calculating Δk based on the fuzzy subset to which the output belongs and its corresponding membership degree. p Δk i Δk d The clarity of the quantity is then used to control the output quantity.

[0066] Preferably, the control parameters of the fuzzy PID control algorithm are calculated in real time according to the following formula:

[0067]

[0068] In the formula, k p0 k i0 and k d0 These are the initial proportional coefficient, integral coefficient, and derivative coefficient of the PID controller.

[0069] Preferably, in the fuzzy PID algorithm, the linguistic subset of the fuzzy input quantity is defined as {NB, NM, NS, ZO, PS, PM, PB}, where NB represents negative large, NM represents negative medium, NS represents negative small, ZO represents zero, PS represents positive small, PM represents positive medium, and PB represents positive large. Each linguistic value corresponds to a membership function. Specifically, the linguistic value NB uses a Z-type membership function, the linguistic value PB uses an S-type membership function, and the linguistic values ​​NM, NS, ZO, PS, and PM use triangular membership functions.

[0070] The expression for the Z-type membership function is as follows:

[0071]

[0072] The expression for the S-type membership function is as follows:

[0073]

[0074] The expression for the membership function of the triangle is as follows:

[0075]

[0076] Preferably, in the fuzzy PID algorithm, the fuzzy subset language value of the fuzzy output is {NB, NM, NS, ZO, PS, PM, PB}, where NB represents negative large, NM represents negative medium, NS represents negative small, ZO represents zero, PS represents positive small, PM represents positive medium, and PB represents positive large, and the membership degree of its fuzzy output is determined by the fuzzy control rule table.

[0077] Preferably, the centroid method is a deblurring method that converts fuzzy output values ​​into sharp values, wherein:

[0078] The deblurring formula is as follows:

[0079] in, It is the precise value after the defuzzification process, x is the value in the domain of the fuzzy control quantity, μ(x) is the membership value, and s represents the support of μ(x).

[0080] Preferably, the control output of the fuzzy PID is as follows:

[0081]

[0082] In the formula, e(t) is the deviation between the preset position and the actual position.

[0083] The following are supplementary explanations for the above steps.

[0084] Based on the initial PID control algorithm, a fuzzy PID control algorithm is designed by introducing the concept of fuzzy control. The fuzzy controller system framework diagram is as follows. Figure 1 As shown, the control output is obtained through fuzzy PID control, which mainly includes three steps:

[0085] The positional deviation E of the slider and its rate of change E c Fuzzification is performed using a fuzzification component, defining seven fuzzy subsets (NB, NM, NS, ZO, PS, PM, PB) on its universe of discourse. The slider's positional deviation E and its rate of change E are also considered. c The universes of discourse are [-0.9, 0.9] and [-0.6, 0.6], respectively; subset NB uses a Z-type membership function, subset PB uses a S-type membership function, and subsets NM, NS, ZO, PS, and PM use triangular membership functions, such as... Figure 3 and Figure 4 As shown;

[0086] Define a set of fuzzy control rule tables to describe the fuzzy input quantity, namely the position deviation E of the slider, and its rate of change E. c And the fuzzy output quantity, i.e., Δk p Δk i Δk d The fuzzy control rules are defined by a set of "if-then" conditional statements, and based on this, the fuzzy subset to which the fuzzy output belongs and its corresponding membership degree are determined. The fuzzy control rule table is shown below:

[0087] Table 1 Δk p Fuzzy control rule table

[0088]

[0089] Table 2 Δk i Fuzzy rules

[0090]

[0091]

[0092] Table 3 Δk d Fuzzy rules

[0093]

[0094] The centroid method is used to defuzzify the data by calculating Δkp and Δk based on the fuzzy subset to which the fuzzy output belongs and its corresponding membership degree. i Δk d The clarity of the quantity.

[0095] Furthermore, the expression for the Z-type membership function is as follows:

[0096]

[0097] Furthermore, the expression for the S-shaped membership function is as follows:

[0098]

[0099] Furthermore, the expression for the membership function of the triangle is as follows:

[0100]

[0101] Furthermore, the fuzzy output quantity Δk p The output universe of discourse is [-0.1, 0.1], Δk i The output universe of discourse is [-0.01, 0.01], Δk d The output universe of discourse is [-0.2, 0.2].

[0102] Furthermore, the relationship rules for the "if-then" conditional statement are as follows:

[0103] R1: if E is A1, and E c It is B1, then Δk p It is C1, and Δk i It is D1, and Δk d It's F1;

[0104] R2: if E is A2, and E c It is B2, then Δk p It is C2, and Δk i It is D2, and Δk d It's F2;

[0105] …

[0106] R n If E is A n , and E c It is B n , then Δk p It is C n , and Δk i It is D n , and Δk d It is F n

[0107] In the formula, E, E c Δk p Δk i Δk d These are linguistic variables, representing the deviation, the change in deviation, and the control coefficient variables of the PID controller within the force feedback control system. A i B i C i D i F i They are E and E respectively c Δk p Δk i Δk d In their respective universes of discourse, i = 1, 2, ..., n.

[0108] Furthermore, the membership degree of the fuzzy output is determined by the fuzzy control rule table.

[0109] Furthermore, the centroid method is a deblurring method that converts fuzzy output values ​​into sharp values, wherein:

[0110] The deblurring formula is as follows:

[0111]

[0112] in, It is the precise value after the defuzzification process, where x is the value in the domain of the fuzzy control quantity, μ(x) is the membership value of x, and s represents the support of μ(x).

[0113] Furthermore, the control parameters of the fuzzy PID control algorithm are calculated in real time according to the following formula:

[0114]

[0115] In the formula, k p0 k i0 and k d0 These are the initial proportional, integral, and differential coefficients, respectively, k. p0 =0.25, k i0 =3.5, k d0 =2.5

[0116] Furthermore, the control output of the fuzzy PID is as follows:

[0117]

[0118] In the formula, e(t) is the deviation between the preset position and the actual position.

[0119] This specific embodiment is merely an explanation of the present invention and is not intended to limit the invention. After reading this specification, those skilled in the art can make modifications to this embodiment without contributing any inventive step, but such modifications are protected by patent law as long as they are within the scope of the claims of the present invention.

Claims

1. A fuzzy PID-based force feedback manipulator control method, characterized by, Includes the following steps: Step 1: Using the slider on the guide rail in the force feedback manipulator platform as the controlled object, the actual position information of the slider is obtained through the displacement sensor and used as the input of the system feedback loop; Step 2: Set the preset position information of the slider through the controller, calculate the deviation value and the rate of change of the deviation value between the preset position and the actual position, and use them as the input of the system; Step 3: Calculate the control output using a fuzzy PID control algorithm, and input the control output into the force feedback control system to control the movement of the slider on the guide rail; The specific steps for calculating the control output using the fuzzy PID control algorithm are as follows: A control model for the slider is established using state-space expressions, and an initial PID control algorithm is designed based on this control model. Based on the initial PID control algorithm, a fuzzy PID control algorithm is designed by introducing the concept of fuzzy control, which automatically adjusts the control system parameters online to obtain the control output. The state-space expression is: , wherein is the displacement of the slider ( ), is the speed of the slider sliding ( ), is the spring damping coefficient ( ), is the spring stiffness coefficient ( ), is the mass containing the slider ( ), is the motor output torque ( ), is the motor reduction ratio, is the synchronous pulley radius ( ), is the slider friction resistance coefficient ( ) with a value between 0.01 and 0.05; The initial PID control algorithm is as follows: , In the formula, is the deviation value of the preset position and the actual position.

2. The force feedback manipulator control method based on fuzzy PID according to claim 1, wherein, The steps of the fuzzy PID algorithm mainly include: 1) The positional deviation and rate of change of the slider are fuzzified by a fuzzification component, that is, several fuzzy subsets are defined on the universe of discourse and their membership functions are specified, thereby converting the clear input quantity into a fuzzy input quantity; 2) Define a set of fuzzy control rule tables to describe the fuzzy input quantity, i.e., the position deviation of the slider. and its rate of change And fuzzy output quantity, i.e. , , A set of "if-then" conditional statements are used to determine the fuzzy subset to which the fuzzy output belongs and its corresponding membership degree. 3) The centroid method is used for defuzzification. Based on the fuzzy subset to which the fuzzy output belongs and its corresponding membership degree, the following parameters are calculated: , , The clarity of the quantity is then used to control the output quantity.

3. The force feedback manipulator control method based on fuzzy PID according to claim 2, characterized in that, The control parameters of the fuzzy PID control algorithm are calculated in real time according to the following formula: , In the formula, , and These are the initial proportional coefficient, integral coefficient, and derivative coefficient of the PID controller.

4. The force feedback manipulator control method based on fuzzy PID according to claim 2, characterized in that, In the fuzzy PID algorithm described above, the fuzzy subset linguistic values ​​of the fuzzy input are {NB, NM, NS, ZO, PS, PM, PB}, where NB represents negative large, NM represents negative medium, NS represents negative small, ZO represents zero, PS represents positive small, PM represents positive medium, and PB represents positive large. Each linguistic value corresponds to a membership function. Specifically, the linguistic value NB uses a Z-type membership function, the linguistic value PB uses an S-type membership function, and the linguistic values ​​NM, NS, ZO, PS, and PM use triangular membership functions. The expression for the Z-type membership function is as follows: , The expression for the S-type membership function is as follows: , The expression for the membership function of the triangle is as follows: 。 5. The force feedback manipulator control method based on fuzzy PID according to claim 2, characterized in that, In the fuzzy PID algorithm, the fuzzy subset language value of the fuzzy output is {NB, NM, NS, ZO, PS, PM, PB}, where NB represents negative large, NM represents negative medium, NS represents negative small, ZO represents zero, PS represents positive small, PM represents positive medium, and PB represents positive large. The membership degree of the fuzzy output is determined by the fuzzy control rule table.

6. The force feedback manipulator control method based on fuzzy PID according to claim 2, characterized in that, The centroid method described above is a deblurring method that converts fuzzy output values ​​into sharp values, wherein: The defuzzification formula is as follows: , in, It is the precise value obtained after the defuzzification process. The value of the fuzzy control quantity within the domain of discourse. Yes, it's the membership value. Indicated Branches.

7. The force feedback manipulator control method based on fuzzy PID according to claim 2, characterized in that, The control output of the fuzzy PID is as follows: , In the formula, This represents the deviation between the preset position and the actual position.

Citation Information

Patent Citations

  • Ultra-precision lathe motion control method based on fuzzy PID self-tuning calculation

    CN112486099A

  • Edible gelatin 3D printing equipment and control system

    CN114594673A