← Search

Marc Toussaint

81 accepted papers

2026

CrazyMARL: Decentralized Direct Motor Control Policies for Cooperative Aerial Transport of Cable-Suspended Payloads

ICRA 2026poster

Collaborative transportation of cable-suspended payloads by teams of Unmanned Aerial Vehicles (UAVs) has the potential to enhance payload capacity, adapt to different payload shapes, and provide built-in compliance, making it attractive for applications ranging from disaster relief to precision logi…

2026

MO-SeGMan: Rearrangement Planning Framework for Multi-Objective Sequential and Guided Manipulation in Constrained Environments

ICRA 2026poster

In this work, we introduce MO-SeGMan, a Multi-Objective Sequential and Guided Manipulation planner for highly constrained rearrangement problems. MO-SeGMan generates object placement sequences that minimize both replanning per object and robot travel distance while preserving critical dependency str…

2026

SVN-ICP: Uncertainty Estimation of ICP-Based LiDAR Odometry Using Stein Variational Newton

ICRA 2026poster

This letter introduces SVN-ICP, a novel Iterative Closest Point (ICP) algorithm with uncertainty estimation that leverages Stein Variational Newton (SVN) on manifold. Designed specifically for fusing LiDAR odometry in multisensor systems, the proposed method ensures accurate pose estimation and cons…

2026

Touch-Based Object Localisation with Spatially-Aware Belief Entropy Estimation

ICRA 2026poster

Robust robotic manipulation in the real world requires coping with incomplete or unreliable sensory input. While vision provides rich information, it often fails in the presence of occlusions, clutter, or poor lighting. In such cases, touch offers a robust alternative, enabling object localisation t…

Cited by 0Scholar
2026

Variance-Reduced Model Predictive Path Integral via Quadratic Model Approximation

RSS 2026poster

Sampling-based controllers, such as Model Predictive Path Integral (MPPI) methods, offer substantial flexibility but often suffer from high variance and low sample efficiency. To address these challenges, we introduce a hybrid variance-reduced MPPI framework that integrates a prior model into the sa…

Cited by 0SourceScholar
2025

Meta-Optimization and Program Search using Language Models for Task and Motion Planning

CoRL 2025poster

Intelligent interaction with the real world requires robotic agents to jointly reason over high-level plans and low-level controls. This requirement is formalized in the task and motion planning (TAMP) problem, in which symbolic planning and continuous trajectory generation must be solved in a coord…

Cited by 0SourceScholar
2025

SVN-ICP: Uncertainty Estimation of ICP-Based LiDAR Odometry Using Stein Variational Newton

RA-L 2025

This letter introduces <monospace xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink">SVN-ICP</monospace>, a novel Iterative Closest Point (ICP) algorithm with uncertainty estimation that leverages Stein Variational Newton (SVN) on manifold. Designed specificall

Cited by 0SourcecodeScholar
2024

Camera-Based Belief Space Planning in Discrete Partially-Observable Domains

IROS 2024poster

Robots often have to operate in discrete partially observable worlds, where the state of the world is only observable at runtime. To react to different world states, robots need contingencies. To find contingencies, prior work developed the path tree optimization (PTO) method, which computes motion…

Cited by 0SourceScholar
2024

Effort Level Search in Infinite Completion Trees with Application to Task-and-Motion Planning

ICRA 2024poster

Solving a Task-and-Motion Planning (TAMP) problem can be represented as a sequential (meta-) decision process, where early decisions concern the skeleton (sequence of logic actions) and later decisions concern what to compute for such skeletons (e.g., action parameters, bounds, RRT paths, or full op…

Cited by 1SourceScholar
2024

GSRM: Building Roadmaps for Query-Efficient and Near-Optimal Path Planning Using a Reaction Diffusion System

IROS 2024poster

Mobile robots frequently navigate on roadmaps, i.e., graphs where edges represent safe motions, in applications such as healthcare, hospitality, and warehouse automation. Often the environment is quasi-static, i.e., it is sufficient to construct a roadmap once and then use it for any future planning…

Cited by 0SourceScholar
2024

Kinodynamic Motion Planning for a Team of Multirotors Transporting a Cable-Suspended Payload in Cluttered Environments

IROS 2024poster

We propose a motion planner for cable-driven payload transportation using multiple unmanned aerial vehicles (UAVs) in an environment cluttered with obstacles. Our planner is kinodynamic, i.e., it considers the full dynamics model of the transporting system including actuation constraints. Due to the…

Cited by 4SourceScholar
2024

Solving Sequential Manipulation Puzzles by Finding Easier Subproblems

ICRA 2024poster

We consider a set of challenging sequential manipulation puzzles, where an agent has to interact with multiple movable objects and navigate narrow passages. Such settings are notoriously difficult for Task-and-Motion Planners, as they require interdependent regrasps and solving hard motion planning…

Cited by 4SourcecodeScholar
2024

db-CBS: Discontinuity-Bounded Conflict-Based Search for Multi-Robot Kinodynamic Motion Planning

ICRA 2024poster

This paper presents a multi-robot kinodynamic motion planner that enables a team of robots with different dynamics, actuation limits, and shapes to reach their goals in challenging environments. We solve this problem by combining Conflict-Based Search (CBS), a multi-agent path finding method, and di…

Cited by 13SourcecodeScholar
2024

iDb-RRT: Sampling-based Kinodynamic Motion Planning with Motion Primitives and Trajectory Optimization

IROS 2024poster

Rapidly-exploring Random Trees (RRT) and its variations have emerged as a robust and efficient tool for finding collision-free paths in robotic systems. However, adding dynamic constraints makes the motion planning problem significantly harder, as it requires solving two-value boundary problems (com…

Cited by 5SourceScholar
2023

Efficient Path Planning In Manipulation Planning Problems by Actively Reusing Validation Effort

IROS 2023poster

The path planning problems arising in manipulation planning and in task and motion planning settings are typically repetitive: the same manipulator moves in a space that only changes slightly. Despite this potential for reuse of information, few planners fully exploit the available information. To b…

Cited by 2SourceScholar
2023

Learning Feasibility of Factored Nonlinear Programs in Robotic Manipulation Planning

ICRA 2023poster

A factored Nonlinear Program (Factored-NLP) explicitly models the dependencies between a set of continuous variables and nonlinear constraints, providing an expressive formulation for relevant robotics problems such as manipulation planning or simultaneous localization and mapping. When the problem…

Cited by 3SourceScholar
2023

PaLM-E: An Embodied Multimodal Language Model

ICML 2023poster

Large language models excel at a wide range of complex tasks. However, enabling general inference in the real world, e.g. for robotics problems, raises the challenge of grounding. We propose embodied language models to directly incorporate real-world continuous sensor modalities into language models…

Cited by 1902SourcePDFScholar
2023

Solving Rearrangement Puzzles Using Path Defragmentation in Factored State Spaces

RA-L 2023

Rearrangement puzzles are variations of rearrangement problems in which the elements of a problem are potentially logically linked together. To efficiently solve such puzzles, we develop a motion planning approach based on a new state space that is logically <italic xmlns:mml="http://www.w3.org/1998

Cited by 8SourceScholar
2023

Spatial Reasoning via Deep Vision Models for Robotic Sequential Manipulation

IROS 2023poster

In this paper, we propose using deep neural architectures (i.e., vision transformers and ResNet) as heuristics for sequential decision-making in robotic manipulation problems. This formulation enables predicting the subset of objects that are relevant for completing a task. Such problems are often a…

Cited by 2SourceScholar
2022

A Conflict-Driven Interface Between Symbolic Planning and Nonlinear Constraint Solving

RA-L 2022

Robotic planning in real-world scenarios typically requires joint optimization of logic and continuous variables. A core challenge to combine the strengths of logic planners and continuous solvers is the design of an efficient interface that informs the logical search about continuous infeasibilitie

Cited by 10SourceScholar
2022

BITKOMO: Combining Sampling and Optimization for Fast Convergence in Optimal Motion Planning

IROS 2022poster

Optimal sampling based motion planning and trajectory optimization are two competing frameworks to generate optimal motion plans. Both frameworks have complementary properties: Sampling based planners are typically slow to converge, but provide optimality guarantees. Trajectory optimizers, however,…

Cited by 17SourcecodeScholar
2022

Deep Visual Constraints: Neural Implicit Models for Manipulation Planning From Visual Input

RA-L 2022

Manipulation planning is the problem of finding a sequence of robot configurations that involves interactions with objects in the scene, e.g., grasping and placing an object, or more general tool-use. To achieve such interactions, traditional approaches require hand-engineering of object representat

Cited by 12SourceScholar
2022

Learning Multi-Object Dynamics with Compositional Neural Radiance Fields

CoRL 2022poster

We present a method to learn compositional multi-object dynamics models from image observations based on implicit object encoders, Neural Radiance Fields (NeRFs), and graph neural networks. NeRFs have become a popular choice for representing scenes due to their strong 3D prior. However, most NeRF ap…

Cited by 95SourcecodeScholar
2022

Learning Robotic Manipulation of Natural Materials With Variable Properties for Construction Tasks

RA-L 2022

The introduction of robotics and machine learning to architectural construction is leading to more efficient construction practices. So far, robotic construction has largely been implemented on standardized materials, conducting simple, predictable, and repetitive tasks. We present a novel mobile ro

Cited by 12SourceScholar
2022

MotionBenchMaker: A Tool to Generate and Benchmark Motion Planning Datasets

RA-L 2022

Recently, there has been a wealth of development in motion planning for robotic manipulation—new motion planners are continuously proposed, each with their own unique strengths and weaknesses. However, evaluating new planners is challenging and researchers often create their own ad-hoc problems for

Cited by 79SourcecodeScholar
2022

Path-Tree Optimization in Discrete Partially Observable Environments Using Rapidly-Exploring Belief-Space Graphs

RA-L 2022

Robots often need to solve path planning problems where essential and discrete aspects of the environment are partially observable. This introduces a multi-modality, where the robot must be able to observe and infer the state of its environment. To tackle this problem, we introduce the Path-Tree Opt

Cited by 5SourcecodeScholar
2022

RHH-LGP: Receding Horizon And Heuristics-Based Logic-Geometric Programming For Task And Motion Planning

IROS 2022poster

Sequential decision-making and motion planning for robotic manipulation induce combinatorial complexity. For long-horizon tasks, especially when the environment comprises many objects that can be interacted with, planning efficiency becomes even more important. To plan such long-horizon tasks, we pr…

Cited by 18SourcecodeScholar
2022

Reinforcement Learning with Neural Radiance Fields

NeurIPS 2022accept

It is a long-standing problem to find effective representations for training reinforcement learning (RL) agents. This paper demonstrates that learning state representations with supervision from Neural Radiance Fields (NeRFs) can improve the performance of RL compared to other learned representation…

2022

ST-RRT*: Asymptotically-Optimal Bidirectional Motion Planning through Space-Time

ICRA 2022poster

We present a motion planner for planning through space-time with dynamic obstacles, velocity constraints, and unknown arrival time. Our algorithm, Space-Time RRT*(ST-RRT*), is a probabilistically complete, bidirectional motion planning algorithm, which is asymptotically optimal with respect to the s…

Cited by 43SourceScholar
2022

Sequence-of-Constraints MPC: Reactive Timing-Optimal Control of Sequential Manipulation

IROS 2022poster

Task and Motion Planning has made great progress in solving hard sequential manipulation problems. However, a gap between such planning formulations and control methods for reactive execution remains. In this paper we pro-pose a model predictive control approach dedicated to robustly execute a singl…

Cited by 27SourceScholar
2022

db-A*: Discontinuity-bounded Search for Kinodynamic Mobile Robot Motion Planning

IROS 2022poster

We consider time-optimal motion planning for dynamical systems that are translation-invariant, a property that holds for many mobile robots, such as differential-drives, cars, airplanes, and multirotors. Our key insight is that we can extend graph-search algorithms to the continuous case when used s…

Cited by 14SourcecodeScholar
2021

Co-Optimizing Robot, Environment, and Tool Design via Joint Manipulation Planning

ICRA 2021poster

Existing work on sequential manipulation planning and trajectory optimization typically assumes the robot, environment and tools to be given. However, in particular in industrial applications, it is highly interesting to ask, what would be an optimal robot design, tool shape, or robot station geomet…

Cited by 20SourceScholar
2021

Control-Tree Optimization: an approach to MPC under discrete Partial Observability

ICRA 2021poster

This paper presents a new approach to Model Predictive Control for environments where essential, discrete variables are partially observed. Under this assumption, the belief state is a probability distribution over a finite number of states. We optimize a control-tree where each branch assumes a giv…

Cited by 9SourcecodeScholar
2021

Learning Efficient Constraint Graph Sampling for Robotic Sequential Manipulation

ICRA 2021poster

Efficient sampling from constraint manifolds, and thereby generating a diverse set of solutions for feasibility problems, is a fundamental challenge. We consider the case where a problem is factored, that is, the underlying nonlinear program is decomposed into differentiable equality and inequality…

Cited by 17SourceScholar
2021

Learning Geometric Reasoning and Control for Long-Horizon Tasks from Visual Input

ICRA 2021poster

Long-horizon manipulation tasks require joint reasoning over a sequence of discrete actions and their associated continuous control parameters. While Task and Motion Planning (TAMP) approaches are capable of generating motion plans that account for this joint reasoning, they usually assume full know…

Cited by 47SourceScholar
2021

Learning Models as Functionals of Signed-Distance Fields for Manipulation Planning

CoRL 2021poster

This work proposes an optimization-based manipulation planning framework where the objectives are learned functionals of signed-distance fields that represent objects in the scene. Most manipulation planning approaches rely on analytical models and carefully chosen abstractions/state-spaces to be ef…

Cited by 67SourceScholar
2021

Learning to Arbitrate Human and Robot Control using Disagreement between Sub-Policies

IROS 2021poster

In the context of teleoperation, arbitration refers to deciding how to blend between human and autonomous robot commands. We present a reinforcement learning solution that learns an optimal arbitration strategy that allocates more control authority to the human when the robot comes across a decision…

Cited by 11SourceScholar
2021

Learning to Execute: Efficient Learning of Universal Plan-Conditioned Policies in Robotics

NeurIPS 2021poster

Applications of Reinforcement Learning (RL) in robotics are often limited by high data demand. On the other hand, approximate models are readily available in many robotics scenarios, making model-based approaches like planning a data-efficient alternative. Still, the performance of these methods suf…

2021

MoGaze: A Dataset of Full-Body Motions that Includes Workspace Geometry and Eye-Gaze

RA-L 2021

As robots become more present in open human environments, it will become crucial for robotic systems to understand and predict human motion. Such capabilities depend heavily on the quality and availability of motion capture data. However, existing datasets of full-body motion rarely include 1) long

Cited by 56SourcecodeScholar
2021

Structured deep generative models for sampling on constraint manifolds in sequential manipulation

CoRL 2021poster

Sampling efficiently on constraint manifolds is a core problem in robotics. We propose Deep Generative Constraint Sampling (DGCS), which combines a deep generative model for sampling close to a constraint manifold with nonlinear constrained optimization to project to the constraint manifold. The gen…

Cited by 30SourceScholar
2020

A Probabilistic Framework for Constrained Manipulations and Task and Motion Planning under Uncertainty

ICRA 2020poster

Logic-Geometric Programming (LGP) is a powerful motion and manipulation planning framework, which represents hierarchical structure using logic rules that describe discrete aspects of problems, e.g., touch, grasp, hit, or push, and solves the resulting smooth trajectory optimization. The expressive…

Cited by 20SourceScholar
2020

Deep Visual Heuristics: Learning Feasibility of Mixed-Integer Programs for Manipulation Planning

ICRA 2020poster

In this paper, we propose a deep neural network that predicts the feasibility of a mixed-integer program from visual input for robot manipulation planning. Integrating learning into task and motion planning is challenging, since it is unclear how the scene and goals can be encoded as input to the le…

Cited by 76SourceScholar
2020

Deep Visual Reasoning: Learning to Predict Action Sequences for Task and Motion Planning from an Initial Scene Image

RSS 2020poster

In this paper, we propose a deep convolutional recurrent neural network that predicts action sequences for task and motion planning (TAMP) from an initial scene image. Typical TAMP problems are formalized by combining reasoning on a symbolic, discrete level (e.g. first-order logic) with continuous m…

Cited by 123SourcePDFScholar
2020

Describing Physics For Physical Reasoning: Force-Based Sequential Manipulation Planning

RA-L 2020

Physical reasoning is a core aspect of intelligence in animals and humans. A central question is what model should be used as a basis for reasoning. Existing work considered models ranging from intuitive physics and physical simulators to contact dynamics models used in robotic manipulation and loco

Cited by 47SourceScholar
2020

Motion Planning Explorer: Visualizing Local Minima Using a Local-Minima Tree

RA-L 2020

Motion planning problems often have many local minima. Those minima are important to visualize to let a user guide, prevent or predict motions. Towards this goal, we develop the motion planning explorer, an algorithm to let users interactively explore a tree of local-minima. Following ideas from Mor

Cited by 18SourcecodeScholar
2020

Prediction of Human Full-Body Movements with Motion Optimization and Recurrent Neural Networks

ICRA 2020poster

Human movement prediction is difficult as humans naturally exhibit complex behaviors that can change drastically from one environment to the next. In order to alleviate this issue, we propose a prediction framework that decouples short-term prediction, linked to internal body dynamics, and long-term…

Cited by 52SourceScholar
2020

Robust Task and Motion Planning for Long-Horizon Architectural Construction Planning

IROS 2020poster

Integrating robotic systems in architectural and construction processes is of core interest to increase the efficiency of the building industry. Automated planning for such systems enables design analysis tools and facilitates faster design iteration cycles for designers and engineers. However, gene…

Cited by 54SourceScholar
2020

Sample-Efficient Learning for Industrial Assembly using Qgraph-bounded DDPG

IROS 2020poster

Recent progress in deep reinforcement learning has enabled agents to autonomously learn complex control strategies from scratch. Model-free approaches like Deep Deterministic Policy Gradients (DDPG) seem promising for applications with intricate dynamics, such as contact-rich manipulation tasks. How…

Cited by 13SourceScholar
2020

Self-Supervised Learning of Scene-Graph Representations for Robotic Sequential Manipulation Planning

CoRL 2020

We present a self-supervised representation learning approach for visual reasoning and integrate it into a nonlinear program formulation for motion optimization to tackle sequential manipulation tasks. Such problems have usually been addressed by combined task and motion planning approaches, for whi

2019

Active Multi-Contact Continuous Tactile Exploration with Gaussian Process Differential Entropy

ICRA 2019poster

In the present work, we propose an active tactile exploration framework to obtain a surface model of an unknown object utilizing multiple contacts simultaneously. To incorporate these multiple contacts, the exploration strategy is based on the differential entropy of the underlying Gaussian process…

Cited by 32SourceScholar
2019

An Optimal Algorithm to Solve the Combined Task Allocation and Path Finding Problem

IROS 2019poster

We consider multi-agent transport task problems where, e.g. in a factory setting, items have to be delivered from a given start to a goal pose while the delivering robots need to avoid collisions with each other on the floor.We introduce a Task Conflict-Based Search (TCBS) Algorithm to solve the com…

Cited by 51SourceScholar
2019

Combined Task and Motion Planning under Partial Observability: An Optimization-Based Approach

ICRA 2019poster

We propose a novel approach to Combined Task and Motion Planning (TAMP) under partial observability. Previous optimization-based TAMP methods [1][2] compute optimal plans and paths assuming full observability. However, partial observability requires the solution to be a policy that reacts to the obs…

Cited by 41SourceScholar
2019

Planning Approximate Exploration Trajectories for Model-Free Reinforcement Learning in Contact-Rich Manipulation

RA-L 2019

Recent progress in deep reinforcement learning has enabled simulated agents to learn complex behavior policies from scratch, but their data complexity often prohibits real-world applications. The learning process can be sped up by expert demonstrations but those can be costly to acquire. We demonstr

Cited by 25SourceScholar
2019

Trajectory-Based Off-Policy Deep Reinforcement Learning

ICML 2019oral

Policy gradient methods are powerful reinforcement learning algorithms and have been demonstrated to solve many complex tasks. However, these methods are also data-inefficient, afflicted with high variance gradient estimates, and frequently get stuck in local optima. This work addresses these weakne…

2018

Differentiable Physics and Stable Modes for Tool-Use and Manipulation Planning

RSS 2018poster

We consider the problem of sequential manipulation and tool-use planning in domains that include physical interactions such as hitting and throwing. The approach integrates a Task And Motion Planning formulation with primitives that either impose stable kinematic constraints or differentiabl…

2018

Learning to Control Redundant Musculoskeletal Systems with Neural Networks and SQP: Exploiting Muscle Properties

ICRA 2018poster

Modeling biomechanical musculoskeletal systems reveals that the mapping from muscle stimulations to movement dynamics is highly nonlinear and complex, which makes it difficult to control those systems with classical techniques. In this work, we not only investigate whether machine learning approache…

Cited by 32SourceScholar
2018

Probabilistic Recurrent State-Space Models

ICML 2018oral

State-space models (SSMs) are a highly expressive model class for learning patterns in time series data and for system identification. Deterministic versions of SSMs (e.g., LSTMs) proved extremely successful in modeling complex time series data. Fully probabilistic SSMs, however, are often found har…

2017

Constrained Bayesian optimization of combined interaction force/task space controllers for manipulations

ICRA 2017poster

In this paper, we address the problem of how a robot can optimize parameters of combined interaction force/task space controllers under a success constraint in an active way. To enable the robot to explore its environment robustly, safely and without the risk of damaging anything, suitable control c…

Cited by 43SourceScholar
2017

Multi-bound tree search for logic-geometric programming in cooperative manipulation domains

ICRA 2017poster

Joint symbolic and geometric planning is one of the core challenges in robotics. We address the problem of multi-agent cooperative manipulation, where we aim for jointly optimal paths for all agents and over the full manipulation sequence. This joint optimization problem can be framed as a logic-geo…

Cited by 94SourceScholar
2016

Relational activity processes for modeling concurrent cooperation

ICRA 2016

In human-robot collaboration, multi-agent domains, or single-robot manipulation with multiple end-effectors, the activities of the involved parties are naturally concurrent. Such domains are also naturally relational as they involve objects, multiple agents, and models should generalize over objects

Cited by 32SourceScholar
2015

Automatic testing and minimax optimization of system parameters for best worst-case performance

IROS 2015poster

Robotic systems typically have numerous parameters, e.g. the choice of planning algorithm, real-valued parameters of motion and vision modules, and control parameters. We consider the problem of optimizing these parameters for best worst-case performance over a range of environments. To this end we…

Cited by 7SourceScholar
2015

Direct Loss Minimization Inverse Optimal Control

RSS 2015poster

Inverse Optimal Control (IOC) has strongly impacted the systems engineering process, enabling automated planner tuning through straightforward and intuitive demonstration. The most successful and established applications, though, have been in lower dimensional problems such as navigation planning wh…

Cited by 57SourcePDFScholar
2015

Robot programming from demonstration, feedback and transfer

IROS 2015poster

This paper presents a novel approach for robot instruction for assembly tasks. We consider that robot programming can be made more efficient, precise and intuitive if we leverage the advantages of complementary approaches such as learning from demonstration, learning from feedback and knowledge tran…

Cited by 59SourceScholar
2015

Sparse Gaussian process regression for compliant, real-time robot control

ICRA 2015poster

Sparse Gaussian process (GP) models provide an efficient way to perform regression on large data sets. The key idea is to select a representative subset of the available training data, which induces the sparse GP model approximation. In the past, a variety of selection criteria for GP approximation…

Cited by 29SourceScholar
2015

Temporal segmentation of pair-wise interaction phases in sequential manipulation demonstrations

IROS 2015poster

We consider the problem of learning from complex sequential demonstrations. We propose to analyze demonstrations in terms of the concurrent interaction phases which arise between pairs of involved bodies (hand-object and object-object). These interaction phases are the key to decompose a full demons…

Cited by 19SourceScholar