tmp90C2 TMP
tmp90C2 TMP
I. I NTRODUCTION
Cascaded control structures for series elastic actuators
(SEAs) [1] have gained attention during the past decade [2],
[3], [4]. This type of structure utilizes multiple nested control
loops to achieve robustness and disturbance rejection. Existing studies proposed one type of cascaded structure with an
inner torque loop for controlling SEA dynamics and an outer
impedance loop for modulating high-level tasks [5], [3]. More
recently, investigations have been made to add an inner-most
motor velocity feedback loop nested inside the torque loop
[2], [3], [4]. This velocity loop enables the motor to behave
as a velocity source, eliminating the need to model drivetrain
friction. The results in [5] analyzed various cascaded loops
including torque, velocity and position feedback loops.
Impedance control is suitable for dynamic interaction control
between a robot and its environment [6]. In general, control
designers often choose low impedance as a design target of
SEAs for compliant performance [3], [4]. However, different
tasks require different impedances and high impedance for
SEAs will benefit stiff tasks. For instance, without feedforward compensation, legged robots require high stiffness to
counteract the effects of gravity. Our target is to maximize
the impedance range of series elastic actuator, i.e., the Zwidth [7], [8]. Since low or near-zero impedance has already
been explored successfully [9], [1], we focus more on the
achievable high impedance of SEAs, which is rarely explored
978-1-4799-7174-9/14/$31.00 2014 IEEE
Fig. 1. UT-SEA and Hume-SEA. This figure shows two types of series
elastic actuators. The upper one is the high-performance UT-SEA test bed.
The lower one is our Hume bipedal robot with series elastic actuators.
999
PF (s) =
r(s)k
k (s)
=
.
2
im (s)
Im s + bm s + r(s)k
k = k(qm qj ).
k = Ij qj + bj qj .
(2)
(3)
(4)
(5)
PF ( 1 + C)
k (s)
=
.
des (s)
1 + PF CeT s
(10)
(1)
(9)
PC (s) =
In this section, we model a series elastic actuator that is
subject to two nested control loops: an inner torque loop
and an outer impedance loop. First, let us consider the SEA
dynamics. As shown in Figure 2, the spring force k is
(7)
2f d
,
s + 2f d
(11)
PF ( 1 + C)
qj
= PL PC =
.
des
(1 + PF CeT s )(Ij s2 + bj s)
(12)
1000
Fig. 3. Joint-Level SEA Control Block Diagram. The inner torque loop has proportional and derivative feedback and a feedforward loop with a mapping
scaler 1 . The outer impedance loop has stiffness and damping feedback. Our distributed controller proposes to embed the damping feedback at the low
level while maintaining the stiffness loop for high-level tasks. Delays in each loop are labeled as eT s . A first order low-pass filter is applied to both
velocity and torque derivatives. The motor has a current input im . k is the spring torque. PC represents the embedded torque control loop.
with coefficients
D4 =Im Ij /k,
D3 =(Ij bm + Im bj )/k + Ij B Q d eT s ,
(15)
D2 =Ij (1 + eT s K ) + Im + bj B Q d eT s
+ B Bq eTqd s Qqd Q d + bj bm /k,
D1 =bj (1 + eT s K ) + bm + B Q d Kq eTqs s
+ eTqd s (1 + K )Bq Qqd ,
D0 =eTqs s (1 + K )Kq .
This transfer function is a sixth order system since the low
pass filters Qqd and Q d increase the order by two in total.
An important issue to notice is that there is a zero in the
numerator of Equation (14). This zero is caused by the torque
derivative term. This induced zero will shorten the rise time
but also cause an overshoot in step response. However, it
does not influence system stability, which is determined by
the characteristic polynomial in the denominator.
1 = 2 , n = 2fn .
(16)
Ij bm + Im bj + Ij B k
= 4n ,
Im Ij
k(Ij (1 + K ) + Im + B (bj + Bq )) + bj bm
= 6n2 ,
Im Ij
k(bj + Bq )(1 + K ) + k(bm + B Kq )
= 4n3 ,
Im Ij
(1 + K )kKq
= n4 .
(17)
Im Ij
Slighly
under-damped
Amplitude
Amplitude
1.2
1
0.8
0.6
0.4
0.2
0
0
Critically-damped
0.1
0.15
Time (seconds)
1.2
1
0.8
0.6
fn =18 Hz, with zero
0.4
0.3
0
0
Time (second)
0.1
0.15
0.2
Time
(seconds)
Time
(second)
0.25
0.8
0.6
fn =18 Hz, with zero
fn =16 Hz, with zero
Unstable
0.2
0.4
0.2
1.4
1.2
0.2
Largely
under-damped
1.4
0.05
1.6
1.6
Overshoot due to
extra zero
Amplitude
Amplitude
1.4
Amplitude
Amplitude
1.6
0.3
0
0
0.1
0.15
0.2
Time
Time(seconds)
(second)
0.25
0.3
Fig. 4. SEA Step Response with Effects from Feedback Delays and An Extra Zero. These subfigures demonstrate that large impedance feedback
delays deteriorate step response performance. Comparing subfigures (b) and (c), we observe that system stability is more sensitive to damping feedback
delays than its stiffness counterpart. Note that, in subfigure (a), the larger fn is, the larger the overshoot, which seems counterintuitive. However, if observed
closely, the solid magenta line with the largest fn already shows distortion and its phase margin value is 36.4 , smaller than other three cases. Also, to
analyze the effect of zero in Equation (14), we simulate step responses without this zero, shown in dashed lines of subfigure (a). By comparison, we can
observe this extra zero induces an overshoot.
TABLE I
C RITICALLY- DAMPED G AIN S ELECTION RULE
Frequency
(Hz)
fn = 12
fn = 14
fn = 16
fn = 18
fn = 20
Impedance Gains
(Nm/rad, Nms/rad)
Kq = 65
Bq = 0.46
Kq = 83
Bq = 0.76
Kq = 103
Bq = 1.02
Kq = 124
Bq = 1.26
Kq = 148
Bq = 1.49
Torque Gains
(A/Nm, As/Nm)
K = 1.18
B = 0.057
K = 1.80
B = 0.067
K = 2.56
B = 0.077
K = 3.45
B = 0.087
K = 4.48
B = 0.097
Phase
Margin
49.1
47.0
43.6
39.9
36.4
GS =
Kqn
Ka
=
.
Kn
Kqa
B a
Bq n
=
,
B n
Bq a
(18)
1002
(a)
60
(b)
nominal GS = 1
(c)
70
1.2
40
30
20
GS = 0.4
When GS > 1, phase margin
monotonously decreases
as GS increases
10
0
10
0
6
8
GainScale
Scale GS
Gain
(GS)
10
12
nominal GS = 1
fn =12 Hz
fn =16 Hz
fn =20 Hz
fn =24 Hz
fn =28 Hz
60
GS = 0.4
0.8
GS =4.0
GS =3.6
GS =3.2
GS =2.8
GS =2.4
GS =2.0
GS =1.6
GS =1.2
GS =0.8
GS =0.4
0.6
0.4
0.2
0
0
0.05
0.1
0.15
Time
(seconds)
Time
(seconds)
0.2
0.25
Phase
Margin (degree)
Phase Margin (degree)
Amplitude
Amplitude
Phase
Margin [degree]
Phase
Margin
(degree)
50
50
40
30
20
10
0
10
0
Gain Scale GS
Gain
Scale (GS)
10
12
Fig. 5. Different Gain Scales between Impedance and Torque Gains. Subfigure (a) shows that our critically-damped gain selection is a sub-optimal
solution since its phase margin is the second best. As subfigure (b) shows, increasing GS will slow down the rise time and cause larger overshoot. This
means larger GS deteriorates system stability. However, decreasing GS may decrease phase margin as well. GS = 0.4 has a phase margin around 34
in subfigure (a) and its step response has a distortion in subfigure (b), although behaving more over-damped. Subfigure (c) samples a range of natural
frequencies for the nominal gains and all of them demonstrate similar results. Filtering and delays are ignored to focus on effects of different gain scales.
Impedance control is suitable for dynamic interaction between robots and their environment [6]. Since legged robots
inevitably have contact impact, it is necessary to study how
SEA impedance behaves within different frequency ranges
based on the gain selection criterion proposed above.
Dz5 =Im Tf Tf v ,
Dz4 =Im (Tf v + Tf ) + Tf v Tf bm ,
Dz3 =Im + bm (Tf + Tf v ) + Tf v k(Tf
+ k (B + K Tf )eT s ),
Dz2 =(bm + Tf k + kk (B + K Tf )eT s )
+ Tf v k(1 + K k eT s ),
P4
Nzi si
j (s)
,
= P5i=0
i
sqj (s)
i=0 Dzi s
(19)
1003
25
5
0
No Filter, No Delay
With Filter, No Delay
No Filter, With Delay
With Filter, With Delay
45
Phase twisted
90
0
10
15
10
5
0
5
10
0
Passivity stability
violation region
10
Frequency
(Hz)
Frequency
(Hz)
10
Small disparity
due to filtering
20
=100 Hz
=20 Hz, f
=50 Hz
qd
qd
d
d
25
Medium disparity
due to delays
20
15
10
Physical Stiffness k/j
Virtual
5 Stiffness K /j
vir
SEA Impedance
different
delays
(c) Impedance
effected by with
feedback
delays
(no filtering)
vir
0
No Delay
T =T =T =1 ms
qs 5 qd
T =5 ms, T =2 ms, T =1 ms
qs10
qd
T =10
ms,
T =3 ms, T =1 ms
qs 0
qd
45
No phase twisted
Phase (deg)
Converge to
virtual stiffness
10
15
10
0
Phase
Phase(degree)
(deg)
Converge to
spring stiffness
Magnitude
(dB)
Magnitude
(dB)
20
Phase
Phase(degree)
(deg)
Magnitude
(dB)
Magnitude
(dB)
25
Magnitude (dB)
SEA Impedance
witheffected
different
frequency
SEA Impedance
with Virtual
Spring
Damper
and filtering
(b) Impedance
byfilter
filtercut
(nooff
delay)
(a) SEA impedance
with/w.o
filter
and delay
45
Phase twisted
90
90
0
10
10
Frequency (Hz)
(Hz)
Frequency
10
10
10
Frequency (Hz)
10
Frequency (Hz)
Fig. 6. SEA Impedance Effected by Filtering and Feedback Delays. In subfigure (a), the yellow and blue dashed lines represent impedance of physical
spring stiffness k and a virtual stiffness gain, respectively. The red dashed line is the ideal SEA impedance without filtering and delay. At low frequencies,
SEA impedance approaches the virtual stiffness, similar to that in [3]. At medium and high frequencies, it converges to another impedance asymptote.
Subfigure (b) analyzes the effect of the filter while subfigure (c) analyzes the effect of feedback delays. Similarly, the sensitivity to different feedback
delays can be analyzed but is not discussed here due to space limitations. A natural frequency of fn = 30 Hz is used for all simulations in this figure
with Kq = 293.6N m/rad, Bq = 2.49N ms/rad, K = 11.71A/N m, B = 0.146As/N m.
Nz2
j Dz3
30
20
10
0
10
Phase (deg)
90
45
0
45
90
10
10
Frequency (Hz)
10
Magnitude (dB)
30
20
0
10
90
Phase (deg)
Fig. 8.
Bode Diagrams with Different Natural Frequencies fn .
This figure shows that increasing fn increases closed-loop bandwidth. At
low frequencies, experiments match simulations quite well. At frequencies
around resonant frequency, experiments show a larger resonant peak and a
slightly larger bandwidth than simulations.
10
45
1.6
0
45
1.4
90
1
10
Frequency (Hz)
GS increases
1.2
10
Amplitude
Amplitude
10
Fig. 7.
Effects of Load Inertia on SEA Impedance. This figure
shows three different load scenarios. At high frequencies, SEA impedance
approaches the load inertia impedance Ij s. Filtering and delays provides
very limited effect since two figures perform very similar.
1
0.8
0.6
Simu GS =1
Simu GS =1.3
Simu GS =1.9
Exp GS =1
Exp GS =1.3
Exp GS =1.9
0.4
0.2
0
0
0.05
0.1
0.15
Time
(seconds)
Time
(second)
0.2
0.25
1005
R EFERENCES
[1] G. A. Pratt, P. Willisson, C. Bolton, and A. Hofman, Late motor
processing in low-impedance robots: Impedance control of serieselastic actuators, in American Control Conference, 2004. Proceedings
of the 2004, vol. 4. IEEE, 2004, pp. 32453251.
20 cm
height
Joint
JointPosition
Angle (degree)
ArmTorque
Torque(Nm)
(Nm) Arm
(degree)
Impulse Response
1
[4] N. L. Tagliamonte, D. Accoto, and E. Guglielmelli, Rendering viscoelasticity with series elastic actuators using cascade control, in
Robotics and Automation (ICRA), 2014 IEEE International Conference
on. IEEE, 2014.
0
1
2
3
0.1
0.1
0.2
Time (second)
0.3
0.4
6
Desired
Measured
4
2
0
2
0.1
0.1
0.2
Time
Time(second)
(second)
0.3
0.4
1006