PROSTHETIC, ORTHOTIC OR EXOSKELETON DEVICE
20230398001 · 2023-12-14
Inventors
- Hugh Miller Herr (Somerville, MA)
- Zhixiu Han (Acton, MA)
- Christopher Eric Barnhart (Carlisle, MA)
- Richard J. Casler, Jr. (Lowell, MA)
Cpc classification
A61F2002/7635
HUMAN NECESSITIES
A61F2002/503
HUMAN NECESSITIES
A61F2002/7645
HUMAN NECESSITIES
A61F2002/701
HUMAN NECESSITIES
International classification
A61B5/11
HUMAN NECESSITIES
A61B5/00
HUMAN NECESSITIES
Abstract
A time-dependent decay behavior is incorporated into one or more joint actuator control parameters during operation of a lower-extremity, prosthetic, orthotic or exoskeleton device. These parameters may include joint equilibrium, joint impedance (e.g., stiffness, damping) and/or joint torque components (e.g., gain, exponent). The decay behavior may be exponential, linear, piecewise, or may conform to any other suitable function. Embodiments presented herein are used in a control system that emulates biological muscle-tendon reflex response providing for a natural walking experience. Further, joint impedance may depend on an angular rate of the joint. Such a relationship between angular rate and joint impedance may assist a wearer in carrying out certain activities, such as standing up and ascending a ladder.
Claims
1. A prosthesis, orthosis or exoskeleton device, comprising: a joint constructed and arranged to permit flexion and extension between a proximal member and a distal member; a motorized actuator configured to apply at least one of a joint impedance referenced to a joint equilibrium or a joint torque; a sensor configured to detect a characteristic of the device; and a controller configured to modulate a parameter comprising at least one of the joint equilibrium, the joint impedance and the joint torque according to the detected characteristic, the modulated parameter exhibiting time-dependent decay behavior.
2. The device of claim 1, wherein the detected characteristic comprises at least one of a phase and a change in a phase of joint motion in a repetitive cycle, each occurrence of the cycle comprising a plurality of phases; and the time-dependent decay behavior comprises a decaying time response to the modulated parameter according to at least one of the detected phase and the detected change in phase of joint motion, wherein a duration of the time-dependent decay behavior comprises at least one phase of the one cycle.
3. The device of claim 1, wherein the joint torque comprises a positive force-feedback component comprising at least one of a gain and an exponent as applied to the joint torque.
4. The apparatus of claim 3, wherein the at least one of the gain or the exponent are modulated as a function of at least one of a proximal member angular rate, a distal member angular rate and a torque rate.
5. The device of claim 4, wherein the positive force feedback component comprises a function of a rate of change of at least one of a joint torque and an actuator torque.
6. The device of claim 1, wherein the modulated parameter comprises at least one of a proximal member angular rate, a distal member angular rate and at least one of a joint torque rate and an actuator torque rate.
7. The device of claim 1, wherein the time-dependent decay behavior comprises an exponential decay.
8. The device of claim 1, wherein the sensor is configured to detect a joint position and the controller is configured to modulate the joint equilibrium to converge with the detected joint position.
9. The apparatus of claim 1, wherein the device is a knee prosthesis, orthosis or exoskeleton.
10. The device of claim 1, wherein the joint impedance includes at least one of a stiffness and damping.
11. The device of claim 10, wherein the stiffness comprises an early stance flexion stiffness.
12. The apparatus of claim 10, wherein the stiffness comprises a knee flexion stiffness that is a function of knee joint angular rate.
13. The apparatus of claim 1, wherein the joint torque is in a late stance and is a positive force feedback component.
14. The apparatus of claim 13, wherein the positive force feedback component modulates a positive force feedback as a function of a rate of change of the joint torque.
15. The apparatus of claim 14, wherein the at least one of the gain or the exponent are modulated according to at least one of the detected phase and a change in the detected phase.
16. A method comprising: actuating the motorized actuator of claim 1 to apply the at least one of the joint impedance or the joint torque; and applying the controller to modulate the parameter.
17. The method of claim 16, wherein the detected characteristic comprises at least one of a phase and a change in a phase of joint motion in a repetitive cycle, each occurrence of the cycle comprising a plurality of phases; and the time-dependent decay behavior comprises a decaying time response to the modulated parameter according to at least one of the detected phase and the detected change in phase of joint motion, wherein a duration of the time-dependent decay behavior comprises at least one phase of the one cycle.
18. The method of claim 16, wherein the joint torque comprises a positive force-feedback component comprising at least one of a gain and an exponent as applied to the joint torque.
19. A controller for a prosthesis, orthosis or exoskeleton device comprising a joint constructed and arranged to permit flexion and extension between a proximal member and a distal member, a motorized actuator configured to apply at least one of a joint impedance referenced to a joint equilibrium or a joint torque, and a sensor configured to detect a characteristic of the device, the controller comprising a processor; and a non-transitory computer-readable medium storing instructions that, when executed by the processor, configure the processor to: modulate a parameter comprising at least one of the joint equilibrium, the joint impedance and the joint torque according to the detected characteristic, the modulated parameter exhibiting time-dependent decay behavior.
20. The controller of claim 19, wherein the detected characteristic comprises at least one of a phase and a change in a phase of joint motion in a repetitive cycle, each occurrence of the cycle comprising a plurality of phases; and the time-dependent decay behavior comprises a decaying time response to the modulated parameter according to at least one of the detected phase and the detected change in phase of joint motion, wherein a duration of the time-dependent decay behavior comprises at least one phase of the one cycle.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0013] Aspects of the present disclosure are described with reference to the following drawings in which numerals reference like elements, and wherein:
[0014]
[0015]
[0016]
[0017]
[0018]
[0019]
[0020]
[0021]
[0022]
[0023]
[0024]
[0025]
[0026]
[0027]
[0028]
[0029]
[0030]
[0031]
[0032]
[0033]
[0034]
[0035]
[0036]
[0037]
[0038]
[0039]
[0040]
[0041]
[0042]
[0043]
[0044]
[0045]
DETAILED DESCRIPTION
[0046] Various embodiments of the present disclosure relate to a biologically-inspired, sensing and control architecture for bionic leg actuation (e.g., knee joint actuation, ankle joint actuation). As described herein, a bionic device may function to restore or replace anatomical structure(s) and/or exhibit physiological process(es), with one or more electro-mechanical components. For instance, bionic devices of the present disclosure may emulate stance-phase kinetics (e.g., torque and power) that may occur naturally in intact limbs. Bionic leg joints described herein may employ a series-elastic actuator (SEA) to amplify mechanical power, to enable closed-loop torque control and to enable sensing of actuator torque through a model of the torque-displacement characteristics. In some embodiments, an ankle device may employ a hardstop with known flexion characteristics that limits dorsiflexion travel of the joint. A control system modulates joint impedance (e.g., stiffness, damping), joint equilibrium (e.g., equilibrium location) and joint torque (e.g., motor reflex gain, motor reflex exponent) in accordance with gait cycle state and walking speed, a surrogate for walking speed, or the rate of change of a state variable or sensor in the actuator control system. In some embodiments, the rate of change of the state variable may include an inertial pitch rate (e.g., of a tibial component) and/or an actuator torque rate (e.g., of an ankle or knee joint), shortly after foot strike.
[0047] In some embodiments, one or more parameters controlled by the system may exhibit time-dependent behavior. For example, the joint impedance, joint stiffness, joint damping, joint equilibrium, reflex torque gain, reflex torque exponent, or another suitable parameter(s) may employ a time decay (e.g., value of the parameter diminishes over time) during an appropriate phase of gait. Such a decay may exhibit any suitable functional behavior, such as exponential, linear, piecewise, etc. This type of behavior, in some cases, may also provide for a natural experience to the wearer, for example, without producing a feeling of abruptness upon changes in the phase of gait. For instance, a gradual lessening of ankle stiffness upon entry into an Early Stance mode may allow for a wearer to rollover smoothly in a natural manner such that mode changes (i.e., state transitions) of the device are transparent (e.g., almost unnoticeable).
[0048] As used herein, a phase of gait may describe a particular state of the device, which may be triggered by a gait event (e.g., heel-strike, toe-off). For example, a phase of gait may refer to: a state transition in a leg prosthesis control system, such as in a joint actuator controller; the inertial state of proximal and distal members of the device; and/or changes in one or more components of the inertial state of the proximal and distal members of the device.
[0049] As used herein, a motorized actuator or motorized actuation system may include any suitable motor. For example, motorized actuators may incorporate one or more electric motors, hydraulic motors, pneumatic motors, piezo-actuated motors, shape-memory motors, electro-polymer motors, or any other appropriate motorized device.
[0050] As used herein, a characteristic of motion of a device may include one or more of the following: an inertial pose of distal and proximal members of the device; changes in the inertial pose of the distal and proximal members of the device; translational velocity or angular rate of one or more points on the distal and proximal members; kinetics, including force, torque and power, and the derivatives thereof at the joints and at the interface between the device and ground; kinematics, including joint angles, and derivatives thereof; dynamic actuator state(s), including force, torque, displacement in the motor drive and transmission, including the elastic elements embodied within the transmission; and other appropriate characteristics.
[0051] While neuroscientists identify increasingly complex neural circuits that control animal and human gait, biomechanists have found that locomotion requires little outside control if principles of legged mechanics are heeded that shape and exploit the dynamics of legged systems. Embodiments according to the present disclosure may include muscle reflex response(s) that encode principles of legged mechanics, and provide a link to the above observations surrounding the behavior of natural limbs. Equipped with reflex control, various embodiments of bionic devices presented herein reproduce human walking dynamics and leg kinetics and kinematics; tolerate ground disturbances; and adapt to slopes without outside parameter intervention(s), such as might otherwise be informed by inertial sensor inputs, neural or cognitive functions. Accordingly, aspects/parameters of the bionic response may be appropriately encoded to adaptively modulate one or more parameters based upon intrinsic kinematic and kinetic measures (e.g., angle and torque including their derivatives) or extrinsic interventions arising from measures of walking speed and terrain (as might be supplied by an inertial measurement unit, for instance), so as to suitably emulate the muscle-tendon reflex. Aspects described herein may employ principles described in the article by Geyer, H. and Herr, H, entitled “A Muscle-Reflex Model that Encodes Principles of Legged Mechanics Produces Human Walking Dynamics and Muscle Activities,” submitted to IEEE Transactions on Neural Systems and Rehabilitation Engineering and accepted in 2010, the disclosure of which is hereby incorporated herein by reference in its entirety.
[0052] It can be appreciated that embodiments of the present disclosure are not required to incorporate a state machine that transitions from one discrete state to another in a gait cycle. For instance, a mere change in inertial state across a gait cycle (e.g., based on the use of a rate gyroscope to measure a rate of tibial pitch) may be a pail of a gait cycle phase.
[0053] Systems described herein may be incorporated in devices made by iWalk. Inc., such as in the BiOM.sup.T2. In some cases, the BiOM.sup.T2 device employs a series-elastic actuator (SEA) that incorporates a biophysically-based, reflexive control system. This system emulates dominant muscle-tendon behavior, during walking, of the ankle plantar flexors, the Soleus and Gastrocnemius calf muscles, as well as the dominant dorsiflexor, the Tibialis Anterior. The SEA may control ankle joint impedance (e.g., stiffness, damping), virtual spring equilibrium and/or reflexive torque. The SEA system may enable sensing of actuator torque (Γ.sub.SEA) through measurements of series-spring deformation. Additionally, the ankle joint may include a hardstop, which limits the ability for the ankle to move to a position of increased dorsiflexion, after a certain point. In addition to measuring actuator torque, the system may also monitor hardstop torque (Γ.sub.hs), through the measurement of hardstop spring deformation.
[0054] A finite state machine may be employed in a State Control Processor to control transitions of the device through different states. The gait cycle states in the State Machine may include early stance, late stance, late stance power, early swing and late swing, which are aligned with the conventional names employed in human biomechanics, namely, controlled plantar flexion, controlled dorsiflexion, powered plantar flexion, early swing and late swing, respectively. The transitions between these walking gait phases may be determined by a system clock (time) and/or the SEA torque (Γ.sub.SEA), hardstop torque (Γ.sub.hs), and their time derivatives.
[0055] In some embodiments, the device includes a single finite state machine for walking. As a result, when a single finite state machine is employed, the control system does not revert to a non-walking state machine based on biomechanical change(s) made by the human wearer. Accordingly, the device is less cumbersome than would otherwise be the case if multiple state machines are incorporated.
[0056] The system may make some or all motor control actuation decisions based upon kinetic sensory information of the device (e.g., force/torque information), without requiring kinematic sensory information of the device (e.g., positions, velocities, accelerations). For example, the system is not required to employ reflex response parameter interventions as these might be informed by accelerometers or rate gyros or any other sensor for the measurement of overall device positions, velocities or accelerations relative to horizontal or vertical reference planes to adapt to walking speed and terrain modality. As a result, the position of the ankle joint may be controlled based on the interaction forces experienced between the human wearer, the device, and the ground surface. Therefore, contrary to conventional robotic systems, it is not necessary for the device to directly control the position of the ankle joint, whether in stance or swing phases, as systems described herein are controlled based on reflex response(s). Though, it can be appreciated that, in some cases, the system may employ position sensors, accelerometers, rate gyros and/or any other sensor, as suitably desired.
[0057] Non-linear, positive force feedback control is applied in powered plantar flexion to emulate human muscle-tendon reflex dynamics. Devices described herein employ positive force feedback with intent to emulate a natural, uncontrolled (e.g., automatic) reflex response. This reflex is implemented by a motor torque control that behaves according to a positive force feedback mathematical relationship involving parameters that include torque gain and torque exponent, each modulated according to the stimulation of certain parameters, for example, the torque rate measured by a series elastic actuator and/or the torque measured at a hardstop.
[0058] The system control architecture employs motor and joint angle sensing to compute, via calibrated models, instantaneous SEA and hardstop torque. Instead of using inertial information, the system architecture employs intrinsic measures of torque, torque rate of change and time duration within a gait cycle state to inform transitions in the State Machine that directs the response modulation in a Motor Processor and, in some embodiments, may rely exclusively on torque and time within a state to inform the transitions. That is, measurements of inertial information, such as position, velocity and acceleration are not used to inform parameter interventions that modulate the actuator response. Rather, force measurements, such as force and torque measured over time, may be used as input to direct the response modulation of the joint actuator.
[0059] The device may exhibit reflexive behavior, without any system memory. That is, the system may monitor device torque(s) and reflexively respond to such torques) with little delay between sensing and actuation. As a result, the monitoring of torque throughout or during a portion of a gait cycle may be the basis for modulation of control actions during a current gait cycle, without any consequence to control actions that affect a subsequent gait cycle.
[0060] In some embodiments, the control system does not require detection of particular gait patterns or events, and in response, the control system is not required to modulate either the control algorithm, or its system parameters. The control algorithm and its parameters are not necessarily adjusted in any manner in response to a user transitioning from a walk to a run, nor while ambulating from a level-ground surface to an incline, nor from level-ground to steps, nor while moving to standing, nor from a standing position to a sitting position, nor from a standing position to a leaning position, nor from a sitting position to a lying down position, nor while putting on pants. That is, despite the type of action the wearer may currently be performing, the control system may function according to a single state machine control, without regard to the type of user action currently performed.
[0061] The control system may be configured to detect a foot strike with the ground surface based on torque/force information. Independently of how the device has struck the ground, whether it is a heel strike, a toe strike, or a foot-flat strike, the system may run the same algorithm with the same control parameters.
[0062] Further, walking speed may be estimated from a known linearly correlated relationship with normalized, peak derivative of SEA torque in late stance. That is, torque rate may be used as an estimate (or surrogate) of a current walking speed so as to inform the reflex parameter modulation. In particular, the gain and exponent parameters of a reflex relationship may be modulated based on a rate of change of a parameter (e.g., pitch rate, torque rate). For example, a rate-based blending (interpolation) of the parameters may be employed.
[0063] In addition, to achieve a smooth and natural response, in some embodiments, the stiffness and/or damping of the joint in Early Stance may be designed to decay exponentially, for example, smoothly reducing stiffness/damping so as to increase joint compliance. Such exponential decay behavior, for impedance, may be particularly beneficial for a wearer of an artificial leg device when walking slowly on uneven terrain or descending down a steep slope, allowing for seamless, hi-fidelity device control.
[0064] In some embodiments, artificial leg devices are constructed according to a biologically-inspired approach where an IMU is not required for their use. A number of design principles are considered in constructing the artificial leg device.
[0065] For example, the time duration in a state, torque and torque derivative (torque rate) may guide the device in transitioning from one state to another, as well as to modulate the reflex parameters, which may or may not correlate with a current walking speed. In some cases, a single measured parameter may be sufficient as a signal for transitioning the device between states and/or estimate walking speed. As discussed, time duration within a state. SEA torque (Γ.sub.SEA) and hardstop torque (Γ.sub.hs)—and the time derivatives of these—may be used as parameters that the system uses to inform state transitions and, in some cases, may be used independently and/or exclusively from other parameters. Peak SEA torque rate as sampled during late stance may be employed in the adjustment of the late stance power reflex, which may occur independently of an estimation (or correlation) of walking speed. As such, it may be a useful observation, yet not necessary for embodiments of the present disclosure, that the above-mentioned rate(s) may correlate with walking speed, for a broad range of wearers. As such, it is not necessary in the preferred embodiment to explicitly estimate the walking speed and to use that estimate to inform the reflex response modulation. So, the intrinsic inertial, kinematic or kinetic may be used directly to inform that modulation.
[0066] As muscle-tendon units of an intact limb do not employ inertial sensing to modulate their response, such intrinsic measures may enable the device to behave and respond as a more natural muscle-tendon unit. Instead, in an intact ankle, muscle and tendon stretch (torque) and their various rates of change are key inputs to the spinal reflex arc connecting the tendon and the muscle. As a result, transitions are more natural and consistent even when the wearer walks softly or runs and jumps in place.
[0067] Further, the system may employ a uniformly-applied stiffness/impedance that decays smoothly after foot strike. When the impedance after foot strike is set to decay, “impedance switching” between states, and the abrupt nature that often accompanies such a switch, may be eliminated. Early Stance impedance—generally defined by stiffness (k.sub.es) and damping (b.sub.es)—may be used by all states, except, in some cases, it might not be used during late stance power and early swing. Impedance may be set in late-swing to a programmable (tuned) value. In some embodiments, k.sub.es decays exponentially to a programmable value, k, which is typically a small fraction of the initial value, k.sub.es.sub.
[0068] Exponential decay of impedance, or one or more other appropriate parameters, may begin at entry into Early Stance. In some cases, the time constant for decay may be set so that the stiffness is substantially maintained (e.g., does not drop quickly) during controlled plantar flexion (CP) (e.g., a time duration between 0.05-0.2 seconds), such as when walking at a brisk walking speed. When walking more slowly. e.g., down a steep hill, the stiffness may be set to drop smoothly, or more quickly, so as to enable the foot to find an equilibrium state at foot-flat with a diminished spring restoring torque—thereby reducing socket stress. The exponential decay behavior (e.g., for joint impedance, joint equilibrium, torque, or others) may continue for a portion of or for the entire gait cycle. For instance, in some cases, exponential decay may continue until it is reset at entry into Early Stance. Such transitions may occur without the wearer even noticing the occurrence of a state transition—thereby eliminating confusion and irritation.
[0069] A single walking state machine may deliver a biomimetic response either while walking or not walking, without need for a secondary non-walking state machine. Instead of discretely switching between a non-walking state machine and a walking state machine, state machines of the present disclosure may use the Early Stance state to uniformly deliver a biomimetic response without having to reconfigure the joint impedance and/or joint equilibrium when in a non-walking state. To accomplish this, the walking state machine may cause transition(s) to Early Stance if the time duration within any of the other walking machine states exceeds a programmable limit for that state, typically about two seconds. The stiffness, k.sub.es may continue to decay to deliver a smoothly varying impedance that, in the limit, devolves to a substantially lightly damped response that responds naturally for non-directed activities that do not involve locomotion. As discussed above, for some embodiments, only torque and torque derivatives are used to inform the logic transition between states, for example, from early stance to late stance and late stance power where locomotion may then be initiated.
[0070] In some embodiments, spring impedance (e.g., stiffness, damping) may be dependent on angular rate in, for example, an ankle or a knee. For instance, an artificial joint device may employ a bionic control system that modulates the impedance of the joint so as to assist the wearer during stair ascent, steep ramp ascent or during the transition from sitting to standing. In some cases, when flexed past a certain threshold angle, the spring stiffness of the joint may be rate dependent, applying positive feedback in response to increases in the joint angular rate or the absolute value of joint angular rate. As an example, the spring stiffness of an artificial knee joint may be modulated such that when a wearer is standing up and the angular rate is increased, the joint becomes stiffer so as to provide increased support during the standing motion. Such support is effective to assist the wearer in standing up.
[0071] The present disclosure relates to U.S. Pat. No. 8,075,633 entitled “Active Ankle Foot Orthosis”; U.S. patent application Ser. No. 13/349,216, entitled “Controlling Powered Human Augmentation Devices”; U.S. patent applications entitled “Hybrid Terrain Adaptive Lower-Extremity Systems” corresponding to Ser. Nos. 61/231,754; 12/552,013; 12/552,021; 12/552,028; 12/552,036; and 12/551,845; U.S. patent application entitled “Biomimetic Transfemoral Prosthesis” corresponding to Ser. No. 61/554,921; U.S. patent application entitled “Powered Ankle Device” corresponding to Ser. No. 61/595,453; U.S. patent application entitled “Under-Actuated Exoskeleton” corresponding to Ser. No. 61/659,723; U.S. patent application entitled “Walking State Machine for Control of a Bionic Ankle Joint” corresponding to Ser. No. 61/658,568; U.S. patent application entitled “Bionic Control System for an Artificial Ankle Joint” corresponding to Ser. No. 61/662,104; U.S. patent application entitled “Biomimetic Ankle and Knee Actuator Designs” corresponding to Ser. No. 61/451,887; U.S. patent application entitled “Terrain Adaptive Powered Joint Orthosis” corresponding to Ser. No. 13/417,949; U.S. patent application entitled “Powered Joint Orthosis” corresponding to Ser. No. 13/347,443; U.S. patent application entitled “Using Knee Trajectory as a Discriminator in a Prosthesis or Orthosis” corresponding to Ser. No. 61/435,045; U.S. patent application entitled “Terrain Adaptive Powered Joint Orthosis” corresponding to Ser. No. 13/356,230; U.S. patent applications entitled “Controlling Power in a Prosthesis or Orthosis Based on Predicted Walking Speed or Surrogate for Same” corresponding to Ser. Nos. 61/432,083; 13/079,564; 13/079,571; U.S. patent application entitled “Estimated Hardstop Ankle Torque Contribution Using Measurements of Bumper/Ankle Shell Deflection” corresponding to Ser. No. 61/422,873; U.S. patent application entitled “Implementing a Stand-up Sequence Using a Lower Extremity Prosthesis or Orthosis” corresponding to Ser. No. 12/872,425. International Patent Application Nos. PCT/US2011/031105; PCT/US2012/020775; PCT/US2012/021084; and U.S. Provisional Patent Application No. 61/649,640, the disclosures of each of which are hereby incorporated herein by reference in their entirety.
[0072] In particular, concepts described herein may be guided by design principles that motivate use of positive force feedback, use of intrinsic, motor damping behavior to implement dynamic clutches, and catapult behaviors, such as those described in U.S. patent applications entitled “Variable-Mechanical-Impedance Artificial Legs” corresponding to Ser. Nos. 60/395,938; 10/613,499; 13/363,820, the disclosures of each of which are also hereby incorporated herein by reference in their entirety.
[0073] It should be understood that for those skilled in the art, the control architecture described herein may be extended to bionic ankles that employ physical and/or SEA-applied virtual, unidirectional and bi-directional parallel elastic elements where torque-displacement characteristics of these systems may be calibrated before use. Further, while such control architecture(s) may be applied to a bionic ankle prosthesis, these principles may be readily extended to orthotic, exoskeletal or humanoid applications in lower-extremity augmentation of ankle, knee and hip.
[0074] While systems in accordance with the present disclosure do not require inertial measurements as input for actuator modulation, it can be appreciated that systems described herein may be used in place of or in combination with inertial measurement systems. For instance, an actuator response may be accomplished by controlling motor torque, τ.sub.m, in a closed-loop or open-loop manner, to match a desired response. In such an architecture, joint angle, motor angle and 6-DOF inertial state (orthogonally-opposed measures of local angular rate and acceleration as sampled by an Inertial Measurement Unit (IMU)) may be used to compute SEA and hardstop torque via calibrated models, to inform state machine transitions, to estimate walking speed and/or to adapt to changes in walking speed or terrain modality. As discussed above, SEA torque and hardstop torque may be used as input to modulate reflex parameters employed in powered plantar flexion. Table 1 provides a summarized mapping of the intrinsic firmware states to the level-ground, gait cycle states as implemented in an artificial ankle device.
TABLE-US-00001 TABLE 1 Alignment of level-ground gait cycle states with intrinsic firmware states for an embodiment. Level-Ground Intrinsic Gait Cycle Firmware State State Actuator Response.sup.1 Controlled State 4: Early τ.sub.m = −k.sub.es(θ − θ.sub.es) − b.sub.es Plantar Stance (ES) Flexion (CP) Controlled Suite 5: Late τ.sub.m = −k.sub.ls(θ − θ.sub.es) − b.sub.ls
Dorsiflexion Stance (LS) (CD) Powered Plantar Flexion (PP) State 6: Late Stance Power (LSP) τ.sub.m = −k.sub.lsp(θ − θ.sub.pp) − b.sub.lsp
+ p.sub.ff(
)
is the estimated instantaneous walking speed, p.sub.ff(
) is the positive force feedback reflex gain, N(
) is the reflex exponent,
=
(
) where
is the tibia pitch rate in late stance and θ.sub.pp is the tail-spring equilibrium Swing (SW) State 2: Early A biologically-derived second-order response that Swing (ESW) returns the ankle joint angle, θ(t), to a position, θ.sub.es, where τ.sub.m = −k.sub.esw(θ(t) − θ.sub.0(t)) − b.sub.esw({dot over (β)} −
) and τ.sub.esw.sup.2
+ 2τ.sub.esw{dot over (θ)}.sub.0 + θ.sub.0 = θ.sub.esw where τ.sub.esw is the time constant of the second-order response. State 3: Late τ.sub.m = −k.sub.es(θ − θ.sub.es) − b.sub.es{dot over (β)} Swing (LSW) Not Walking Non-walking τ.sub.m = −b.sub.nw.sub.
= f(x, τ.sub.m) and Γ.sub.SEA = c.sup.Tx, where x, f and c define the non-linear dynamics.
indicates data missing or illegible when filed
[0075] In systems that operate under the firmware states summarized by Table 1, the State Machine employs state, transitions that are informed by time duration within the state, actuator torque, hardstop torque, and inputs from the Inertial Measurement Unit (IMU). Complex measures of “jerk” and vibration applied to the z-component of the local or world-referenced acceleration are employed to detect heel or toe strike transition from late swing (LSW) to early stance (ES) Logic employing pitch velocity (tibia rotation in the sagittal plane) is used as a “guard” (qualifying) condition prior to applying the accelerometer-based foot strike logic. Pitch velocity, as measured at or near the entry into late stance (LS) may be used (as a surrogate) to estimate walking speed and as input for determining resulting reflex response parameters (p.sub.ff({dot over (s)}) and N({dot over (s)})) in late stance power (LSP).
[0076] Further, pitch rate or velocity may be used to inform state transitions from a non-walking state machine into a walking state machine. While such an IMU-based approach may work well for normal gait cycles involving locomotion (e.g., walking), such an approach might not be optimized for non-walking type sequences, for example, those that may occur when the wearer is moving slowly in a confined space, moving between standing and sitting positions, or ascending/descending a ladder. In a small percentage of such cases, a completely IMU-based actuator may have a tendency to respond more vigorously than desired. Conversely, in situations where the wearer is running or jumping in place, the state machine might miss an occasional transition, thereby causing the actuator response to be, in some cases, inconsistent.
[0077] The impedance response when the system is set to a non-walking state may, at times, be constrained to be a viscous damper (e.g., have a high damping coefficient resulting from shorting of the motor leads) for a discrete period of time (e.g., approximately two seconds) followed by a more lightly-damped response, which is a less than natural response for the wearer. In cases where transitions between non-walking and walking occur over short time intervals, the step response in viscosity may become less than desirable.
[0078] Considering again artificial leg devices that are programmed in a biologically-inspired manner where an IMU is not required, Table 2 provides a summary for such a device. Such devices may be constructed and programmed to capture the reliance on torque-time and the use of an exponential decay so as to eliminate or reduce the abruptness that may result due to transition from one state to another.
TABLE-US-00002 TABLE 2 Alignment of level-ground gait cycle states with intrinsic firmware states for an embodiment. Intrinsic Level-Ground Firmware State State Actuator Response.sup.2 Controlled State 4: Early τ.sub.m = −k.sub.es(t)(θ − θ.sub.es)(1 − u.sub.1(θ − θ.sub.es)) − b.sub.es{dot over (β)} .sup.3 Plantar Stance (ES) Where τ.sub.es{dot over (k)}.sub.es(t) + k.sub.es = k.sub.es.sub. ; Flexion (CP) b.sub.es =
for θ ≤ θ.sub.es and b.sub.es =
for θ > θ.sub.es Controlled State 5: Late and u.sub.1(x) is a unit step function of x .sup.4 Dorsiflexion Stance (LS) (CD) Powered Plantar Flexion (PP) State 6: Late Stance Power (LSP) τ.sub.m = −k.sub.lsp(t)(θ − θ.sub.pp)(1 − u.sub.1(θ)) −
+ p.sub.ff(
)
is the estimated instantaneous walking speed, p.sub.ff(
) is the positive force feedback reflex gain, N(
) is the reflex exponent,
=
(
), where
is the peak time- derivative of the SEA torque, Γ.sub.SEA, in late stance and θ.sub.pp is the tail-spring equilibrium;
−
(t)) and τ.sub.esw.sup.2
+ 2τ.sub.esw{dot over (θ)}.sub.0 + θ.sub.0 = θ.sub.esw where τ.sub.esw is the time constant of the second-order response. State 3: Late τ.sub.m = −
(θ −
) −
Swing (LSW) Where
= θ(t) on every time step to track the instantaneous joint angle. .sup.2Only open-Loop response is shown, where τ.sub.m is the motor torque as reflected onto the joint-referenced series-elastic element via the actuator gear ratio. β is the joint equilibrium as defined by the motor position. In a closed-loop formulation for States 4, 5, 2, 3 and 1, β is replaced by the joint angle, θ, and τ.sub.m is replaced by Γ.sub.SEA—the torque as applied by the series-elastic element via closed-loop torque control. In State 6 so as to avoid a circular reference to Γ.sub.SEA, τ.sub.m would serve as an input to dynamics that emulate muscle-tendon response, where
= f(x, τ.sub.m) and Γ.sub.SEA = c.sup.Tx, where x, f and c define the non-linear dynamics. .sup.3 The stiffness applied in ES is unidirectional. .sup.4 The damping when θ > 0 is increased to a large value to handle the case when θ.sub.0 > 0.
indicates data missing or illegible when filed
[0079] To those skilled in the art it should be readily apparent that the computation and prediction of walking speed is not necessary. In some embodiments, the reflex parameters can be computed as a function directly of the SEA torque rate without loss of generality in another preferred embodiment.
Early Swing (ESW) to Late Swing (LSW) Transition
[0080] As shown in
Late Swing (LSW) to Early Stance (ES) Transition
[0081]
[0082]
[0083] Accordingly, for each type of state transition, a threshold would be crossed (e.g., when the measured or sensed torque is greater than or less than a particular set torque value, within a certain period of time) that triggers transition from one state to
Walking-Speed Referenced Reflex
[0084] The device may use the maximum, rate-of-change in SEA torque ({dot over (Γ)}.sub.SEA) as measured in Late Stance as an estimation (or surrogate) for instantaneous walking speed.
[0085] The graph shown in
[0086] Such studies have shown that .sub.SEA is not invariant across a population of wearers, even when normalized by, for example, peak torque at a self-selected walking speed. So, in one embodiment, {dot over (Γ)}.sub.SEA is observed for each specific wearer—both at the fastest achievable walking speed and at the slowest desired walking speed. At each speed, preferred values for torque gain, p.sub.ff({dot over (s)}), and torque exponent, N({dot over (s)}), may be determined by tuning—thereby determining values/ranges for various parameters, such as p.sub.ff.sub.
Method I: Blended Torque Models
[0087]
Method II: Blended Coefficients
[0088]
Where
[0089]
{tilde over (P)}.sub.ff({dot over (Γ)})=c.sub.1({dot over (Γ)})P.sub.ff({dot over (Γ)}.sub.slow)+c.sub.2P.sub.ff({dot over (Γ)}.sub.fast)
and
Ñ({dot over (Γ)})=c.sub.1({dot over (Γ)})N({dot over (Γ)}.sub.slow)+c.sub.2N({dot over (Γ)}.sub.fast)
[0090] where c.sub.1 and c.sub.2 are defined as in Method I.
[0091] Where the subscript, SEA, on {dot over (Γ)}.sub.SEA, is removed to simplify the notation.
Device Extensions
[0092] It should be appreciated that while device control architectures in accordance with the present disclosure have been applied to an artificial (bionic) ankle device with a hardstop, the hardstop functionality may be replaced by a physical, unidirectional or bi-directional element, parallel elastic element, a virtual. SEA-applied, parallel elastic element, or other suitable component. For example, in either case the hard stop torque, Γ.sub.hs, may be replaced by a parallel elastic element torque, Γ.sub.PE, where Γ.sub.PE is calibrated in manufacturing to determine the torque displacement characteristics of the physical or virtual elasticity.
[0093] Further, while device control architectures described herein have been applied to artificial ankle prostheses, concepts presented here may be extended for application in orthotic, exoskeletal, humanoid ankles, or other appropriate devices. And, while the device control architectures herein have been applied to artificial ankle applications, the techniques applied here may also be extended for use in accordance with other lower-extremity applications, for example, in the knee and hip.
Further Embodiments and their Implementation for Prosthetic or Orthotic Ankle Devices
[0094] Embodiments of bionic leg devices, such as the BiOM.sup.T2 system produced by iWalk, Inc., may employ five states—Early Stance (ES; State 4), Late Stance (LS; State 5), Late Stance Power (LSP; State 6), Early Swing (ESW; State 2) and Late Swing (LSW; State 3)—that align with the human biomechanical gait cycle states controlled plantar flexion (CP), controlled dorsiflexion (CD), powered plantar flexion (PP), Early Swing (ESW) and Late Swing (LSW), respectively. The present disclosure reviews various details of control actions within each state and describes the state transition logic that causes entry into the state.
Early Stance (ES) Control Action In ES (State 4), for some embodiments, the SEA applies a lightly-damped, torsional spring response in accordance with the human biomechanical joint response in Controlled Plantar Flexion. The impedance as applied by the SEA motor torque, τ.sub.m is comprised of a time-varying spring, k.sub.es(t), and a time-varying damping component, b.sub.es(t). The “virtual spring” joint equilibrium, θ.sub.es, is the ankle angle as captured at ES entry. In some cases, one or more variables (e.g., spring constant, damping component, joint equilibrium, gain, exponent, etc.) of the motor torque may be time-dependent and/or may exhibit a time decay-type behavior (e.g., exponential, linear, piecewise, etc.). The actuator may apply an exponential decay to the stiffness component in order to make the ankle increasingly more compliant as the state progresses—to emulate human biomechanics while walking slowly, including on steep or uneven terrain. The ES control action may be modeled as follows:
where
τ.sub.m is the motor torque,
θ is the joint angle.
β is the SEA motor angle,
And where,
τ.sub.esk.sub.es(t)+k.sub.es(t)=k applies an exponential stiffness decay with time constant, τ.sub.es θ.sub.es=θ(t=0),
In some embodiments, the following second-order relation may be used to model exponential stiffness decay:
τ.sup.2{umlaut over (k)}.sub.es(t)+2r
{dot over (k)}.sub.es(t)+k.sub.es(t)=k
t=time since ES entry
k(0)=k
b(0)=b.sub.es.sub.
To those skilled in the art, other linear or non-linear differential equations can be applied to accomplish this decay function.
As provided in the equation above, the stiffness decays to k with a time constant, τ.sub.ES—e.g., about 200 milliseconds, or between 100-500 milliseconds. In some embodiments, the time constant may be set (e.g., optimized) so as to allow the ankle to conform to the ground surface while the wearer walks slowly down an incline.
Examples of these are included in Table 3 below.
Early Stance (ES) Entry State-Transition Details
Late Swing (LSW)-to-Early Stance (ES) Transition
[0095] In some embodiments, the state transition into ES from LSW may occur when a foot-strike is detected—for example, by presence of a large or increasing heel load (L or L
, respectively) as measured by Γ.sub.SEA is a large toe load (L
) as measured by Γ.sub.hard stop; or the extended presence of a large ankle load (L.sub.3-4.sub.
GUARD=((t<100 msec) AND (Γ.sub.hard stop<0.58Γ.sub.0)) OR ((t
<250 msec) AND (TransitionEnabled=FALSE) AND (Γ.sub.hard stop<0.58Γ.sub.0))
Or, alternatively, the GUARD logic may be employed according to the following relation:
GUARD=((t<100 msec) AND (Γ.sub.hard stop<0.58Γ.sub.0)) OR ((t
<250 msec) AND (AnkleNotReturned=TRUE) AND (Γ.sub.hard stop<0.58Γ.sub.0))
In the event that GUARD is FALSE, the LSW to ES state transition (3-4) logic may be as follows:
L.sub.3-4=LOR L
OR L
OR L
where [0096] L.sub.3-4.sub.) detected) AND [0099] (Motor is in the READY state) AND [0100] ({dot over (Γ)}.sub.SEA<−50 Nm/s) AND [0101] (Γ.sub.SEA<min(Γ
)−2 Nm). [0102] L.sub.3-4.sub.
<min(Γ
)−1 Nm) AND [0105] (Γ.sub.SEA(t)−Γ.sub.SEA(t−8 msec)<−0.5 Nm) AND [0106] (Γ.sub.SEA(t)−Δ.sub.SEA(t−10 msec)<−1.0 Nm). [0107] L.sub.3-4
:(t.sub.LSW>1500 msec) AND [0108] (TrasitionEnabled=TRUE) AND [0109] (Γ.sub.ankle(t)>30 Nm)∨t where t.sub.LSW−300 msec<t≤t.sub.LSW.
where [0110] t.sub.LSW is the elapsed time since LSW entry. [0111] Γ.sub.SEA(t), and Γ.sub.hard stop(t) are the SEA and Hard Stop torque at time, t, respectively, READY is a signal indicating that the motor controller processor has completed the trajectory return, [0112] Transition Enabled is a motor state indicating that the motor controller has completed the trajectory return instruction and that the motor temperature measurement has been completed. [0113] AnkleNotReturned is a check to indicate whether the ankle has returned to an initial state and has suitably dorsiflexed. [0114] min(Γ) is the first validated minimum, of SEA torque while GUARD=FALSE. [0115] {umlaut over (Γ)}
is notation for the mean of Γ.sub.SEA computed using samples from the prior n milliseconds referenced to the current time, t. [0116] Γ.sub.ankle(t)=Γ.sub.SEA(t)+Γ.sub.hard stop(t) is the total ankle torque.
[0117] For various embodiments presented herein, it is noted that the ES, LS, LSP, ESW and LSW control response may be invariant with respect to which logic condition—L.sub.3-4.sub.
Late Stance (LS)-to-Early Stance (ES) Transition
[0118] In some cases, for instance, when the wearer stops in mid-stance, the control system may transition from LS (State 5) back to ES (State 4), so that the ankle state responds in accordance with the true walking cycle state. The L.sub.5-4 transition may be informed by a negative change in Γ.sub.SEA after the elapsed time in LS exceeds 500 msec and may be summarized as follows:
L.sub.5-4=((Γ.sub.SEA(L.sub.LS)−max.sub.LS(Γ.sub.SEA))<−5 Nm) AND ((Γ.sub.SEA(t.sub.LS)−Γ.sub.SEA(t.sub.LS−10 msec))<−0.5 Nm) AND (t.sub.LS>500 msec)
where [0119] t.sub.LS is the elapsed time since entering LS [0120] max.sub.LS(Γ.sub.SEA(t)) is the maximum value of Γ.sub.SEA(t) in LS.
Early Stance (ES)-to-Early Stance (ES) Transition
[0121] In some cases, for instance, when the wearer stops in ES then begins to walk again, the impedance and equilibrium are reset to appropriate values for foot strike to occur. Accordingly, the device may be configured to re-enter the ES state based upon detection of an L.sub.4-1 transition. This transition may be informed by a negative change is Γ.sub.SEA after the elapsed time in ES exceeds 500 msec, and may be summarized as follows:
L.sub.4-4=((Γ.sub.SEA(t.sub.ES)−max.sub.ES(Γ.sub.SEA))<−5 Nm) AND ((Γ.sub.SEA((Γ.sub.SEA(t.sub.ES)−Γ.sub.SEA(t.sub.ES−10 msec))<−0.5 Nm) AND (t.sub.ES>500 msec)
where [0122] t.sub.ES is the elapsed time since entering ES [0123] max.sub.ES(Γ.sub.SEA(t)) is the maximum value of Γ.sub.SEA(t) in ES.
Late Stance Power (LSP)-to-Early Stance (ES) Transition
[0124] In some cases, the entry into ES from LSP may occur if the ankle is back-driven into LSP (LSPRegen)—to protect the wearer in the event that the state machine does not detect a walking state transition out of LSP, for example, to ESW. Because there is no stiffness in opposition to a plantar flexion displacement in LSP, the expected ES impedance (heel-strike stiffness) may be absent in a heel-strike event and would thereby surprise the wearer. That is, if there is no stiffness in the ankle after LSP occurs, the system may, by default, set its parameters to the ES stance in preparation for the device in striking the ground.
LSP-to-ES “LSPRegen” Transition
[0125] The LSP-ES LSPRegen transition may occur when L.sub.6-4.sub.
L=
GUARD.sub.Regen=(max.sub.LSPΓ.sub.SEA−Γ.sub.SEA(0)<10 Nm)
L={dot over (Γ)}.sub.SEA(t)<−150 Nm AND (Γ.sub.SEA(t)−Γ.sub.SEA(t−10 msec)<−1.2 Nm AND Γ.sub.hard stop(t)<1 Nm
where [0126] t=t.sub.LSP is the elapsed time in LSP and [0127] max.sub.LSPΓ.sub.SEA is the maximum value of the SEA torque since entry into LSP.
Late Stance (LS) Control Response
[0128] In various embodiments of a controller for artificial leg devices presented herein, LS (State 5) bridges the control response between ES and LSP—typically between foot flat and hard stop engagement. In LS, the actuator continues to apply a damped, torsional, spring response so as to correspond with the early CD response in human biomechanics. Mathematically, the LS response is captured in Eq. 0.1.
[0129] It is well-understood that the spinal reflex arc connecting the Achilles tendon stretch and the soleus (calf) muscle contraction employs positive force feedback—both torque and torque derivative are employed to amplify the reflex response in the contractile element (muscle). To mimic this reflex arc in artificial leg devices according to the present disclosure, the peak rate of change of ankle torque in LS. {dot over (Γ)}, may be used as input for the strain-rate component of the reflex and spring dynamics applied in LSP by the SEA itself the bionic, artificial muscle-tendon unit in the BiOM ankle. Here,
{dot over (Γ)}={c.sub.SEA max
({dot over (Γ)}.sub.SEA)+c
max
({dot over (Γ)}.sub.hard stop)}
(1)
where [0130] max(⋅) denotes the maximum of a function during LS
and [0131] ∫(⋅)dt denotes the time integral over LS.
Late Stance (LS) Entry State-Transition Details
[0132] In some embodiments, ES entry into LS (State 5) is the only state transition into LS. The LS transition may occur if either a large toe load (L.sub.4-5.sub.
L.sub.4-5=L.sub.4-5.sub.
where
L.sub.4-5=L.sub.4-5.sub.
Where
[0133]
[0134] It should be appreciated that the control response in LS, LSP, ESW and LSW may be invariant with respect to which logic condition—L.sub.4-5.sub.
Late Stance Power (LSP) Control Response
[0135] In some embodiments, the actuator response in LSP (State 6) is comprised of two terms—a unidirectional torsional spring, k.sub.lsp, with equilibrium at a torque-rate-dependent plantar flexion angle, θ.sub.pp, and a torque-rate-dependent reflex. The reflex term applies a positive force-feedback response that comprises two components—a torque-rate dependent gain, p.sub.ff({dot over (Γ)}.sub.ankle), and a non-linear, normalized joint torque feedback,
with a torque-rate dependent exponent, N({dot over (Γ)}.sub.ankle). In some embodiments, the torque gain may range between 0 and 200 Nm, and the torque exponent may range between 1 and 5. Here, {dot over (Γ)}.sub.LS is the peak rate of change of joint torque in LS, as described in the previous section that addresses late stance. Both p.sub.ff and N may be piecewise-continuous, linear functions, defined each by their values at a slow speed and a high speed torque rate—{dot over (Γ)}.sub.ankle
.sub.slow and {dot over (Γ)}.sub.ankle
.sub.fast respectively. At torque rates beyond this range both p.sub.ff and N may be held constant. In some embodiments, p.sub.ff and/or N are time-dependent functions, for example, that exhibit an exponential decay behavior.
Mathematically, the LSP control response may be defined in Equation 2, shown below.
where [0136] τ.sub.m is the SEA motor torque [0137] k.sub.lsp.sub. [0139] p.sub.ff and N are each a piecewise, continuous linear function of {dot over (Γ)}.sub.ankle
as defined above, or may be time-dependent functions that may range between 0-200 Nm and between 1-5, respectively.
[0140] is the normalized ankle torque
where [0141] Γ.sub.0 is a normalizing torque equal to
[0143] In some cases, one or more of the parameters of an actuated torque are time-dependent functions that exhibit time-decay behavior (e.g., exponential, linear, piecewise, etc.). For instance, k.sub.pp, θ.sub.pp, p.sub.ff and/or N may exhibit exponential decay behavior over time, so as to provide for a soft reflex response or gradual joint equilibrium transitions. As an example, during LSP, the wearer may decide that he/she would like to ease in or out of powered plantar flexion. If the gain and/or exponent of the torque reflex response exhibits time-dependent decay, the wearer may experience a relatively smooth reflex response than may otherwise be the case without the decay behavior. Or, θ.sub.pp may also exhibit time-dependent decay behavior, resulting in relatively smooth transitions from one state to another. Any suitable time-dependent behavior may be employed, such as those functions described for various embodiments of the present disclosure.
Late Stance Power (LSP) Entry State-Transition Details
[0144] In some embodiments, the IS to LSP transition (5-6) may occur when the toe load torque exceeds a programmable threshold. Mathematically, the L.sub.5-6 transition may occur when Γhard stop>5 Nm.
Early Swing Control Response
[0145] In some embodiments, the ESW (State 2) control response of the artificial leg device mimics the damped, second-order, spring-mass response of the early swing phase in human walking biomechanics—this response restores the ankle from the toe-off position at the terminus of powered plantar flexion to its neutral position, in anticipation of the foot strike in the next gait cycle. Typically, the time constant, τ.sub.esw, of this response is approximately 50 milliseconds, but may vary appropriately.
[0146] In ESW, an overdamped, second-order equilibrium trajectory, θ.sub.0(t), may be applied to return the joint to a fixed neutral position, θ.sub.esw—a position that may be invariant to all biomechanical modalities including, but not limited to, terrain, walking speed, and toe-off angle. A damped (b.sub.esw) and spring (k.sub.esw) impedance may be applied in relation to this equilibrium trajectory. Feedforward of the estimated motor torque may be used to eliminate response lag due to motor/drive-train inertia and damping. The mathematical formulation of the ESW control response with inertia-only feedforward may be summarized in Equation 3 shown below.
where [0147] τ.sub.m is the SEA motor torque, [0148] τ is the time constant of the over-damped, second-order response, [0149] θ
(0) is the toe-off angle, initialized to θ(t) at ESW entry (LSP Exit), [0150] β is the SEA motor angle reflected at the ankle joint and [0151] θ.sub.esw is the invariant, neutral position destination for all ESW trajectories [0152] J
is the motor inertia reflected onto the joint
Early Swing (ESW) Entry State Transition Logic
[0153] Transitions into ESW may normally originate from LSP, as described in the following section that addresses the late stance power to early swing transition. Transitions into ESW can originate from ES when the wearer lifts the foot oil the ground, as described in the section that addresses ES-to-ESW at Foot-off.
Late Stance Power (LSP)-to-Early Swing (ESW) Transition
[0154] The LSP-ESW transition may be defined by either a toe-off (L.sub.6-2.sub.
LSP-to-ESW at Toe-Off
[0155] Toe-off may occur when the ankle torque, Γ.sub.ankle, drops below a threshold close to zero.
[0156] The following guard, pre-trigger, and state transition conditions may be applied in succession to accomplish the LSP-ESW (6-2) transition by toe-off
Toe-Off Guard Condition Details
[0157] The LSP-ESW by toe-off transition may be halted until GUARD has transitioned from TRUE to FALSE.
GUARD=(t.sub.lsp<200 msec) AND (Γ.sub.hard stop>0 OR >−200 sec/Nm OR max.sub.lsp(Γ.sub.hard stop)<20 Nm)
Toe-Off Pre-Trigger Details
[0158] Before detecting the LSP-ESW toe-off transition, compute the following:
ToeOffTransitionEnable=Γ.sub.ankle<0.5 max.sub.lsp(Γ.sub.hard stop(t)) AND Γ.sub.ankle<25 Nm if ToeOffTransitionEnable=TRUE=True then capture t.sub.enabled
Toe-Off Transition (6-2) Logic
[0159]
L.sub.6-2=ToeOffTransitionEnable AND (Γ.sub.ankle<10 Nm OR t−t.sub.enabled≥20 msec)
where in the above, [0160] t.sub.lsp is the time since LSP entry [0161] max.sub.lsp(Γ.sub.hard-step(t)) is the maximum value of hard stop torque in LSP prior to t.sub.lsp [0162] is the mean value of SEA torque rate over the past 10 milliseconds.
As a result, the LSP to ESW transition can occur when L.sub.6-3 is TRUE.
LSP-to-ESW at Foot-Off
[0163] The “foot-off” condition—L.sub.6-2—may be informed by a rapid drop in both SEA and Hard Stop torque, which may be summarized as follows:
L.sub.6-2=(L.sub.6-2
OR L.sub.6-2
OR L.sub.6-2
OR L.sub.6-2
) AND (t.sub.lsp>1600 msec)
L.sub.6-2=Γ.sub.SEA<0 AND Γ.sub.SEA(t)−Γ.sub.SEA(t−10 msec)<−1 Nm AND Γ.sub.hard stop<30 Nm AND Γ.sub.hard stop(t)−Γ.sub.hard stop(t−40 msec)<−11 Nm
L.sub.6-2.sub.
L.sub.6-2={dot over (Γ)}.sub.SEA<−50 Nm/sec AND Γ.sub.hard stop<30 Nm AND Γ.sub.hard stop(t)−Γ.sub.hard stop(t−40 msec)<−11 Nm
L.sub.6-2={dot over (Γ)}.sub.SEA<−50 Nm/sec AND Γ.sub.hard stop<50 Nm AND Γ.sub.hard stop(t)−Γ.sub.hard stop(t−40 msec)<−22 Nm
where [0164] t=t.sub.LSP is the elapsed time since entry into LSP
ES-to-ESW at Foot-Off
[0165] The “foot-off” condition—L.sub.4-2.sub.
L.sub.4-2.sub. OR L.sub.4-2
OR L.sub.4-2
OR L.sub.4-2
}
Guard.sub.foot-off=FromLSPRegen OR t<800 msec
L.sub.4-2=Γ.sub.SEA<0 AND Γ.sub.SEA(t)−Γ.sub.SEA(t−10 msec)<−1 Nm AND Γ.sub.hard step<30 Nm AND Γ.sub.hard stop(t)−Γ.sub.hard stop(t−40 msec)<−11 Nm
L.sub.4-2={dot over (Γ)}.sub.SEA<−180 Nm/sec AND Γ.sub.hard stop<30 Nm AND Γ.sub.hard stop(t)−Γ.sub.hard stop(t−40 msec)<−5 Nm
L.sub.4-2={dot over (Γ)}.sub.SEA<−50 Nm/sec AND Γ.sub.hard stop<30 Nm AND Γ.sub.hard stop(t)−Γ.sub.hard stop(t−40 msec)<−11 Nm
L.sub.4-2={dot over (Γ)}.sub.SEA<−50 Nm/sec AND Γ.sub.hard stop<50 Nm AND Γ.sub.hard stop(t)−Γ.sub.hard stop(t−40 msec)<−22 Nm
where [0166] t=t.sub.ES is the elapsed time since entry into ES, [0167] FromLSPRegen is a flag set in ES to note that ES entry originated from LSP during an unexpected regeneration event in powered plantar flexion, [0168] GUARD.sub.foot-off is a guard logic condition that blocks the transition if ES entry originated from the excessive regeneration event in LSP or if the elapsed time within ES is less than a pre-specified duration (800 milliseconds).
Late Swing (LSW) Control Response
[0169] In LSW after the ESW return to the neutral angle is completed, the SEA applies a lightly-damped, torsional spring response equivalent to that applied at ES entry. This ensures that the intended impedance to be applied at foot strike is instantiated before impact—thereby achieving response continuity that is insensitive to ES state transition delay. The mathematical formulation of the LSW response is captured in Equation 4.
[0170] where [0171] θ=θ(0) [0172] β is the motor angle as projected onto the joint angle from SEA kinematics
[0173] In LSW, after the ESW return to the neutral angle is completed, the SEA may apply a lightly damped, torsional spring response—with a spring constant, k.sub.es(t) that may be designed to decay exponentially, according to a second-order differential equation. Such a decay, while not limited to exponential behavior, may help to ensure that the intended impedance to be applied at foot strike is instantiated before impact—thereby achieving foot-strike response continuity that is insensitive to ES state transition delay. Such a form of decay dynamics has the emergent property that stiffness decreases with increased walking speed. This property acts to reduce foot-strike stiffness while walking slowly down a steep slope, for instance. The joint equilibrium, θ, may be set to the ankle angle, at entry, θ(0). The mathematical formulation of the LSW response, including stiffness decay dynamics, is captured in the Equations 5 and 6 below.
[0174] Where [0175] t is the time elapsed since LSW entry [0176] θ=θ(0), the value at LSW entry [0177] b
is the fixed value of damping [0178] β is the motor angle as projected onto the joint angle from SEA kinematics [0179] τ.sub.h
controls the stiffness decay, typically 200 milliseconds [0180] k
(0)=k.sub.es
[0181] k.sub.es
is the terminal value of stiffness
Late Swing (LSW) Entry State-Transition Details
[0182] The ESW-LSW state transition may occur when the motor control processor reports that it is READY, thereby signifying that the ESW trajectory is completed. OR, for example, when L <100 msec.
Late Swing (LSW) Entry from Early Stance (ES)
[0183] An ES-LSW transition can occur in cases where alter an extended period in ES (e.g., approximately two seconds) a possible ground impact is present as detected by a toe load (L.sub.3-4.sub.) detected) AND [0189] (Motor is in the READY state) AND [0190] ({dot over (Γ)}.sub.SEA<−50 Nm/s) AND [0191] (Γ.sub.SEA<min(Γ.sub.SEA
)−2 Nm). [0192] L.sub.4-3.sub.
) detected) AND [0194] ({dot over (Γ)}.sub.SEA<−180 Nm/s) AND [0195] (
<min(Γ.sub.SEA
)−1 Nm) AND [0196] (Γ.sub.SEA(t.sub.es)−Γ.sub.SEA(t.sub.es−0 msec)<−0.5 Nm) AND [0197] (Γ.sub.SEA(t)−Γ.sub.SEA(t−10 msec)<−1.0 Nm). [0198] Where [0199] t.sub.es is the elapsed time since ES entry, [0200] Γ.sub.SEA(t), and Γ.sub.hard stop(t) are the SEA and hard stop torque at time, t, respectively, [0201] READY is a motor state indicating that the motor controller processor is ready to accept commands. [0202] min(Γ.sub.SEA.sub.
[0203] While description for each of the state transitions is provided above. Table 3 summarizes the state transition logic, including various non-limiting conditions and thresholds that are used for an embodiment of an artificial leg device, in accordance with the present disclosure.
TABLE-US-00003 TABLE 3 State transition setup for an embodiment of an artificial leg device. State Machine Transitions and Threshold Setup State & Threshold Thresholds Transition Transition Conditions Setting values notes In STATE 1 Power On Systems Initializing; {short motor leads; Check battery powery etc.} 1 −> 3 Systems initialization completed! AND Ks torque value −35 Nm to 10 Nm 10 Nm > Ks_torque > −35 Nm In STATE 2 Setup motor swing Impedance control{ } 2 −> 3 Timer > 100 ms Local Timer 0.1 sec Time period given for foot return In STATE3 On entry{update HS_torque_Thr}; Setup impedance_control; Shut_down_check; 3 −> 4 Guard - (Timer < 0.1 sec)AND Timer 0.1 sec min time period in 4; No (Ankle_Torque < 0.58 PCI) Large Ankle Load 058 PCI Large ankle load to Transition see foot on ground; (Timer < 0.25 sec) AND Timer 0.25 sec Short time period in 3; (transition NOT enabled) AND Motor_ready_flag 0.58 PCI Motor NOT ready (ankle_Torque < 0.58 PCI) Large Ankle Load (ankle returned, temperature measured); Large ankle load to see foot on ground; Transitions (1.sup.st_min Ks_torque found) AND Ks torque rate −180 Nm/s Min Ks Torque found (Ks_torque_dot < −180 Nm/s) AND Ks_torque_changes_6 ms −0.5 Nm/6 ms.sup. at beginning of 3 Ks: (Ks_torque_rising_6 ms < 0.5 Nm) AND Ks_torque_changes_10 ms −1 Nm/10 ms torque reduced in (Ks_torque_rising_10 ms < −1 Nm) AND Ks_torque_drops_from −1.0 Nm fast speed (Ks_torque_6 ms_mean-1.sup.st min min position Ks torque drops in Ks_torque < −1 Nm) 6 ms period Ks torque keeps dropping in 10 ms Ks torque drops from its min position (1.sup.st_min Ks_torque found) AND Ks torque rate .sup. −50 Nnm/s-2.0 Nm Min Ks Torque found (motor ready flag re-settled) AND Ks_torque_drops_from at beginning of 3 HS: (Ks_torque_dot < −50 Nm/s) AND min position torque NOT rising; (Ks_torque_6 ms_mean-1.sup.st min Ks torque Ks_torque < −2 Nm) reduced in moderate speed; Ks torque drops big from its min position (HS torque > HS_torque_Thr) Hard Stop Torque 25 Nm to 45 Nm Protect 3 count AND (HS torque_rising in 40 ms > 11 Nm) HS torque rate_mean drift on ankle 11 Nm/40 ms encoder; varying based on user weight; Protect slow loading. case; (Timer > 1.5 sec) AND Local Timer 1.5 sec Long enough in 3; (transition enabled ) AND Ankle Torque 30 Nm Ankle loaded (>2 (ankle Torque > 30 Nm) AND Timer_High Load 0.3 sec encoder counts); (High Ankle Torque Timer > 0.3 sec) Ankle Loaded long to see foot on ground; In STATE 4 On Entry (Check_battery_power; Read_motor_temperature;) Setup_decay_impedance_control; Update_Ks_torque_changes; Update_maximum_Ks_torque; Shut_down_check; 4 −> 5 HS_torque > 0.58 PCI Hard stop torque 0.58 PCI Large Hard stop load (HS_torque > HS_torque_Thr)AND Hard Stop Torque 25 to 45 Nm Ankle loaded; (HS torque_rising in 40 ms > 11 Nm) HS torque rate_mean 11 Nm/40 ms Ankle loaded fast; (HS_torque < 15 Nm) AND Hard stop Torque −5 Nm Hard stop NOT loaded; (Ks_torque_max_drops_from_entry < −5 Nm) AND Ks torque max drops in 4 0.10 Nm/s Ks torque drops big to confirm foot strike; (Ks_torque_dot > 0) AND ks_torque_rate Positive Ks torque rates to confirm (Ks_torque_dot_10 ms_mean > 10 Nm/s Ks_torque_rate_10 ms_mean foot flat happened; 4 −> 4 (Timer > 0.5 sec) AND Timer 0.5 sec Max time in 4 normally; (Ks_torque_drops_in_10 ms < −0.5 Nm) AND Ks_torque_changes_10 ms −0.5 Nm/10 ms To see Ks torque changing direction; (Ks_torque_max_drops_from_entry < −5 Nm) Ks torque max drops in 4 −5 Nm Ks torque drops big to confirm foot strike; 4 −> 2 Guard - State 6 to 4 protection ON This state 4 was transitioned from NO state 6 transition Timer < 0.8 sec Timer 0.8 sec Must stay in 4 long enough Foot: (HS_torque_40 ms_Ago < 30 Nm) AND Hard Stop Torque 40m s ago 30 Nm Low Hard stop torque; unloading (HS_torque_drops_in_40 ms < −5 Nm) Hard Stop Torque drops −5 Nm/40 ms Hard stop torque drops to see detector AND (Ks_torque_dot < −180 Nm/s) moderately −180 Nm/s unloading; Transitions: Ks torque rate Ks torque reduced in fast speed to see unloading (HS_torque_40 ms_Ago < 30 Nm) AND Hard Stop Torque 40 ms ago 30 Nm Low Hard stop torque; (HS_torque_drops_in_40 ms < −11 Nm) AND Hard Stop Torque drops −11 Nm/40 ms Hard stop torque drops to see (Ks_torque_dot < −50 Nm/s) fast −50 Nm/s unloading; Ks torque rate Ks torque reduced in moderate speed to see unloading (HS_torque_40 ms_Ago < 30 Nm) AND Hard Stop Torque 40 ms ago 30 Nm Low Hard stop torque; (HS_toque_drops_in_40 ms < −11 Nm) AND Hard Stop Torque drops fast −11 Nm/40 ms Hard stop torque drops to see (Ks_torque_rising_10 ms < −1 Nm) AND Ks_torque_changes_10 ms 0 Nm unloading; (Ks_torque < 0 Nm) Ks torque Ks torque keeps dropping in 10 ms Ks torque is low Transitions: (HS_torque_40 ms_Ago < 50 Nm) AND Hard Stop Torque 40 ms ago 50 Nm moderate Hard stop torque; (HS_torque_drops_in_40 ms < −22 Nm) AND Hard Stop Torque drops −22 Nm/40 ms Hard stop torque drops very fast (Ks_torque_dot < −50 Nm/s) very fast −50 Nm/s to see unloading; Ks torque rate Ks torque reduced in moderate speed to see unloading In STATE 5 Update_extreme_Torque_rate, Update_Ks_torque_changes; Setup_decay_impedance_control; Shut_down_check; On Exit { Blend_torque_rate; Blend_reflex_Coeff; Blend_tail_spring;} 5 −> 6 MS_torque > 5 Nm Hard Stop Torque 5 Nm Hard stop triggered 5 −> 4 (Time > 0.5 sec) AND Timer 0.5 sec Max time in 5 normally; (Ks_torque_rising_in_10 msc < −0.5 Nm) Ks_torque_changes_10 ms −0.5 Nm/10 ms To see Ks torque changing direction; AND Ks_torque_max_changes −5 Nm To see foot strike for sure; (Ks_torque_drops_from_max_in_5 < −5 Nm) In STATE 6 Detect_peak_ankle_moment; Detect_significant_reflex_action; Update_motor_command_torque (torque, tailSpring, temperatureFactor, ForceField): Shut_down_check; 6 −> 2 Guard - (Timer < 0.2 sec) AND Timer 0.2 sec Min Time in state 6 normally; No ((maxHS_torque < 20 Nm) OR Max HS torque 20 Nm Hard stop NOT engaged; Transition (HS torque > 0) OR HS torque 0 Nm Hard stop still touching: (KS_torque_dot_10 ms_mean > −200 Nm/s)) Mean Ks tongue rate in 10 ms −200 Nm/s Ks Not released; Transitions (Timer > 1.6 sec) AND Timer 1.6 sec Max time allowed in state 6 (foot_unloading_detector) If Low ankle torque 25 Nm (ankle_Torque < 0.5*PeakTorque) AND (ankle_torque < 25 Nm) low ankle torque Acknowledged; Timer_delayed ++ End Transitions: Ankle total torque 10 Nm Ankle load released; (ankleTorque < 10 Nm) OR Low ankle Torque Timer 0.02 sec Stayed long enough at low ankle (Timer_delayed >= 0.02 sec) torque level; 6 −> 4 (maxKs_torque_rising_from_entry_in_6 < 10 Nm) AND maxKs_torque_rising_from_entry_in_6 10 Nm No reflex detested; (HS torque < 1 Nm) AND 1 Nm Hard stop NOT triggered: (Ks_torque_rising_in_10 ms < −1.2 Nm) AND Hard Stop Torque −1.2 Nm/10 ms Last two conditions to see foot strike (Ks_torque_dot < −150 Nm/s) Ks_torque_changes_10 ms −150 Nm/s for sure ; Ks_torque_rate
[0204] Embodiments of the present disclosure may include a multi-modal control system for an artificial leg device having series and parallelelastic actuator-based muscle-tendon units (MTU) at the ankle and knee for modulation of joint impedance, joint equilibrium and reflex torque, in accordance with locomotion modality, gait cycle phase within that modality and cadence; a plurality of metasensors for intra-gait cycle determination of terrain modality, ground reaction force and zero-moment point, and external load-bearing influence; an intent recognition processor that employs the metasensor data to infer locomotion modality and the transitions between these; and a biophysically-inspired state control processor that employs MTU torque and derivatives, metasensor state and intent recognition output to accomplish transitions between the joint-based state machines.
[0205] The bionic architecture may restore function per normative measures of metabolic cost-of-transport and gait mechanics, including joint kinematics and kinetic measures. The architecture may further optimize battery economy and achieve safe operation in the event of power loss through use of tuned series-elastic elements and regenerative dynamic clutching (braking) functions in the joint MTU controls. The multi-modal architecture herein can be broadly applied to lower extremity augmentation systems—including powered prosthetic and orthotic leg systems, exoskeletons, and exomuscle-tendon units—and humanoid robots that actuate the ankle, knee and hip.
[0206]
Control Architecture
[0211] Embodiments of the leg system employ a loosely-coupled joint control architecture. Here, the ankle state machine and control behaviors are largely independent of the knee control state. Ankle state machine and control behaviors are described in greater detail in the references incorporated by reference above. In particular, the biophysically-motivated ankle state machine and behaviors are described in detail in U.S. Provisional Patent Application Ser. No. 61/662,104, entitled “Bionic Control System for an Artificial Ankle Joint.”
[0212] A schematic of one embodiment of a knee state machine is illustrated in
State-Dependent Control Behaviors
[0213]
Early Stance
[0214] In Early Stance, the knee applies a lightly-damped spring response defined by stiffness, k.sub.ES, and damping, b.sub.ES0. For stance flexion, δθ.sub.k=θ.sub.k−θ.sub.0es, when less than about 15°, the early stance impedance relation may be provided as follows:
Γ.sub.k=−k.sub.ES(θ−θ)−b
{dot over (θ)} Eq (7)
[0215] Where [0216] Γ.sub.k=knee joint torque [0217] θ.sub.es=fully extended knee angle setpoint, typically 0 deg
[0218] For stance flexion that exceeds about 15°, the joint impedance relation creates a highly damped response:
Γ.sub.k=−b{dot over (θ)}.sub.k Eq (8)
[0219] Equations 7 and 8 may be implemented by using closed-loop torque control, using SEA deflection as a measure of joint torque feedback. In another embodiment, the knee SEA may employ a series elasticity with stiffness substantially equal to k.sub.es. In this way, the motor drive transmission can be locked at θ.sub.es0, enabling the series elastic element to compress and extend without motor movement to account for the maximum early stance knee fluxion for typical level-ground gait cycles.
[0220] In another embodiment, the motor may be employed as a programmable clutch (dynamic brake/damper) by shorting the motor leads-applying a strong braking function with a time constant typically in the range of approximately 800-1500 milliseconds. Details concerning the use of shorted leads may be found in U.S. patent application Ser. No. 13/417,949, entitled “Biomimetic Joint Actuators.” In such an embodiment, the battery power source may be disconnected from the SEA, thereby eliminating battery consumption during knee flexion and extension in level-ground walking.
[0221] In some cases, the shorted-leads may be pulse-width modulated, enabling the damping to be controlled, e.g., to reduce the damping at large flexion, while at the same time harvesting energy to charge the bionic leg power source (i.e., battery) during, for example, the swing phase of walking. Since the knee joint generally draws net energy, such an embodiment can be used to operate the knee joint at extremely low power in at least early stance flexion/extension early swing and late swing, even when the battery is disconnected. The shorted leads functionality can make possible assertion of a safe state during fault or power interruption, thereby protecting the wearer. In some embodiments, k.sub.es, and b.sub.es, are functions of time (e.g., may exhibit a time-dependent decay behavior). For instance, the change from a stiffness-dominated response to the damping-dominated response may not be accomplished by crossing an angle threshold, but rather by applying a programmable, exponential decay of the stiffness and damping as shown in
[0222] The stiffness and damping impedance coefficients may be defined by the following relations:
=τ.sub.k.sup.2{umlaut over (k)}.sub.es(i)+2τ.sub.k{dot over (k)}.sub.es(t)+1=k.sub.es.sub.
[0223] Where [0224] k.sub.es(0)=k.sub.es.sub.
τ.sub.b.sup.2
[0226] Where [0227] b.sub.es(0)=b.sub.es.sub.
[0229] As shown in
[0230] In some embodiments, a first-order or higher order differential equation may be used in place of Eqs. 9 and 10. A second-order response may be advantageous in that the attenuation is substantively delayed the initial values are substantially maintained, for a certain amount of time controlled by the time constant prior to dropping off. Through these time varying impedances, the knee will behave during early stance as an efficient spring during level ground walking, a damper with a relatively high damping value for stair and slope descent, and a lightly damped knee while sitting.
Late Stance
[0231] The joint torque sign reversal at substantially full knee extension signals the transition from Early Stance to Late Stance in a typical gait cycle. In one embodiment, the Late Stance reflex behavior follows the relation below:
[0232] Where [0233] τ.sub.motor.sub. is a normalizing torque defined by body weight and activity level, and [0235] pff( ) and N( ) are functions of knee torque rate of change at entry to late stance.
[0236] In other embodiments, a neuromuscular model, also employing positive force feedback on a modeled Gastrocnemius muscle, may be used. For further details regarding this neuromuscular model, the disclosure of U.S. Provisional Patent Application Ser. No. 61/595,453, entitled “Powered Ankle Device” may be relevant.
[0237] In certain cases—including stair ascent, steep dump ascent and during the transition from sitting to standing—the knee joint may be flexed past a threshold of θ.sub.k, and extending at a substantial rate (|{dot over (θ)}.sub.k|>{dot over (ξ)}
) where {dot over (ξ)}
is the rate threshold. In this case, a rate dependent spring stiffness, k.sub.ex, that applies positive feedback in response to angular rate increases for an embodiment of a knee device as shown in
Γ.sub.k=−k (
({dot over (θ)}){dot over (θ)}.sub.k Eq (12)
[0238] Where [0239] b ({dot over (θ)}) applies light damping to achieve stability when {dot over (θ)}<0, [0240] b
({dot over (0)}) applies strong damping to resist flexing [0241] {dot over (θ)}.sub.k is the knee joint angular rate, and [0242]
if {dot over (0)}<0 and [0245] τ.sub.ext({dot over (θ)})=τ.sub.ext
if {dot over (θ)}≥0 [0246] And where [0247] k.sub.ex({tilde over ({dot over (θ)})}) of the form shown in
In some embodiments, k.sub.ex and b.sub.ex are time-dependent functions that exponentially decay over time and are initialized to the nominal form when retriggered ({dot over (θ)}≥ξ). In an “anti-slip” embodiment described here, momentary flexion velocities do not cause the knee torque to drop—thereby making it easier for the wearer to maneuver (e.g., to get out of a chair or to transition to bionic limb support when the sound side (trailing leg) is pushing off of a stair below the bionic limb).
illustrating that the flexion stiffness may increase with increasing joint speed. In some cases, the peak flexion stiffness may have a lower peak than in extension, enabling the wearer to more easily flex the knee while sitting.
Swing Flexion
[0248] The Early Swing state transition occurs at toe-off, as reported by the ankle state machine. In early swing flexion, knee behavior may be ballistic for flexion angles less than about 45° (e.g., no spring or damping) and lightly damped (b=b.sub.sf) for greater flexion. This behavior is captured in Eq. 13.
Γ.sub.k=−b.sub.sf{dot over (θ)}.sub.k∨θ.sub.k<θ.sub.sf=0 elsewhere Eq. (13)
Swing Extension
[0249] Once the maximum swing flexion is achieved, the knee state transitions to swing extension. In early swing extension the behavior is nearly ballistic (e.g., lightly damped) with damping constant, b.sub.se=b.sub.se. The damping coefficient increases nearly quadratically as the knee flexion approaches θ.sub.k=θ.sub.kes
as shown in three piecewise continuous angle-dependent damping function embodiments (in swing extension) in
In Swing Extension, such behavior may be captured in Eq. 14.
Γ.sub.k=−b.sub.se(θ.sub.k){dot over (θ)}.sub.k Eq. (14)
[0250] Where [0251] b.sub.se(θ.sub.k) is defined as a piecewise continuous function per
[0252] Damping during Swing Extension may be used to decelerate knee flexion (tibia angular rate) as the joint angle approaches full-extension—increasing substantially linearly until θ drops below a threshold angle. Below the threshold, the damping increases according to a substantially quadratic function as it approaches θ=0. Such damping creates a “sticky” behavior that holds the joint near full-extension-preparing the knee to absorb the foot strike energy and to transition to the spring-like behavior in Early Stance.
State Transitions
[0253]
State Transition 1 (ST1): Swing Extension (or Flexion)-to-Early Stance
[0254] The foot strike gait event marks the transition from Swing Extension (or Flexion)-to-Early Stance—a transition that aligns with the Late Swing to Early Stance transition on the ankle. Here, the world-z component of the ground reaction force, as shown in
ST1=(F.sub.z>F.sub.z.sub.
Where
[0255] F.sub.z.sub.
[0256] In another embodiment as described in U.S. Provisional Patent Application Ser. No. 61/662,104, entitled “Bionic control System for an Artificial Joints” a logic transition informed by ankle torque and derivatives can be used to accomplish ST1.
State Transition 6 (ST6): Early Stance-to-Late Stance
[0257] The Early Stance to Late Stance transition gait event signifies that toe-loading is occurring when the knee is fully extended as defined by the logic equation;
[0258] Where [0259] ξ.sup.+ are ξ.sup.− are small angles signifying proximity to full extension, and [0260] Γ.sub.toe load is the toe loading threshold as measured at the ankle, and [0261] Γ.sub.a signifies the ankle torque reported by the ankle MTU.
[0262] In other embodiments, toe loading is detected by determining whether the ZMP of a ground reaction force of significant magnitude is substantially located in the forward half of the foot.
State Transition 4 (ST4): Late Stance (or Early Stance)-to-Swing Flexion
[0263] The toe-off gait event signals the transition to Swing Flexion from either Late Stance or Early Stance. ST4 is defined as:
ST1=(F.sub.z<F.sub.z.sub.
[0264] Where [0265] F.sub.z is the z-component of the ground reaction force, and [0266] F.sub.z.sub.
In other embodiments, substantially zero torque, as reported by the ankle MTU, can be used to detect the toe-off condition. In another embodiment described in U.S. Provisional Patent Application Ser. No. 61/662,104, entitled “Bionic Control System for an Artificial Joint,” ankle torque and derivatives (Γ.sub.ankle≈0) can be used as input for triggering or modulating parameters of the ST4 transition.
State Transition 7 (ST7): Swing Flexion-to-Swing Extension
[0267] The state transition from Swing-Flexion to Swing Extension is marked by a sign reversal in the knee angular velocity detected here as the time when the knee velocity goes to zero at a time sufficiently after toe-off:
Where
[0268] t is the time elaplsed since toe-off, t
is the minimum duration threshold, and [0269] {dot over (ξ)}.sup.+ and {dot over (ξ)}.sup.− define the small velocity boundary.
State Transition 8 (ST8): Late Stance-to-Early Stance
[0270] In some circumstances, e.g. when the wearer is standing quietly and then enters Late Stance and then flexes the knee, it may be appropriate for the state machine to transition back to early stance. The logic is defined as follows:
[0271] Where [0272] θ.sub.k.sub.
OTHER EMBODIMENTS
Self-Adjusting Joint Equilibrium
[0274] In this embodiment, the joint equilibrium tracks the joint angle with a programmable convergence preferably through use of a first or second-order tracking filter with time constant, τ. In some embodiments, the system is configured for the joint equilibrium to exhibit time-dependent behavior that relaxes to an equilibrium that is substantially equivalent to the current joint angle. That is, in accordance with the system exhibiting a programmable convergence, the joint equilibrium of the system continually, yet gradually, tracks the current joint angle. For example, if the joint angle does not change after a long period of time, then the joint equilibrium gradually relaxes from an initial value to a value equal to that of the current joint angle.
[0275] In some embodiments, self-adjusting joint equilibrium behavior may be governed by the following relationships:
Γ=−k(θ−θ.sub.0)−b{dot over (θ)} Eq. 20
τ.sub.0{dot over (θ)}.sub.0+{dot over (θ)}.sub.0=θ Eq. 21
Equation 21 is inserted into Eq. 20 and the resulting relationship is subject to a Fourier transform, where the function is transformed from the time domain to the frequency domain. Accordingly, the derivative represented by ({dot over ( )}) is replaced with s=jω and
resulting in an impedance relation of the form:
where H (s) is defined by the relation.
represented by Eq. 22.
[0276] The frequency response of this impedance law has interesting properties. At low frequencies, the impedance behaves as a damper with coefficient, b*=b+kτ. At medium frequencies, the impedance has stiffness properties with an equivalent stiffness of
And at high frequencies, the impedance behaves as a damper with equivalent damping of
is the transition frequency between the first damping and stiffness behaviors. Here, ω.sub.0 may range from 0-13 rad/sec (0-2 Hz) providing a primarily damping response in that range. Between ω.sub.theta and about 60 rad/sec (a preferred range between 5-20 Hz), a stiffness dominated response is applied. Above this latter frequency defined by
a damping-dominated response is applied. Often wearers complain that it is hard to maintain balance when the leg joints are in a substantially lightly damped state. So by implementing this method, improved stability results because in the frequency range between 1-10 Hz a stiffness-dominated response is applied that serves to restore balance.
Blended Reflex,
[0277] The following disclosure describes two blended reflex methods, each blending (interpolating) independently tuned responses—defined by torque gain (P.sub.ff) and torque exponent (N), at a fast and a slow walk speed. At speeds below the “slow-walk” speed as determined by the wearer (e.g., less than 0.75 m/s), the reflex employs a slow-walk parameter set; at speeds greater than the fast-walk speed as determined by the wearer (e.g., greater than 1.75 m/s), the reflex employs the fast walk parameter set; and at speeds in between, the reflex adds the two responses together in accordance with a linear or non-linear interpolation based upon walking speed, a surrogate for walking speed (e.g., pitch rate in mid-stance), a kinetic (e.g., torque rate) or kinematic (e.g., joint angle rate). The term walking speed and operating speed below may loosely refer to the walking speed, surrogates of walking speed, a suitable kinetic rate or a suitable kinematic rate.
[0278] Other interpolations may be used, and more than two speed-registered responses may be blended through more complex interpolation, for example, based upon the “distance” between the operating speed and each of the tuned speeds. This approach may be advantageous over the existing methods in that both the gain and exponent can be independently controlled—that is, these reflex coefficients can be tuned independently of each other. For instance, a slow walk reflex response may require a lower exponent torque than that required by a fast walk reflex response, and vice-versa. With fixed N (the variable that controls timing), there is a tradeoff between slow-walk consistency and fast walk power and battery economy. By applying independent tuning, an optimum performance may be achieved, at both ends of the walking speed spectrum, and overall wearer experience can be improved.
[0279] Method I blends two torque models—one defined at a slow speed and one at the fast speed, as determined by the wearer—with gain, P.sub.ff({dot over (s)}.sub.slow), and exponent, N({dot over (s)}.sub.slow), for a first (“slow-walk”) torque model; and gain, P.sub.ff({dot over (s)}.sub.fast), and exponent, N({dot over (s)}.sub.fast), for a second (“fast-walk”) torque model. Method II blends the gains and exponents into a single torque model—with gain,
Method I: Blended Torque Models
[0280]
Method II: Blended Coefficients
[0281]
Where
[0282]
Where c.sub.1 and c.sub.2 are defined as in Method I.
Non-Linear Distance-Based (Quadratic Non-Linear Interpolation)
[0285]
[0286]
[0287]
[0288]
[0289]
[0290]
[0291] It should also be understood that, unless clearly indicated to the contrary, in, any methods claimed herein that include more than one step or act, the order of the steps or acts of the method is not necessarily limited to the order in which the steps or acts of the method are recited.
[0292] While aspects of the invention have been described with reference to various illustrative embodiments, such aspects are not limited to the embodiments described. Thus, it is evident that many alternatives, modifications, and variations of the embodiments described will be apparent to those skilled in the art. Accordingly, embodiments as set forth herein are intended to be illustrative, not limiting. Various changes may be made without departing from the spirit of aspects of the invention.