Beruflich Dokumente
Kultur Dokumente
A. Contact Model
Fig. 3: L OLA’s foot with the 4 contact pads and the proposed
In contrast to most other force control approaches on
contact springs in top and side view
bipeds, we use an explicit contact model. This allows to
easily consider the specific foot geometry & kinematics, the
contact stiffness, as well as the actual state of the contact.
Note that superposition of the rotational parts is valid as the
Furthermore, the model includes the coupling between the
angle definition is based on independent roll (αx ) and pitch
normal force and the torques as the rotation of the foot along
(αy ) angles in the inertial frame. This matches the definition
one axis does not only influence the respective torque, but
of the task-space in Sec. III. Fig. 3 illustrates the relation
can also affect the other force components. For example, if
between the vertical deformation of one element, the rotation
the reference point for rotations is not in the center of a
with pitch-angle αy and the translation of the TCP I zTCP in
symmetric foot, a rotation will automatically also introduce
the inertial frame I. Based on geometrical considerations,
normal forces on the system. As we assume sufficient
the vertical force fz can be written as a relation of all three
friction between ground and foot, the model is formulated
degrees of freedoms, which yields:
specifically for the force-controlled directions, see Sec. III.
The contact with the environment is described by a linear fz = cA,z · (F x sin αy − F y sin αx − (I zTCP − I z0 )). (2)
elastic stiffness acting on each infinitesimal element dA of
For the normal force caused by translation of the TCP, the
the contact area. This corresponds to an infinite number of
difference to an unstressed position I z0 is used. Based on
decoupled linear springs perpendicular to the ground, which
the information about fz on each contact area element dA =
act on the robot’s foot, Fig. 3. The contact area of the robot’s
d F x d F y, the overall torques and force are calculated with
foot is assumed to be flat, and we choose our “tool center
a surface integral. This yields three equations for the torques
point” (TCP) to reside somewhere on the contact area plane.
I Tx , I Ty as well as the normal force I Fz in the inertial
Within that plane, the position of each contact element is
frame:
described via r = [F x , F y]T with F x, F y defined in the Z
foot-attached frame F . The stiffness cA,z [N/m3 ] of these I Tx = fz · F y cos αx dA (3)
elements can for instance be derived from the elasticity SZ
of the contact material E and the effective thickness d (4)
I Ty = − fz · F x cos αy dA
of the ground with cA,z = Ed . Alternatively, it may be Z S
determined experimentally by measuring the vertical stiffness
c I Fz = fz dA. (5)
of a ground contact cm,z with a contact area A: cA,z = m,z A . S
For several reasons we do not consider damping effects in The cosine parts result from the calculation of the correct
our model: (1) The actual damping is hard to estimate. (2) A lever arm for every fz . Inserting (2) into (3) and simplifying
wrong estimation for the damping may be even worse than yields:
not considering damping at all. (3) As the force control acts Z Z
on velocity-level, disturbances caused by damping effects are T = c cos α sin α x y dA − sin α 2
I x A,z x y F F x F y dA
reduced effectively (An error in the force results in a changed
| S {z | S {z }
velocity of the foot).
}
Ixy Ixx
Consequently, the vertical force on each infinitesimal Z
element fz only depends on the vertical displacement ∆z of − (I zTCP − I z0 ) F y dA . (6)
the corresponding contact area dA. The overall deformation | S {z }
of this contact element can be derived as a superposition of rc,y ·A
the rotational components in vertical direction ∆zαx , ∆zαy The first two surface integrals can be interpreted as the
and the vertical translation ∆zTCP of the foot: second moments of area Ixy , Ixx of the contact area A. The
third integral contains the F y-position rc,y of the center of
fz = cA,z · (∆zαx + ∆zαy + ∆zTCP ). (1) the contact area with respect to the TCP. Using the same
relations for the remaining terms I Ty and I Fz leads to the workspace components w, a binary selection matrix S c,f
following linear equation for the contact model of one foot is used to retrieve the force-controlled directions of a foot f
in the workspace
I Tx sin αx
λf = I Ty = U · sin αy = U · xf . (7)
sin γx
I Fz I zTCP − I z0 wf = S c,f w = sin γy . (12)
The complete information on the geometry of the foot, z
T TCP − z
T CoM
material stiffness, the effective contact area (closed contacts) The corresponding forces/torques λf for the foot can be
and the coupling between torques and forces is contained in retrieved from the force/torque sensor readings λf,m with
the symmetric matrix U . It can be interpreted as the gradient
of the torques/forces on the foot λf with respect to inertial λf = AT F λf,m . (13)
movement xf of the foot and generally depends on the cosine A projection matrix AT F is needed to transform the
of the angles. Within this work, we assume small angles of forces/torques to the TCP and the torso FoR T . Furthermore,
the feet, which yields the matrix maps the full 6-axis force/torque information in
λf,m to the force-controlled directions in λf . To track the
−Ixx Ixy −rc,y A
U ≈ cA,z · Ixy −Iyy rc,x A . (8) desired forces λf,d on each foot, a first-order linear error
−rc,y A rc,x A −A dynamics
This gradient can either be considered constant or even δ ė + e = 0, e = λf,d − λf (14)
be time-variable, e.g. based on contact sensor information.
In this paper, we consider U constant by using the foot with time-constant δ is used. By solving (14) for λ̇f ,
geometry, i.e. assuming that all parts of the foot have contact differentiating as well as inverting the contact-model (7) for
with the ground, if the force control is activated. Note that constant U and substituting ẋf = ẇf , the force control law
the contact model is only used if the respective foot is on is given:
the ground. To retrieve the necessary motions of the foot 1
ẇf = U −1 (λ̇f,d + (λf,d − λf )). (15)
for a given desired λf , U must be invertible, which is not δ
generally the case. For a time-variable U , special measures By mapping the components of ẇf to the components of ẋf
are necessary to avoid a singular gradient. in the contact model, we assume small inclination angles of
In contrast to the definition used here, the original contact the upper-body as well as T żCoM ≈ 0. If the walking state of
model for the force control of L OLA described the gradient the robot changes from double-support to single-support, the
of forces/torques with respect to motions in the configuration force controller of the swing leg is blended out. Simultane-
space, [23]: ously, a parallel position-control loop is activated to pull the
∂λ foot back to the ideally planned trajectory during its swing-
λ̇ = q̇. (9) phase. This results in the following extended control law
∂q
The gradient is calculated from Jacobians of the contact 1
ẇf,ext = bf · U −1 (λ̇f,d + (λf,d − λf ))
points and inverse kinematics is required within the hy- δ
brid position/force controller in order to retrieve task-space + (1 − bf ) · (S c,f Kx (wid − w)) (16)
modifications. However, changing contact areas and their
with the blending factor bf ∈ [0, 1] and the position-control
effects in task-space are hard to formalize for a gradient
gain Kx . The blend factor is changed continuously based on
in the configuration space q. The newly defined model in
the planned contacts of the feet. The trajectory modification
task-space can be derived from easy to calculate geometric
for both feet is then given by
properties of the contact and has an analytical description.
We consider this contact model as a starting point for future
X
∆ẇ = S Tc,f ẇf,ext . (17)
research on how to integrate dynamically changing contact f ={l,r}
areas in the force controller.
C. Integration of CoM Dynamics
B. Hybrid Position/Force Control With the explicit contact model and the hybrid posi-
The force controller is based on a hybrid position/force tion/force control scheme, the ground reaction forces can
control scheme with inner position-control loop in task- already be controlled effectively. However, ground reaction
space. To close the force-control loop, the ideal trajectories forces can also be induced by accelerating the center of mass
from the planner module wid , ẇid are modified: of the humanoid, which is not considered in the contact
model itself. This is of special interest for the single-support
ẇmod = ẇid + ∆ẇ (10)
Z phase, where the realizable stabilization torques are limited
wmod = wid + ∆ẇ dt. (11) by the smaller contact surface. We approximate the dynamics
of the humanoid in the single-support phase by a single
The controller output ∆ẇ is defined on velocity-level to mass m located at the CoM and the moments of inertia
ensure smooth trajectories. Starting from the full set of T θxx , T θyy , Fig. 4. We only consider directions which
Tz
∆ϕ̈y
m, θxx , θyy Tx
∆z̈c
Iz
Ix r com,f
e
(a) Simulation Scenario (b) Experimental Scenario
Fig. 4: Reduced model for the CoM dynamics of the hu-
manoid used for integration in the force controller Fig. 5: Test scenarios with a board (9 cm height) and a
platform (5.5 cm height) as disturbances
Inclination ϕy [°]
8
Inclination ϕy [°]
5
6 4
∆z̈ c [m/s2 ]
4 0
2
2 −5
0
0
−2 −2
−4 −4
5 6 7 8 9 10 11 12 4 6 8 10 12 14
t [s] t [s]
Fig. 7: Experimental results without (ref) and with (dyn)
Fig. 6: Simulation results without (ref) and with (dyn) integrated CoM dynamics for unexpectedly stepping down a
integrated CoM dynamics for stepping on an unexpected platform of 5.5 cm height
obstacle of 9 cm height