LASA
Physical human-robot interaction for hand-over, support, and carrying heavy objects
updated
We introduce a novel framework to achieve action contextualization, aimed at tailoring robot actions to the context of specific tasks, thereby enhancing adaptability through applying LLM-derived contextual insights.
Our framework integrates motion metrics that evaluate robot performances for each motion to resolve redundancy in planning.
Moreover, it supports online feedback between the robot and the LLM, enabling immediate modifications to the task plans and corrections of errors.
An overall success rate of 81.25% has been achieved through extensive experimental validation.
Finally, when integrated with dynamical system (DS)-based robot controllers, the robotic arm-hand system demonstrates its proficiency in autonomously executing LLM-generated motion plans for sequential table-clearing tasks, rectifying errors without human intervention, and showcasing robustness against external disturbances.
Our proposed framework also features the potential to be integrated with modular control approaches, significantly enhancing robots' adaptability and autonomy in performing sequential tasks in the real world.
Open access: ieeexplore.ieee.org/document/10494917
To throw generic objects that differ in mass, shape, material, and deformability, instead of case-by-case adaptation, what about synthesizing robust release motion to compensate for our ignorance of object properties?
Tube Acceleration is a novel solution concept that drives the robot's end-effector to stay in the family of admissible object flying trajectories, ensuring robustness against release uncertainty. Through insightful observations, Tube Acceleration can be found via convex optimization within 50ms with bounded error. This facilitated robust throwing motion achieves a high accuracy and success rate at throwing a variety of complex deformable objects with dexterous throwing configurations. For planar throwing, the success rate exceeds 97%.
github.com/hubernikus/nonlinear_obstacle_avoidance
The open-access publication can be found under:
arxiv.org/abs/2306.16160
Controlling complex tasks in robotic systems, such as circular motion for cleaning or following curvy lines, can be dealt with using nonlinear vector fields. In this paper, we introduce a novel approach called rotational obstacle avoidance method (ROAM) for adapting the initial dynamics when the workspace is partially occluded by obstacles. ROAM presents a closed-form solution that effectively avoids star-shaped obstacles in spaces of arbitrary dimensions by rotating the initial dynamics towards the tangent space. The algorithm enables navigation within obstacle hulls and can be customized to actively move away from surfaces, while guaranteeing the presence of only a single saddle point on the boundary of each obstacle. We introduce a sequence of mappings to extend the approach for general nonlinear dynamics. Moreover, ROAM extends its capabilities to handle multi-obstacle environments and provides the ability to constrain dynamics within a safe tube. By utilizing weighted vector-tree summation, we successfully navigate around general concave obstacles represented as a tree-of-stars. Through experimental evaluation, ROAM demonstrates superior performance in terms of minimizing occurrences of local minima and maintaining similarity to the initial dynamics, outperforming existing approaches in multi-obstacle simulations. The proposed method is highly reactive, owing to its simplicity, and can be applied effectively in dynamic environments. This was demonstrated during the collision-free navigation of a 7 degree-of-freedom robot arm around dynamic obstacles.
in environments where humans operate, such as warehouses,
assistive living rooms, or automated hospitals, is crucial for
adopting automation. In this paper, we augment the obstacle
avoidance algorithm based on dynamical system modulation
for a swarm of heterogeneous holonomic mobile agents. A
smooth prioritization is proposed to change the reactivity of the
swarm towards the specific agents. Further, a soft decoupling of
the initial agent’s kinematics is used to design an independent
rotation control to ensure the agent reaches the desired position
and orientation simultaneously. This decoupling allowed the
introduction of a novel heuristic, the virtual drag. It minimizes
the disturbance influence an agent has when moving through its
surroundings. Additionally, the safety module adapts the velocity
commands from the dynamical system modulation to avoid
colliding trajectories between agents. The evaluation was per-
formed in simulated assisted living and hospital environments.
The prioritization successfully increased the minimum distance
relative to a moving agent. The safety module is observed
to create collision-free dynamics where alternative methods
fail. Additionally, the repulsive nature of the safety module
augments the convergence rate, thus making the proposed
method better applicable to dense real-world scenarios.
The paper was published as:
Douce, L. N., Menichelli, A., Huber, L., Bolotnikova, A., Paez-Granados, D., Ijspeert, A., & Billard, A. (2023, October). Agent Prioritization and Virtual Drag Minimization in Dynamical System Modulation For Obstacle Avoidance of Decentralized Swarms. In 2023 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE.
Link to the paper:
https://www.research-collection.ethz.ch/bitstream/handle/20.500.11850/632370/Swarm_DS_Furniture-IROS_2023.pdf?sequence=1
Link to the source code to recreate simulations:
github.com/epfl-lasa/autonomous_furniture
It shows the dual-arm coordination required by such a dynamic task and the fast adaptation abilities when the moving tossing target is subject to perturbations.
ieeexplore.ieee.org/stamp/stamp.jsp?arnumber=9981583
The source code repository can be found on:
github.com/epfl-lasa/autonomous_furniture
In order to facilitate and assist the indoor mobility of people with special needs, the classically static objects in the environment, such as furniture, can be rendered mobile. The need for efficient and safe autonomous coordination of a mobile furniture swarm arises. We present a closed-form approach for mobile furniture obstacle avoidance and navigation within
an indoor environment. The approach shows that each mobile furniture agent, defined by a polygonal surface, does not collide with any static or mobile obstacle (e.g., a person is moving around). All controllable mobile furniture converges towards a defined goal position and orientation. We showcase the application of this algorithm in simulation on mobile furniture
for smart environments. Results demonstrate that the proposed method can coordinate a swarm of mobile furniture to get out of the way of a mobile agent representing a person with limited mobility passing through the room while avoiding obstacles and converging towards a predefined target pose.
Digital Object Identifier 10.1109/TSMC.2023.3262954
In this video, we introduce our Self-Correcting Quadratic Programming-Based controller, which enables robotic systems to undertake complex motions and interactions, even in situations where the underlying model of the environment and robot dynamics is unmodeled. Our approach augments traditional QP-based controllers with a learned residual inverse dynamics model and an adaptive control law, allowing for online adjustment to account for uncertainties and unforeseen disturbances. We extensively evaluate our method in several simulated robotic scenarios and validate our approach in physical robotic systems with unknown environmental models. Check out our paper for more information!
ieeexplore.ieee.org/document/10102575
open-access: http://infoscience.epfl.ch/record/301975?&ln=en
iopscience.iop.org/article/10.1088/1741-2552/aca35f
Authors:
Farshad Khadivar, Vincent Mendez, Carolina Correia, Iason Batzianoulis, Aude Billard, and Silvestro Micera
Abstract:
Objective. The limited functionality of hand prostheses remains one of the main reasons behind the lack of its wide adoption by amputees. Indeed, while commercial prostheses can perform a reasonable number of grasps, they are often inadequate for manipulating the object once in hand. This lack of dexterity drastically restricts the utility of prosthetic hands. We aim at investigating a novel shared control strategy that combines autonomous control of forces exerted by a robotic hand with electromyographic (EMG) decoding to perform robust in-hand object manipulation.
Approach. We conduct a three-day long longitudinal study with eight healthy subjects controlling a 16-degrees-of-freedom robotic hand to insert objects in boxes of various orientations. EMG decoding from forearm muscles enables subjects to move, proportionally and simultaneously, the fingers of the robotic hand. The desired object rotation is inferred using two EMG electrodes placed on the shoulder that record the activity of muscles responsible for elevation and depression. During the object interaction phase, the autonomous controller stabilizes and rotates the object to achieve the desired pose. In this study, we compare an incremental and a proportional shoulder-decoding method in combination with two state machine interfaces offering different levels of assistance.
Main results. Results indicate that robotic assistance reduces the number of failures by 41% and, when combined with an incremental shoulder EMG decoding, leads to faster task completion time (median = 16.9 s), compared to other control conditions. Training to use the assistive device is fast. After one session of practice, all subjects managed to achieve tasks with 50% less failures.
Significance. Shared control approaches that give some authority to an autonomous controller on-board the prosthesis are an alternative to control schemes relying on EMG decoding alone. This may improve the dexterity and versatility of robotic prosthetic hands for people with trans-radial amputation. By delegating control of forces to the prosthesis’ on-board control, one speeds up reaction time and improves the precision of force control. Such a shared control mechanism may enable amputees to perform fine insertion tasks solely using their prosthetic hands. This may restore some of the functionality of the disabled arm.
ieeexplore.ieee.org/document/9999335
The software used to program the robot is open-source:
github.com/hubernikus/fast_obstacle_avoidance
Humans excel at navigating and moving through dynamic and complex spaces, such as crowded streets. For robots to do the same, it is crucial that they are endowed with highly reactive obstacle avoidance which is adept at partial and poor sensing. We address the issue of enabling obstacle
avoidance based on sparse and asynchronous perception. The proposed control scheme combines a high-level input command provided by either a planner or a human operator with fast reactive obstacle avoidance (FOA). The sampling-based sensor data can be combined with an analytical reconstruction of the obstacles for real-time collision avoidance. Thus, we can ensure that the agent does not become stuck when a feasible path exists between obstacles. Our algorithm was evaluated experimentally
on static laser data from cluttered, indoor office environments.
Additionally, it was used in shared-control mode in a dynamic and complex outdoor environment in the center of Lausanne. The proposed control scheme successfully avoided collisions in both scenarios. During the experiments, the controller took 1 millisecond to evaluate over 30000 data points.
ieeexplore.ieee.org/document/9976191
M. Koptev, N. Figueroa and A. Billard, "Neural Joint Space Implicit Signed Distance Functions for Reactive Robot Manipulator Control," in IEEE Robotics and Automation Letters, doi: 10.1109/LRA.2022.3227860.
ieeexplore.ieee.org/abstract/document/9765824
Find also the open source implementation:
github.com/epfl-lasa/dynamic_obstacle_avoidance
This video presents a closed-form approach to constraining a flow within a given volume and around objects. The flow is guaranteed to converge and to stop at a single fixed point. The obstacle avoidance problem is inverted to enforce that the flow remains enclosed within a volume defined by a polygonal surface. We formally guarantee that such a flow will never contact the boundaries of the enclosing volume or obstacles. It asymptotically converges towards an attractor. We further create smooth motion fields around obstacles with edges (e.g., tables). Both obstacles and enclosures may be time-varying, i.e., moving, expanding, and shrinking. The technique enables a robot to navigate within enclosed corridors while avoiding static and moving obstacles. It was applied on an autonomous robot (QOLO) in a static complex indoor environment and tested in simulations with dense crowds. The final proof of concept was performed in an outdoor environment in Lausanne. The QOLO robot successfully traversed a marketplace in the center of town in the presence of a diverse crowd with a non-uniform motion pattern.
Reference to the paper / video with:
Huber, Lukas, Jean-Jacques Slotine, and Aude Billard. "Avoiding Dense and Dynamic Obstacles in Enclosed Spaces: Application to Moving in Crowds." IEEE Transactions on Robotics (2022).
Paez-Granados, D., Billard, A. Crash test-based assessment of injury risks for adults and children when colliding with personal mobility devices and service robots. Nature Scientific Reports 12, 5285 (2022). doi.org/10.1038/s41598-022-09349-9
Abstract:
Autonomous mobility devices such as transport, cleaning, and delivery robots, hold a massive economic and social benefit. However, their deployment should not endanger bystanders, particularly vulnerable populations such as children and older adults who are inherently smaller and fragile. This study compared the risks faced by different pedestrian categories and determined risks through crash testing involving a service robot hitting an adult and a child dummy. Results of collisions at 3.1 m/s (11.1 km/h/6.9 mph) showed risks of serious head (14%), neck (20%), and chest (50%) injuries in children, and tibia fracture (33%) in adults.
Furthermore, secondary impact analysis resulted in both populations at risk of severe head injuries, namely, from falling to the ground. Our data and simulations show mitigation strategies for reducing impact injury risks below 5% by either lowering the differential speed at impact below 1.5 m/s (5.4 km/h/3.3 mph) or through the usage of absorbent materials. The results presented herein may influence the design of controllers, sensing awareness, and assessment methods for robots and small vehicles standardization, as well as, policymaking and regulations for the speed, design, and usage of these devices in populated areas.
In this video we show the performance of the control strategy with force assistance but no coordination assistance.
Amanhoud W, Hernandez Sanchez J, Bouri M, Billard A. Contact-initiated shared control strategies for four-arm supernumerary manipulation with foot interfaces. The International Journal of Robotics Research. 2021;40(8-9):986-1014. doi:10.1177/02783649211017642
Can be found originally in doi.org/10.1177/02783649211017642.
In this video show the performance of the control strategy with full assistance (force and coordination)
Amanhoud W, Hernandez Sanchez J, Bouri M, Billard A. Contact-initiated shared control strategies for four-arm supernumerary manipulation with foot interfaces. The International Journal of Robotics Research. 2021;40(8-9):986-1014. doi:10.1177/02783649211017642
Can be found originally in doi.org/10.1177/02783649211017642.
In this video we show the performance of the control strategy with coordination assistance and no force assistance.
Amanhoud W, Hernandez Sanchez J, Bouri M, Billard A. Contact-initiated shared control strategies for four-arm supernumerary manipulation with foot interfaces. The International Journal of Robotics Research. 2021;40(8-9):986-1014. doi:10.1177/02783649211017642
Can be found originally in doi.org/10.1177/02783649211017642.
In this video we explain the mapping between the foot platforms and the robotic arms, for the coordinated and uncoordinated control strategies.
Amanhoud W, Hernandez Sanchez J, Bouri M, Billard A. Contact-initiated shared control strategies for four-arm supernumerary manipulation with foot interfaces. The International Journal of Robotics Research. 2021;40(8-9):986-1014. doi:10.1177/02783649211017642
Can be found originally in doi.org/10.1177/02783649211017642.
In this video we highlight some remarks related to human motor control during the four handed manipulation.
Amanhoud W, Hernandez Sanchez J, Bouri M, Billard A. Contact-initiated shared control strategies for four-arm supernumerary manipulation with foot interfaces. The International Journal of Robotics Research. 2021;40(8-9):986-1014. doi:10.1177/02783649211017642
Can be found originally in doi.org/10.1177/02783649211017642.
In this video we highlight the importance of force assistance for the bipedal sub-task of the four-handed task.
Amanhoud W, Hernandez Sanchez J, Bouri M, Billard A. Contact-initiated shared control strategies for four-arm supernumerary manipulation with foot interfaces. The International Journal of Robotics Research. 2021;40(8-9):986-1014. doi:10.1177/02783649211017642
Can be found originally in doi.org/10.1177/02783649211017642.
ieeexplore.ieee.org/abstract/document/9561587/media#media
Access arXiv paper at: arxiv.org/pdf/2110.04633.pdf
Authors: Ahalya Prabhakar and Aude Billard
Access the arXiv paper at: arxiv.org/pdf/2110.04634.pdf
Authors: Ahalya Prabhakar, Stanislas Furrer, Lorenzo Panchetti, Maxence Perret and Aude Billard
In this video, we explain the four handed task and show the performance of the control strategy without assistance (baseline)
Amanhoud W, Hernandez Sanchez J, Bouri M, Billard A. Contact-initiated shared control strategies for four-arm supernumerary manipulation with foot interfaces. The International Journal of Robotics Research. 2021;40(8-9):986-1014. doi:10.1177/02783649211017642
Can be found originally in doi.org/10.1177/02783649211017642.
Paper: http://infoscience.epfl.ch/record/287442?&ln=en
Abstract—Soon human-robot interactions in pedestrian areas
will be beyond the novelty effect with the deployment of delivery robots, autonomous personal mobility vehicles, and surveillance robots. Proxemics and other social rules guide these interactions, nonetheless, contactless navigation might be yielded infeasible by pedestrian density in certain areas or by adversarial pedestrians. In such scenarios, freezing the robot might go against bystanders safety and task completion might only be feasible under controlled contact interactions. We present a force-limited and obstacle avoidance integrated controller through a time-invariant dynamical system in a closed-loop force controller that let the robot react instantaneously and drive around pedestrians. Mitigating the risk of collision is done by modulating the velocity commands upon detecting a pedestrian and absorbing part of the contact force through active compliant control when the robot bumps inadvertently against the pedestrian.
Work by; Diego Paez-Granados,
Vaibhav Gupta,
Aude Billard
This work was part of the EU CrowdBot Project.
Contact: Diego Paez
Work presented as DEMO for EU H2020 CrowdBot Project
Work by: Diego Paez-Granados
David Gonon
Vaibhav Gupta
Aude Billard
Redirecting Driver Support Controller:
doi.org/10.1109/LRA.2021.3068660
Method for Passive Dynamical Systems:
doi.org/10.1109/icra40945.2020.9197509
Hands-free Navigation System:
doi.org/10.1109/IROS45743.2020.9340875
Qolo robot:
doi.org/10.1109/IROS.2018.8594199
Researcher:
Iason Batzianoulis
Related code:
- github.com/yias/eurekaRes/tree/master/gaze
Acknowledgements:
This research is supported by the Swiss National Science Foundation through the National Centre of Competence in Research Robotics and the Hasler Foundation.
Reference paper:Batzianoulis, I., Krausz, N., Simon, A. et al. Decoding the grasping intention from electromyography during reaching motions. J NeuroEngineering Rehabil 15, 57 (2018).
doi.org/10.1186/s12984-018-0396-5
Acknowledgements:This research is supported by Swiss National Science Foundation through the National Centre of Competence in Research Robotics and the United States’ National Institutes of Health
Researchers:
Iason Batzianoulis, Farshad Khadivar, Vincent Alexandre Mendez
Acknowledgements:
This research is supported by Swiss National Science Foundation through the National Centre of Competence in Research Robotics and the Hasler Foundation.
Researcher:
Iason Batzianoulis
Related code:
- Object detection: github.com/yias/eurekaRes/tree/master/gaze
- Robot arm motion generator: github.com/yias/robot_arm_motion
- Kuka LWR control interface: github.com/epfl-lasa/kuka-lwr-ros
- Mask R-CNN: github.com/matterport/Mask_RCNN
Related work:
- Mask R-CNN, arxiv.org/abs/1703.06870
- A Dynamical System Approach to Realtime Obstacle Avoidance, https://infoscience.epfl.ch/record/174759?ln=en
- Passive Interaction Control with Dynamical Systems, https://infoscience.epfl.ch/record/221276?ln=en
Acknowledgements:
This research is supported by the Swiss National Science Foundation through the National Centre of Competence in Research Robotics and the Hasler Foundation.
Highlights:
•Learning bifurcation parameters to encode a dynamical system with discrete and periodic dynamics.
•Exploiting Hopf bifurcations to smoothly switch across periodic and non-periodic phases.
•Using diffeomorphism to acquire nonlinear limit cycles from demonstration.
#bifurcation #nonlinear #limit_cycle #supervised #learning #robotics #LfD #demonstration #diffeomorphism #gmm #pca #lasa #kuka #humanoid
#robotics #hri #haptics #epfl #lasa #rehassist #sti #foot #5dof #surgery #gripper #laparoscopy #hasler #future #technology #science #shared #control #surgical training #simulation
Full paper in Open-Access: doi.org/10.1109/LRA.2021.3068660
Work done by David Gonon, Diego Paez-Granados, and Aude Billard at LASA, EPFL, Switzerland.
We thank all our co-workers appearing in the video for their help.
This work's source code (C++ w/ ROS) is publicly available at: github.com/epfl-lasa/rds
Authors: Nadia Figueroa, Salman Faraji, Mikhail Koptev and Aude Billard
Website: epfl-lasa.github.io/iCub-Assistant
nature.com/articles/s42256-019-0093-5
Our research aims at endowing the surgeon with the capacity to complement the work of both hands with two robotic arms that are controlled via haptic foot interfaces of five degrees of freedom. One foot controls an endoscope (camera) while the other foot controls a complementary retractor ( in this demo resembled with a hook).
The robots are teleoperated using impedance control modulated via linear dynamical systems.
arxiv.org/abs/1909.04993
Abstract: In this paper, we present an integrated framework that provides compliant control of an iCub humanoid robot and adaptive reaching, grasping, navigating and co-manipulating. We use state-dependent dynamical systems (DS) to (i) coordinate and drive the robot's hands an object in position and orientation to grasp an object, and (ii) drive the robot's base while walking/navigating. The use of DS as motion generators allows us to adapt smoothly as the object moves and to re-plan on-line motion of arms and body to reach the object's new location. The desired trajectory generated by the DS are used in combination with a whole-body compliant control strategy that absorbs perturbations while walking and offers compliant behaviors for grasping and manipulation tasks. The desired dynamics for arm and body can be learned from demonstrations. By integrating these components we achieve unprecedented adaptive behaviors for whole body manipulation. We showcase this in simulations and real-world experiments where iCub robots (i) walk-to-grasp objects, (ii) follow a human (or another iCub) through interaction and (iii) learn to navigate or co-manipulate an object from human guided demonstrations; whilst being robust to changing targets and perturbations.
Authors: Nadia Figueroa, Salman Faraji, Mikhail Koptev and Aude Billard
Webpage: epfl-lasa.github.io/iCub-Assistant
"Locally Active Globally Stable Dynamical Systems: Theory, Learning and Experiments"
Abstract: State-dependent Dynamical Systems (DS) offer adaptivity, reactivity and robustness to perturbations in motion planning and physical human-robot interaction tasks. Learning DS-based motion representations from non-linear reference trajectories is an active research area in robotics. Most approaches focus on learning DS that can (i) accurately mimic the demonstrated motion, while (ii) ensuring convergence to the target; i.e. they are globally asymptotically (or exponentially) stable. When the objective of a task is to reach a target while tracking a reference trajectory, if perturbations are present a compliant robot guided with a DS will ultimately reach the target, albeit failing to track the reference trajectory. In this work, we propose a novel DS formulation referred to as the locally active globally stable DS (LAGS-DS). The LAGS-DS provides both global convergence and stiffness-like symmetric attraction behaviors around a reference-trajectory in regions of the state-space where trajectory tracking is important. This allows for a unified approach towards motion and impedance encoding in a single motion model without parameterizing the controller of the robot; i.e. stiffness is embedded in the motion model. To learn LAGS-DS from demonstrations we propose a learning strategy based on Bayesian non-parametric Gaussian mixture models, Gaussian processes and a sequence of constrained optimization problems that ensure estimation of stable DS parameters via Lyapunov theory. This novel DS and learning scheme is extensively validated on writing tasks with a KUKA LWR manipulator, as well as navigation and co-manipulation scenarios with iCub humanoid robots.
Contact: Nadia Figueroa [nbfigueroa.github.io]
Funding: Cogimon [https://cogimon.eu/]
"Locally Active Globally Stable Dynamical Systems: Theory, Learning and Experiments"
Abstract: State-dependent Dynamical Systems (DS) offer adaptivity, reactivity and robustness to perturbations in motion planning and physical human-robot interaction tasks. Learning DS-based motion representations from non-linear reference trajectories is an active research area in robotics. Most approaches focus on learning DS that can (i) accurately mimic the demonstrated motion, while (ii) ensuring convergence to the target; i.e. they are globally asymptotically (or exponentially) stable. When the objective of a task is to reach a target while tracking a reference trajectory, if perturbations are present a compliant robot guided with a DS will ultimately reach the target, albeit failing to track the reference trajectory. In this work, we propose a novel DS formulation referred to as the locally active globally stable DS (LAGS-DS). The LAGS-DS provides both global convergence and stiffness-like symmetric attraction behaviors around a reference-trajectory in regions of the state-space where trajectory tracking is important. This allows for a unified approach towards motion and impedance encoding in a single motion model without parameterizing the controller of the robot; i.e. stiffness is embedded in the motion model. To learn LAGS-DS from demonstrations we propose a learning strategy based on Bayesian non-parametric Gaussian mixture models, Gaussian processes and a sequence of constrained optimization problems that ensure estimation of stable DS parameters via Lyapunov theory. This novel DS and learning scheme is extensively validated on writing tasks with a KUKA LWR manipulator, as well as navigation and co-manipulation scenarios with iCub humanoid robots.
Contact: Nadia Figueroa [nbfigueroa.github.io]
Funding: Cogimon [https://cogimon.eu/]
Tasks evaluated: 1) Wiping a door fender, 2) Wiping a Rim Cover, 3) Dough Rolling and 4) Zucchini Peeling
[1] Figueroa N. and Billard A., "Geometric Invariance of Covariance Matrices for Unsupervised Clustering, Segmentation and Action Discovery in Robotic Applications". Submitted to Journal of Machine Learning Research (JMLR).


