Using the Whole Body Control online planner with TIAGo robot

TIAGo robot whole body control

Making programmers’ life (much, much) easier

Whole Body Control concept (based on the research done by N. Mansard, O. Stasse, P. Evrard, and A. Kheddar) when coding robot applications.

We are sure Whole Body Control is the future: robots with a high amount of Degrees of Freedom require software that abstracts the complexity of the platform for easily developing high-level applications. In this post, you will discover how does it work and to what extent it enhances robots like the mobile manipulator TIAGo!

PAL Robotics’ online planner is designed to command high-level tasks in an incredibly simple way so the robot robustly executes it, and the programmer skips any effort of low-level coding.

The Whole Body Control takes into account different goals, such as, for example, respecting joint limits, avoiding self-collision, or maintaining the end effector in a certain position or space volume. These objectives are defined by the programmer and are prioritized into a stack of tasks by the software.

Such tasks and their priority level are not rigid: they can be modified online. This makes a great difference, as the robot can instantly react to both unexpected events or changes. You can see it in this demo of TIAGo pointing at a fiducial marker, where the robot is constantly processing the new information and adapting its movements to accomplish the goal:

In essence, the Whole Body Control is useful for redundancy resolution. For instance, TIAGo’s 7 DoF arm can execute a task that takes only 3 DoF in multiple ways. The Whole Body Control optimizes cases like that and finds the optimal movement to accomplish with the high-level task.

From technical to practical: the power of Whole Body Control

Besides saving time when developing robotics applications, the main outcome of using Whole Body Control is to make the robot behaviour more robust, reasonable, interactive, safer and natural. PAL Robotics’ bipedal humanoids are mostly using it, especially for undertaking tasks while keeping the balance. TIAGo robot widely benefits from the Whole Body Control software too:

As an example, the Whole Body Control can equip TIAGo robot with admittance control thanks to the combination of this software plug-in with the feedback from its force/torque sensor, turning the robot compliant, which is crucial for doing tasks in which a human is involved.

Take an application for assisted living at home, or TIAGo as a collaborative robot in the Factory of the Future. Human-Robot Interaction demands robustness and fast reaction times. Other complex actions for a robot interacting with human equipment, like cleaning a table or opening a sliding door (without adapting the situation to the robot, of course), or the robot teleoperation in real time, are also much more effective with such versatile software.

Read more about AI in service robotics and deep learning.


Why spending endless time to program a complex application when you can optimize it all? If you have a TIAGo robot, contact us to learn more about WBC and how you can implement this software into your mobile manipulator! Visit our blog about robotics and read all our news!

If you have any question or curiosity, don’t hesitate to contact us!

Related articles
SAFE-LY Project: Improving Patient Safety with Healthcare Robotics
Read More

SAFE-LY Project: Improving Patient Safety with Healthcare Robotics

The healthcare sector is increasingly recognising the importance of robotics in enhancing patient safety and care. With the global healthcare…
PROCARED blog by PAL Robotics
Read More

PRO-CARED pilots: robot ARI as education robot helping students with Catalan language

Integrating robots into education brings a number of potential benefits to the sector, such as enhancing the learning experience for…
Banner for the European Robotics Forum (ERF) 2024 event, highlighting the theme 'Let's talk about collaboration' set against a dark blue background. The event is scheduled from 13-15 March in Rimini, Italy, with the logo of EU Robotics and a decorative pattern of stars in varying sizes and colors. Text also mentions PAL as the gold sponsor of the event.
Read More

European Robotics Forum – ERF2024

The most prominent conference in the European robotics community, the European Robotics Forum, is back for its 15th edition, taking…