68,642 research outputs found
Balancing experiments on a torque-controlled humanoid with hierarchical inverse dynamics
Recently several hierarchical inverse dynamics controllers based on cascades
of quadratic programs have been proposed for application on torque controlled
robots. They have important theoretical benefits but have never been
implemented on a torque controlled robot where model inaccuracies and real-time
computation requirements can be problematic. In this contribution we present an
experimental evaluation of these algorithms in the context of balance control
for a humanoid robot. The presented experiments demonstrate the applicability
of the approach under real robot conditions (i.e. model uncertainty, estimation
errors, etc). We propose a simplification of the optimization problem that
allows us to decrease computation time enough to implement it in a fast torque
control loop. We implement a momentum-based balance controller which shows
robust performance in face of unknown disturbances, even when the robot is
standing on only one foot. In a second experiment, a tracking task is evaluated
to demonstrate the performance of the controller with more complicated
hierarchies. Our results show that hierarchical inverse dynamics controllers
can be used for feedback control of humanoid robots and that momentum-based
balance control can be efficiently implemented on a real robot.Comment: appears in IEEE/RSJ International Conference on Intelligent Robots
and Systems (IROS), 201
Automatic Differentiation of Rigid Body Dynamics for Optimal Control and Estimation
Many algorithms for control, optimization and estimation in robotics depend
on derivatives of the underlying system dynamics, e.g. to compute
linearizations, sensitivities or gradient directions. However, we show that
when dealing with Rigid Body Dynamics, these derivatives are difficult to
derive analytically and to implement efficiently. To overcome this issue, we
extend the modelling tool `RobCoGen' to be compatible with Automatic
Differentiation. Additionally, we propose how to automatically obtain the
derivatives and generate highly efficient source code. We highlight the
flexibility and performance of the approach in two application examples. First,
we show a Trajectory Optimization example for the quadrupedal robot HyQ, which
employs auto-differentiation on the dynamics including a contact model. Second,
we present a hardware experiment in which a 6 DoF robotic arm avoids a randomly
moving obstacle in a go-to task by fast, dynamic replanning
Momentum Control with Hierarchical Inverse Dynamics on a Torque-Controlled Humanoid
Hierarchical inverse dynamics based on cascades of quadratic programs have
been proposed for the control of legged robots. They have important benefits
but to the best of our knowledge have never been implemented on a torque
controlled humanoid where model inaccuracies, sensor noise and real-time
computation requirements can be problematic. Using a reformulation of existing
algorithms, we propose a simplification of the problem that allows to achieve
real-time control. Momentum-based control is integrated in the task hierarchy
and a LQR design approach is used to compute the desired associated closed-loop
behavior and improve performance. Extensive experiments on various balancing
and tracking tasks show very robust performance in the face of unknown
disturbances, even when the humanoid is standing on one foot. Our results
demonstrate that hierarchical inverse dynamics together with momentum control
can be efficiently used for feedback control under real robot conditions.Comment: 21 pages, 11 figures, 4 tables in Autonomous Robots (2015
Contact-Implicit Trajectory Optimization Based on a Variable Smooth Contact Model and Successive Convexification
In this paper, we propose a contact-implicit trajectory optimization (CITO)
method based on a variable smooth contact model (VSCM) and successive
convexification (SCvx). The VSCM facilitates the convergence of gradient-based
optimization without compromising physical fidelity. On the other hand, the
proposed SCvx-based approach combines the advantages of direct and shooting
methods for CITO. For evaluations, we consider non-prehensile manipulation
tasks. The proposed method is compared to a version based on iterative linear
quadratic regulator (iLQR) on a planar example. The results demonstrate that
both methods can find physically-consistent motions that complete the tasks
without a meaningful initial guess owing to the VSCM. The proposed SCvx-based
method outperforms the iLQR-based method in terms of convergence, computation
time, and the quality of motions found. Finally, the proposed SCvx-based method
is tested on a standard robot platform and shown to perform efficiently for a
real-world application.Comment: Accepted for publication in ICRA 201
A New Approach to Time-Optimal Path Parameterization based on Reachability Analysis
Time-Optimal Path Parameterization (TOPP) is a well-studied problem in
robotics and has a wide range of applications. There are two main families of
methods to address TOPP: Numerical Integration (NI) and Convex Optimization
(CO). NI-based methods are fast but difficult to implement and suffer from
robustness issues, while CO-based approaches are more robust but at the same
time significantly slower. Here we propose a new approach to TOPP based on
Reachability Analysis (RA). The key insight is to recursively compute reachable
and controllable sets at discretized positions on the path by solving small
Linear Programs (LPs). The resulting algorithm is faster than NI-based methods
and as robust as CO-based ones (100% success rate), as confirmed by extensive
numerical evaluations. Moreover, the proposed approach offers unique additional
benefits: Admissible Velocity Propagation and robustness to parametric
uncertainty can be derived from it in a simple and natural way.Comment: 15 pages, 9 figure
Optimization algorithms for the solution of the frictionless normal contact between rough surfaces
This paper revisits the fundamental equations for the solution of the
frictionless unilateral normal contact problem between a rough rigid surface
and a linear elastic half-plane using the boundary element method (BEM). After
recasting the resulting Linear Complementarity Problem (LCP) as a convex
quadratic program (QP) with nonnegative constraints, different optimization
algorithms are compared for its solution: (i) a Greedy method, based on
different solvers for the unconstrained linear system (Conjugate Gradient CG,
Gauss-Seidel, Cholesky factorization), (ii) a constrained CG algorithm, (iii)
the Alternating Direction Method of Multipliers (ADMM), and () the
Non-Negative Least Squares (NNLS) algorithm, possibly warm-started by
accelerated gradient projection steps or taking advantage of a loading history.
The latter method is two orders of magnitude faster than the Greedy CG method
and one order of magnitude faster than the constrained CG algorithm. Finally,
we propose another type of warm start based on a refined criterion for the
identification of the initial trial contact domain that can be used in
conjunction with all the previous optimization algorithms. This method, called
Cascade Multi-Resolution (CMR), takes advantage of physical considerations
regarding the scaling of the contact predictions by changing the surface
resolution. The method is very efficient and accurate when applied to real or
numerically generated rough surfaces, provided that their power spectral
density function is of power-law type, as in case of self-similar fractal
surfaces.Comment: 38 pages, 11 figure
Keep Rollin' - Whole-Body Motion Control and Planning for Wheeled Quadrupedal Robots
We show dynamic locomotion strategies for wheeled quadrupedal robots, which
combine the advantages of both walking and driving. The developed optimization
framework tightly integrates the additional degrees of freedom introduced by
the wheels. Our approach relies on a zero-moment point based motion
optimization which continuously updates reference trajectories. The reference
motions are tracked by a hierarchical whole-body controller which computes
optimal generalized accelerations and contact forces by solving a sequence of
prioritized tasks including the nonholonomic rolling constraints. Our approach
has been tested on ANYmal, a quadrupedal robot that is fully torque-controlled
including the non-steerable wheels attached to its legs. We conducted
experiments on flat and inclined terrains as well as over steps, whereby we
show that integrating the wheels into the motion control and planning framework
results in intuitive motion trajectories, which enable more robust and dynamic
locomotion compared to other wheeled-legged robots. Moreover, with a speed of 4
m/s and a reduction of the cost of transport by 83 % we prove the superiority
of wheeled-legged robots compared to their legged counterparts.Comment: IEEE Robotics and Automation Letter
- …