Fast and Safe Trajectory Optimization for Mobile Manipulators With Neural Configuration Space Distance Field

Fuente: arXiv
Guardado en:
Detalles Bibliográficos
Autores principales: Li, Yulin, Song, Zhiyuan, Li, Yiming, Song, Zhicheng, Chen, Kai, Zheng, Chunxin, Bi, Zhihai, Cao, Jiahang, Calinon, Sylvain, Shi, Fan, Ma, Jun
Formato: Preprint
Publicado: 2026
Materias:
Acceso en línea:
Etiquetas: Agregar Etiqueta
Sin Etiquetas, Sea el primero en etiquetar este registro!
_version_ 1866917224651948032
author Li, Yulin
Song, Zhiyuan
Li, Yiming
Song, Zhicheng
Chen, Kai
Zheng, Chunxin
Bi, Zhihai
Cao, Jiahang
Calinon, Sylvain
Shi, Fan
Ma, Jun
author_facet Li, Yulin
Song, Zhiyuan
Li, Yiming
Song, Zhicheng
Chen, Kai
Zheng, Chunxin
Bi, Zhihai
Cao, Jiahang
Calinon, Sylvain
Shi, Fan
Ma, Jun
contents Mobile manipulators promise agile, long-horizon behavior by coordinating base and arm motion, yet whole-body trajectory optimization in cluttered, confined spaces remains difficult due to high-dimensional nonconvexity and the need for fast, accurate collision reasoning. Configuration Space Distance Fields (CDF) enable fixed-base manipulators to model collisions directly in configuration space via smooth, implicit distances. This representation holds strong potential to bypass the nonlinear configuration-to-workspace mapping while preserving accurate whole-body geometry and providing optimization-friendly collision costs. Yet, extending this capability to mobile manipulators is hindered by unbounded workspaces and tighter base-arm coupling. We lift this promise to mobile manipulation with Generalized Configuration Space Distance Fields (GCDF), extending CDF to robots with both translational and rotational joints in unbounded workspaces with tighter base-arm coupling. We prove that GCDF preserves Euclidean-like local distance structure and accurately encodes whole-body geometry in configuration space, and develop a data generation and training pipeline that yields continuous neural GCDFs with accurate values and gradients, supporting efficient GPU-batched queries. Building on this representation, we develop a high-performance sequential convex optimization framework centered on GCDF-based collision reasoning. The solver scales to large numbers of implicit constraints through (i) online specification of neural constraints, (ii) sparsity-aware active-set detection with parallel batched evaluation across thousands of constraints, and (iii) incremental constraint management for rapid replanning under scene changes.
format Preprint
id arxiv_https___arxiv_org_abs_2601_18548
institution arXiv
publishDate 2026
record_format arxiv
spellingShingle Fast and Safe Trajectory Optimization for Mobile Manipulators With Neural Configuration Space Distance Field
Li, Yulin
Song, Zhiyuan
Li, Yiming
Song, Zhicheng
Chen, Kai
Zheng, Chunxin
Bi, Zhihai
Cao, Jiahang
Calinon, Sylvain
Shi, Fan
Ma, Jun
Robotics
Mobile manipulators promise agile, long-horizon behavior by coordinating base and arm motion, yet whole-body trajectory optimization in cluttered, confined spaces remains difficult due to high-dimensional nonconvexity and the need for fast, accurate collision reasoning. Configuration Space Distance Fields (CDF) enable fixed-base manipulators to model collisions directly in configuration space via smooth, implicit distances. This representation holds strong potential to bypass the nonlinear configuration-to-workspace mapping while preserving accurate whole-body geometry and providing optimization-friendly collision costs. Yet, extending this capability to mobile manipulators is hindered by unbounded workspaces and tighter base-arm coupling. We lift this promise to mobile manipulation with Generalized Configuration Space Distance Fields (GCDF), extending CDF to robots with both translational and rotational joints in unbounded workspaces with tighter base-arm coupling. We prove that GCDF preserves Euclidean-like local distance structure and accurately encodes whole-body geometry in configuration space, and develop a data generation and training pipeline that yields continuous neural GCDFs with accurate values and gradients, supporting efficient GPU-batched queries. Building on this representation, we develop a high-performance sequential convex optimization framework centered on GCDF-based collision reasoning. The solver scales to large numbers of implicit constraints through (i) online specification of neural constraints, (ii) sparsity-aware active-set detection with parallel batched evaluation across thousands of constraints, and (iii) incremental constraint management for rapid replanning under scene changes.
title Fast and Safe Trajectory Optimization for Mobile Manipulators With Neural Configuration Space Distance Field
topic Robotics
url https://arxiv.org/abs/2601.18548