FOCI: Trajectory Optimization on Gaussian Splats

Fuente: arXiv
Saved in:
Bibliographic Details
Main Authors: Andreu, Mario Gomez, Wilder-Smith, Maximum, Klemm, Victor, Patil, Vaishakh, Tordesillas, Jesus, Hutter, Marco
Format: Preprint
Published: 2025
Subjects:
Online Access:
Tags: Add Tag
No Tags, Be the first to tag this record!
_version_ 1866916870338117632
author Andreu, Mario Gomez
Wilder-Smith, Maximum
Klemm, Victor
Patil, Vaishakh
Tordesillas, Jesus
Hutter, Marco
author_facet Andreu, Mario Gomez
Wilder-Smith, Maximum
Klemm, Victor
Patil, Vaishakh
Tordesillas, Jesus
Hutter, Marco
contents 3D Gaussian Splatting (3DGS) has recently gained popularity as a faster alternative to Neural Radiance Fields (NeRFs) in 3D reconstruction and view synthesis methods. Leveraging the spatial information encoded in 3DGS, this work proposes FOCI (Field Overlap Collision Integral), an algorithm that is able to optimize trajectories directly on the Gaussians themselves. FOCI leverages a novel and interpretable collision formulation for 3DGS using the notion of the overlap integral between Gaussians. Contrary to other approaches, which represent the robot with conservative bounding boxes that underestimate the traversability of the environment, we propose to represent the environment and the robot as Gaussian Splats. This not only has desirable computational properties, but also allows for orientation-aware planning, allowing the robot to pass through very tight and narrow spaces. We extensively test our algorithm in both synthetic and real Gaussian Splats, showcasing that collision-free trajectories for the ANYmal legged robot that can be computed in a few seconds, even with hundreds of thousands of Gaussians making up the environment. The project page and code are available at https://rffr.leggedrobotics.com/works/foci/
format Preprint
id arxiv_https___arxiv_org_abs_2505_08510
institution arXiv
publishDate 2025
record_format arxiv
spellingShingle FOCI: Trajectory Optimization on Gaussian Splats
Andreu, Mario Gomez
Wilder-Smith, Maximum
Klemm, Victor
Patil, Vaishakh
Tordesillas, Jesus
Hutter, Marco
Robotics
3D Gaussian Splatting (3DGS) has recently gained popularity as a faster alternative to Neural Radiance Fields (NeRFs) in 3D reconstruction and view synthesis methods. Leveraging the spatial information encoded in 3DGS, this work proposes FOCI (Field Overlap Collision Integral), an algorithm that is able to optimize trajectories directly on the Gaussians themselves. FOCI leverages a novel and interpretable collision formulation for 3DGS using the notion of the overlap integral between Gaussians. Contrary to other approaches, which represent the robot with conservative bounding boxes that underestimate the traversability of the environment, we propose to represent the environment and the robot as Gaussian Splats. This not only has desirable computational properties, but also allows for orientation-aware planning, allowing the robot to pass through very tight and narrow spaces. We extensively test our algorithm in both synthetic and real Gaussian Splats, showcasing that collision-free trajectories for the ANYmal legged robot that can be computed in a few seconds, even with hundreds of thousands of Gaussians making up the environment. The project page and code are available at https://rffr.leggedrobotics.com/works/foci/
title FOCI: Trajectory Optimization on Gaussian Splats
topic Robotics
url https://arxiv.org/abs/2505.08510