You are on page 1of 6

Design and Control of an Under-actuated Robot Leg,

Using State Feedback and Impulse Shaping

Yunha Kim Valerio Salvucci Yoichi Hori


Graduate School of Engineering, Graduate School of Engineering, Graduate School of Frontier Sciences,
The University of Tokyo, The University of Tokyo, The University of Tokyo,
Tokyo, Japan 113-8656 Tokyo, Japan 113-8656 Chiba, Japan 277-8561
Email: yunha.kim@hori.k.u-tokyo.ac.jp Email: valerio@koseki.t.u-tokyo.ac.jp Email: hori@k.u-tokyo.ac.jp

Abstract—This paper is about a novel type mono-pedal robot the number of actuators required, and thus make robots more
with a bi-articular spring and a mono-articular electric motor. affordable and accessible to more latent users. The novelty
The mechanism is designed based on the concept of the mono-bi of the mechanical configuration which enables reduction of
configuration, which effectively reduces the number of actuators the number of actuators and thus in the complexity of control
and consequently the cost, keeping the advantages of bi-articular while keeping the advantages of bi-articular actuation, is one
actuators such as high compliance, stability, accuracy, and homo-
of the most important contributions of this work.
geneity of motion. By showing the control strategies of JUMPBiE,
it shows the feasibility of the proposed system configuration
and gives insights on the under-actuated bi-articular actuation II. S YTEM C ONFIGURATION
problems. In this work, the background of the robot design and its
mathematical model were elaborated, and the simulation results A. Bi-articular Actuator
were shown and discussed.
A bi-articular muscle refers to a muscle that exerts the same
amount of torque to the two adjacent joints simultaneously.
I. BACKGROUND The effectiveness of bi-articular muscles in animal motions
was extensively studied by Kumamoto et al. [9], showing
In many aging societies, demands for robots for welfare
that the existence of bi-articular muscles enables not only
and humanitarian purposes are rising. To satisfy these demands
force and energy transmission in animal limbs, but also the
and to bring robots closer to the real life, problems regarding
precise position control during movement. With bi-articular
safety, performance, and cost must be resolved. Biomimicry
muscles, it is generally known that animals can move smoothly,
is one of many approaches to clear these problems. Mimicry
rapidly, and precisely without using positional feedback signal
of different organisms, from micro-creatures to primates, can
of the end-effector; remain stable in their posture regardless of
be seen at different levels such as structural, physiological,
external disturbances; control the stiffness of the extremities
functional, and behavioral. Many biologically inspired robots
by using the antagonistic muscle pair; and easily exert forces
have been introduced in recent years, proving to be successful
in the straight forward direction.
in achieving given tasks effectively and energy-efficiently
[1][2]. Hogan in [5] proposed a 3-pair 6-muscle two-link manip-
ulator model as shown in Fig. 1. as the fundamental structure
The bi-articular actuation is one of the most promising of an animal limb, including human arms. e1 and f1 in the
fields of bio-mimetic robotics, due to the fact that bi-articular figure are the mono-articular extensor and flexor muscles for
muscles in animal limbs, including human arms and legs, en- the upper joint, e2 and f2 are the mono-articular extensor
able mechanical energy transfer from proximal to distal joints and flexor muscles for the lower joint, and e3 and f3 are the
[3][4], impedance modulation in accordance with disturbances bi-articular extensor and flexor muscles for the two adjacent
[5][6], and thus stabilization and accuracy of motion [7]. In joints.
addition, bi-articular muscles help to provide homogeneous
output force in respect to working direction, with having The model has been widely accepted and used by many
transverse force component, from the proximal joint to the researchers, and its validity has been verified by a number
tip of the end-effector, which coincides with the direction of of research works. Oh [10], Salvucci [11], and Kimura [12]
the motion [8]. made contributions to the field by verifying the model via
experiments focusing on statics. The output force profile and
These advantages of bi-articular muscles are particularly the stiffness ellipse introduced in those works provide in-depth
appropriate and essential for robots working in human envi- insights into animal motion.
ronments. High compliance which bi-articular muscles provide
enables safe and, human- and environment-friendly motion
of robots. Homogeneity in output force characteristics of bi- B. Mono-Bi Configuration
articular muscles helps to improve the performance of the The main motivation for the proposal of the mono-bi con-
robots in human environments. Last but not least, use of bi- figuration is to reduce redundancy, and thus cost. In animals’
articular muscles effectively can reduce the cost, decreasing case, redundancy provides additional degrees of freedom in
978-1-4799-2722-7/13/$31.00
c 2013 IEEE motion, which can help to avoid postural singularities, and to
Figure 1. The schematic model of a human arm. e1 and f1 are the mono-
articular extensor and flexor muscles for the shoulder joint, e2 and f2 are the
mono-articular extensor and flexor muscles for the elbow joint, and e3 and f3 Figure 2. A mono-pedal robotic leg with a bi-articular spring and a mono-
are the bi-articular extensor and flexor muscles for the two adjacent joints. articular electric motor, JUMPBiE.

back up when they are partially disabled. On the other hand, it configuration without any mono-articular actuator at its knee
is rather too costly for robotic systems. Moreover, redundancy joint, which makes it difficult to authorize valid forces to
sometimes imposes difficult control problems in dealing with the direction in need because of the difference in dynamics
manipulator statics and dynamics [13]. between the electric motor and the spring, and thus sophisti-
cated control strategies are necessary to realize continuous and
Among many researchers, Oh et al. in [14] first attempted extensive jumping motion.
to resolve the redundancy problem by elimination, and pro-
posed a way to eliminate it by using combinations of two III. D ESIGN AND M ODELING
actuators among three for the two dimensional motion. The
results showed that the combination of the mono-articular A. Robot Design
muscle of the upper joint and the bi-articular muscle can An mono-pedal robotic leg, JUMPBiE (Jumping Leg using
possibly eliminate the redundancy without losing the output Passive Bi-articular Elements; shown in Fig. 2) is designed
force characteristics. This combination was then named the and fabricated to experimentally verify the feasibility and the
mono-bi configured system. Based on this, recently Sonokawa effectiveness of the SLMB configuration. The robot is currently
et al. introduced a novel leg space coordinate system and being modified to implement the control strategy developed
velocity control method for two link robotic arm equipped in this work. Its design philosophy and basic control strategy
with mono-bi-actuators [15]. are introduced in [16] and [17]. JUMPBiE has one electric
motor attached to the upper joint, and a passive bi-articular
C. Spring-Loaded Mono-Bi Configuration (SLMB) spring which applies torque to the upper and the lower joint
simultaneously. The theoretical background of the system is
Furthermore, considering the fact that bi-articular muscles elaborated in detail in [10], [11], and [12].
function as an energy transmitter in animals’ jumping motion
as reported in [3] and [4], a spring can replace an active bi- The construct of the robot leg and body is made of ABS,
articular actuator for applications like jumping robots. The which is the toughest engineering plastic with over 300 J/m of
system consisting of a mono-articular electric motor and a Izod impact strength, the half of aluminum. At the same time
bi-articular spring is hereafter called the spring-loaded mono- the specific weight of ABS is 1.05, which is much lighter than
bi (SLMB) configured system. JUMPBiE the jumping robot aluminum which has 2.69, and still strong enough to endure
adopted the SLMB configuration. the impact of jumping.
For the mono-articular actuator, a 150W DC motor with
In [16] and [17], the feasibility of the configuration was
1/43-reduction ratio was chosen, together with a tensional
shown, by using an equivalent spring model to determine the
spring whose stiffness is 1.88N/mm, which is equivalent to
bouncing direction of the robot. The result is comparable to
4.70 Nm/rad. Two links are fixed and free to rotate at the hip
that of [18], where four linear actuators are used in realizing
and knee joints, while the robot body is fixed to a 2-DOF linear
jumping motion. One linear actuator is used for bi-articular
guide, which allows two dimensional translational motion but
muscle, another for mono-articular muscle for the upper joint,
prevents rotation.
and the other two for mono-articular muscles for the lower
joint. This configuration makes it simpler and easier to realize Two encoders of 3600 ppr are attached to each joint to
continuous jumping, due to the fact that the four actuators measure the angular displacements, and the Compact RIO
are controlled accordingly to produce desired output force of National Instruments Corp. is used as the controller. The
characteristics. On the other hand, JUMPBiE has the mono-bi control period is set at 1 kHz.
Major mechanical parameters of JUMPBiE are indicated
in Table I. The values are measured, and/or computed from
the measured ones.
Table I. P HYSICAL PARAMETERS
Parameters Meanings Values
M total mass 6.55 kg
Mc counter mass 3.65 kg
Me effective mass 2.90 kg
m1 mass of l1 0.371 kg
m2 mass of l1 0.308 kg
I1 Inertia moment of l1 at the hip joint 0.0808 kgm2
I2 Inertia moment of l2 at the knee joint 0.0019 kgm2
l Length of each link 0.300 m
Ks bi-articular spring coefficient 4.70 Nm/rad
g gravitational acceleration 9.81 m/s2

B. Kinematics of the System


Oh et al. showed the effectiveness of the mono-bi config-
uration in the two-link manipulator [14]. When considering
economy and performance, it is shown that using the mono- Figure 3. The system construct and the frame of reference.
articular actuator in the upper joint and the bi-articular one
between the upper and the lower joints is effective.
where,
The system schematic is shown in Fig. 3. Assuming that
the length of each link is identical without losing generality Θ = [θ1 θ2 ]T (6)
[14], i.e.:
T = [τm + τs τs ]T (7)
 
l1 = l2 = l (1) M11 M12
M(Θ) = (8)
M21 M22
" #
2
the kinematics of the system can be described as: −2Rθ˙1 θ˙2 s2 − Rθ˙2 s2
C(Θ, Θ̇) = 2 (9)
    Rθ˙1 s2
τm fx
= JmT
 
τs fy V1 0
V= (10)
   0 V2
−s1 c1 fx
= l (2)
 
−s12 c12 fy G1
G(Θ) = (11)
     G2
fx 1 c12 −c1 τm
= (3)
fy ls2 s12 −s1 τs and
1 5
M11 = I1 + I2 + m1 l 2 + m2 l 2 + m2 l 2 c2 (12)
where si = sin θi , ci = cos θi , si j = sin(θi + θ j ), and ci j = 4 4
cos(θi + θ j ). τm is the output torque of the mono-articular 1 1
M12 = M21 = I2 + m2 l 2 + m2 l 2 c2 (13)
motor, and τs is the bi-articular spring torque. The modified 4 2
Jacobian matrix JmT has its inverse unless θ2 = π/2 + nπ, 1
M22 = I2 + m2 l 2 (14)
which cannot be reached due to that lower link is mechanically 4
constrained to the range of π/12 ≤ θ2 ≤ π/3. 1
R = m2 l 2 (15)
2
And the bi-articular spring torque τs is represented as  
1 1
follows from its construct: G1 = gl m1 s1 + m2 s12 + m2 s1 (16)
2 2
τs = −Ks ∆(θ1 + θ2 ) (4) 1
G2 = gm2 ls12 (17)
2
where, Ks represents the torsional stiffness of the bi-articular where, the viscous friction coefficients V1 and V2 are empirical
spring in [Nm/rad]. values. The parameters shown in the Table I are used for the
others.
C. Dynamics of the System
D. Jumping Motion of the Lumped Body
The dynamics of the system is written as follows. Coulomb
friction is neglected. The output force of the manipulator, described in (3),
results in the ground reaction force fGRF when the tip of the
M(Θ)Θ̈ +C(Θ, Θ̇) +V Θ̇ + G(Θ) = T (5) end-effector touches the ground. Then, the jumping motion of
Figure 5. State Feedback Control Schematic of JUMPBiE.

Then the equations are linearized around the vicinity of the


operating position, which is the given initial position of θ10 =
−pi/6 and θ20 = pi/3, and transformed into the state space
system representation. Constant terms are canceled out at the
initial position due to the fact that motor torque balances the
residual spring torque to stand still. Then, the system is written
as follows.

Figure 4. Jumping motion of the lumped body is assumed. The ground Ẋ = AX + Bτm (24)
reaction force fGRF works as the propulsion force of the lumped body M. A Y = CX + Dτm (25)
counter mass Mc is used to lighten the effective mass.

where,
the robot leg can be simply modeled as that of a lumped body  
using fGRF as the propulsion force, as shown in Fig. 4. θ1
 θ2 
The simplified model is described as follows. X =  ˙  (26)
θ1
θ˙
(M + Mc )ẍ +Vx ẋ = x
fGRF − (M − Mc )g (18)  2
y fx
M ÿ +Vy ẏ = fGRF (19) Y = (27)
fy
 re f 
where, the coefficients Vx and Vy have empirical values result- fx
r = (28)
ing from the viscous friction of the linear guides. And the fyre f
momentum is written as:
Z τ
x The system matrices are written as:
(M + Mc )ẋ0 = ( fGRF − (M − Mc )g −Vx ẋ)dt (20)
Z0 τ 0 0 1 0
 
y  0 0 0 1
M ẏ0 = ( fGRF −Vy ẏ)dt (21) A = 

(29)
0 19.3 19.3 −0.0855 0.0632 
−467 −467 0.127 −0.561
where, ẋ0 and ẏ0 are the velocities of the lumped body in x- 
0

and y- direction at the very moment of each take-off. These 0
are the entities that be controlled during jumping motion, due B =  (30)
 
8.55 
to the fact that the momentum of the lumped body relies on −12.7
the impulse transmitted from the ground. τ is the duration of
ground contact.
and from the kinematics in (3),
 
IV. S TATE F EEDBACK AND I MPULSE S HAPING 15.7 15.7 0 0
C = (31)
−9.05 −9.05 0 0
A. State Space Representation  
3.33
Equations introduced in the previous section are trans- D = (32)
1.92
formed into state space representation. By substituting all
parameters, the model is rewritten into the form below.
Using this system, a state feedback loop is designed as
2 2
θ¨1 = 0.103(θ˙2 + 2θ˙1 θ˙2 ) + 0.152θ˙1 + 17.2 shown in Fig. 5. The feedback gain matrix K is designed
+19.3(θ1 + θ2 ) − 0.0855θ̇1 + 0.0632θ̇2 + 8.55τm (22) via pole placement to assign multiple poles at -10 rad/sec,
2 2 as below.
θ¨2 = −1.34θ˙1 − 0.152(θ˙2 + 2θ˙1 θ˙2 ) − 245
−467(θ1 + θ2 ) + 0.127θ̇1 − 0.561θ̇2 − 12.7τm (23) K = [ −34.4 −37.1 −6.15 −7.24 ] (33)
Then the closed loop system can be rewritten as follows. the magnitude of the horizontal impulse. This is due to the
fact that the output forces in x- and y- direction are strongly
Acl = A − BK coupled because of the SLMB construct.
0 0 1 0
 
 0 0 0 1 Fig. 9 shows the simulated trajectory of the center of
=  (34)

313 337 52.5 62.0  gravity of JUMPBiE, when the impulse introduced above
−904 −938 −78.0 −92.5 is given. The trajectory seems rather erratic, because the
Bcl = B oscillation cycle of the equivalent stiffness of the whole robot
0
 
does not coincide with the period of the impulse given. The
0 SLIP (Spring-Loaded Inverted Pendulum) model in [19] and
=  (35)
 
8.55  [20], which packages the robotic leg as a mass-sping model,
−12.7 gives hints for solving this problem.
Ccl = C −
 DK 
130 139 20.5 24.1 The SLMB construct improves the cost performance of
= (36)
57.0 62.2 11.8 14.0 the system, however at the same time it generally imposes
Dcl = D instability to the system such as the oscillatory behavior. As

3.33
 the simulation study result implies, by using state feedback
= (37) and impulse shaping technique, the robot can be stabilized and
1.92
made to jump. Still, problems such as decoupling the forces in
different directions, and harmonizing the whole body stiffness
B. Impulse Shaping with the control input, need to be resolved.
Now, the input gain N̄ which shapes the force output of the
end-effector is designed. N̄ is designed by scaling the force
gains as follows.

N̄ = [ 2.52 5.04 ] (38)

Then from (20), (21), and the Jacobian, the force reference
r can be designed as follows.
 re f   
fx P
= (39)
Vy 0.52θ˙1 + 0.26θ˙2

fyre f

where, P is the derivative of an arbitrary impulse, which


provides the robot with necessary jumping momentum, and
Vy is empirically set.

V. S IMULATION R ESULTS
Figure 6. End-effector output force without state feedback or impulse shaping.
A simulation study was done with the given initial position The bi-articular spring makes the system oscillatory.
of θ10 = −pi/6 and θ20 = pi/3, using the physical parameters
shown in Table I. P in (39) was given as a square wave at
every two second for 100 ms, with the magnitude equivalent
to 10 Nm at Joint 1.
The resultant output force is shown in Fig. 6 without
state feedback or impulse shaping. It is oscillatory because
of the existence of the bi-articular spring. The result with state
feedback and impulse shaping is shown in Fig. 7; in can be
confirmed that the system is stabilized. The shape of the force
in each direction is similar to each other, while there exists
the difference in magnitude. It is assumed that when the robot
is off the ground, the manipulator output forces do not act on
the ground, i.e. the ground does not react. They act and react
only when the robot leg is touching the ground.
Fig. 8 shows the impulse resulting from the robot-ground
action and reaction considering these different jumping phases.
The sharp rises in impulse during the first 100 ms enable
the robot to take off, however at the same time, to a certain Figure 7. End-effector output force when using state feedback and impulse
degree the robot moves in horizontal direction according to shaping.
[2] D. W. Hong, “Biologically Inspired Locomotion Strategies: Novel
Ground Mobile Robots at RoMeLa,” Proc. the 3rd International Confer-
ence on Ubiquitous Robots and Ambient Intelligence, 2006
[3] R. Jacobs, M. F. Bobbert, and G. J. van Ingen Schenau, “Mechanical
output from from individual muscles during explosive leg extensions:
The role of bi-articular muscles,” Journal of Biomechanics, Vol.29, No.4,
pp.513-523, April 1996
[4] B. I. Prilutsky and V. M. Zatsiorsky, “Tendon action of two-joint muscles:
Transfer of mechanical energy between joints during jumping, landing,
and running,” Journal of Biomechanics, Vol.27, No.1, pp.25-34, January
1994
[5] N. Hogan, “The mechanics of multi-joint posture and movement control,”
Biological Cybernetics, Vol.52, No.5, pp.315-331, 1985
[6] T. Horita, P. V. Komi, C. Nicol, and H. Kyröläinen, “Interaction be-
tween pre-landing activities and stiffness regulation of the knee joint
musculoskeletal system in the drop jump: implications to performance,”
European Journal of Applied Physiology, Vol.88, No.1-2, pp.76-84,
November 2002
Figure 8. Impulse resulting from the end-effector output and its ground [7] M. A. Daley, J. R. Usherwood, G. Felix, and A. A. Biewener, “Running
reaction force. over rough terrain: guinea fowl maintain dynamic stability despite a large
unexpected change in substrate height,” Journal of Experimental Biology,
Vol.209, No.1, pp.171-187, January 2006
[8] T. Fujikawa, T. Oshima, M. Kumamoto, and N. Yokoi, “Output force at
the endpoint in human upper extremities and coordinating activities of
each antagonistic pairs of muscles,” Trans. Japan Society of Mechanical
Engineers, C, Vol.65, No.632, pp.1557-1564, 1999
[9] M. Kumamoto, T. Oshima, and T. Yamamoto, “Control properties
induced by the existence of antagonistic pairs of bi-articular muscles
– Mechanical engineering model analyses,” Human Movement Science,
Vol.13, No.5, pp.611-634, 1994
[10] S. Oh and Y. Hori, “Development of two-degree-of-freedom control
for robot manipulator with bi-articular muscle torque,” Proc. American
Control Conference 2009
[11] V. Salvucci, Y. Kimura, S. Oh, and Y. Hori, “BiWi: Bi-articularly
actuated and wire driven robot arm,” Proc. International Conference on
Mechatronics 2011, pp.827-833
[12] Y. Kimura, S. Oh, and Y. Hori, “Novel robot arm with bi-articular
driving system using a planetary gear system and disturbance observer,”
Proc. IEEE International Workshop on Advanced Motion Control 2010,
pp.815-820
[13] V. Salvucci, Y. Kimura, S. Oh, T. Koseki, and Y. Hori, “Compar-
ing Approaches for Actuator Redundancy Resolution in Biarticularly-
Figure 9. Simulated trajectory of the center of mass of JUMPBiE when the Actuated Robot Arms,” IEEE/ASME Transactions on Mechatronics,
impulse is given in a feed-forward fashion. 10.1109/TMECH.2012.2193670, 2013
[14] S. Oh, V. Salvucci, Y. Kimura, and Y. Hori, “Mathematical and
Experimental Verification of Efficient Force Transmission by Bi-articular
Muscle Actuator,” Proc. World Congress of the International Federation
VI. C ONCLUDING R EMARKS of Automatic Control 2011, pp.13516-13521
An under-actuated mono-pedal robot JUMPBiE is intro- [15] S. Sonokawa, Y. Kimura, S. Oh, and Y. Hori, “Center of Mass Velocity
Control during Stance Phase by Endeffector Force Control in the Leg
duced. Its mechanical construct, the SLMB, enables reduction Coordinate for Bi-articularly-actuated Leg System,” Proc. IEEJ Technical
of the number of actuators, and thus reduction in the complex- Meeting Record 2012, pp.117-122
ity of control, and at the same time retains the advantages of [16] Y. Kim, S. Sonokawa, S. Oh, and Y. Hori, “JUMPBiE: Jumping Leg
bi-articular actuation: energy efficiency, high compliance, and with Passive Bi-articular Elements, its Design and Propulsion Control us-
homogeneity in force output. And as shown in the simulation ing Equivalent Spring Model,” Proc. IEEJ Industry Applications Society
study, by using state feedback and the impulse shaping tech- Conference 2012, Vol.II, pp.155-158
nique, the robot jumps in a stable way, resolving the inherent [17] Y. Kim, S. Sonokawa, Y. Kimura, V. Salvucci, S. Oh, and Y. Hori,
“Design and Propulsion Control of a Robotic Leg with Passive Bi-
instability due to the existence of the bi-articular spring. The articular Actuators,” Proc. of the 30th Annual Conference of the Robotics
SLMB configuration is the solution for robot actuation in Society of Japan 2012
human environment, optimizing cost and guaranteeing compli- [18] Y. Nakata, A. Ide, K. Hirata, and H. Ishiguro, “Hopping of a Monopedal
ance. Still, there exist problems such as decoupling forces in Robot with a Bi-articular Muscle Driven by Electromagnetic Linear
different directions, and harmonizing the whole body stiffness Actuators,” Proc. of 2012 IEEE International Conference on Robotics
with the control input. Future work will include resolution to and Automation, pp.3153-3160
these problems along with the experimental verification. [19] W. J. Schwind and D. E. Koditschek, “Characterization of Monoped
Equilibrium Gaits,” Proc. of the 1997 IEEE International Conference on
Robotics and Automation, pp.1986-1992, April 1997
R EFERENCES [20] R. J. Full and D. E. Koditschek, “Templates and Anchors: Neurome-
chanical Hypotheses of Legged Locomotion on Land,” The Journal of
[1] C. Chang and P. Gaudiano, “Bio-mimetic Robotics Editorial,” Robotics Experimental Biology, Vol.202, pp.3322-3332, 1999
and Autonomous Systems, Vol.30, 2000

You might also like