Active prosthetic foot control method and system and terminal sliding mode controller

An active prosthetic foot control method designed using a terminal sliding mode controller solves the problems of stability and anti-interference during walking, enabling smooth walking in complex road conditions.

CN114594780BActive Publication Date: 2024-11-12NAT REHABILITATION ASSISTIVE DEVICES RES CENT
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210081772.7
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-01-24
Publication Date
2024-11-12
Estimated Expiration
2042-01-24

AI Technical Summary

Technical Problem

Lower limb prosthetic feet are easily affected by changes in road conditions when walking, resulting in insufficient stability and resistance to interference.

Method used

An active prosthetic foot control method is designed using an end-sliding controller. By establishing a general dynamic model of the prosthetic foot ankle joint, designing the end-sliding surface, and calculating the joint torque to resist external disturbances, the stability and anti-interference of the prosthetic foot are ensured.

Benefits of technology

It improves the stability and anti-interference ability of the prosthetic foot during walking, enabling it to walk smoothly in complex road conditions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114594780B_ABST
    Figure CN114594780B_ABST
Patent Text Reader

Abstract

The present invention discloses an active prosthetic foot control method and system, and also relates to a terminal sliding mode controller, which designs a terminal sliding mode surface by introducing terminal sliding mode and integral sliding mode, and analyzes and proves the stability of the algorithm, which can well improve the stability and anti-interference of the prosthetic foot.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of prosthetic control, in particular to an active prosthetic foot control method and system, and also to a terminal sliding mode controller. Background Art

[0002] The lower limb prosthesis may encounter some interference when walking, such as encountering a stone road surface, encountering a stone, entering sandy land from flat land, etc., which will cause disturbance to the prosthesis. Summary of the invention

[0003] In response to the problems of stability and anti-interference in related technologies, the present invention proposes an active prosthetic foot control method and designs a terminal sliding surface so that the prosthetic foot has higher stability and anti-interference, allowing the prosthetic foot to walk smoothly.

[0004] The technical solution of the present invention is achieved in this way:

[0005] According to one aspect of the present invention, there is provided an active prosthetic foot control method, comprising the following steps:

[0006] S1, based on the human walking scene, the general dynamic model of the artificial ankle joint is established as follows:

[0007]

[0008] Among them, θ∈R n represents the ankle joint angle, represents the angular velocity, represents angular acceleration, M(θ)∈R n×n represents the symmetric positive definite inertia matrix, Represents the Coriolis force and centrifugal force matrix, G(θ)∈R n represents the gravity matrix, τ∈R n represents the joint torque output by the controller to the system, and D is the bounded external disturbance.

[0009] S2, the design of terminal sliding mode controller,

[0010] make:

[0011]

[0012] Substituting equation (2) into equation (1) to transform it into the state equation, we get the following equation:

[0013]

[0014] The ideal ankle angle is x d =θ d , the joint angle error is defined as:

[0015] The terminal sliding surface is designed as follows:

[0016]

[0017] Among them, sig(e) 2-γ =|e| 2-γ sign(e), Λ>0, α>0, β>0, 1<2-γ<2, γ is the ratio of two positive odd numbers;

[0018] According to the joint angle error, the terminal sliding mode controller is designed as:

[0019]

[0020] Among them, k s >η>0.

[0021] According to an embodiment of the present invention, the stability analysis process of the designed terminal sliding mode controller is as follows:

[0022] Take the Lyapunov function:

[0023]

[0024] Joint error The derivative is:

[0025]

[0026] Derivative of formula (6):

[0027]

[0028] Substituting formula (5) into formula (8) yields:

[0029]

[0030] Among them, α>0,1<2-γ<2,0<1-γ<1,k s >η>0, when hour, Then formula (9) can be written as:

[0031]

[0032] Therefore, when When , the designed terminal sliding mode controller satisfies the Lyapunov stability condition.

[0033] According to another aspect of the embodiments of the present invention, a terminal sliding mode controller is provided. The terminal sliding mode controller uses the above-mentioned active prosthetic foot control method to drive a prosthetic foot.

[0034] According to another aspect of the embodiments of the present invention, there is also provided an active prosthetic foot control system, comprising the following modules:

[0035] The model building module is used to build a general dynamic model of the artificial ankle joint based on the human walking scene as follows:

[0036]

[0037] Among them, θ∈R n represents the ankle joint angle, represents the angular velocity, represents angular acceleration, M(θ)∈R n×n represents the symmetric positive definite inertia matrix, Represents the Coriolis force and centrifugal force matrix, G(θ)∈R n represents the gravity matrix, τ∈R n represents the joint torque output by the controller to the system, and D is the bounded external disturbance;

[0038] Model conversion module, used to convert the model.

[0039] make:

[0040]

[0041] Substituting equation (2) into equation (1) to transform it into the state equation, we get the following equation:

[0042]

[0043] The desired ankle angle is x d =θ d , the joint angle error is defined as:

[0044] The controller parameter calculation module is used to calculate the desired ankle joint angle θ according to the input d , the wearer's condition and the controller-related adjustment parameters required for torque calculation. The controller-related adjustment parameters include Λ, α, β, γ, k s ;

[0045] Sliding surface module, where the terminal sliding surface is designed as:

[0046]

[0047] Among them, sig(e) 2-γ =|e| 2-γ sign(e), Λ>0, α>0, β>0, 1<2-γ<2, γ is the ratio of two positive odd numbers;

[0048] Controller for the desired ankle joint angle θ based on the input d The parameters related to the controller are adjusted, and the torque τ required for the prosthetic foot movement is calculated according to the input parameters. The calculation formula of the torque τ is:

[0049]

[0050] Among them, k s >η>0;

[0051] The controller is also used to drive the prosthetic foot using the calculated torque τ. BRIEF DESCRIPTION OF THE DRAWINGS

[0052] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0053] Figure 1 is a flow chart of an active prosthetic foot control method according to an embodiment of the present invention.

[0054] Figure 2 is a schematic diagram showing ankle joint related parameters.

[0055] Figure 3 is a control block diagram according to an embodiment of the present invention. DETAILED DESCRIPTION

[0056] The following will be combined with the accompanying drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field belong to the scope of protection of the present invention.

[0057] According to an embodiment of the present invention, a method for controlling an active prosthetic foot is provided. Figure 1 : is a flow chart of the active prosthetic foot control method according to an embodiment of the present invention. In view of the fact that the prosthetic foot is easily disturbed when walking, the active prosthetic foot control method of the present invention provides a terminal sliding mode controller (hereinafter referred to as a controller) to weaken the influence of the disturbance on the prosthetic foot, so that the prosthetic foot can walk smoothly. Figure 1 As shown, the active prosthetic foot control method mainly includes steps S1-S4.

[0058] 1. In step S1

[0059] Based on the human walking scene, the general dynamic model of the prosthetic ankle joint is established as follows:

[0060]

[0061] Among them, θ∈R n represents the ankle joint angle, represents the angular velocity, represents angular acceleration, M(θ)∈R n×n represents the symmetric positive definite inertia matrix, Represents the Coriolis force and centrifugal force matrix, G(θ)∈R n represents the gravity matrix, τ∈R n represents the joint torque output by the controller to the system, D is the bounded external disturbance, and |D|≤η. Among them, η represents the upper bound of the bounded external disturbance, that is, the maximum value of the disturbance.

[0062] Figure 2 The ankle joint angle θ is shown in FIG. Figure 2 As shown, m1 and l1 are the mass and length of the lower leg 210, respectively, and m2 and l2 are the mass and length of the sole 220. M(θ) is a positive definite matrix related to m1, l1, m2, l2 and the ankle joint angle θ. is related to m1, l1, m2, l2, ankle joint angle θ, angular velocity The related matrix, G(θ) is the matrix related to m1, l1, m2, l2, ankle joint angle θ and gravitational acceleration g.

[0063] In order to facilitate the subsequent controller control, the general dynamic model of the artificial ankle joint established above is transformed.

[0064] Specifically,

[0065]

[0066] For easier mathematical derivation, x1 is used to represent the ankle joint angle and x2 is used to represent the ankle joint angular velocity.

[0067] Substituting equation (2) into equation (1) and transforming it into the state equation, we can obtain:

[0068]

[0069] The ideal ankle angle is x d =θ d , the joint angle error is defined as:

[0070] 2. At step S2

[0071] Input the desired ankle joint angle θ dAccording to the wearer's condition and the torque calculation formula, the controller-related adjustment parameters required include Λ, α, β, γ, k s . Figure 3 is a control block diagram according to an embodiment of the present invention. Figure 3 As shown, the desired ankle joint angle θ d As input.

[0072] 3. At step S3

[0073] In order to make the prosthetic ankle joint follow the desired angle more accurately and improve the stability of the human-machine statistical system, a controller is designed.

[0074] The terminal sliding surface is designed as follows:

[0075]

[0076] Among them, sig(e) 2-γ =|e| 2-γ sign(e), Λ>0, α>0, β>0, 1<2-γ<2, γ is the ratio of two positive odd numbers.

[0077] Based on the input desired ankle angle θ d The controller is related to the adjustment parameters. The controller calculates the torque τ required for the lower limb prosthetic foot movement according to the input parameters. The calculation formula of the torque τ calculated by the controller is:

[0078]

[0079] where k s >η>0. Λ, α, β, γ and k s It is the coefficient for adjusting the variables in the controller.

[0080] Step S4

[0081] The calculated torque τ drives the lower limb prosthesis. Figure 3 As shown, the controller 310 drives the lower limb prosthetic foot 320 to move with the calculated torque τ, and the actual angle θ of the lower limb prosthetic foot 320 can be obtained. If interference D is encountered during the movement of the prosthetic foot, the actual angle θ is different from the ideal angle θ. d There will be an error e. In the case of error e, steps S3 and S4 will be repeated until the actual movement angle θ obtained by the controller 310 driving the lower limb prosthetic foot 320 is consistent with the ideal angle θ. d same.

[0082] 5. Conduct stability analysis and proof of the designed controller.

[0083] Take the Lyapunov function:

[0084]

[0085] Derivative of the joint error:

[0086]

[0087] Derivative of formula (6):

[0088]

[0089] Substituting formula (5) into formula (8) yields:

[0090]

[0091] Because α>0,1<2-γ<2,0<1-γ<1,k s >η>0, when hour, Then formula (9) can be written as:

[0092]

[0093] Therefore, when When , the controller designed in this paper satisfies the Lyapunov stability condition, and the characteristics of the terminal sliding mode show that it converges in global finite time.

[0094] The embodiment of the present invention further provides a terminal sliding mode controller, which uses the above-mentioned active prosthetic foot control method to drive the prosthetic foot.

[0095] An embodiment of the present invention further provides an active prosthetic foot control system, which includes a model building module, a model conversion module, a controller parameter calculation module, a sliding surface module and a controller.

[0096] The model building module is used to build a general dynamic model of the artificial ankle joint based on the human walking scene as follows:

[0097]

[0098] Among them, θ∈R n represents the ankle joint angle, represents the angular velocity, represents angular acceleration, M(θ)∈R n×n represents the symmetric positive definite inertia matrix, Represents the Coriolis force and centrifugal force matrix, G(θ)∈R n represents the gravity matrix, τ∈R n represents the joint torque output by the controller to the system, and D is the bounded external disturbance.

[0099] The model conversion module is used to convert the model.

[0100]

[0101] Substituting equation (2) into equation (1) to transform it into the state equation, we get the following equation:

[0102]

[0103] The desired ankle angle is x d =θ d , the joint angle error is defined as:

[0104] The controller parameter calculation module is used to calculate the desired ankle joint angle θ according to the input d , wearer conditions and controller-related adjustment parameters required for torque calculation. Controller-related adjustment parameters include Λ, α, β, γ, k s .

[0105] In the sliding surface module, the terminal sliding surface is designed as:

[0106]

[0107] Among them, sig(e) 2-γ =|e| 2-γ sign(e), Λ>0, α>0, β>0, 1<2-γ<2, γ is the ratio of two positive odd numbers.

[0108] The controller is used to determine the desired ankle joint angle θ based on the input d The parameters related to the controller are adjusted, and the torque τ required for the prosthetic foot movement is calculated according to the input parameters. The calculation formula of the torque τ is:

[0109]

[0110] Among them, k s >η>0.

[0111] The controller is also used to drive the prosthetic foot using the calculated torque τ.

[0112] In summary, the present invention designs a terminal sliding surface by introducing terminal sliding mode and integral sliding mode, and analyzes and proves the stability of the algorithm. The active prosthetic foot control method of the present invention can better improve the stability and anti-interference of the prosthetic foot.

[0113] 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. An active prosthetic foot control method, characterized in that: The following steps are involved: S1, based on the human walking scene, the general dynamic model of the artificial ankle joint is established as follows: Among them, θ∈R n represents the ankle joint angle, represents the angular velocity, represents angular acceleration, M(θ)∈R n×n represents the symmetric positive definite inertia matrix, Represents the Coriolis force and centrifugal force matrix, G(θ)∈R n represents the gravity matrix, τ∈R n represents the joint torque output by the controller to the system, and D is the bounded external disturbance; Transform the model. make: Substituting equation (2) into equation (1) to transform it into the state equation, we get the following equation: The desired ankle angle is x d =θ d , the joint angle error is defined as: S2, input the expected ankle joint angle θ that has been collected d , according to the wearer's condition and the controller-related adjustment parameters required for torque calculation, the controller-related adjustment parameters include Λ, α, β, γ, k s ; S3, the terminal sliding surface is designed as: Among them, sig(e) 2-γ =|e| 2-γ sign(e), Λ>0, α>0, β>0, 1<2-γ<2, γ is the ratio of two positive odd numbers; Based on the input of the desired ankle angle θ d The controller is related to the adjustment parameters. The controller calculates the torque τ required for the prosthetic foot movement according to the input parameters. The calculation formula of the torque τ is: Among them, k s >η>0; S4, the prosthetic foot is driven by the calculated torque τ.

2. The active prosthetic foot control method according to claim 1, characterized in that: The stability analysis process of the designed terminal sliding mode controller is as follows: Take the Lyapunov function: Joint error The derivative is: Derivative of formula (6): Substituting formula (5) into formula (8) yields: Among them, α>0,1<2-γ<2,0<1-γ<1,k s >η>0, when hour, Then formula (9) can be written as: Therefore, when When , the designed terminal sliding mode controller satisfies the Lyapunov stability condition.

3. A terminal sliding mode controller, characterized in that: The active prosthetic foot control method according to any one of claims 1 to 2 is used to drive the prosthetic foot.

4. An active prosthetic foot control system, characterized in that: Includes the following modules: The model building module is used to build a general dynamic model of the artificial ankle joint based on the human walking scene as follows: Among them, θ∈R n represents the ankle joint angle, represents the angular velocity, represents angular acceleration, M(θ)∈R n×n represents the symmetric positive definite inertia matrix, Represents the Coriolis force and centrifugal force matrix, G(θ)∈R n represents the gravity matrix, τ∈R n represents the joint torque output by the controller to the system, and D is the bounded external disturbance; Model conversion module, used to convert the model. make: Substituting equation (2) into equation (1) to transform it into the state equation, we get the following equation: The desired ankle angle is x d =θ d , the joint angle error is defined as: The controller parameter calculation module is used to calculate the desired ankle joint angle θ according to the input d , the wearer's condition and the controller-related adjustment parameters required for torque calculation, the controller-related adjustment parameters include Λ, α, β, γ, k s ; Sliding surface module, where the terminal sliding surface is designed as: Among them, sig(e) 2-γ =|e| 2-γ sign(e), Λ>0, α>0, β>0, 1<2-γ<2, γ is the ratio of two positive odd numbers; A controller for determining the desired ankle joint angle θ based on the input d The controller is related to the adjustment parameters, and the torque τ required for the prosthetic foot movement is calculated according to the input parameters. The calculation formula of the torque τ is: Among them, k s >η>0; The controller is further configured to drive the artificial foot according to the calculated torque τ.