Professional Documents
Culture Documents
highlights
article info a b s t r a c t
Article history: One of the most intriguing research challenges in legged locomotion is robot performance on compliant
Received 30 January 2017 terrains. The foot-terrain interaction is usually tackled by disregarding some of the effects of ground
Received in revised form 27 November deformation, like permanent deformation and compaction; however this approach restricts their appli-
2017
cation to stiff environments. In this work, the foot-terrain interaction is studied, and used in developing
Accepted 12 January 2018
a controller immune to terrain compliance. An impact dynamics model is developed, employing a
viscoplastic extension of viscoelastic impact models, and used to study the performance of a monopod
Keywords: robot. To include the effects of compliance, a model of the robot that incorporates the description of the
Legged robots foot-terrain interaction is presented. A novel monopod controller immune to ground energy dissipation
Hopping robots is developed, which does not require knowledge of ground parameters. The controller adapts to terrain
Contact modeling changes quickly, successfully tackles the effects of slip during touchdown, and copes with the problems,
Field robots which arise during hard impacts, as the terrain becomes stiffer. Simulation results demonstrate the
Legged robot control validity of the developed analysis.
© 2018 Elsevier B.V. All rights reserved.
1. Introduction patterns, on flat [3] or irregular terrains [4]. Other works focused
on bipeds running over stair-like terrain [5], while early studies
A central goal in the field of legged robotics is the development on the RHex platform demonstrated running on rough terrains [6].
of machines able to traverse rough terrain, inaccessible to wheeled However, this robot uses open-loop control, thus forward speed
vehicles. However, such machines are subject to more complex is not controlled tightly. In contrast, the Boston Dynamics’ BigDog
control requirements. The problem is exacerbated when running is capable of performing a variety of locomotion scenarios, such
on terrain with unknown properties. Earlier approaches required a as walking, trotting or bounding, over unknown terrains; however
known type of terrain, to be traversed with a statically stable gait, its motion is highly inefficient [7]. On the other hand, StarlETH
hence simplifying control and stability issues [1]. On the contrary, uses a foot placement strategy with an appropriate distribution of
quadruped robots like Minitaur [2] and IIT’s HyQ have recently virtual forces among the stance legs, so as to reach and maintain
shown satisfying dynamic response with specific locomotion a specific stable gait by rejecting perturbations, such as unex-
behaviors, such as bounding or trotting, by imitating animal gait pected obstacles [8]. A similar approach with footstep planning
for overcoming significantly rough terrains was used in Boston
✩ This work was completed while all authors were with the School of Mechanical
Dynamics’ LittleDog [9]; however, this robot is capable of static
Engineering, NTUA, 15780 Athens, Greece. walking only.
*
Corresponding author.
E-mail addresses: vvasilo@seas.upenn.edu (V. Vasilopoulos),
Despite the emergence of recent works where the ground prop-
isparas@mail.ntua.gr (I.S. Paraskevas), egpapado@central.ntua.gr erties are explicitly considered in the study of hopping [10,11],
(E.G. Papadopoulos). running [12], walking [13] or tumbling [14], many notable studies
https://doi.org/10.1016/j.robot.2018.01.004
0921-8890/© 2018 Elsevier B.V. All rights reserved.
14 V. Vasilopoulos et al. / Robotics and Autonomous Systems 102 (2018) 13–26
Fig. 2. Use of Raibert’s Controller and MP on a nondeformable ground: (a) Apex height. (b) Forward velocity. Although Raibert’s controller converges faster to the desired
forward speed, the MP controller is capable of regulating both the forward speed and the apex height.
Among the various monopod controllers, two characteristic velocity with a single hip actuator was proposed in [16] and [35].
controllers are presented briefly for comparison with the controller Controlling apex height is important when running on unknown
developed in this work: Raibert’s controller, since it has been used terrain, allowing the foot to maintain a specific clearance from the
extensively in the legged robotics literature, and the MP controller, ground, thus avoiding obstacles (e.g. rocks). At the end of each
as an example of a hopping control law capable of regulating both stance phase, the controller calculates a desired touchdown angle
the apex height and the forward speed. γtd to achieve the desired apex height and a constant torque τs
applied during stance, to achieve the desired forward speed. To
(a) Raibert’s Controller. A foot placement algorithm able to reg-
keep the energy consumption to a minimum, the controller re-
ulate the robot forward speed was proposed in [34]. The algorithm
quires an estimate of leg compliance and damping, while it applies
uses the assumption that there is a unique foot position for each
appropriate actuation to compensate for energy losses.
forward speed, which results in zero net forward acceleration. This
The desired γtd is found with the use of (2) by making the
foot position is called the ‘‘neutral point’’ and, for each gait j, it
j assumptions: (i) during the stance phase the leg angle γ can be
can be determined as the forward displacement ∆xf 0 of the foot
approximated by a linear equation so that:
with respect to the robot center of mass just before touchdown as
follows γ = γtd − ẋdes ∆tL−1 (10)
( )
j j−1
∆xf 0 = ẋlo ∆tsj−1 /2 (6) where ẋdes and ∆t are the desired forward speed and time elapsed
since touchdown respectively, (ii) small angle trigonometric ap-
j−1 j−1
where ẋlo and ∆ts are the liftoff forward speed and stance proximations are valid and (iii) the actuator torque τs does not
duration of gait j − 1 respectively. To accelerate or decelerate contribute to the body’s vertical motion during stance due to (ii).
the monopod for gait j, the difference between the actual speed Thus (2) takes the following form:
j−1
ẋlo and the desired forward speed ẋdes is used to determine the
mb ÿ + bẏ + ky = kL cos γtd − ẋdes ∆tL−1 − mb g
( )
j
displacement ∆xf ∆ from the neutral point: (11)
j
(
j−1
) where the following expressions were used,
∆xf ∆ = kx ẋlo − ẋdes (7)
y = l cos γ (12)
where kx is a gain. Combining (6) and (7) yields the algorithm for
j
foot placement ∆xf for gait j as follows ẏ ≈ l̇ cos γ (13)
( ) ( )
j j j j−1
∆xf = ∆xf 0 + ∆xf ∆ = ẋlo ∆tsj−1 /2 + kx ẋlo − ẋdes
j−1
(8) With the appropriate initial conditions regarding the beginning of
the stance phase and the assumption of a ballistic trajectory during
j flight, (11) can be integrated twice to yield the desired touchdown
Using ∆xf ∆ , the desired touchdown angle is found as,
angle:
( )
γtdj = sin−1 ∆xjf L−1 (9) γtd = f (state at liftoff, ẋdes , hdes ) (14)
The controller in [34] also includes the means for reaching and where hdes is the desired apex height.
maintaining a desired hopping height; however, it requires two Similarly, the necessary control torque to be applied during the
actuators, i.e. it relies on the assumption that the leg spring is stance phase can be found by linearizing and integrating (1) twice
actuated and that a specific amount of thrust can be delivered so that,
during each stance phase. For the monopod used here, the leg
spring is not actuated, but behaves instead as a passive element. τs = g (state at liftoff, ẋdes , hdes , γtd ) (15)
Therefore, a moderate constant torque is applied in each stance
Following the end of the flight phase, the next stance begins, the
phase to compensate for losses and maintain main body motion.
constant torque τs is applied, and the cycle repeats itself.
Thus the goal for this controller here will be to maintain a specified
In Fig. 2 the motion of the monopod using the controllers pre-
forward velocity only.
sented earlier on non-compliant ground is shown. The parameters
(b) MultiPart Controller. The MultiPart controller (MP) for of the robot are: body mass mb = 4 kg, length of the leg L = 0.30 m,
monopods that can control both the apex height and forward spring stiffness k = 12,000 N/m and damping coefficient b =
16 V. Vasilopoulos et al. / Robotics and Autonomous Systems 102 (2018) 13–26
Fig. 3. Impact models (a) Standard viscoelastic and (b) Proposed viscoplastic. In contrast to standard viscoelastic models, our viscoplastic model is capable of describing
permanent ground deformations.
3 Ns/m. The acceleration of gravity is 9.81 m/s2 . The simulations According to the HC model, the interaction force Fg is,
were executed in Matlab using ode23s with absolute and relative
Fg yg , ẏg = kg yng + bg ẏg yng
( )
tolerance 10−5 and 10−4 respectively and maximum step 10−4 . (16)
Regarding the PD controller presented in (5), the values of kp = 150
where kg and bg are the stiffness and damping coefficients respec-
and kd = 2.4 were selected, for the controller to be fast enough to
tively, n in the case of Hertzian non-adhesive contact is equal to 1.5,
reach γtd before the next touchdown, while avoiding overshooting
and yg is the depth of penetration (positive towards the ground).
and undesired oscillations.
The parameter kg represents the equivalent stiffness between the
Although the controllers presented earlier satisfy the desired
materials that come into contact, in this case the stiffness between
gait targets, they both rely on the assumptions of an ideal massless
the foot and the terrain [36]. Damping is considered as a parameter
foot and of an interaction with a stiff ground that can be modeled
related to the equivalent stiffness according to [37],
as a revolute joint. It turns out that this is common for most legged
robot controllers.
bg = 1.5ca kg (17)
In the subsequent sections, the assumptions of stiff ground
and massless foot are dropped, and the corresponding effects on where ca is usually between 0.01–0.5 depending on the materials
controller performance and gait characteristics are studied. To this and the impact velocity [37]. Without affecting the generality of
end, a realistic terrain model is developed. the results, in this work ca = 0.2 is used.
Model Rationale. Existing viscoelastic models implicitly assume
3. Viscoplastic impact model and friction
that the impact starts and ends (e) at yg = ye = 0, i.e. that
no permanent deformation ye occurs. However, due to permanent
Introduction. The foot-terrain interaction during running on de- terrain deformation on a nonideal deformable ground, the robot
formable terrains must be represented realistically. Here the focus clears the ground at ye > 0; this has an effect on the final spring
is on typical indoor or outdoor terrains, excluding granular media elongation and the energy lost due to the permanent deformation.
such as sandy terrains, for which interaction forces are of hydro- In addition, in viscoelastic models, the terrain behavior under
dynamic nature. The main parameters of interest include ground repetitive loading or compaction is ignored. This is important
compliance, the depth of the permanent deformation that may when rebounds occur. Hence a model that takes into account such
occur, and the change of ground characteristics due to repetitive deformations is needed.
loading at a particular point. Assuming initially a viscoelastic model, such as the HC, suppose
In a terramechanics approach, it is assumed that a wheel or that a body impacts the ground, as shown in Fig. 3a.
a foot is in touch with the ground for considerable amount of During compression, both the interaction force and depth in-
time, or even permanently. This approach cannot be applied in crease, while the relative to the ground velocity decreases. When
the case of fast dynamic walking, because the stance is practically the foot velocity is zeroed, i.e. ẏg = 0, the maximum compres-
an impact. It is reasonable to assume that during the foot-terrain sion yc ,max has been reached. Note that generally, the maximum
interaction, time dependent phenomena, such as creepage, have force appears before the maximum compression due to model
negligible effect compared to the inertia and interface stiffness or non-linearity. During restitution, the foot velocity increases, but
damping effects. However the plastic deformations, which occur in the opposite direction, while the depth and the interaction
to one or both of the interacting bodies, play an important role. force decrease. The restitution ends when both the depth and the
A method to incorporate the ground elastoplastic behavior is by interaction force are zeroed, but in fact this is due to the closed
using a viscoplastic extension of the non-linear viscoelastic models. form of the models. The key event characterizing the end of stance
According to the viscoelastic theory, a compliant surface can be is that the interaction force is zeroed, i.e. there is no more contact
modeled by a combination of lumped parameter elements, i.e. by between the impacting body and the terrain.
springs and dampers. Common impact models include the Kelvin– Experimental results as for example in [21], reveal that vis-
Voigt (KV) and the Hunt–Crossley (HC) models [25]. As the former coelastic models do not describe accurately terrain deformation.
introduces non-physical nonlinearities such as non-zero forces at Yet, the strict viscoelastic description of the process can be ex-
the beginning or the end of an impact, the latter model, which is tended in the case of plastic deformations via appropriate lumped
free of these, will be used as a reference. Additionally, it is the basis elements to result in a viscoplastic description. Here, a model that
for many interesting viscoelastic models found in the literature. treats the impact piecewise is developed, as shown in Fig. 3b.
V. Vasilopoulos et al. / Robotics and Autonomous Systems 102 (2018) 13–26 17
are of static nature, e.g. using the Bevameter technique, which may
not be adequate for dynamic impacts.
Generally, as the same contact area is compressed, it becomes
stiffer. Thus after a number of impacts at the same point, its
stiffness eventually reaches a critical limit. To model this increasing
stiffness, the following function is proposed,
where a(i) and β (i) are functions of the impact instance i and of
the materials and velocity. Note that if a (i) = 0 or β (i) = 0, (18)
reduces to the HC model. Parameter a sets the maximum value of
λir , whereas an increase in β increases the speed to reach this value,
i.e. fewer impacts at the same point are needed to reach the critical
value.
The final depth yie after the ith impact can be calculated by
observing that at the maximum compression yic ,max there is force
Fig. 4. Impact curves for the proposed impact model (18) for various λ. continuity, while the interface velocity is zero, i.e.
Fig. 5. Description of recompression for a falling 2-body system where Fg is the ground force and Fk is the spring force: (a) Initial contact, (b) Compression, (c) Restitution
and (d) Recompression.
Table 1
Summary of the algorithm for the proposed viscoplastic model simulation.
<Set initial conditions> For kg , bg and λic from Eq. (19)
<For impact instant i run> Eq. (18) for Fci untilẏ = 0.
<If ẏ = 0> Keep yic and calculate yif from Eq. (22). Set λir from Eq. (19)
<For impact instant i run> Eq. (18) for Fri
<If Fri = 0> Impact ends
<Elseif Fri ̸= 0 and ẏ = 0>Recompression occurs.
<Set λci+1 = λir and start over>
<End>
Fig. 7. Stance instances with recompressions and rebounds. Rebounds occur when the interaction force is zeroed.
V. Vasilopoulos et al. / Robotics and Autonomous Systems 102 (2018) 13–26 19
The system variables for both the flight and the stance phase are
the leg length l, the leg angle γ and the coordinates of the foot xft ,
yft . The equations of motion take the form
robot body during the stance phase of gait j can be found using (11) j
and (40) with respect to γ it can be shown that the desired td ,
with the new equivalent parameters, j
( ) touchdown angle γtd is given by (41) as
j ẋdes t
M ′ ÿj + b′ ẏj + k′ yj = k′ L cos γtd − − M ′g (34)
γtdj = θ + cos−1 rR−1
( )
L (42)
j−1 where θ , r and R are given in Appendix B. The PD controller pre-
for 0 ≤ t ≤ ∆ts (t = 0 at touchdown). Eq. (34) is a second
sented in (5) is used to position the leg at the desired touchdown
order differential equation and can be solved with the following
angle γtd during flight.
boundary conditions:
j j
(b) Constant torque τs . The constant torque τs to be applied
j j
y (0) =
j
ytd,est = L cos γ td (35) during the stance phase so as to achieve and maintain the desired
V. Vasilopoulos et al. / Robotics and Autonomous Systems 102 (2018) 13–26 21
j−1 j−1
forward speed is calculated such that a desired energy level is during which ẋft ,s ̸ = 0, where ẋft ,s is the horizontal component
secured. The robot is commanded to have height hdes and speed of foot velocity during stance. A solution to the slip problem is
ẋdes at its apex point. It is assumed that at the apex, the leg spring to command the actuator to exert maximum negative torque for
j−1
has reached its free length L, the leg has been positioned already at a time interval of ∆tslip after touchdown. It must be noted that
j
the desired touchdown angle γtd and does not rotate (γ̇ = 0), and negative torque corresponds to positive work from the actuator,
the robot body has reached the apex height hdes . Thus, the desired since in this case the leg moves in the negative direction during
energy level (kinetic and potential) that the system must maintain stance, which is desired. Using this method, ẋft ,s is zeroed as fast as
at gait j is possible and the system reaches quickly the desired static friction
zone where the foot does not slip in the horizontal direction.
j 1 (
j
)
Edes = (M + ml ) ẋ2des + Mghdes + ml g hdes − 0.5L cos γtd (43) (d) False liftoff rejection. Another issue in controller design is
2
j−1 related to the rebounds occurring during stance on a very stiff
while the liftoff energy of the previous gait Elo is terrain. In such a case, and following a flight phase, the stance
[
M ( )2 ( )2 ] [
ml ( )2 ( )2 ] may be comprised of several rebounds; then the system loses
j−1 j−1 j−1 j−1 j−1
Elo = ẋlo + ẏlo + ẋl,lo + ẏl,lo contact with the ground momentarily, until the inertia of the main
2 2
body and the leg spring force the foot to impact again. This may
Il k( )2
happen several times until a proper stance takes place, and if the
+ γ̇loj−1 + Mgyjlo−1 + ml gyjl,−lo1 + L − llo
j−1
(44)
2 2 periods between these rebounds are detected as flight phases by
Since the mass of the robot leg ml for the DM is considered signifi- the controller, unstable gaits can result. To tackle this issue, during
j j−1 the contact of the foot with the ground, the x-MP-II compares the
cantly smaller than M, Edes and Elo can be approximated as follows j−1
contact duration with the estimated stance duration ∆ts equal
j 1 to half of the system natural period
Edes ≈ M ẋ2des + Mghdes (45)
2 √
Tn = 2π (M /k) (51)
[ )2 ]
j−1 M ( j−1
)2 ( Il Obviously, considering the ground effect as well as the viscous
Elo ≈ ẋlo + ẏjlo−1 + γ̇loj−1 j−1 j−1
2 2 losses, ∆ts cannot be less than 0.5Tn . In this way, if ∆ts ≤
k( )2 0.5Tn , the controller does not apply new γtd or τs , but it rather waits
+ Mgyjlo−1 + j−1
L − llo (46) for the stance phase to be over properly before it applies these.
2
Note that in (51) the stiffness k was chosen instead of k′ as this
The actuator during the stance phase of gait j must compensate
criterion is computed before the calculation of k′ in order to deter-
for the losses and maintain the motion, thus the required energy
j mine whether the controller should proceed to its calculations.
Em,s that it must provide is
( ) Discussion. The development of the x-MP-II relies on energy
j j−1 j−1 j−1
j
Em ,s = Edes − Elo + Egdis + Edamp − Emj−,f1 (47) calculations that do not require knowledge of terrain parameters or
of a more complex sensor system. For this reason, it is expected that
j−1
where Em,f is the energy the actuator provided during the flight this controller would demonstrate robustness in measurement
j−1 noise and uncertainties. Also, its application can be easily extended
phase of the gait j − 1, Egdis is the energy dissipated by the ground
j−1 to irregular terrains, by accompanying it with an inclination es-
as shown in (32) and Edamp
are the energy losses due to viscous timation algorithm, as shown in [30]. Finally, the development
frictions for the whole gait j − 1 so that of x-MP-II allows its implementation on multi-legged machines;
∫ j−1
tlo with proper leg coordination, we have already demonstrated that
j−1
Em,f = τ j−1 γ̇ j−1 dt (48) it can successfully generate a pronking gait on a quadrupedal
j−2
tlo robot [31]. Since the x-MP-II uses data from the previous gait,
some approximate initial values are assumed before the first gait
and
is accomplished. The full x-MP-II algorithm is given in Table 2.
j−1 j−1
∫ tlo ( j−1 )2
∫ tlo ( j−1 )2
j−1
Edamp = bl l̇ dt + bh γ̇ dt (49) 5. Simulations results
j−2 j−2
tlo tlo
Table 2 Table 4
Algorithm of the x-MP-II controller. Robot parameters used in simulations.
<If ∆tsj−1 ≤ 0.5Tn > A short-duration flight has occurred Body mass M 4 kg
Leg mass ml 0.5 kg
<Use the former values of γtd and τs and exit> Leg inertia Il 0.00325 kgm2
<ElseIf ∆tsj−1 > 0.5Tn > Proceed to the main controller Leg length L 0.3 m
Spring stiffness k 12,000 N/m
<Calculate ∆ljmax
−1
> Eq. (29) Leg damping bl 3 Ns/m
j−1 j−1
<Calculate Egdis and Edamp,s > Eqs. (32) and (33) Hip damping bh 0.2 Nms
′ ′ Max torque τmax 4 Nm
<Calculate k , b > Eqs. (27) and (31)
′ ′
<Use k , b to calculate γtdj > Eq. (42)
j j−1
<Calculate Edes and Elo > Eqs. (45) and (46)
<Calculate Emj ,f and Edamp
j−1
> Eqs. (48) and (49) angle is large. In this way, the assumption that the foot behaves as
<Determine τsj > Eqs. (47) and (50) a completely stiff revolute joint during each stance phase, on which
j−1
<Determine the time interval ∆tslip > both Raibert’s controller and the MP rely, ceases to apply. This issue
<End> is addressed by the x-MP-II, and is successfully tackled resulting
in stable motion of the hopping robot. Also, as shown in Fig. 11,
our controller achieves the desired result, although the small-angle
approximation ceases to apply, despite the fact that recent studies
like [41] show the important effect this assumption could have on
force between the foot and the terrain was below 5 N, while the the control strategy.
foot transition from slip to stick occurred when the foot horizontal Fig. 12 displays the response of the x-MP-II for various terrains
velocity was below 10−4 m/s. By increasing tolerances, these val- where except for different compliances, shape deformation occurs
ues can be lower, however this set was selected as it produces both and is described by (20), with α (i) = max λ − 1 (max λ is included
fast and reasonable results. in Fig. 12 for each case) and β (i) = 1; larger max λ represents
In Fig. 10, the responses of Raibert’s, of the MP, and of the x-MP- a terrain with deeper permanent deformation, e.g. wet clay. The
II controllers for the defined ground types are compared. The initial initial conditions are height h0 = 0.33 m, forward velocity ẋ0 =
conditions are: height h0 = 0.32 m, forward velocity ẋ0 = 1.0 m/s. 1.0 m/s, with the desired values for apex height and forward
The apex height is commanded to change from hdes = 0.32 m to velocity shown in Fig. 12. Considering the performance of the x-
0.34 m at increments of 1 cm, the forward velocity to be ẋdes = MP-II with respect to terrain alterations, it can be observed from
0.8 m/s, while the ground is becoming more compliant, in order Fig. 12 that the robot follows the set points for desired main body
to make the task more challenging. The figure is divided into three apex height and forward velocity. In addition, it adapts easily to
regions according to stiffness. When the ground is stiff, Raibert’s sudden terrain changes, without being sensitive to permanent
and the MP try to achieve the objectives; however they fail to terrain deformations.
reach the desired velocities. The x-MP-II quickly converges to the Deviations during abrupt changes of forward velocity require a
desired values. In the moderate ground, Raibert’s controller fails few transient gaits until the controller reaches the required energy
to maintain stability. The MP controller on the other hand fails level and the gaits become stable. The number of these transient
to achieve the desired goals in the moderate and soft ground; as gaits increases as the desired values become more demanding
these become more demanding and the terrain compliance more or as the terrain compliance increases significantly. This occurs
significant, the deviation of the apex height and of the velocity from because the actuator is considered to be torque limited; when
the desired goals increases. On the contrary, the x-MP-II follows the the constant torque saturation level τmax is reached, it can only
desired commands. provide a fixed maximum amount of energy per gait until the
As expected, Raibert’s and MP controllers perform better in stiff actual energy level becomes equal to the system’s desired energy
terrain than in compliant terrains, i.e. kg → (≥106 N/m). As com- level. This is shown in Fig. 13, where the torque applied by the
pliance increases, they both deviate from the desired commands. motor is displayed. During the first transient gaits of each terrain
This is due to the fact that the mechanics of the impact between type, the torque applied is generally higher and it may reach its
the foot and the ground are disregarded; both controllers assume saturation level. Apart from that, it can be seen that the torque
no energy losses occur in stance due to ground compliance. On the increases as the ground becomes more compliant. In the inset of
other hand, the x-MP-II adapts quickly to each terrain after some Fig. 13, a profile of the torque applied for an entire gait is shown.
transitional steps that depend on ground compliance and actuator This profile consists of the PD controller part for the leg placement
saturation level, and maintains its performance independently of at the desired touchdown angle, the maximum torque applied for
the ground. specific time interval after touchdown for slip compensation, and
Although the MP controller fails to achieve its objectives, it is the main torque applied during stance.
useful to examine the friction profile for an entire gait during the
motion of the DM. The profile is shown in Fig. 11, along with the 6. Conclusion
response of the leg angle (a typical normal force profile is shown
in Fig. 7). As can be seen in that figure, the leg slips for a short time This paper studied legged locomotion in the presence of foot-
just after its touchdown and just before its liftoff, where the leg terrain interactions. The adverse effects of terrain deformation
Table 3
Terrain parameters used in simulations.
Terrain type Stiffness kg (N/m) Static friction coefficient µs Coulomb friction coefficient µc
Soft 80,000 0.5 0.4
Moderate 200,000 0.6 0.5
Stiff 400,000 0.7 0.6
V. Vasilopoulos et al. / Robotics and Autonomous Systems 102 (2018) 13–26 23
Fig. 10. Raibert’s Controller, MP & x-MP-II comparison for (a) apex height (b) forward velocity. Raibert’s controller fails upon transition to terrain with moderate stiffness
and the MP controller fails to achieve the objectives. The x-MP-II, on the other hand, always converges to the desired apex height and forward speed.
Fig. 11. (a) Friction profile and (b) Leg angle during a gait using the MP. Notice the rapid slip-to-stick transition described by our friction model and the almost monotonic
evolution of the leg angle during a stance phase.
24 V. Vasilopoulos et al. / Robotics and Autonomous Systems 102 (2018) 13–26
Fig. 12. Monopod runs on various terrains using the x-MP-II controller on DM: (a) Apex height and (b) Forward velocity. Our controller always achieves the control objectives
on terrains of various characteristics.
Fig. 13. Motor torque during monopod motion. Inset: the applied torque during a gait. Our controller is always successful and, at the same time, never violates the pre-
determined torque bounds.
−Mb sγ Mb cγ
⎡ ⎤
Ma 0 (
j−1
) (
j−1
)
Aẋdes ẋdes ∆ts Bẋdes ẋdes ∆ts
⎢0 Ma l2 + Il −Mb lcγ −Mb lsγ ⎥ δ4 = cos − sin (B.15)
H (q) = ⎢
⎣−Mb sγ −Mb lcγ M + ml 0
⎥
⎦ (A.1) L L L L
Mb cγ −Mb lsγ 0 M + ml √ (
j−1
) gL
ε1 = 2g hdes − L − yft ,lo + √ (B.16)
bl l̇ − k (L − l) + Mb gcγ − Ma lγ̇ 2
⎡ ⎤ ( )
j−1
2g hdes − L − yft ,lo
bh γ̇ − Mb glsγ + 2Ma ll̇γ̇
V (q, q̇) = ⎢
⎢ ⎥
⎥ (A.2)
⎣ Mb lγ̇ 2 sγ − 2Mb l̇γ̇ cγ ⎦
(M + ml )g − Mb lγ̇ 2 cγ − 2Mb l̇γ̇ sγ gL
ε2 = − √ ( ) (B.17)
j−1
2g hdes − L − yft ,lo
T = [0 τ Ft Fg ]T (A.3)
where Ma = M + ml /4 and Mb = M + ml /2 are auxiliary variables.
ε3 = ε2 cos ẋdes L−1 ∆tsj−1
( )
(B.18)
Appendix B
ε4 = ε2 sin ẋdes L−1 ∆tsj−1
( )
(B.19)
The constants a1 , a2 , A, B, c1 , c2 used for the main body vertical
height prediction in Section 4 are: √
( ) gL
a1 = −b 2M ′
( ′ −1
)
(B.1) ε5 = − 2g yjapex,est − L − √ ( ) (B.20)
j
2g yapex,est − L
√ )−1
4M ′ k′ − b′ 2 2M ′
(
a2 = (B.2)
[ ( )]−1/2
ε6 = gL 2g yjapex,est − L (B.21)
k L k − M (xdes ) L 2 −2
′
[ ′ ′
]
A= ( )2 ( )2 (B.3)
k′ − M ′ ẋ2des L−2 + b′ ẋdes L−1
References
k′ b′ ẋdes
B = −( )2 ( )2 (B.4) [1] R.B. McGhee, G.I. Iswandhi, Adaptive locomotion of a multilegged robot over
k′ − M ′ ẋ2des L−2 + b′ ẋdes L−1 rough terrain, IEEE Trans. Syst. Man Cybern. 9 (1979) 176–182.
[2] G. Kenneally, A. De, D.E. Koditschek, Design principles for a family of direct-
drive legged robots, IEEE Robot. Automat. Lett. (2016).
j j M ′g
c1 = (L − A) cos γtd − B sin γtd + (B.5) [3] I. Havoutis, et al., Quadrupedal trotting with active compliance, Mechatronics
k′ (ICM), in: 2013 IEEE International Conference on, pp. 610–616, February 2013.
( ) [4] S. Bazeille, et al., Quadruped robot trotting over irregular terrain assisted by
A · ẋdes B · ẋdes stereo-vision, Intell. Serv. Robot. 7 (2) (2014) 67–77.
j j j
c2 = ẏtd,est − sin γtd + cos γtd − c1 a1 a−
2
1
(B.6) [5] J. Hodgins, Legged robots on rough terrain: Experiments in adjusting step
L L length, in: IEEE Int. Conf. on Robotics and Automation, Philadelphia, PA, 1988,
The constants θ , r and R used for the calculation of the desired pp. 824–826.
j [6] U. Saranli, M. Buehler, D.E. Koditschek, RHex: A simple and highly mobile
touchdown angle γtd in Section 4 are: hexapod robot, Int. J. Robot. Res. 20 (2001) 616–631.
[7] M. Buehler, R. Playter, M. Raibert, Robots step outside, in: Int. Symp. Adaptive
θ = tan−1 (ρ2 /ρ1 ) (B.7) Motion of Animals and Machines, Ilmenau, 2005.
[8] C. Gehring, et al., Control of dynamic gaits for a quadrupedal robot, in: IEEE
International Conference on Robotics and Automation, ICRA ’13, May 2013,
√
R = ρ12 + ρ22 (B.8) Karlsruhe, Germany, pp. 3287–3292.
[9] K. Kalakrishnan, et al., Fast robust quadruped locomotion over challenging
terrain, in: IEEE Int. Conf. on Robotics and Automation, ICRA ’10, May 2010,
δ2 M ′g M ′g
( )
r = ε1 + a1 − ε5 − δ 1 (B.9) Anchorage, Alaska, USA, pp. 2665–2670.
a2 k′ k′ [10] J. Nakanishi, A. Radulescu, S. Vijayakumar, Spatio-temporal optimization of
multi-phase movements: Dealing with contacts and switching dynamics, in:
where IEEE/RSJ Int. Conf. on Intelligent Robots and Systems, Tokyo, Japan, 2013, pp.
δ2 5100–5107.
[ ]
Bẋdes
ρ1 = δ1 (L − A) + − a1 (L − A) + ε6 + δ3 − ε3 (B.10) [11] M. Rutschmann, B. Satzinger, M. Byl, K. Byl, Nonlinear model predictive control
a2 L for rough-terrain robot hopping, in: IEEE/RSJ Int. Conf. on Intelligent Robots
and Systems, 2012, pp. 1859–1864.
δ2 [12] W. Bosworth, J. Whitney, S. Kim, N. Hogan, Robot locomotion on hard and soft
[ ]
Aẋdes
ρ2 = −Bδ1 + − + a1 B + δ 4 − ε 4 (B.11) ground: Measuring stability and ground properties in situ, in: IEEE Int. Conf. on
a2 L Robotics and Automation, ICRA ’16, May 2016, Stockholm, Sweden, pp. 3582–
3589.
and the auxiliary constants δ1 , δ2 , δ3 , δ4 and ε1 , ε2 , ε3 , ε4 , ε5 , ε6 are [13] C. M. Hubicki, J.J. Aguilar, D.I. Goldman, A.D. Ames, Tractable terrain-aware
given by the following equations motion planning on granular media: An Impulsive jumping study, in: IEEE/RSJ
j−1 j−1 Int. Conf. on Intelligent Robots and Systems, Daejeon, Korea, 2016, pp. 3887–
δ1 = a1 ea1 ∆ts cos a2 ∆tsj−1 − a2 ea1 ∆ts sin a2 ∆tsj−1
( ) ( )
(B.12) 3892.
26 V. Vasilopoulos et al. / Robotics and Autonomous Systems 102 (2018) 13–26
[14] J.V. Albro, J.E. Bobrow, Motion generation for a tumbling robot using a general [38] N. Doh, W.K. Chung, Y. Youm, On hard contact force control, in: IEEE/RSJ
contact model, in: IEEE International Conference on Robotics and Automation, International Conference on Intelligent Robots and Systems, IROS, Takamatsu,
ICRA ‘04, April 2004, New Orleans, pp. 3270-3275. Japan, 2000, pp. 1528–1533.
[15] M.D. Berkemeier, R.S. Fearing, Sliding and hopping gaits for the underactuated [39] E.G. Papadopoulos, G.C. Chasparis, Analysis and model-based control of ser-
acrobot, IEEE Trans. Robot. Autom. 14 (4) (1998) 629–634. vomechanisms with friction, J. Dynam. Syst. Meas. Control 126 (4) (2004) 911–
[16] N. Cherouvim, E. Papadopoulos, Control of hopping speed and height over 915.
unknown rough terrain using a single actuator, in: IEEE Int. Conf. on Robotics [40] http://www.stanford.edu/~tyzhu/Documents/Some%20Useful%20Numbers.p
and Automation, ICRA ’09, May 2009, Kobe, Japan, pp. 2743–2748. df..
[17] H. Park, et al., Quadruped bounding control with variable duty cycle via vertical [41] U. Saranli, et al., Approximate analytic solutions to non-symmetric stance
impulse scaling, in: IEEE/RSJ Int. Conf. on Int. Robots and Systems, Chicago, trajectories of the passive spring-loaded inverted pendulum with damping,
Illinois, USA, 2014, pp. 3245–3252. Nonlinear Dynam. 62 (4) (2010) 729–742.
[18] S. Faraji, et al., Compliant and adaptive control of a planar monopod hopper
in rough terrain, :in IEEE Int. Conf. on Robotics and Automation, ICRA ’13,
Karlsruhe, Germany, May 2013, pp. 4818–4825.
[19] V. Vasilopoulos, I.S. Paraskevas, E. Papadopoulos, Compliant terrain legged Vasileios Vasilopoulos received his Diploma in Mechani-
locomotion using a viscoplastic approach, in: IEEE/RSJ Int. Conf. on Intelligent cal Engineering in 2014 from the National Technical Uni-
Robots and Systems, Chicago, Illinois, USA, 2014, pp. 4849–4854. versity of Athens (NTUA). Currently, he is a Ph.D. student
[20] L. Ding, et al., Foot-terrain interaction mechanics for legged robots: modeling in the Department of Mechanical Engineering and Applied
and experimental validation, Int. J. Robot. Res. (2013) 585–1606. Mechanics at the University of Pennsylvania, and is affili-
[21] J.Y. Wong, Terramechanics and Off-road Vehicle Engineering, second ed., ated with the GRASP Lab.
Elsevier Ltd, 2010. His research interests are in the areas of legged
[22] A. Wu, H. Geyer, Highly robust running of articulated bipeds in unobserved robotics, motion planning, and symbolic control of dynam-
terrain, in: IEEE/RSJ Int. Conf. on Intelligent Robots and Systems, Chicago, ical systems.
Illinois, USA, 2014, pp. 2558–2565. He is a Student Member of IEEE, ASME and AMS.
[23] C. Li, T. Zhang, D.I. Goldman, A terradynamics of legged locomotion on granular
media, Science 339 (6126) (2013) 1408–1412.
[24] G. Gilardi, I. Sharf, Literature survey of contact dynamics modelling, Mech. Iosif S. Paraskevas received his Diploma in Mechanical
Mach. Theory 37 (10) (2002) 1213–1239. Engineering, MS in Automation, and Ph.D. in Mechanical
[25] W.J. Stronge, Impact Mechanics, Cambridge Univ. Press, 2000. Engineering, in 2005, 2007 and 2015 respectively from the
[26] A.S. Yigit, A.P. Christoforou, M.A. Majeed, A nonlinear visco-elastoplastic im- National Technical University of Athens (NTUA).
pact model and the coefficient of restitution, Nonlinear Dynam. 66 (4) (2011) Currently he is an External Associate of the Control
509–521. Systems Lab of the Mechanical Engineering School and
[27] I. Kontolatis, et al., Quadruped optimum gaits analysis for planetary explo- the Microprocessors Laboratory and Digital Systems Lab of
ration, in: 12th Symposium on Advanced Space Technologies in Robotics and the School of Electrical and Computer Engineering, both of
Automation, ASTRA ‘13, ESA, Noordwijk, 2013. NTUA. He also works as a freelancer Technical Consultant.
[28] M. Azad, R. Featherstone, A new nonlinear model of contact normal force, IEEE His research interests are in the areas of space robotics and
Trans. Robot. 30 (3) (2014) 736–739. space technology, robotics, control, modeling of dynami-
[29] D. Jacobs, Efficient, stable locomotion in legged robots, (Ph.D. thesis), Dep. of cal systems, and of contact/impact dynamics.
Mech. Engineering, Stanford University, 2012. He is a member of the Technical Chamber of Greece (TEE), and a Member of
[30] V. Vasilopoulos, I.S. Paraskevas, E.G. Papadopoulos, Control and energy con- IEEE, ASME, AIAA, and HEL.A.S. (the Hellenic Astronomical Society).
siderations for a hopping monopod on rough compliant terrains, in: IEEE
International Conference on Robotics and Automation, ICRA ’15, Seattle, WA,
USA, May 2015, pp. 4570–4575. Evangelos Papadopoulos received his Diploma from the
[31] V. Vasilopoulos, K. Machairas, E.G. Papadopoulos, Quadruped pronking on National Technical University of Athens (NTUA) in 1981,
compliant terrains using a reaction wheel, in: IEEE International Conference on and his M.S. and Ph.D. degrees from MIT in 1983 and
Robotics and Automation, ICRA ’16, Stockholm, Sweden, May 2016, pp. 3590– 1991 respectively, all in Mechanical Engineering. He was
3595. an analyst with the Hellenic Navy, Athens, Greece, from
[32] V. Vasilopoulos, I.S. Paraskevas, E.G. Papadopoulos, Monopod Hopping on 1985 to 1987. In 1991 he joined McGill U. and the Centre
Rough Planetary Environments, in: 13th Symposium on Advanced Space Tech- for Intelligent Machines (CIM) as an Assistant Professor.
nologies in Robotics and Automation, ASTRA ’15, ESA, ESTEC, Noordwijk, The Currently, he is a Professor with the Department of Me-
Netherlands, May 2015. chanical Engineering at the NTUA.
[33] A.M. Johnson, S.A. Burden, D.E. Koditschek, A hybrid systems model for simple He teaches courses in the areas of Systems, Controls,
manipulation and self-manipulation systems, Int. J. Robot. Res. 35 (11) (2016). Mechatronics and Robotics. His research interests are in
[34] M.H. Raibert, Legged Robots that Balance, MIT Press, Cambridge, MA, 1986 the area of robotics, modeling and control of dynamic systems, mechatronics and
(19). design. He has published more than 200 technical articles in journals and refereed
[35] A. Nikolakakis, et al., Implementation of a quadruped robot pronking/ bound- conference proceedings. He serves as an Associate Editor for the ASME J. of Dynamic
ing gait using a multipart controller, in: Dynamic Systems and Control Confer- Systems, Measurement and Control, the Machine and Mechanism Theory, the IEEE
ence, Cambridge, MA, USA, 2010. Robotics & Automation Letters, and the Frontiers in Space Robotics, while he served
[36] K.L. Johnson, Contact Mechanics, Cambridge Univ. Press, 1977. as an Associate Editor of the IEEE Transactions on Robotics. He is a Fellow of ASME,
[37] D.W. Marhefka, D.E. Orin, A compliant contact model with nonlinear damping an Associate Fellow of AIAA, and a Senior Member of IEEE.
for simulation of robotic systems, IEEE Trans. Syst. Man Cybernet. A: Syst.
Humans 29 (6) (1999) 566–572.