The present invention relates to a control system and a method for controlling an actuated prosthesis. This invention is particularly well adapted for controlling an actuated leg prosthesis for above-knee amputees.
As is well known to control engineers, the automation of complex mechanical systems is not something easy to achieve. Among such systems, conventional powered artificial limbs, or myoelectric prostheses, as they are more commonly referred to, are notorious for having control problems. These conventional prostheses are equipped with basic controllers that artificially mobilize the joints without any interaction from the amputee and are only capable of generating basic motions. Such basic controllers do not take into consideration the dynamic conditions of the working environment, regardless of the fact that the prosthesis is required to generate appropriate control within a practical application. They are generally lacking in predictive control strategies necessary to anticipate the artificial limb's response as well as lacking in adaptive regulation enabling the adjustment of the control parameters to the dynamics of the prosthesis. Because human limb mobility is a complex process including voluntary, reflex and random events at the same time, conventional myoelectric prostheses do not have the capability to interact simultaneously with the human body and the external environment in order to have minimal appropriate functioning.
For example, in the case of artificial leg prostheses for above-knee amputees, the complexity of human locomotion resulted in that the technical improvements of conventional leg prostheses have until now been focused on passive mechanisms. This proved to be truly detrimental to the integration of motorized leg prostheses onto the human body. According to amputees, specific conditions of use of conventional leg prostheses, such as repetitive movements and continuous loading, typically entail problems such as increases in metabolic energy expenditures, increases of socket pressure, limitations of locomotion speeds, discrepancies in the locomotion movements, disruptions of postural balance, disruptions of the pelvis-spinal column alignment, and increases in the use of postural clinical rehabilitation programs.
The major problem remains that the energy used during mobility mainly stems from the user because conventional leg prostheses are not equipped with servomechanisms that enable self-propulsion. This energy compensation has considerable short and long-term negative effects resulting from the daily use of such prostheses. Accordingly, the dynamic role played by the stump during locomotion renders impossible the prolonged wearing of the prostheses as it may create, among other things, several skin problems such as folliculitis, contact dermatitis, edema, cysts, skin shearing, scarring and ulcers. Although these skin problems may be partially alleviated by using a silicone sheath, a complete suction socket, or powder, skin problems remain one of the major preoccupations today.
As well, the passive nature of the conventional leg prostheses typically leads to movement instability, disrupted movement synchronism and reduced speed of locomotion. Recent developments in the field of energy-saving prosthetic components have partially contributed to improve energy transfer between the amputee and the prosthesis. Nevertheless, the problem of energy expenditure is still not fully resolved and remains the major concern.
Considering this background, it clearly appears that there was a need to develop an improved control system and a new method for controlling an actuated prosthesis in order to fulfill the needs of amputees, in particular those of above-knee amputees.
In accordance with one aspect of the present invention, there is provided a method for determining a portion of locomotion and a phase of locomotion portion in view of controlling an actuated prosthesis in real time, the method comprising:
providing a plurality of main artificial proprioceptors;
receiving a data signal from each of the main artificial proprioceptors;
obtaining a first and a second derivative signal for each data signal;
obtaining a third derivative signal for at least one of the data signals;
using a set of a first state machines to select one state among a plurality of possible states for each main artificial proprioceptor with the corresponding data and derivative signals;
generating the phase of locomotion portion using the states of the main artificial proprioceptors; and
using a second state machine to select the portion of locomotion among a plurality of possible portions of locomotion using events associated to the data signals.
In accordance with another aspect of the present invention, there is provided a method for controlling an actuated prosthesis in real time, the method comprising:
providing a plurality of main artificial proprioceptors;
receiving a data signal from each of the main artificial proprioceptors;
obtaining a first and a second derivative signal for each data signal;
obtaining a third derivative signal for at least one of the data signals;
using a set of first state machines to select one state among a plurality of possible states for each main artificial proprioceptor with the corresponding data and derivative signals;
generating the phase of locomotion portion using the states of the main artificial proprioceptors;
using a second state machine to select the portion of locomotion among a plurality of possible portions of locomotion using events associated to the data signals;
calculating a locomotion speed value;
determining coefficient values from a lookup table using at least the phase of locomotion portion, the portion of locomotion and the locomotion speed value;
calculating at least one dynamic parameter value of the actuated prosthesis using the coefficient values from the lookup table; and
converting the dynamic parameter value into an output signal to control the actuated prosthesis.
In accordance with a further aspect of the present invention, there is provided a device for determining a portion of locomotion and a phase of locomotion portion in view of controlling an actuated prosthesis in real time using a plurality of main artificial proprioceptors, the device comprising:
a data signal input for each of the main artificial proprioceptors;
means for obtaining a first and a second derivative signal for each data signal;
means for obtaining a third derivative signal for at least one of the data signals;
a set of first state machines, the first state machines being used to select one state among a plurality of possible states for each main artificial proprioceptor with the corresponding data and derivative signals;
means for generating the phase of locomotion portion using the states of the main artificial proprioceptors; and
a second state machine, the second state means being used to select the portion of locomotion among a plurality of possible portions of locomotion using events associated to the data signals.
In accordance with a further aspect of the present invention, there is provided a control system for controlling an actuated prosthesis in real time, the system comprising:
a plurality of main artificial proprioceptors;
means for obtaining a first and a second derivative signal for each data signal;
means for obtaining a third derivative signal for at least one of the data signals;
a set of first state machines, the first state machines being used to select one state among a plurality of possible states for each main artificial proprioceptor with the corresponding data and derivative signals;
means for generating the phase of locomotion portion using the states of the main artificial proprioceptors;
a second state machine, the second state machine being used to select the portion of locomotion among a plurality of possible portions of locomotion using events associated to data signals;
means for calculating a locomotion speed value;
means for storing a lookup table comprising coefficient values with reference to at least phases of locomotion, portions of locomotion and locomotion speed values;
means for determining actual coefficient values from the lookup table using at least the phase of locomotion portion, the portion of locomotion and the locomotion speed value;
means for calculating at least one dynamic parameter value of the actuated prosthesis using the coefficient values from the lookup table; and
means for converting the dynamic parameter value into an output signal to control the actuated prosthesis.
These and other aspects of the present invention are described in or apparent from the following detailed description, which description is made in conjunction with the accompanying figures.
a to 8d are examples of four data signals using plantar pressure sensors during typical walking on flat ground;
a to 9d give an example of a data signal obtained from a plantar pressure sensor at the calcaneus region and its first three differentials;
a to 10d give an example of a data signal obtained from a plantar pressure sensor at the metatarsophalangeal (MP) region and its first three differentials;
a to 11d give an example of the states of a plantar pressure sensor with reference to the data signal and its three first differentiations for a plantar pressure sensor at the calcaneous region;
a to 12c give an example of the states of a plantar pressure sensor with reference to the data signal and its three first differentiation for a plantar pressure sensor at the metatarsophalangeal (MP) region;
The detailed description and figures refer to the following technical acronyms:
A/D Analog/Digital
BDW “Downward Inclined Walking—Beginning path” portion of locomotion
BGD “Going Down Stairs—Beginning path” portion of locomotion
BGU “Going Up Stairs—Beginning path portion of locomotion
BTW “Linear Walking—Beginning path” portion of locomotion
BTW_SWING Detection of typical walking gr
BUW “Upward Inclined Walking—Beginning path” portion of locomotion
CDW “Downward Inclined Walking—Cyclical path” portion of locomotion
CGD “Going Down Stairs—Cyclical path” portion of locomotion
CGU “Going Up Stairs—Cyclical path” portion of locomotion
CTW “Linear Walking—Cyclical path” portion of locomotion
CUW “Upward Inclined Walking—Cyclical path” portion of locomotion
ECW “Curve Walking Path” portion of locomotion
EDW “Downward Inclined Walking—Ending path” portion of locomotion
EGD “Going Down Stairs—Ending path” portion of locomotion
EGU “Going Up Stairs—Ending path” portion of locomotion
ETW “Linear Walking—Ending path” portion of locomotion
EUW “Upward Inclined Walking—Ending path” portion of locomotion
FR BIN Detection of a positive frx
FRfst_BIN Detection of positive first differentiation of frx
FRsec_BIN Detection of positive second differentiation of frx
FRtrd_BIN Detection of positive third differentiation of frx
FR_HIGH. Detection of frx level above the STA envelope
FR_LOW Detection of frx level between the zero envelope and the STA envelope
FSR Force Sensing Resistor
GR_POSy Detection of a positive gry
MIN_SIT Detection of a minimum time in portion SIT MPMetatarsophalangeal
PID Proportional-Integral-Differential
PKA_SDW Sit down knee angle
PKA_ETW End walking knee angle
PKA_STA Stance knee angle
PKA_SIT Sit down knee angle
PKA_SUP_RAMP Standing up knee angle
PPMV Plantar Pressure Maximal Variation
PPS Plantar Pressure Sensor
PRM Phase Recognition Module
REG Regulator
RF Radio Frequency
SDW “Sitting down” portion of locomotion
SIT “Sitting” portion of locomotion
STA “Stance of fee” portion of locomotion
STA_BIN Detection of a static evolution of all Frx
STATIC_GRy Detection of gry level below the zero angular speed envelope and the zero acceleration envelope
suma Localized plantar pressure signal of left foot
sumb Localized plantar pressure signal of right foot
sumc Localized plantar pressure signal of both calcaneus
sumd Localized plantar pressure signal of both MP
sume Localized plantar pressure signal of both feet
SUM_BINy Non-Zero of sums
SUP “Standing Up” portion of locomotion
SVD Singular Values Decomposition
SWINGy Detection of a swing prior to a foot strike
TG Trajectory Generator
XHLSB Heel Loading State Bottom (X=Left (L) or Right))
XHLSM Heel Loading State Middle (X=Left (L) or Right))
XHLST Heel Loading State Top (X=Left (L) or Right))
XHSTA Heel STAtic state (X=Left (L) or Right))
XHUSB Heel Unloading State Bottom (X=Left (L) or Right))
XHUST Heel Unloading State Top (X=Left (L) or Right))
XHZVS Heel Zero Value State (X=Left (L) or Right))
XMLSM MP Loading State Middle (X=Left (L) or Right))
XMLST MP Loading State Top (X=Left (L) or Right))
XMSTA MP STAtic state (X=Left (L) or Right))
XMUSB MP Unloading State Bottom (X=Left (L) or Right))
XMUST MP Unloading State Top (X=Left (L) or Right))
XMZVS MP Zero Value State (X=Left (L) or Right))
ZV_FRfstx Threshold to consider the first differentiation of frx to be positive
ZV_FRsecx Threshold to consider the second differentiation of frx to be positive
ZV_FRtrdx Threshold to consider the third differentiation of frx to be positive
ZV_FRx Threshold to consider frx to be positive
ZV_SUMfst Threshold to consider the absolute value of the 1st diff of sumy to be positive
ZV_SUMsec Threshold to consider the absolute value of the 2nd diff of sumy to be positive
The appended figures show a control system (10) in accordance with the preferred embodiment of the present invention. It should be understood that the present invention is not limited to the illustrated implementation since various changes and modifications may be effected herein without departing from the scope of the appended claims.
An artificial foot (24) is provided under a bottom end of the trans-tibial member (22). The knee member (20) comprises a connector (25) to which a socket (26) can be attached. The socket (26) is used to hold the sump of the amputee. The design of the knee member (20) is such that the actuator (14) has an upper end connected to another pivot on the knee member (20). The bottom end of the actuator (14) is then connected to a third pivot at the bottom end of the trans-tibial member (22). In use, the actuator (14) is operated by activating an electrical motor therein. This rotates, in one direction or another, a screw (28). The screw (28) is then moved in or out with reference to a follower (30), thereby changing the relative angular position between the two movable parts, namely the knee member (20) and the trans-tibial member (22).
It should be noted that the present invention is not limited to the mechanical configurations illustrated in
Referring back to
Preferably, feedback signals are received from sensors (36) provided on the prosthesis (12). In the case of an actuated leg prosthesis (12) such as the one illustrated in
The control system (10) shown in
The control system (10) further comprises a part called “Phase Recognition Module” or PRM (42). The PRM (42) is a very important part of the control system (10) since it is used to determine two important parameters, namely the portion of locomotion and the phase of locomotion portion. These parameters are explained later in the text. The PRM (42) is connected to a Trajectory Generator, or TG (44), from which dynamic parameters required to control the actuated prosthesis (12) are calculated to create the output signal. A lookup table (6) is stored in a memory connected to the TG (44). Moreover, the control system (10) comprises a regulator (48) at which the feedback signals are received and the output signal can be adjusted.
Software residing on an electronic circuit board contains all the above mentioned algorithms enabling the control system (10) to provide the required signals allowing to control the actuator (14). More specifically, the software contains the following three modules: the Phase Recognition Module (PRM), the Trajectories Generator (TG) and the Regulator (REG). Of course, any number of auxiliary modules may be added.
The artificial proprioceptors (16) preferably comprise main artificial proprioceptors and auxiliary artificial proprioceptors. The main artificial proprioceptors are preferably localized plantar pressure sensors which measure the vertical plantar pressure of a specific underfoot area, while the auxiliary artificial proprioceptors are preferably a pair of gyroscopes which measure the angular speed of body segments of the lower extremities and a kinematic sensor which measures the angle of the prosthesis knee joint. The plantar pressure sensors are used under both feet, including the artificial foot. It could also be used under two artificial feet if required. One of the gyroscopes is located at the shank of the normal leg while the other is located on the upper portion of the prosthesis above the knee joint. As for the kinematic sensor, it is located at the prosthesis knee joint. Other examples of artificial proprioceptors (16) are neuro-sensors which measure the action potential of motor nerves, myoelectrical electrodes which measure the internal or the external myoelectrical activity of muscles, needle matrix implants which measure the cerebral activity of specific region of the cerebrum cortex such as motor cortex or any other region indirectly related to the somatic mobility of limbs or any internal or external kinematic and/or kinetic sensors which measure the position and the torque at any joints of the actuated prosthesis. Of course, depending on the application, additional types of sensors which provide information about various dynamics of human movement may be used.
A PPMV of a given underfoot area of coordinates i,j during a given step denoted event x, is defined as stable, through a set of N walking steps, if the ratio of the absolute difference between this PPMV and the average PPMV over the set is inferior to a certain value representing the criteria of stability, thus:
where Δmaxfr,ij|x is the PPMV localized at underfoot area of coordinates i,j during the event x, thus
Δmaxfr,ij|x=fr,ijmax(k)|k→0 to K−fr,ijmin(k)|k→0 to K for the event x
K is the number of samples (frames),
N is the number of steps in the set,
S is the chosen criteria to define if a given PPMV is stable.
A PPMV of a given underfoot area of coordinates i,j during a given step denoted event x, is defined as rich in information, through a set of N walking steps, if the ratio between the PPMV and the average PPMV of the set is superior to certain value representing the criteria of richness thus:
where Δmaxfr,ij|x is the PPMV localized at underfoot area of coordinates i,j during the event x, thus
Δmaxfr,ij|x=fr,ijmax(k)|k→0 to K−fr,ijmin(k)|k→0 to K for the event x
K is the number of samples (frames),
N is the number of steps in the set,
R is the chosen criteria to define if a given PPMV is rich in information.
It was found by experimentation that the size and the position of plantar pressure sensor are well defined when the criteria are set at 5% and 10% for the stability and the richness PPMV respectively. As a result, it was found that the calcaneus and the Metatarsophalangeal (MP) regions are two regions of the foot sole where the PPMV may be considered as providing a signal that is both stable and rich in information.
In
The normalized position of the pressure sensors and their size are shown in Table 1, where the length L and the width W are respectively the length and the width of the subject's foot. The coefficients in Table 1 have been obtained by experimentation. A typical diameter for the plantar pressure sensors (16) is between 20 and 30 mm.
In use, the PRM (42) ensures, in real-time, the recognition of the phase of locomotion portion and the portion of locomotion of an individual based on the information provided by the artificial proprioceptors (16). The PRM (42) is said to operate in real time, which means that the computations and other steps are performed continuously and with almost no delay.
In accordance with the present invention, it was found that data signals received from individual artificial proprioceptors (16) can provide enough information in order to control the actuator (14) of an actuated prosthesis (12). For instance, in the case of plantar pressure sensors, it has been noticed experimentally that the slope (first derivative), the sign of the concavity (second derivative) and the slope of concavity (third derivative) of the data signals received from plantar pressure sensors, and of combinations of those signals, give highly accurate and stable information on the human locomotion. The PRM (42) is then used to decompose of the human locomotion into three levels, namely the states of each artificial proprioceptor (16), the phase of locomotion portion and the portion of locomotion. This breakdown ensures the proper identification of the complete mobility dynamics of the lower extremities in order to model the human locomotion.
The actual states of each main artificial proprioceptor depict the first level of the locomotion breakdown. This level is defined as the evolution of the main artificial proprioceptors' sensors during the mobility of the lower extremities. Each sensor has its respective state identified from the combination of its data signal and its first three differential signals. For the main artificial proprioceptors of the preferred embodiment, which provide information about localized plantar pressures, it has been discovered experimentally that the localized plantar pressures signals located at the calcaneous and at the metatarsophalangeal (MP) regions may be grouped into seven and six states respectively.
For the sensors at the calcaneous regions, the states are preferably as follows:
For the sensors at the MP regions, the states are preferably as follows:
Identifying the states at each sensor allows to obtain the second level of the locomotion breakdown, referred to as the phase of locomotion portion. The phase of locomotion portion is defined as the progression of the subject's mobility within the third level of locomotion breakdown, namely the portion of locomotion. This third level of the locomotion breakdown defines the type of mobility the subject is currently in, such as, for example, standing, sitting or climbing up stairs. Each locomotion portion contains a set of sequential phases illustrating the progression of the subject's mobility within that locomotion portion. The phase sequence mapping for each locomotion portion has been identified by experimentation according to the evolution of the state of the localized plantar pressures throughout the portion.
The portions of locomotion are preferably as follows:
For the selection of the portion of locomotion the subject is in, the algorithm uses the state machine approach. For this purpose, the algorithm uses a set of events which values define the conditions, or portion boundary conditions, to pass from one locomotion portion to another. These events are identified by experimentation according to the evolution of the localized plantar pressure signals, the complementary signals and their first three differentials, as well as the signals from the auxiliary artificial proprioceptors, when the subject passes from one locomotion portion to another.
Having determined the states of the main artificial proprioceptors' sensors, the phase of locomotion portion and portion of locomotion of the subject, the TG (44) can be used to calculate one or more dynamic parameter values to be converted to an output signal for the control of the actuator. Examples of dynamic parameter values are the angular displacement and the torque (or moment of force) at the knee joint of the actuated leg prosthesis (12). Since these values are given in real time, they provide what is commonly referred to as the “system's trajectory”. At any time k during the subject's locomotion, a mathematical relationship is selected according to the state of the whole system, that is the states of the main artificial proprioceptors, the phase of locomotion portion, the portion of locomotion and the walking speed. Following which, the angular displacement θkn and the moment of force mkn are then computed using simple time dependant equations and static characteristics associated with the state of the system, thereby providing the joint's trajectory to the knee joint member. This process is repeated throughout the subject's locomotion.
a to 8d show examples of data signals from the four localized plantar pressure sensors (16) during a standard walking path at 109.5 steps/minute. The four signals, fr1(t), ffr2(t), fr3(t) and fr4(t), correspond to the variation in time of the localized plantar pressure at the calcaneus region of the left foot (
In accordance with the present invention, the PRM (42) uses the first, the second and the third differentials of each of those four localized plantar pressure signals in order to determine the sensors' state. From there, the PRM (42) will be able to determine the phase of locomotion portion and portion of locomotion of the subject.
a to 9d and 10a to 10d show examples of graphs of localized plantar pressures, as well as their first, second and third differentials, at the calcaneus and MP regions respectively, for a linear walking path of 109.5 steps/minute.
a to 11d show graphically the state boundary conditions for a typical localized plantar pressure signal, and its first three differentials, at the calcaneous region, while
In use, for the detection of the state of the four localized plantar pressures, denoted frx where x=[1, 4], the PRM (42) uses a set of first state machines to select, at each increment in time, the current state of each sensor. For this purpose, the algorithm uses a set of events whose values define the conditions to pass from one state to another for each of the localized plantar pressures. Table 2 lists the events:
The conditions placed on the values of each of the depicted events of Table 2 define when the state machines pass from one state to another for each of the localized plantar pressures. Table 3 lists the thresholds used to assess if the aforementioned conditions are met, in which sumy depicts the five complementary signals, for y=[a, e] as described in Table 4, while Table 5 shows the mathematical form of the events used to evaluate the state boundary condition of the localized plantar pressures.
The normalization step, represented by block 106, consists in levelling the magnitude of the raw data signals according to the anthropomorphic characteristics of the subject such as, in the preferred embodiment, the subject's weight. The raw data signals of the four localized plantar pressures are divided by the total magnitude provided by the four sensors during calibration and then provided as the normalized local plantar pressures to block 110.
At block 112 the normalized raw signals of the four localized plantar pressures and their first three differentials are numerically filtered to reduce their spectral composition, as well as to limit the noise induced during the derivative computation. The preferred embodiment of the PRM (42) uses a 2nd order numerical filter in which the cut-off frequency, the damping factor and the forward shifting have been set, experimentally, to optimize the calculation according to the locomotion portion and the type of signal. The PRM (42) may use other types of numerical filters as well, for example a “Butterworth” filter, as long as the filter's dynamic is similar to the one provided by the 2nd order filter shown thereafter for each locomotion portion. Equation 4 shows the mathematical relationships of the 2nd order numerical filter which is implemented within the PRM (42). Table 8 provides examples of filtering parameters for three different portions of locomotion.
where ωn in the nth damping natural frequency,
ωr is called the resonance frequency for ζ<1
ζ is the damping factor
At block 110, the derivatives are obtained by the standard method consisting of numerically differentiating the current and the previous samples of localized plantar pressures.
The derivatives obtained at block 110 then go through binary formatting at block 114. The result of the binary formatting operation will be a “1” if the sign of the derivative is positive, “0” if it is negative. This step facilitates the identification of the sign changes of the differentiated signals as binary events.
At block 120, the PRM (42) determines the current state of each sensor using state machines such as the ones shown in
In the PRM (42), the states of the localized plantar pressures are preferably expressed as a 10-bit words in which each bit corresponds to a specific possible state. Tables 9 to 12 list the binary equivalents of each state of the localized plantar pressures at the calcaneous and the MP regions of the left and the right foot. Of course, words of different bit length may be used as well to represent the state of each localized plantar pressure.
At block 122, the PRM (42) generates the phase, which is preferably expressed as the direct binary combination of the states of the four localized plantar pressures. Accordingly, the phase can be represented by a 40-bit word wherein the lower part of the lower half word, the higher part of the lower half word, the lower part of the higher half word and the higher part of the higher half word correspond, respectively, to the calcaneous area of the left foot, the MP area of the left foot, the calcaneous area of the right foot and the MP area of the right foot, as represented in Tables 9 to 12. Table 13 presents an example of the identification of a phase from the states of the four localized plantar pressures.
At block 124, the PRM (42) selects the portion of locomotion the subject is currently using the state machine shown in
Accordingly, Table 14 presents the phases sequence mapping for the Beginning Path of Linear Walking (BTW) locomotion portion corresponding to
Table 15 enumerates a sample of boundary conditions associated with the locomotion portion of the sitting and typical walking on flat ground movements, while Table 3 lists the thresholds used to assess if the aforementioned conditions are met.
The normalization step of block 106 uses specific calibration values. These values are computed the first time a subject uses the actuated prosthesis (12) or at any other time as may be required. Two calibration values are preferably used: the zero calibration value and the subject's weight calibration value. The zero calibration value consists in the measurement of the four localized plantar pressures when no pressure is applied to the sensors, while the subject's weight calibration value is the subject's weight relative to the magnitude of the total response of the sensors.
The algorithm to obtain the zero calibration value of the sensors is depicted by the flow chart shown in
In a similar fashion, the algorithm to obtain the subject's weight calibration value is depicted by the flow chart shown in
where fs is the frame sampling frequency (frames/second).
A heel strike event occurs when:
THRESHOLDHEELLOADING<fri
At block 404, the algorithm uses the normalized localized plantar pressures, the phase of locomotion portion, the portion of the locomotion and the subject's speed in binary format to identify a set of linear normalized static characteristics linking the knee joint kinetic/kinematic parameters with the subject's locomotion in a lookup table. At block 406 the TG (44) comprises two transformation functions which compute the kinetic/kinematic parameters at time k, which are the angular displacement θkn(k) and the moment of force (torque) mkn(k), using the localized plantar pressures and their corresponding mathematical relationships (time-dependant equations and static characteristics) identified at block 404. The values of the kinetic/kinematic variables are then provided to the REG (48) at block 408.
The transformation functions used by the TG (44) at block 406 may generally be represented by a system of equations such as:
θg,h(k)=Ω1(θ1(k),χ(k),v(k))+Ω2(θ2(k),χ(k),v(k)+ . . . +Ωq-1(θq-1(k),χ(k),v(k))+Ωq(θq(k),χ(k),v(k)) Equation 7
m
g,h(k)=M1(θ1(k),χ(k),v(k))+M2(θ2(k),χ(k),v(k)+ . . . +Mq-1(θq-1(k),χ(k),v(k))+Mq(θq(k),χ(k),v(k)) Equation 8
where
In the case where the TG (44) uses polynomial relationships of order n, Equation 7 and Equation 8 become:
θg,h(k)=a1,1(χ(k),v(k))·θ1(k)+ . . . +a1,n(χ(k),v(k))·θ1(k)n+a2,1(χ(k),v(k))·θ2(k)+ . . . +a2,n(χ(k),v(k))·θ2(k)n+ . . . +aq-1,1(χ(k),v(k))·θq-1(k)+ . . . +aq-1,n(χ(k),v(k))·θq-1(k)n+ . . . +aq,1(χ(k),v(k))·θq(k)+ . . . +aq,n(χ(k),v(k))·θq(k)n Equation 9
m
g,h(k)=b1,1(χ(k),v(k))·θ1(k)+ . . . +b1,n(χ(k),v(k))·θ1(k)n+b2,1(χ(k),v(k))·θ2(k)+ . . . +b2,n(χ(k),v(k))·θ2(k)n+ . . . +bq-1,1(χ(k),v(k))·θq-1(k)+ . . . +bq-1,n(χ(k),v(k))·θq-1(k)n+ . . . +bq,1(χ(k),v(k))·θq(k)+ . . . +bq,n(χ(k),v(k))·θq(k)n Equation 10
where ai,j(χ(k)) and bi,j(χ(k)) i=1→q are the coefficients for the state χ(k) of the whole system and the walking speed v(k) and n is the order of the polynomial.
The preferred embodiment uses four localized plantar pressures, thus Equation 9 and Equation 10 become:
θg,h(k)=a1,1(χ(k),v(k))·fr1(k)+ . . . +a1,n(χ(k),v(k))·fr1(k)n+a2,1(χ(k),v(k))·fr2(k)+ . . . +a2,n(χ(k),v(k))·fr2(k)n+a3,1(χ(k),v(k))·fr3(k)+ . . . +a3,n(χ(k),v(k))·fr3(k)n+a4,1(χ(k),v(k))·fr3(k)+ . . . +a4,n(χ(k),v(k))·fr3(k)n Equation 11
m
g,h(k)=b1,1(χ(k),v(k))·fr1(k)+ . . . +b1,n(χ(k),v(k))·fr1(k)n+b2,1(χ(k),v(k))·fr2(k)+ . . . +b2,n(χ(k),v(k))·fr2(k)n+b1,1(χ(k),v(k))·fr3(k)+ . . . +b3,n(χ(k),v(k))·fr3(k)n+b4,1(χ(k),v(k))·fr3(k)+ . . . +b4,n(χ(k),v(k))·fr3(k)n Equation 12
where ai,j(χ(k)) and bi,j(χ(k)) i=1→q are the coefficients for the state χ(k) of the whole system and the walking speed v(k) and n is the order of the polynomial
Since all the kinetic/kinematic parameters θkn(k) and mkn(k) are computed from non-complex mathematical relationships, the computation of the trajectory is simple and fast and can be calculated by a non-sophisticated electronic circuit board.
The mathematical relationships (time-dependent equations and static characteristics) used in these non-complex mathematical relationships are contained in a lookup table referenced at block 404.
The method for building this TG lookup table depicted by the flow chart of
where
If it is considered that the family of functions in Equation 13 are dependant on the state of the system they depict, thus following system of equations is obtained:
where
In the preferred embodiment, x, may be substituted by the localized plantar pressures denoted fri
where
Previously, yg,h has been defined as the estimated kinematic ({circumflex over (θ)}g,h) or kinetic ({circumflex over (m)}g,h) variable for the g lower extremities joints through the h plan of motion. Thus, Equation 15 may be written as:
The goal is the identification of the Equation 16 and Equation 17 functions from a set of II, samples, obtained from experimentation. A sample contains data related to the locomotion related phenomenon along with the corresponding kinematic (θg,h) or kinetic (mg,h) variables.
The following array of data is obtained from experimentation:
The logical functions aj,i(x) are then presented in the form of a look-up table, as shown in the following example:
Table 18 establishes the relationship between the time dependent state vector of the system, the locomotion related phenomenon and the kinematic and the kinetic variables of the lower extremities joints, which are the following static characteristics:
{circumflex over (θ)}g,h=fθ(x,x) Equation 18
{circumflex over (m)}
g,h
=f
m(x,x) Equation 19
The methodology used to identify the parameters aj,i(x) is based on the application of a curve-fitting algorithm to a set of data provided from experimentation on human subjects. This experimentation is performed in a laboratory environment under controlled conditions, yielding a set of data in the form of an array, as shown in Table 17.
The curve-fitting algorithm is used to obtain the parameters aj,i(x) for every given time dependant state vector x. This data is used to construct the look-up table, as shown in Table 18.
An example of configuration for the method previously described is presented below:
the particularities of this configuration are:
the selected lower extremities joints is the knee joint, which is the joint between the thigh (th) and the shank (sh);
the selected plan of motion is the sagittal plan;
In the case where Equation 16 and Equation 17 are linear functions, the time dependant state vector further comprises the binary formatted magnitude of the four localized plantar pressures as added parameters to further segment the curve representing the kinematic (θg,h) or kinetic (mg,h) variables. This is due to the fact that, as shown by
It should be noted that in the preferred embodiment, the lookup table contains mathematical relationships that have been normalized in amplitude. The TG (44) uses the relative value of the localized plantar pressures instead of the magnitude of the signal. This means that the localized plantar pressures are set into a [0, 1] scale for a specific state of the whole system χ(k). This ensures that the mathematical relationships (time-dependant equations and static characteristics) are independent of the weight of the subject. It is worth to note that, because the TG's architecture use the walking speed as a component of the state of the whole system, the static characteristics lookup table is valid for any walking speed comprised within the operational conditions, which are, in the preferred embodiment, between 84 and 126 steps/min, though the lookup table may be computed for other intervals.
The Regulator (48) uses a control law with a similar structure to control algorithms currently employed in numerous commercial or experimental applications. Various control laws may be implemented in the Regulator (48), examples of which are provided below.
First, the Regulator (48) may use a simple PID control law, which is written as:
μ(t)=kd
where
applied to the proposed system, that is x=θ or x=m, we have:
μg,hx(t)=kd
where
x=θ or m
where the transfer function between the error
where
in which the corresponding recurrent equation is:
μg,hx(k)=μg,hx(k−1)+b0·
where
Secondly, the Regulator (48) may use an adaptive PID control law. The transfer function of an adaptive PID is the same as that of a conventional PID but the parameters b2, b1 and b0 are function of the state of the whole system χ(k). From Equation 23, the recurrence equation of the adaptive PID is:
μg,hx(k)=μg,hx(k−1)+b0(χ(k))·
where
Thirdly, the Regulator (48) may use a conventional PID with measured moment, which may be written as:
f
g,h
μ(k)=fg,hm(k)+
where
Form Equation 22, the transfer function between the position error
where
Thus, the recurrent equation of the final force set point fg,hμ(k) is given by the following relationship:
f
g,h
μ(k)=fm(k)+
where
The present application is a continuation of U.S. patent application Ser. No. 12/987,801 filed Jan. 10, 2011, entitled “CONTROL DEVICE AND SYSTEM FOR CONTROLLING AN ACTUATED PROSTHESIS,” which is a continuation of U.S. patent application Ser. No. 11/270,684 filed Nov. 9, 2005, now issued as U.S. Pat. No. 7,867,284, entitled “CONTROL DEVICE AND SYSTEM FOR CONTROLLING AN ACTUATED PROSTHESIS,” which is a divisional of U.S. patent application Ser. No. 10/600,725 filed Jun. 20, 2003, now issued as U.S. Pat. No. 7,147,667, which claims the benefit of U.S. provisional patent application Nos. 60/453,556 filed Mar. 11, 2003, 60/424,261 filed Nov. 6, 2002, and 60/405,281 filed Aug. 22, 2002, all of which are hereby incorporated by reference in their entirety.
Number | Date | Country | |
---|---|---|---|
60405281 | Aug 2002 | US | |
60424261 | Nov 2002 | US | |
60453556 | Mar 2003 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 10600725 | Jun 2003 | US |
Child | 11270684 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 12987801 | Jan 2011 | US |
Child | 13944778 | US | |
Parent | 11270684 | Nov 2005 | US |
Child | 12987801 | US |