Contact-Aware Motion Planning Among Movable Objects

Fuente: arXiv
Enregistré dans:
Détails bibliographiques
Auteurs principaux: Wang, Haokun, Wang, Qianhao, Gao, Fei, Shen, Shaojie
Format: Preprint
Publié: 2025
Sujets:
Accès en ligne:
Tags: Ajouter un tag
Pas de tags, Soyez le premier à ajouter un tag!
_version_ 1866917914008879104
author Wang, Haokun
Wang, Qianhao
Gao, Fei
Shen, Shaojie
author_facet Wang, Haokun
Wang, Qianhao
Gao, Fei
Shen, Shaojie
contents Most existing methods for motion planning of mobile robots involve generating collision-free trajectories. However, these methods focusing solely on contact avoidance may limit the robots' locomotion and can not be applied to tasks where contact is inevitable or intentional. To address these issues, we propose a novel contact-aware motion planning (CAMP) paradigm for robotic systems. Our approach incorporates contact between robots and movable objects as complementarity constraints in optimization-based trajectory planning. By leveraging augmented Lagrangian methods (ALMs), we efficiently solve the optimization problem with complementarity constraints, producing spatial-temporal optimal trajectories of the robots. Simulations demonstrate that, compared to the state-of-the-art method, our proposed CAMP method expands the reachable space of mobile robots, resulting in a significant improvement in the success rate of two types of fundamental tasks: navigation among movable objects (NAMO) and rearrangement of movable objects (RAMO). Real-world experiments show that the trajectories generated by our proposed method are feasible and quickly deployed in different tasks.
format Preprint
id arxiv_https___arxiv_org_abs_2502_03317
institution arXiv
publishDate 2025
record_format arxiv
spellingShingle Contact-Aware Motion Planning Among Movable Objects
Wang, Haokun
Wang, Qianhao
Gao, Fei
Shen, Shaojie
Robotics
Most existing methods for motion planning of mobile robots involve generating collision-free trajectories. However, these methods focusing solely on contact avoidance may limit the robots' locomotion and can not be applied to tasks where contact is inevitable or intentional. To address these issues, we propose a novel contact-aware motion planning (CAMP) paradigm for robotic systems. Our approach incorporates contact between robots and movable objects as complementarity constraints in optimization-based trajectory planning. By leveraging augmented Lagrangian methods (ALMs), we efficiently solve the optimization problem with complementarity constraints, producing spatial-temporal optimal trajectories of the robots. Simulations demonstrate that, compared to the state-of-the-art method, our proposed CAMP method expands the reachable space of mobile robots, resulting in a significant improvement in the success rate of two types of fundamental tasks: navigation among movable objects (NAMO) and rearrangement of movable objects (RAMO). Real-world experiments show that the trajectories generated by our proposed method are feasible and quickly deployed in different tasks.
title Contact-Aware Motion Planning Among Movable Objects
topic Robotics
url https://arxiv.org/abs/2502.03317