Professional Documents
Culture Documents
(I)
Because we assumed that the knee is only composed of
the damper, ui is the torque acting on the damper.
where 2.2 Damper Model
The relation between angular velocity and dissipation
torque is represented as
: inertial matrix
T = uL = CW+ {T, + T(B)}sign(w) (3)
where c is the damping coefficient when no field and it
is came from pressure drop in the duct of the damper.
T ( B ) is the variable torque which can be controlled by
magnetic field. This model is shown in figure 2. The
operating point moves parallel to the coefficient when
+ m,l,)(cosq,x, + sinqljja+ sinq,g)
(nz,ul
nz,a,(cosq,i, +sinq,jj,l +sinq2g) 1 constant magnetic field is applied.
1
I I ,
21 11
= [''[I
LUL-
: input vector of the hip and knee torques
3687
Then, the control input T(B) is chosen as where uV = pressure drop due to viscous flow
c, =2-3
1)if w > O 7, (H) = variable yield stress
(controlled by magnetic field)
L = field length
(5)
= g a p length
otherwise
If the magnetic field is induced by moving a permanent
2)if w < O
magnet instead of applying current to a solenoid, it has
TBman i f T, < -T,,,, advantage in power consumption, but there exist time
delay in operating motor additionally.[3,4] Because fast
otherwise response time is needed in tracking knee angle, a solenoid
is selected as a magnetic field induction device.
where, T ~ : , maximum
~ ~ ~variable torque The structure of MR damper is shown in figure 3.
T , = uk- c w - T , s ~ ~ ~ ( w ) Magnetic filed is applied in the upper plate of choke
(choke: narrow and long passage, in which pressure drop
is affected by viscosity ) and cross section of choke is
3 Design of the Damper for Above Knee rectangular. Magnet core is made of silicon steel, the
Prosthesis resistance of coil is 10.6Q and inductance is 1H. As a
current
current supplier, PWM generator and amplifier are used.
P aramagnetic In addition, the upper plate of choke is made of
magnetic fie1Id
nonmagnetic material and the lower plate of choke is
made of soft steel in order to minimize the leakage flux.
The gap of damper is selected as 2". [3,4]
J ferromagnetic
material 9
M , I I I , I I I I
'
rotary vane
T=- @''
2K
+TJ (7)
3688
Figure 4 shows the relation between PWM duty, torque
dissipation and angular velocity for the damper. Figure 5
shows the controller for the MR damper. It is composed
of TMS320F240 DSP, AD converter, ROM, RAM, PWM
AMP and serial communication module.
4 Leg Simulator
The leg simulator is used for generating the various
movements of human thigh. This simulator shortens time
of developing AK prostheses and makes it possible to get
reliable results from lots of experiments. The simulator in 0 02 04 06
Time (Sec)
OS 1
4- FOOT
3689
periodic and the period is known.[8] Moreover, It is this interval because the resistant force from the ground
desirable to include a anti-windup concept when the was not applied to the foot. If the resistant force is applied
actuator is operating at its saturation limit.[9] to the damper in the real environment, the damper should
Tracking control of the knee angle have been carried out give a maximum torque to achieve stability.
to examine the performance of the controller. Figure
10(A) is the knee tracking error when PD control law and
computed torque law are adopted. RMS errors are more 6 Estimation of Gait Period Using Gyro
than 4' as the repetition. q, is assumed to be known in
the experiment. In order to design the controller adaptable to the walking
speed, the gait period should be estimated. Gyro sensor is
attached to the thigh because person moves the thigh
actively. Gait period is estimated by measuring the zero
crossing interval of gyro signal.[7] Initial gait period is
assumed to the normal walking speed and the updated
value of estimated value is determined by
T ( k + 1) = T ( k ) +ore@) (10)
where e(k) = T,,( k ) - ~ ( k :)k-th error
T(k) : k-th estimation period
2 4 6 8 10
relielltlon
12 I4 16 18
Tm( k ) : k-th measurement period
a : weighting factor
Figure 10 Comparison of RMS tracking error
as the repetition After generating the reference knee angle trajectory
based on the estimated period, the tracking of the
Figure 10(B) is the knee tracking error when repetitive trajectory has been performed. The result is represented in
controller in conjunction with a PD control law and figure 12. At the transition of gyro signal from minus to
computed control law is used. This RMS error converges plus sign, the period is estimated by the equation (10) and
as the repetition and the deviation of error is also small. new reference profile is generated. In the experiment, leg
Figure 1 1 shows the tracking control of knee as the simulator is operated repeatedly with the 1.1Ssec period.
repetition. Only initial angle was set to be coincided with At the start, the damper is maintained passively without
the reference as a initial condition, initial angular velocity control until first zero crossing point is detected.
and acceleration was set to zero in the experiment.
1 . 5 ~ ~ I
I . I .- I . I . b I I , I
00 02 04 08 08 I O
penodic hme(sec)
S I
Figure 11 Relative knee joint angle tracking of PD
-th period
+ Computed torque + Repetitive control method
Figure 12 Knee joint angle tracking and estimation of
The time interval between 0. lsec and 0.4sec corresponds
period
to the stance phase, in which the weight is applied on the
ground in the real environment. Large error was found in
Relative knee joint angle is minus sign at the start since
3690
the proposed AK prosthesis is now the structure that can 2857-2865,1996
be folded down inversely. In the estimation of period, a
[7] J.C. Cho, "A Study on Control for Above-Knee
is 0.5 and initial period is assumed to 1 sec. The estimated
Prosthesis through Gait Analysis," M.Eng. Thesis, Dept of
period converges in the 5-6 repetitions as shown in the figure.
Mechanical Engineering, KAIST, 1998
[8] Tsai, M.'C., Anwar, G. and Tomizuka, M., "Discrete
7 Conclusion Time Repetitive Control for Robot Manipulators", IEEE
International Conf. On Robotics and Automation, pp.
In this study, we proposed rotary MR damper using 1341-1346, Philadelphia, PN, 1988
microprocessor as a control device for AK prosthesis. We
[9] Y.S. Ryu and R.W. Longman, "Use of Anti-Reset
designed the MR damper that is controlled by applying
Windup in Integral Control Based Learning and
current to a solenoid. The damper was attached into knee
Repetitive Control," IEEE Int. Conf. on Systems, Man,
of leg simulator and experimental tracking control of
and Cybernetics, Vol3, pp. 2617 -2622, 1994
above knee angle was carried out. Leg simulator was
designed and this robot made it possible to develop
intelligent AK prosthesis. As the controller for tracking of
repetitive reference profile, repetitive controller in
conjunction with a PD control law and computed control
law was adopted. Consequently, the algorithm reduced
RMS tracking error and possibility of application for AK
prosthesis was proved. Using gyro sensor attached in the
thigh, the gait period was estimated and real time
feedback control adaptable to walking speed was
performed based on the estimated period. As a future
work, structural reinforcement should be carried out to
resist the sufficient weight at stance phase even though
the damper is passive condition without power supply.
Reference
[ 11 T.K.Wang, M.S.Ju and Y.G.Tsuei, "Adaptive Control
of Above Knee Electro-Hydraulic Prosthesis," Journal of
Biomechanical Engineering, Vol. 114, pp.421-424, 1992
[2] A.Bar, G.Ishai, P. Meretsky and Y. Koren, "Adaptive
Microcomputer Control of An Artificial Knee in Level
Walking," Journal of Biomedical Engineering , Vol. 5 ,
145-150,1983
[3] J.H. Kim, J.H Oh, "The design of low-power MR
damper using permanent magnet," In Pi-ec. of the KSME
2000 Spring Annual Meeting A , pp.433-439,2000
[4] J.H. Kim, "A study on the design of valve mode MR
damper using permanent magnetic circuit," M.Eng. Thesis,
Dept of Mechanical Engineering, KAIST, 1999
[5] S.H. Kim, "Constrained Rotary MR Damper Design
and Its Application," M.Eng. Thesis, Dept of Mechanical
Engineering, KAIST, 1998
[6] J.D.Carlson, D.M.Catanzarite and K.A.St. Clair,
"Commercial Magneto-Rheological Fluid Devices",
International Journal of Modern Physics B, Vol. 10, pp.
3691