“…This paper extends our previous work, [12] and [13], in two directions. Firstly, it provides the extension of the multi-DoF drift compensator presented in [12] to compensate for the drift caused by TDPA in all subtasks, not only the main one, as shown in that paper. In addition, the framework presented here can be seen as a generalization of the one presented in [13], where the following points were improved: the task selection logic, which allows the user to switch among tasks, was modified in order to make the system more robust to time delay and allow online switching among tasks; moreover, an analytical treatment of the effects of the coordinate transformation performed by the whole-body controller and its effects on the passivity of the system is presented.…”