Simulation method of unilateral lower limb pneumatic muscle rehabilitation robot

CN119045313APending Publication Date: 2024-11-29浙江谱麦科技有限公司
View PDF 0 Cites 4 Cited by

Patent Information

Application Number
CN202410363988.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-03-28
Publication Date
2024-11-29

AI Technical Summary

Technical Problem

[0004]本发明的发明目的是为了解决单侧下肢气动肌肉康复机器人在实物验证中耗费的成本较大的问题,提供了一种单侧下肢气动肌肉康复机器人的仿真方法

Benefits of technology

[0050] Therefore, the present invention has the following beneficial effects: using Simulink's powerful controller design capabilities and powerful modeling capabilities, the establishment of a unilateral lower limb pneumatic muscle rehabilitation robot model and reliable simulation control of it are realized on the computer, and the verification cost is low. It provides a reliable data basis for the development of medical rehabilitation robots.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119045313A_ABST
    Figure CN119045313A_ABST
Patent Text Reader

Abstract

The invention discloses a simulation method of a unilateral lower limb pneumatic muscle rehabilitation robot. The simulation method comprises the following steps: establishing a two-link simulation model and a pneumatic muscle joint torque model by using a Simulink module of MATLAB software; using a Simulink module to construct fuzzy PID controllers of the hip joint and the knee joint; simulation construction of the unilateral lower limb pneumatic muscle rehabilitation robot is completed in a Simulink module in MATLAB software, and fuzzy PID control simulation under sinusoidal signal input is carried out; calculating a root-mean-square error between the hip joint angle control curve and the input sine curve and a root-mean-square error between the knee joint angle control curve and the input sine curve, and when the two root-mean-square errors are both smaller than 2 degrees, completing simulation; the single-side lower limb pneumatic muscle rehabilitation robot model has the advantages that the single-side lower limb pneumatic muscle rehabilitation robot model is established, and reliable simulation control can be conducted on the single-side lower limb pneumatic muscle rehabilitation robot model.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of medical robots, and in particular to a simulation method for a unilateral lower limb pneumatic muscle rehabilitation robot. Background Art

[0002] The aging of the population in my country is becoming increasingly serious. Due to various reasons, the number of people with movement disorders is increasing. Therefore, medical rehabilitation robots have become one of the important research fields. Rehabilitation training equipment does not have high requirements for motion position control, but pays more attention to safety and comfort. Pneumatic artificial muscles perform well in all these aspects.

[0003] In actual design, for cost and safety considerations, reasonable simulation verification is required before physical verification. Summary of the invention

[0004] The purpose of the invention is to solve the problem of high cost in physical verification of a unilateral lower limb pneumatic muscle rehabilitation robot, and to provide a simulation method for a unilateral lower limb pneumatic muscle rehabilitation robot.

[0005] In order to achieve the above object, the present invention adopts the following technical solutions:

[0006] A simulation method for a unilateral lower limb pneumatic muscle rehabilitation robot comprises the following steps:

[0007] Step 1, install MATLAB software on the computer, and use the Simulink module of MATLAB software to establish a two-link simulation model and a pneumatic muscle joint torque model;

[0008] Step 2, use Simulink modules to build fuzzy PID controllers for hip and knee joints;

[0009] Step 3, combining the fuzzy PID controller with the two-link simulation model and the pneumatic muscle joint torque model, completing the simulation construction of the unilateral lower limb pneumatic muscle rehabilitation robot in the Simulink module in the MATLAB software, and performing fuzzy PID control simulation under sinusoidal signal input; during the simulation process, the computer records the hip joint angle control curve and the knee joint angle control curve under the control of the fuzzy PID controller;

[0010] Step 4: The computer uses the angle control curves of the hip joint and the knee joint, combined with the input sinusoidal signal, to calculate the root mean square error between the hip joint angle control curve and the input sinusoidal curve, and the root mean square error between the knee joint angle control curve and the input sinusoidal curve during the 10-second simulation process. When both root mean square error values ​​are less than 2°, the simulation is completed; otherwise, change the PID parameters and return to step 3.

[0011] The present invention uses the powerful controller design capability and powerful modeling capability of Simulink to realize the establishment of a unilateral lower limb pneumatic muscle rehabilitation robot model and perform reliable simulation control on it on a computer, with low verification cost and easy implementation.

[0012] Preferably, the creation of the two-link simulation model in step 1 includes the following steps:

[0013] Select the Multibody template in the Simscape library on the Simulink start page, create an initial model, and delete the Simulink-PS Converter module, PS-Simulink Converter module, and Scope module in Simulink;

[0014] There are Rigid Transform modules and Cylindrical Solid modules in Simulink. Copy the Rigid Transform module, connect the B ends of the two Rigid Transform modules to the R end of the Cylindrical Solid module, set the properties of the two Rigid Transform modules so that the two ends of the cylindrical rigid body defined by the Cylindrical Solid module have a fixed coordinate system, select the Cylindrical Solid module and the two Rigid Transform modules, right-click and select Create Subsystem from Selection to create the subsystem Subsystem1, which is the connecting rod template; right-click Subsystem1 to open the Mask editor, and add 4 controls in the Parameters&Dialog tab, which are the length, radius, density and color of Subsystem1;

[0015] Add a Solid module and name it Solid; add two Revolute Joint modules and name them Revolute Joint1 and Revolute Joint2; copy Subsystem1 and name it Subsystem2; connect the B ends of Solid and Revolute Joint1 to the base coordinate system World Frame module of the Multibody template, and connect the F end of RevoluteJoint1 to the Com1 end of Subsystem1; connect the Com2 end of Subsystem1 to the B end of Revolute Joint2, and connect the F end of Revolute Joint2 to the Com1 end of Subsystem2; use the Mechanism Configuration module of the Multibody template to define the gravity direction and gravity acceleration, and the two-link simulation model is created.

[0016] Preferably, the creation of the pneumatic muscle joint torque model in step 1 comprises the following steps:

[0017] Input F(P)=K(P)×L(P) into the MATLAB Function module in Simulink and name it Function1; where P is the internal air pressure of the pneumatic muscle joint torque model, F(P) is the pneumatic muscle output force, K(P) is the elastic coefficient, and L(P) is the initial length of the change; copy Function1 and name it Function2, add Derivative module and Switch module, use P as the input of Function1, Function2 and Derivative modules, connect the output of Function1, Function2 and Derivative modules to the Switch module, use the output of the Derivative module as the switching condition of the Switch module, and use the output of the Switch module as the output torque signal of the pneumatic muscle joint torque model.

[0018] The pneumatic muscle joint torque model can be simplified as a spring with a variable initial length L(P) and an elastic coefficient K(P). Both the initial length and the elastic coefficient are functions of the internal air pressure P of the pneumatic muscle joint torque model.

[0019] The output force of pneumatic muscle can be expressed as follows:

[0020] F(P)=K(P)·L(P)

[0021] Where F(P) is the pneumatic muscle output force.

[0022] The fitting model of the pneumatic muscle inflation and deflation process is:

[0023] Inflation process: L(P) inflate =0.4212P 3 -4.293P 2 +1.477P+261.9

[0024] Degassing process: L(P) deflate =0.3073P 3 -1.88P 2 -9.343P+261.8

[0025] The fitting expression of the rate of change of its output force is:

[0026] K(P)=1.141P 2 -11.85P+37.35

[0027] The joint active torque model is similar to a fixed pulley with a radius of r and a center of O, with pneumatic muscles exerting tension on both sides.

[0028] The joint active torque model can be expressed as:

[0029] τ h =τ u -τ d =(F u -F d )r

[0030] Among them, τ h is the torque output by the main torque model, τ u , τ d is the tension F u and F d The moment F is applied to the fixed pulley center O with radius r as the lever arm. u and F d is the output force of the pneumatic muscles on both sides, r is the radius of the fixed pulley, τ h0 is the torque output by the joint active torque model in the initial state.

[0031] The relationship between the output torque and the traction force on both sides can be expressed as:

[0032]

[0033]

[0034] Preferably, the construction of the fuzzy PID controller in step 2 includes the following steps:

[0035] The air pressure signal u(t) of the fuzzy PID controller is set to:

[0036]

[0037] Among them, K P , K I and K D are proportional coefficient, integral coefficient and differential coefficient respectively, e(t) is the error signal between the expected sinusoidal signal r(t) input to the fuzzy PID controller and the actual output signal c(t), ΔK P , ΔK I and ΔK D They are the adjustment values ​​of the proportional coefficient, integral coefficient and differential coefficient output after calculation by the fuzzy PID controller;

[0038] Use the Constant module in Simulink to set r(t) of the hip joint and knee joint, use the Sum module in Simulink to calculate the error signal e(t) between r(t) and c(t), use the Integrator module and Derivative module in Simulink to integrate and differentiate e(t) to obtain the integral signal and differential signal of e(t);

[0039] The design of the fuzzy controller in the fuzzy PID controller can directly call the Fuzzy LogicDesigner module in MATLAB.

[0040] Set the input and output of the fuzzy controller in the Fuzzy Logic Designer module. Set the input of the fuzzy controller to the deviation signal e(t) and the differential signal of e(t). Set the output of the fuzzy controller to ΔK P , ΔK I and ΔK D Three correction parameters. The second is to set the fuzzy subset and membership function. Open the Member Function Edit window in the Fuzzy Logic Designer module. Set the fuzzy subset to {NB, NM, NS, ZO, PS, PM, PB}, which is defined as NB for left large, NM for left middle, NS for left small, Z for middle, PS for right small, PM for right middle, and PB for right large. Select the Gaussian membership function (gauss2mf) as the membership function of the input signal, select the triangular membership function (trimf) as the membership function of the output signal, and set the domain of the input and output variables. Finally, complete the K in the fuzzy controller. P , K I and K D The setting of fuzzy rules.

[0041] Use the Fuzzy Logic Designer module in Simulink to complete the writing of fuzzy rules of the fuzzy controller and determine the membership function. Input the differential signals of e(t) and e(t) into the Fuzzy Logic Designer module, and the Fuzzy Logic Designer module outputs ΔK P , ΔK I and ΔK D ;

[0042] Call a new MATLAB Function module, named Function3, and

[0043]

[0044] Write to Function3 and use the Constant module to set three PID parameters: K P , K I and K D , use the Sum module to convert K P , K I and K D Respectively with ΔK P , ΔK I and ΔK D Add together to get the PID parameters adjusted by fuzzy rules: K P +ΔK P , K I +ΔK I and K D +ΔK D ; e(t), the integral signal of e(t), the differential signal of e(t), K P +ΔK P , K I +ΔK I and K D +ΔK D Input into Function3, Function3 outputs the air pressure signal μ(t), and the construction of the fuzzy PID controller is completed.

[0045] Preferably, the simulation construction of the unilateral lower limb pneumatic muscle rehabilitation robot in step 3 includes the following steps:

[0046] Input μ(t) into the pneumatic muscle joint torque model, and the pneumatic muscle joint torque model obtains the output torque. Input the output torque into the two-link simulation model, and the two-link simulation model obtains the joint rotation angle to complete the simulation construction of the unilateral lower limb pneumatic muscle rehabilitation robot.

[0047] As a preference, the root mean square error E in step 4 RMS (t) The formula is as follows;

[0048]

[0049] Among them, t0 is the simulation start time, t f is the end time of simulation, c(t) is the control curve, that is, the actual output signal.

[0050] Therefore, the present invention has the following beneficial effects: using Simulink's powerful controller design capabilities and powerful modeling capabilities, the establishment of a unilateral lower limb pneumatic muscle rehabilitation robot model and reliable simulation control thereof are realized on a computer, the verification cost is low, and a reliable data basis is provided for the development of medical rehabilitation robots. BRIEF DESCRIPTION OF THE DRAWINGS

[0051] Figure 1 is a flow chart of the present invention;

[0052] Figure 2 It is a sine signal hip joint fuzzy PID response diagram of the present invention;

[0053] Figure 3 It is a sinusoidal signal knee joint fuzzy PID response diagram of the present invention. DETAILED DESCRIPTION

[0054] The present invention is further described below in conjunction with the accompanying drawings and specific embodiments.

[0055] like Figure 1-Figure 3 The embodiment shown is a simulation method of a unilateral lower limb pneumatic muscle rehabilitation robot, comprising the following steps:

[0056] Step 1, install MATLAB software on the computer, and use the Simulink module of MATLAB software to establish a two-link simulation model and a pneumatic muscle joint torque model;

[0057] The creation of a two-link simulation model includes the following steps:

[0058] Select the Multibody template in the Simscape library on the Simulink start page, create an initial model, and delete the Simulink-PS Converter module, PS-Simulink Converter module, and Scope module in Simulink;

[0059] There are Rigid Transform modules and Cylindrical Solid modules in Simulink. Copy the Rigid Transform module, connect the B ends of the two Rigid Transform modules to the R end of the Cylindrical Solid module, set the properties of the two Rigid Transform modules, so that the two ends of the cylindrical rigid body defined by the Cylindrical Solid module have a fixed coordinate system, select the Cylindrical Solid module and the two Rigid Transform modules, right-click and select Create Subsystem from Selection to create the subsystem Subsystem1, Subsystem1 is the connecting rod template; right-click Subsystem1, open the Mask editor, and add 4 controls in the Parameters&Dialog tab. The 4 controls are the length, radius, density and color of Subsystem1; in the subsequent simulation, the thigh is equivalent to a length of 0.55m, a radius of 0.07m, and a density of 982kg / m 3 The calf is equivalent to a cylinder with a length of 0.45m, a radius of 0.055m and a density of 985kg / m3.

[0060] Add a Solid module and name it Solid; add two Revolute Joint modules and name them Revolute Joint1 and Revolute Joint2; copy Subsystem1 and name it Subsystem2; connect the B ends of Solid and Revolute Joint1 to the base coordinate system World Frame module of the Multibody template, and connect the F end of RevoluteJoint1 to the Com1 end of Subsystem1; connect the Com2 end of Subsystem1 to the B end of Revolute Joint2, and connect the F end of Revolute Joint2 to the Com1 end of Subsystem2; use the Mechanism Configuration module of the Multibody template to define the gravity direction and gravity acceleration, and the two-link simulation model is created.

[0061] The creation of the pneumatic muscle joint torque model includes the following steps:

[0062] Input F(P)=K(P)×L(P) into the MATLAB Function module in Simulink and name it Function1; where P is the internal air pressure of the pneumatic muscle joint torque model, F(P) is the pneumatic muscle output force, K(P) is the elastic coefficient, and L(P) is the initial length of the change; copy Function1 and name it Function2, add Derivative module and Switch module, use P as the input of Function1, Function2 and Derivative modules, connect the output of Function1, Function2 and Derivative modules to the Switch module, use the output of the Derivative module as the switching condition of the Switch module, and use the output of the Switch module as the output torque signal of the pneumatic muscle joint torque model.

[0063] Step 2, use Simulink modules to build fuzzy PID controllers for hip and knee joints;

[0064] The construction of the fuzzy PID controller includes the following steps:

[0065] The air pressure signal u(t) of the fuzzy PID controller is set to:

[0066]

[0067] Among them, K P , K I and K D are proportional coefficient, integral coefficient and differential coefficient respectively, e(t) is the error signal between the expected sinusoidal signal r(t) input to the fuzzy PID controller and the actual output signal c(t), ΔK P , ΔK I and ΔK D They are the adjustment values ​​of the proportional coefficient, integral coefficient and differential coefficient output after calculation by the fuzzy PID controller;

[0068] Use the Constant module in Simulink to set the r(t) of the hip and knee joints, use the Sum module in Simulink to calculate the error signal e(t) between r(t) and c(t), and use the Integrator module and Derivative module in Simulink to integrate and differentiate e(t) to obtain the integral signal and differential signal of e(t).

[0069] Use the Fuzzy Logic Designer module in Simulink to complete the writing of fuzzy rules of the fuzzy controller and determine the membership function. Input the differential signals of e(t) and e(t) into the Fuzzy Logic Designer module, and the Fuzzy Logic Designer module outputs ΔK P , ΔK I and ΔK D ;

[0070] Call a new MATLAB Function module, named Function3, and

[0071]

[0072] Write to Function3 and use the Constant module to set three PID parameters: K P , K I and K D , use the Sum module to convert K P , K I and K D Respectively with ΔK P , ΔK I and ΔK D Add together to get the PID parameters adjusted by fuzzy rules: K P +ΔK P , K I +ΔK I and K D +ΔK D ; e(t), the integral signal of e(t), the differential signal of e(t), K P +ΔK P , K I +ΔK I and K D +ΔK D Input into Function3, Function3 outputs the air pressure signal μ(t), and the construction of the fuzzy PID controller is completed.

[0073] Step 3, combining the fuzzy PID controller with the two-link simulation model and the pneumatic muscle joint torque model, completing the simulation construction of the unilateral lower limb pneumatic muscle rehabilitation robot in the Simulink module in the MATLAB software, and performing fuzzy PID control simulation under sinusoidal signal input; during the simulation process, the computer records the hip joint angle control curve and the knee joint angle control curve under the control of the fuzzy PID controller;

[0074] Among them, the simulation construction of the unilateral lower limb pneumatic muscle rehabilitation robot includes the following steps:

[0075] Input μ(t) into the pneumatic muscle joint torque model, and the pneumatic muscle joint torque model obtains the output torque. Input the output torque into the two-link simulation model, and the two-link simulation model obtains the joint rotation angle to complete the simulation construction of the unilateral lower limb pneumatic muscle rehabilitation robot.

[0076] Step 4: The computer uses the angle control curves of the hip joint and the knee joint, combined with the input sinusoidal signal, to calculate the root mean square error between the hip joint angle control curve and the input sinusoidal curve, and the root mean square error between the knee joint angle control curve and the input sinusoidal curve during the 10-second simulation process. When both root mean square error values ​​are less than 2°, the simulation is completed; otherwise, change the PID parameters and return to step 3.

[0077]

[0078] Among them, t0 is the simulation start time, t f is the end time of simulation, c(t) is the control curve, that is, the actual output signal. Specific embodiment:

[0080] In the process of building the Simulink simulation, the fuzzy PID controller uses a unilateral lower limb pneumatic muscle rehabilitation robot simulation model composed of a pneumatic muscle joint torque model and a two-link simulation model as the control object. Its input state variables are the input air pressures of the hip and knee joints, and its output state variables are the angular positions of the hip and knee joints.

[0081] Taking the hip joint as an example, first use the Constant module in Simulink to set the r(t) of the hip joint, then use the Sum module to calculate the difference between r(t) and c(t) to obtain the error signal e(t), and use the Integrator module and Derivative module to integrate and differentiate e(t) to obtain the integral signal and differential signal of e(t).

[0082] In the Fuzzy Logic Designer module, set the input of the fuzzy controller to the error signal e(t) and the differential signal of e(t), and set the output of the fuzzy controller to ΔK P , ΔK I and ΔK D Three correction parameters.

[0083] In the Fuzzy Logic Designer module, open the Member Function Edit window and set the fuzzy subset to {NB, NM, NS, ZO, PS, PM, PB}, which is defined as NB for left large, NM for left middle, NS for left small, Z for middle, PS for right small, PM for right middle, and PB for right large. Select the Gaussian membership function (gauss2mf) as the membership function of the input signal, and set the domain of the input signal to [-1, 1]. Select the triangular membership function (trimf) as the membership function of the output signal, and set the domain of the output signal to [-1, 1].

[0084] K P , K I and K D The fuzzy rule design is shown in Table 1, Table 2 and Table 3:

[0085] Table 1

[0086]

[0087]

[0088] Table 2

[0089]

[0090] Table 3

[0091]

[0092] In the Fuzzy Logic Designer module, double-click the mamdani box to call the fuzzy rule input interface. Complete the setting of 49 fuzzy rules according to Table 1, Table 2, and Table 3. If you select E as NB, EC as NB, then K P PB, K I NB, K D For PS.

[0093] After completing the design of the fuzzy controller using the Fuzzy Logic Designer module in Simulink, the differential signals of e(t) and e(t) are input into the Fuzzy Logic Designer module, which outputs the adjustment values ​​of the proportional coefficient, integral coefficient, and differential coefficient, i.e., ΔK P , ΔK I and ΔK D .

[0094] Call a new MATLAB Function module, named Function3, and

[0095]

[0096] Write to Function3 and use the Constant module to set three PID parameters: K P , K I and K D , use the Sum module to convert K P , K I and K D Respectively with ΔK P , ΔK I and ΔK D Add together to get the PID parameters adjusted by fuzzy rules: K P +ΔK P , K I +ΔK I and K D +ΔK D ; e(t), the integral signal of e(t), the differential signal of e(t), K P +ΔK P , K I +ΔK I and K D +ΔK D Input into Function3, Function3 outputs the air pressure signal u(t), and the construction of the fuzzy PID controller is completed.

[0097] By inputting the air pressure signal into the pneumatic muscle joint torque model, the output torque can be obtained. By inputting the output torque into the hip joint of the two-link simulation model, the hip joint rotation angle can be obtained, completing the construction of Simulink simulation based on fuzzy PID control for the hip joint.

[0098] The simulation verification is carried out, and the K of the fuzzy PID in the fuzzy PID controller P , K I , K D The parameters and expected sinusoidal signal settings are shown in Table 4:

[0099] Table 4

[0100]

[0101] The actual control effect is as follows Figure 2 and Figure 3 As shown, during the 10s simulation process, 60 points are evenly taken per second, totaling 600 points, and the root mean square error is calculated. The result is: the root mean square error of the hip joint tracking sinusoidal signal is 0.7532°, and the root mean square error of the knee joint tracking sinusoidal signal is 0.1902°. Both root mean square errors are less than 2°, and the simulation is completed.

[0102] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims

1. A simulation method for a unilateral lower limb pneumatic muscle rehabilitation robot, characterized in that: The steps include: Step 1, install MATLAB software on the computer, and use the Simulink module of MATLAB software to establish a two-link simulation model and a pneumatic muscle joint torque model; Step 2, use Simulink modules to build fuzzy PID controllers for hip and knee joints; Step 3, combining the fuzzy PID controller with the two-link simulation model and the pneumatic muscle joint torque model, completing the simulation construction of the unilateral lower limb pneumatic muscle rehabilitation robot in the Simulink module in the MATLAB software, and performing fuzzy PID control simulation under sinusoidal signal input; during the simulation process, the computer records the hip joint angle control curve and the knee joint angle control curve under the control of the fuzzy PID controller; Step 4, the computer uses the angle control curves of the hip joint and the knee joint, combined with the input sinusoidal signal, to calculate the root mean square error between the hip joint angle control curve and the input sinusoidal curve, and the root mean square error between the knee joint angle control curve and the input sinusoidal curve during the 10-second simulation process. When both root mean square error values ​​are less than 2°, the simulation is completed; Otherwise, change the PID parameters and return to step 3.

2. The simulation method of the unilateral lower limb pneumatic muscle rehabilitation robot according to claim 1, characterized in that: The creation of the two-link simulation model in step 1 includes the following steps: Select the Multibody template in the Simscape library on the Simulink start page, create an initial model, and delete the Simulink-PS Converter module, PS-Simulink Converter module, and Scope module in Simulink; There are Rigid Transform modules and Cylindrical Solid modules in Simulink. Copy the Rigid Transform module, connect the B ends of the two Rigid Transform modules to the R end of the Cylindrical Solid module, set the properties of the two Rigid Transform modules so that the two ends of the cylindrical rigid body defined by the Cylindrical Solid module have a fixed coordinate system. Select the Cylindrical Solid module and the two Rigid Transform modules, right-click and select Create Subsystem from Selection to create the subsystem Subsystem1. Subsystem1 is a connecting rod template. Right-click Subsystem1 to open the Mask editor. Add 4 controls in the Parameters&Dialog tab. The 4 controls are the length, radius, density and color of Subsystem1. Add a Solid module and name it Solid; add two Revolute Joint modules and name them RevoluteJoint1 and Revolute Joint2; copy Subsystem1 and name it Subsystem2; connect the B ends of Solid and RevoluteJoint1 to the base coordinate system World Frame module of the Multibody template, and connect the F end of Revolute Joint1 to the Com1 end of Subsystem1; connect the Com2 end of Subsystem1 to the B end of Revolute Joint2, and connect the F end of Revolute Joint2 to the Com1 end of Subsystem2; use the MechanismConfiguration module of the Multibody template to define the gravity direction and gravity acceleration, and the two-link simulation model is created.

3. The simulation method of the unilateral lower limb pneumatic muscle rehabilitation robot according to claim 1, characterized in that: The creation of the pneumatic muscle joint torque model in step 1 includes the following steps: Input F(P)=K(P)×L(P) into the MATLAB Function module in Simulink and name it Function1; where P is the internal air pressure of the pneumatic muscle joint torque model, F(P) is the pneumatic muscle output force, K(P) is the elastic coefficient, and L(P) is the initial length of the change; copy Function1 and name it Function2, add Derivative module and Switch module, use P as the input of Function1, Function2 and Derivative modules, connect the output of Function1, Function2 and Derivative modules to the Switch module, use the output of the Derivative module as the switching condition of the Switch module, and use the output of the Switch module as the output torque signal of the pneumatic muscle joint torque model.

4. The simulation method of the unilateral lower limb pneumatic muscle rehabilitation robot according to claim 1, characterized in that: The construction of the fuzzy PID controller in step 2 includes the following steps: The air pressure signal μ(t) of the fuzzy PID controller is set to: Among them, K P , K I and K D are the proportional coefficient, integral coefficient and differential coefficient respectively, e(t) is the error signal between the expected sinusoidal signal r(t) input to the fuzzy PID controller and the actual output signal c(t), ΔK P , ΔK I and ΔK D They are the adjustment values ​​of the proportional coefficient, integral coefficient and differential coefficient output after calculation by the fuzzy PID controller; Use the Constant module in Simulink to set r(t) of the hip joint and knee joint, use the Sum module in Simulink to calculate the error signal e(t) between r(t) and c(t), use the Integrator module and Derivative module in Simulink to integrate and differentiate e(t) to obtain the integral signal and differential signal of e(t); Use the Fuzzy Logic Designer module in Simulink to complete the writing of fuzzy rules and determine the membership function of the fuzzy controller. Input the differential signals of e(t) and e(t) into the Fuzzy Logic Designer module, and the Fuzzy Logic Designer module outputs ΔK P , ΔK I and ΔK D ; Call a new MATLAB Function module, named Function3, and Write to Function3 and use the Constant module to set three PID parameters: K P , K I and K D , use the Sum module to convert K P , K I and K D Respectively with ΔK P , ΔK I and ΔK D Add together to get the PID parameters adjusted by fuzzy rules: K P +ΔK P , K I +ΔK I and K D +ΔK D ; e(t), the integral signal of e(t), the differential signal of e(t), K P +ΔK P , K I +ΔK I and K D +ΔK D Input into Function3, Function3 outputs the air pressure signal μ(t), and the construction of the fuzzy PID controller is completed.

5. The simulation method of the unilateral lower limb pneumatic muscle rehabilitation robot according to claim 1, characterized in that: The simulation construction of the unilateral lower limb pneumatic muscle rehabilitation robot in step 3 includes the following steps: Input μ(t) into the pneumatic muscle joint torque model, and the pneumatic muscle joint torque model obtains the output torque. Input the output torque into the two-link simulation model, and the two-link simulation model obtains the joint rotation angle to complete the simulation construction of the unilateral lower limb pneumatic muscle rehabilitation robot.

6. The simulation method of the unilateral lower limb pneumatic muscle rehabilitation robot according to claim 1, 2, 3, 4 or 5, characterized in that: The root mean square error E in step 4 RMS (t) The formula is as follows; Among them, t0 is the simulation start time, t f is the end time of simulation, c(t) is the control curve, that is, the actual output signal.

Citation Information

Cited By

  • Hydraulic joint control method based on AMESimm-Simulink joint simulation

    CN119328766A

  • A hydraulic joint control method based on AMESim-Simulink joint simulation

    CN119328766B

  • Control method of artificial muscle

    CN119937286A

  • A control method for an artificial muscle

    CN119937286B