Asociación Española de Ingeniería Mecánica XVIII CONGRESO NACIONAL DE INGENIERÍA MECÁNICA Simulación del control híbrido de un modelo simplificado de órtesis activa para ayuda a la marcha S.H. Hosseinnia, B.M. Vinagre, F.J. Alonso Dpto. de Ingeniería Eléctrica, Electrónica y Automática, Escuela de Ingenierías Industriales, Universidad de Extremadura [email protected];{bvinagre,fjas}@unex.es Resumen De acuerdo con la “Encuesta de Discapacidad, Autonomía personal y situaciones de Dependencia (EDAD) “ de 2008, sólo en España aproximadamente 1.5 millones de personas tienen dificultades para caminar como resultado de accidentes, lesiones medulares, parálisis cerebral o síndrome postpolio. Este tipo de lesionados pueden mover sus piernas pero no son capaces de caminar adecuadamente debido a la debilidad de sus músculos, y prodrían mejorar notablemente sus condiciones de vida con el uso de órtesis activas. Entre estas órtesis, son de gran interés las tipo SKAFO (Stance-control Knee-Ankle-Foot Orthosis) al permitir el movimiento libre de la rodilla durante la fase de balanceo (swing) y resitir a la flexion durante la fase de apoyo (stance) , haciendo así posible una marcha más natural. El control de estos dispositivos debe contemplar para cada pierna varias fases o estados caracterizados por distintas dinámicas, amén de supervisar y coordinar el movimiento de las dos piernas. Este trabajo se enmarca dentro de un proyecto cuyo objetivo es el diseño de un controlador para una órtesis activa modelando el sistema como un sistema híbrido en el que interactúan las dinámicas continuas correspondientes a los modelos de los miembros y articulaciones, con la dinámica de eventos discretos correspondiente a las distintas fases o estados y a las transiciones entre ellos. Se ha desarrollado aquí un modelo simple suponiendo que los pacientes pueden controlar el movimiento de la cadera pero no el de la rodilla. Considerando las dos fases de la marcha, se han diseñado dos tipos de controladores para regular el adecuado movimiento de la rodilla. Las simulaciones muestran la efectividad de las estrategias de control propuestas. INTRODUCTION The inability to properly walk because of lower limb paralysis is a common result of a thoracic-level spinal cord injury (SCI). For people with isolated quadriceps weakness or paralysis, a standard knee-ankle-foot orthosis (KAFO) is typically prescribed to support the limb during locomotion. Many of these KAFOs support the limb by locking the knee in full extension throughout the gait cycle to prevent the leg from collapsing while weightbearing. The user must have good trunk control and a strong upper body because considerable effort is required from the arms engaging parallel bars, a walker, or crutches for support. While constraining the knee to full extension solves the body-weight support problem, straight-legged gait introduces other issues. During swing phase, KAFO users must adopt unnatural gait strategies to bring their braced leg forward to prepare for the next heel or foot strike. Compensatory gait patterns include increased upper-body lateral sway, ankle plantar flexion of the contralateral foot (vaulting), hip elevation during swing phase (hip hike), or leg circumduction [1]. Lack of knee flexion during foot strike causes abrupt initial loading and disrupts the smooth progression of the center of mass (COM) of the body [2]. Different control strategies applied at the level of the joints for functional compensation of gait in wearable devices. Kazerooni et al. [3], [4] proposed the application of proportional control of position for the Bleex system, a powered lower extremity exoskeleton for human strength augmentation during locomotion. The authors proposed the use of proportional control on each joint to cause the exoskeleton joint angles to track the human joint angles. Myoelectric proportional control of pneumatic actuators has been proposed by Ferris et al. [5], for regulation of artificial generation of dorsi flexion and plantar flexion torques, activated proportionally to the amplitude of EMG signals. Variable-impedance control of ankle-foot orthoses to assist drop foot gait, is S. Hassan HosseinNia et al. / XVIII Congreso Nacional de Ingeniería Mecánica (2010) 2 proposed by Blaya et al. [5], discussing the application of a state machine with selective gait phase-dependent control of the stiffness of a spring, by means of a DC motor. PD control of impedance is applied during the swing phase (proportional to position), while impedance zero target is defined during plantar flexion trajectories. A springclutch design for a swing phase knee orthosis controlled by a solenoid is presented by Irby et al. [6], proposing the characterisation of gait events relying on foot contact information, provided by force-sensitive resistors (FSR), to release and lock the knee joint during gait. Gharooni et al. [7], propose an hybrid orthosis with a controllable brake with the aim of improving the performance of functional electrical stimulation (FES). Sliding Mode Control (SMC) is a variable structure control method (see [8, 9] and references therein). The multiple control structures are designed so that trajectories always move toward a switching condition, and so the ultimate trajectory will not exist entirely within one control structure. Instead, the ultimate trajectory will slide along the boundaries of the control structures. The motion of the system as it slides along these boundaries is called a sliding mode and the geometrical locus consisting of the boundaries is called the sliding surface. In the context of modern control theory, any variable structure system, like a system under SMC, may be viewed as a special case of a hybrid dynamical system. The main strength of SMC is its robustness. Because the control can be as simple as a switching between two states (e.g., "on"/"off" or "forward"/"reverse"), it need not be precise and will not be sensitive to parameter variations that enter into the control channel. Additionally, because the control law is not a continuous function, the sliding mode can be reached in finite time (i.e., better than asymptotic behavior) and the response is usually so rapid. In this paper, the dynamic model of the orthosis presented in [10] is obtained and control of knee angle is studied for this system. A modified hybrid PID controller is proposed using a switching complementary controller based on sliding mode theory. The rest of paper is organized as follows. In the next section, biomechanics of walking and system dynamics of the orthosis is presented. Controller design and simulation results are discussed in section 3 and 4, respectively. Finally the paper is concluded in the section 5. BIOMECHANICS OF WALKING AND SYSTEM DYNAMICS A simplified diagram of human walking gait is presented in Fig. 1. Joint motion in this plane is referred to as flexion (positive direction) and extension (negative direction). Additionally, motion of the hip in the coronal plane is referred to as abduction (away from the center of the body) and adduction. Further, motion of the ankle in the coronal plane is referred to as eversion (away from the center of the body) and inversion. The remaining degrees of freedom of the hip and ankle are referred to as simply `rotation'. Fig. 1. Biomechanics of Walking Fig. 2 shows the biomechanics of a normal, healthy individual (1 m leg-length), showing joint angle for hip, knee flexion/extension motions during level-ground walking. From Fig. 2 can be seen that there are two main phases, i.e. stance phase (SC) and swing phase (SW). Another thing which should be considered is Ground Reaction Force (GRF) Sensors. Using the knee angle, θh, ankle angle, θk, , and GRF, this two phases can be identified. To formulate the corresponding hybrid automation, SC phase and SW phase are defined as q and q , respectively. The swing phase is about started in 60 percent of gait cycle which is obvious in Fig. 1. The hybrid automaton of this system can be described as: Simulación del control híbrido de un modelo simplificado de órtesis activa para ayuda a la marcha 3 · Q={q₁,q₂}, · X=(θh ,θk) · Init={q₁}×{x ², ²:-0.4< θh <0.3 & 0<θk<0.35 & GRF>0.5}, · D(q₁)={X ²: -0.4<θh<0.3 & 0< θk <0.35 & GRF>0.5}, · D(q₂)={X ²: -0.3<θh<0 & 0< θk <1.1 & GRF≤0.5}, · E={(q₁,q₂),(q₂,q₁)}, · R(q₁,q₂,X)=R(q₂,q₁,X)={X}. Angle (Rad) 1 Knee Hip 0.5 0 -0.5 0 20 40 60 Percent gait cycle 80 100 Fig. 2. Biomechanics of the normal person: joint angle of hip and knee The hybrid automaton is also shown in Fig. 3, in which we can easily see the separation of stance and swing phase. Fig. 3. Hybrid automaton The continuous dynamics in this system is modeled as a two-link Euler dynamics, and it is shown in Fig. 4. Fig. 4. Mechanical representation of orthosis S. Hassan HosseinNia et al. / XVIII Congreso Nacional de Ingeniería Mecánica (2010) 4 The parameter and dynamics of this robot can be described as: L1 (m1 m2 )1 m2 L22 cos(1 2 ) m2 L2 22 sin(1 2 ) g (m1 m2 ) sin(1 ) h , m L m L cos( ) m L 2 sin( ) gm sin( ) . 2 2 2 2 1 1 1 2 2 1 1 1 2 2 2 (1) k Where L1 , L2 and m1 , m2 are length and mass of the each link in Fig. (4), respectively. h and k are hip and knee torque which should be controlled. Regarding to knee angle ( 1 2 ), it should be limited between 0 to π/2. In addition, in this paper the aim is not to control the hip and it is supposed that the patients can control their hip but they have problem for controlling the knee. Therefore, it is just needed to control knee and the hip is controlled by patients and they can follow the movement as shown in Fig. 2. In order to control the knee angle to follow the reference a PID with a sliding surface is proposed in the next section. CONTROLLER DESIGN A PID controller with combination of a sliding switching law is proposed to control the orthosis dynamics. As it can be seen from Fig. 2 knee angle will always vary during the stance phase and specially swing phase and in order to have precise movement the controller need to reach the reference value (Fig. 2), rapidly. Therefore, the SMC controller is used to control the orthosis system. Indeed, the design procedure of sliding mode control has the following steps: 1. Constructing a sliding surface which represents a desired system dynamics. 2. Developing a switching control law to make the sliding mode possible on every point in the sliding surface. Any states outside the surface are driven to reach the surface in a finite time. Correspondingly, the sliding mode control will be deigned in two phases: the reaching phase when S≠0 and the sliding phase by S=0. Actually, in this paper PID controller plays the role of equivalent control law for the reaching phase and the switching control law will make the responses faster and help the robustness of the system. The error of the knee angle ( 1 2 ) and the reference value ( r ) which is shown in Fig. 2 is considered as a sliding surface, S 1 2 r (2) Consequently, the control law will be achieved as, uPID us (3) d S K i Sdt and uS K sgn( S ) . And the sgn(.) is the well-known signum function. dt PID controller will help the states to reach the surface and the switching law causes the states to stay in the sliding surface. The system which is considered is nonlinear and it is not exact dynamics of the orthosis. In addition, the PID controller is not fast enough in this case and to have more exact and faster results, linear and precise model of orthosis is needed. Therefore, a complementary controller (switching control in this case) is necessary. The block diagram of controlled system is depicted in Fig. 5. where uPID K p S K d Fig. 5. Block diagram of controlled system Simulación del control híbrido de un modelo simplificado de órtesis activa para ayuda a la marcha 5 SIMULATION RESULTS The simulation results are carried out using SIMULINK using simmechanics toolbox. System parameter are selected as, m₁=3 kg, m₂=2 kg, L₁=0.433 m, L₁=0.567 m and the controller parameter are also selected as K p 10, K d 10, K i 20 and K=10. The results are shown in Figs. 6 and 7. As it can be seen the response in PID controller is too slow and cannot track the variable reference value. If K i increases the response will be better and in the other hand the controller may need more energy to reach desired values. Therefore, a switching law can make the response faster and the controller can behave more robust than the classic PID controller. 1.2 PID PID & Sliding Reference Knee angle (Rad) 1 0.8 0.6 0.4 0.2 0 -0.2 0 20 40 60 Percent gait cycle 80 100 Fig. 6. Simulation results 0.8 PID PID & Sliding 0.6 Error 0.4 0.2 0 -0.2 -0.4 0 20 40 60 Percent gait cycle 80 100 Fig. 7. Tracking error Figs. 8 and 9 show the results for K i 20 and PID sliding controller with same parameter as pervious simulation. As it can be seen the response for PID improved but still there is considerable error, especially in the stance phase. As it is mentioned before this controller is applied for the people who has spinal injury and they can walk but control of the knee is hard for them the orthosis would help them to control their knee properly. Therefore, knee control is very important in the stance phase. As it can be seen the tracking error in the stance phase is about 0.2 rad which may cause the patient to lose its control. In addition, the patient may have sudden force in their knee which is not modeled in the dynamics of the system. Therefore, the behavior of the controllers is studied in the orthosis model with an external 5 N/m torque as a not modeled disturbance. The disturbance is applied in 50% of the gait cycle. The results are shown in the Figs. 10 and 11. As it can be seen when the disturbance is activated the response of PID controller is not reach the reference whereas the response of PID with switching law is reach after a short time. Therefore, the existence of a complementary controller like switching law in this case would be necessary to control the orthosis. S. Hassan HosseinNia et al. / XVIII Congreso Nacional de Ingeniería Mecánica (2010) 1.2 PID PID & Sliding Reference 1 Knee angle (Rad) 0.8 0.6 0.4 0.2 0 -0.2 0 20 40 60 Percent gait cycle 80 100 Fig. 8. Simulation results 0.8 PID PID & Sliding 0.6 Error 0.4 0.2 0 -0.2 -0.4 0 20 40 60 Percent gait cycle 80 100 Fig. 9. Tracking error 1.4 1.2 PID PID & Sliding Reference Knee angle(Rad) 1 0.8 0.6 0.4 0.2 0 Unmodeled disturbance in action -0.2 0 20 40 60 Percent gait cycle 80 100 Fig. 10. simulation results with unmolded disturbance 0.8 PID PID & Sliding 0.6 Error 0.4 Unmodeled disturbance in action 0.2 0 -0.2 -0.4 0 20 40 60 Percent gait cycle Fig. 11. Tracking error 80 100 6 Simulación del control híbrido de un modelo simplificado de órtesis activa para ayuda a la marcha 7 CONCLUSION In this paper, a hybrid controller using PID controller in combination with a SMC is proposed to control the knee angle in the orthosis model. A simple model based on Euler equation of motion is considered for two link orthosis whereas the hip angle is considered to be controller by the patient. Since the knee strongly varies during the swing phase and the model of the orthosis is not exact, the results for PID controller are not applicable. Using a switching control law the error caused by PID controller is eliminated and the response improved. For the future work, this group is considering a more exact model for orthosis and the control of hip angle would also considered. In addition, the real application is in progress. REFERENCIAS [1] P Bowker, DN Condie, DL Bader, DJ Pratt, Biomechanical basis of orthotic management. Oxford (UK): Butterworth-Heinemann; 1993. [2] T. Yakimovich, E. D. Lemaire, J. Kofman, Engineering design review of stance-control knee-ankle-foot orthoses, Journal of Rehabilitation Research & Development, 46(2) (2009) 257--268. [3] Kazerooni H, Steger R, Huang L, Hybrid control of the berkeley lower extremity exoskeleton. Int J Robotics Res, 25(5–6)(2003)561–573. [4] 13. Kazerooni H, Steger R, Huang L Hybrid control of the Berkeley lower extremity exoskeleton. Int J Robotics Res, 25(5)(2003) 61–573. [5] Ferris D et al, An improved powered ankle foot orthosis using proportional myoelectric control. Gait Posture, 23(2006)425–428. [6] S Irby, Optimization and application of a wrap-spring clutch to a dynamic knee-ankle-foot orthosis. IEEE Trans Rehabil Eng 7(1999)130–134. [7] S Gharooni, B Heller, M Tokhi, A new hybrid spring brake orthosis for controlling hip and knee flexion in the swing phase. IEEE Trans Rehabil Eng, 9(2000)106–107. [8] V. Utkin, Sliding Mode Control Design Principles and Applications to Electric Drives, IEEE Transactions on Industrial Electronics, 40, 1 (1993), 23-36. [9] C. Edwards, S. Spurgeon, Sliding Mode Control: Theory and Applications. Taylor and Francis, London 1998. [10] J. M. Font-Llagunes, G. Arroyo Eremian, F. J. Alonso, B. M. Vinagre, Diseño de una órtesis activa para ayuda a la marcha de lesionados medulares, (Enviado a) XVIII Congreso Nacional de Ingeniería Mecánica, Ciudad Real, Noviembre 2010.