Paper deep dive
From Distances to Trajectories: Real-Time Signed Distance Function Mapping and Distance-Accelerated Motion Planning for UAVs
Jason Stanley, Zhirui Dai, Qihao Qian, Tzu-Chin Ho, Tianxing Fan, Siddharth Saha, Christopher Barngrover, Ki Myung Brian Lee, Nikolay Atanasov
Intelligence
Status: succeeded | Model: Gemma-4-26B-A4B | Prompt: intel-v1 | Confidence: 92%
Last extracted: 7/25/2026, 1:39:45 AM
Summary
This paper presents a unified framework for real-time autonomous UAV navigation in cluttered environments by co-designing mapping and motion planning around a Signed Distance Function (SDF) representation. The authors introduce Octree REsidual Network (OREN), a hybrid method combining explicit octree priors with implicit neural residuals to reconstruct accurate, differentiable SDFs from point clouds. Complementing this, they propose Bubble*, a search-based planner that exploits SDF distance information to grow maximal collision-free spheres (bubbles), forming a safe corridor for trajectory optimization. The integrated approach demonstrates significant improvements in SDF estimation accuracy and planning speed compared to baselines, enabling real-time flight on resource-constrained hardware.
Entities (10)
Relation Signals (10)
OREN → produces → Signed Distance Function
confidence 98% · OREN... reconstruct SDFs online from point cloud observations
OREN → uses → Neural Network
confidence 95% · OREN pairs an explicit octree prior with an implicit neural residual
Bubble* → uses → Signed Distance Function
confidence 95% · Bubble*, a search-based planner that exploits the distance information
OREN → uses → Octree
confidence 95% · OREN pairs an explicit octree prior with an implicit neural residual
OREN → improves → SDF Estimation
confidence 90% · OREN improves SDF estimation by 22% compared to baselines
Bubble* → produces → Safe Corridor
confidence 90% · returns a bubble sequence that forms a safe corridor for trajectory optimization
UAV → uses → Bubble*
confidence 90% · demonstrate the integrated OREN-Bubble* approach onboard a quadrotor
UAV → uses → OREN
confidence 90% · demonstrate the integrated OREN-Bubble* approach onboard a quadrotor
Bubble* → optimizes →
Cypher Suggestions (0)
No Cypher suggestions yet.
Abstract
Abstract:Autonomous flight in cluttered environments requires a robot to build a geometric map of its surroundings and plan safe, dynamically feasible trajectories, all onboard and in real time. Conventional approaches treat mapping and planning as separate stages and often rely on binary occupancy for collision checking. We argue that these two stages should be co-designed around a single representation: a signed distance function (SDF). By encoding distance to the nearest obstacle, an SDF provides richer information for planning and trajectory optimization than occupancy alone. We develop an Octree REsidual Network (OREN) that pairs an explicit octree prior with an implicit neural residual to reconstruct SDFs online from point cloud observations with the efficiency of volumetric methods and the accuracy and differentiability of neural methods. In tandem, we develop Bubble$^\star$, a search-based planner that exploits the distance information to grow maximal collision-free balls, which we call bubbles, with formal guarantees of termination, completeness, and failure detection. Planning over a graph of bubbles significantly reduces collision checks compared to a grid-based A$^\star$ search and returns a bubble sequence that forms a safe corridor for trajectory optimization. We demonstrate the integrated OREN-Bubble$^\star$ approach onboard a quadrotor, navigating unseen indoor environments in real time under tight compute constraints. OREN improves SDF estimation by $22$% compared to baselines, while Bubble$^\star$ finds trajectories spanning $\approx 90$ m through a cluttered environment in $1$-$3$ sec., whereas baselines take up to $10$ sec. in the same environment.
Tags
Links
- Source: https://arxiv.org/abs/2607.19306v1
- Canonical: https://arxiv.org/abs/2607.19306v1
Trouble viewing inline? Open PDF directly →
Full Text
114,476 characters extracted from source content.
Expand or collapse full text
[1] 0009-0002-5425-4834 authors contributed equally to this work. [1] 0000-0001-8362-3796 authors contributed equally to this work. 1] and Computer Engineering Department, San Diego, 9500 Gilman Dr, Jolla, 92093, , 2] AI, 600 W Broadway Suite #600, Diego, 92101, , From Distances to Trajectories: Real-Time Signed Distance Function Mapping and Distance-Accelerated Motion Planning for UAVs jtstanle@ucsd.edu zhdai@ucsd.edu 0009-0005-7286-9084 q2qian@ucsd.edu -Chin 0009-0002-8051-1072 tzh005@ucsd.edu 0009-0003-0820-7735 t2fan@ucsd.edu Myung Brian 0000-0003-1449-2125 kmblee@ucsd.edu 0000-0003-0272-7580 natanasov@ucsd.edu [ [ Abstract Autonomous flight in cluttered environments requires a robot to build a geometric map of its surroundings and plan safe, dynamically feasible trajectories, all onboard and in real time. Conventional approaches treat mapping and planning as separate stages and often rely on binary occupancy for collision checking. We argue that these two stages should be co-designed around a single representation: a signed distance function (SDF). By encoding distance to the nearest obstacle, an SDF provides richer information for planning and trajectory optimization than occupancy alone. We develop an Octree REsidual Network (OREN) that pairs an explicit octree prior with an implicit neural residual to reconstruct SDFs online from point cloud observations with the efficiency of volumetric methods and the accuracy and differentiability of neural methods. In tandem, we develop Bubble⋆, a search-based planner that exploits the distance information to grow maximal collision-free balls, which we call bubbles, with formal guarantees of termination, completeness, and failure detection. Planning over a graph of bubbles significantly reduces collision checks compared to a grid-based A⋆ search and returns a bubble sequence that forms a safe corridor for trajectory optimization. We demonstrate the integrated OREN-Bubble⋆ approach onboard a quadrotor, navigating unseen indoor environments in real time under tight compute constraints. OREN improves SDF estimation by 2222% compared to baselines, while Bubble⋆ finds trajectories spanning ≈90≈ 90 m through a cluttered environment in 11–33 sec., whereas baselines take up to 1010 sec. in the same environment. keywords: Signed Distance Function, Implicit Representation, Motion Planning, Unmanned Aerial Vehicle, Autonomous Flight 1 Introduction Autonomous flight in unknown environments requires an unmanned aerial vehicle (UAV) to build a map of its surroundings and to plan safe, dynamically feasible motion through it, all onboard and in real time from streaming sensor data. This capability underpins many applications of aerial robotics, including inspection, delivery, and search and rescue, where UAVs must navigate safely and efficiently. Conventionally, mapping and planning are treated as two separate stages connected by a binary occupancy map. The planner queries the map to test for collisions at each robot configuration, disregarding distance and gradient information that a richer distance-based representation could provide. We argue that the two stages can instead be co-designed around a signed distance function (SDF) representation, exploiting the distance information to reduce the collision checking operations, accelerate the planning, and provide constraints for trajectory optimization. Accurate environment representations are essential across the robot autonomy stack, including in simultaneous localization and mapping [44, 46, 56], navigation [43, 32], and manipulation [29, 26, 27, 3]. SDF representations are particularly well suited to serve both mapping and planning. Given a query point, an SDF returns the signed distance to the nearest surface, with the sign indicating whether the query lies in free (positive) or occupied (negative) space. It captures obstacle surfaces implicitly as its zero-level set [47], while simultaneously providing clearance to the nearest obstacle. To be useful in aerial autonomy, an SDF must be built and queried quickly from streaming observations, keeping a small memory footprint and remaining accurate under a tight onboard computational budget. However, existing SDF methods rarely meet all these requirements at once. (a) (b) Figure 1: We consider integrated mapping and planning for autonomous UAV flight. We develop OREN to reconstruct accurate Euclidean SDF online from streaming point clouds and Bubble⋆ to plan safe flight corridors exploiting the distance information. (a) The color map shows distance to the nearest surface (large to small), and the planned safe corridor (composed of cyan balls). (b) OREN and Bubble⋆ running onboard a quadrotor equipped with a Jetson Orin NX. In this paper, we present a unified approach for mapping and planning for aerial robots, built around non-truncated SDF (Fig. 1). Our method reconstructs SDF from point cloud measurements onboard a UAV and enables efficient distance-aware motion planning and trajectory optimization with safety and dynamic-feasibility guarantees. We extend our prior conference paper, Dai, Qian . [6], which introduced an Octree REsidual Network (OREN) for SDF mapping, combining an explicit prior from octree interpolation with implicit neural features decoded into a correction of the prior. To construct the prior, we use an octree with distance and gradient estimates stored at the octant vertices and gradient-augmented interpolation to compute SDF at arbitrary query positions. We correct the prior with a neural network residual, which recovers fine details of the observed surface from implicit features. Given an SDF model of the environment, the second challenge is turning it into safe, dynamically feasible UAV trajectories. Commonly, this is done by first planning a collision-free path, e.g., via A⋆ or RRT [15, 20], then constructing a safe corridor of overlapping convex regions around the path [31], and finally optimizing a dynamically feasible trajectory inside the corridor [62]. Bubble Planner [48], a representative work, finds a path via search, grows a receding corridor of spheres around it, and optimizes a trajectory through the corridor. We observe that with SDF, the path search and the corridor construction need not be separate stages because the distance at any point already defines a maximal collision-free ball around it, which we call a bubble. We develop Bubble⋆, a motion planning algorithm that constructs a graph of bubbles from SDF queries to plan a safe bubble corridor. We establish formal guarantees of termination, completeness, and failure detection under mild clearance assumptions, then optimize a dynamically feasible trajectory within the corridor using MINCO [62], a minimum-control-effort polynomial parameterization. Because Bubble⋆ reads signed distances directly from OREN, mapping and planning share a single representation, requiring far fewer collision checks than grid-based A⋆. In our experiments, OREN improves SDF estimation by 2222% over baseline methods and runs efficiently enough for real-time deployment onboard a UAV, while Bubble⋆ finds trajectories ≈90≈ 90 m long through a cluttered environment in 11–33 sec., versus up to 1010 sec. for existing methods. In summary, our work makes the following contributions. • We develop OREN, a mapping approach that uses an explicit octree prior and implicit neural correction to reconstruct accurate, differentiable, non-truncated SDF in real time. • We propose Bubble⋆, a search-based planner that exploits an SDF map to construct a graph of collision-free spheres (bubbles), unifying path search and safe-corridor construction into a single algorithm. We provide formal guarantees of termination, completeness, and failure detection, and perform trajectory optimization within the bubble corridor to produce dynamically feasible UAV trajectories. • We compare our methods to mapping and planning baselines and demonstrate the complete approach in real-world autonomous quadrotor flight in unknown environments. 2 Related Work This section reviews existing methods for SDF reconstruction and integrated mapping and planning for aerial robots. 2.1 SDF Reconstruction Methods for learning SDFs fall into three broad groups: volumetric, Gaussian Process (GP), and neural network. Volumetric methods [4, 42, 21, 43, 13, 45, 38] fuse observations into a regular grid using voxel hashing for efficient updates and queries. Voxblox [43] builds a TSDF layer from projective distance, then propagates it to an SDF layer via breadth-first search (BFS). Both steps introduce errors that subsequent works [13, 45] reduce by using non-projective distance and replacing BFS path length with distance to the nearest oriented surface point. Nonetheless, these representations are discrete, non-differentiable, and hard to scale to large scenes. In comparison, OREN learns a continuous, differentiable SDF in real time, with low memory usage that scales to large scenes. OREN first estimates an SDF prior from explicit discrete priors stored in an octree, then uses implicit neural features to predict residuals that correct the prior, forming a compact, differentiable representation of continuous SDF. Gaussian Process (GP) methods [24, 63, 64, 5] learn continuous fields supporting gradient computation and uncertainty quantification. GP implicit surface (GPIS) [24] iteratively estimates oriented surface points and regresses SDF online, learning the surface implicitly as the SDF’s zero-level set. GPIS is accurate near the surface but fails to extrapolate away from it, since training data comes only from near-surface points and distant queries fall back to the zero-mean prior. Based on the connection between the heat equation and the unsigned distance function (UDF) [58], Log-GPIS [63] learns globally-generalized unsigned distances in log space. VDB-GPDF [64] extends this log-GP technique to jointly learn surface estimation and UDF, using OpenVDB [41] for memory efficiency. However, both methods omit the sign and struggle to scale to large scenes on resource-constrained platforms due to the cubic complexity of matrix inversion during training. In comparison, OREN computes the prior via O(1)O(1) trilinear interpolation in the octree and the residual via matrix multiplication, roughly O(n2)O(n^2) for n hidden dimensions, while using less memory than GP. Neural network methods are attractive for their native speed on GPUs. DeepSDF [47] showed that neural networks can learn continuous implicit SDFs, inspiring many follow-up works. iSDF [44] learns SDF incrementally with Eikonal regularization. NeuS [60] jointly learns SDF and radiance fields [37]. Gropp . [12], Takikawa . [55] refine the network architecture and loss designs. These methods learn accurate SDF near the surface, which suffices for surface reconstruction, but rarely far from it. HotSpot [61] learns non-truncated SDF but is only verified at the object level and requires extensive data and training. Recent work develops promising hybrid models that combine an explicit geometric structure with implicit neural features. PIN-SLAM [46] stores neural features in near-surface voxels and decodes the SDF from nearby features, while H2H_2-Mapping [19] combines an octree-based SDF prior with a neural residual. However, both methods learn only truncated SDF. HIO-SDF [59] removes truncation by training on global priors from Voxfield [45], but inherits the volumetric method’s limited accuracy, and over-smoothes as the scene grows due to fixed network capacity. In contrast, our method, OREN, builds an extendable semi-sparse octree that stores SDF values and gradients to efficiently capture the SDF of the whole space as the environment grows. Through gradient-augmented interpolation, OREN produces more accurate SDF priors, leaving more capacity for the subsequent neural network to recover surface detail from implicit features. Furthermore, the loss function is designed to encourage the network to learn accurate SDF far from the surface, which is critical for planning, and enables faster convergence than existing methods, allowing OREN to run in real time on a UAV. 2.2 Integrated Mapping and Planning for Aerial Robots Motion planning for quadrotors involves local trajectory optimization and, most often, global path planning, both relying on differential flatness [36, 9]: the property that a dynamical system’s full states and controls can be computed analytically from a reduced state, the flat output, and its derivatives up to the relative degree. Quadrotor dynamics are differentially flat, with 3D position and yaw as flat outputs of relative degree four: all quadrotor states (e.g., orientation) and controls (e.g., thrust) can be computed analytically from up to the fourth derivatives of position and yaw [36], even with drag [9]. Thus, planning methods need only produce a position trajectory that is at least four times differentiable, and optionally yaw, without considering the full dynamics. Mapless local trajectory optimization methods plan directly from observations to avoid obstacles, trading global optimality for fast computation. Song . [52] achieve high-speed drone racing by using reinforcement learning to generate trajectories from a single image, treating planning as a black box. Jacquet . [17] take a grey-box approach, learning a network that converts a depth image to a local SDF for local nonlinear model-predictive control (NMPC). All these methods share a limited field of view, risking dead-end failures. Ji . [18] partially mitigate this by efficiently storing sensor history. Since they do not rely on a map, these methods often lack formal guarantees of optimality, leading to local optima. Global planning methods store obstacle information in a map and plan safe paths against it. Global motion planning is dominated by search-based algorithms, e.g., A⋆ [15], and sampling-based ones, e.g., RRT [23] and its asymptotically optimal variant RRT⋆ [20]. Sampling-based methods are widely used, e.g., in OMPL [54], with quadrotor examples by Gao . [11], Funk . [10]. Because they rely on random sampling, their completeness and optimality guarantees are only probabilistic or asymptotic. In contrast, search-based methods operate on regular grids or state lattices [28], guaranteeing deterministic (resolution-)completeness or optimality, albeit confined by the chosen resolution. S. Liu, Watterson . [31], Dharmadhikari . [8] use search-based methods for quadrotor navigation. Our approach mitigates this cost-versus-speed trade-off in resolution choice by building safe bubbles from clearance information, obviating collision checking within them. Both search-based and sampling-based planners can be either geometric or kinodynamic. Geometric planners produce a sequence of waypoints, assuming any pair of waypoints is achievable, whereas kinodynamic planners account for kinematic or dynamic constraints by requiring a valid motion between waypoints. To plan dynamically feasible quadrotor trajectories, one can either 1) use a geometric planner followed by trajectory optimization to track the resulting waypoints, or 2) use a single kinodynamic planner directly. Kinodynamic planning may appear simpler, as it uses a single planner. LaValle Kuffner [23] originally designed RRT for kinodynamic planning. However, Richter . [50] show that for real quadrotors, full kinodynamic planning performs worse than combining geometric planning with trajectory optimization, due to its additional computation. Allen Pavone [2] speed up real-time sampling-based kinodynamic planning by introducing a learned reachability classifier between states. Meanwhile, Mueller . [40] present efficient methods for computing motion primitives: a library of trajectories used to connect states during planning. S. Liu, Atanasov . [30] use such motion primitives in a search-based kinodynamic planner, showing they discretize the state space into a lattice suitable for efficient search. Zhou . [66] improve search-based planning with continuous optimization, and Ryll . [51] present a receding-horizon variant for unknown environments. To handle state uncertainty alongside dynamic feasibility, Agha-Mohammadi . [1], Majumdar Tedrake [33] plan between distributions rather than states, composing feedback controllers to reach one distribution from another. Our approach is most similar to Richter . [50], combining a geometric planner with subsequent trajectory optimization. However, our geometric planner composes collision-free regions, leaving room for dynamic feasibility while ensuring collision avoidance. Safe corridor methods, such as Deits Tedrake [7], S. Liu, Watterson . [31], Ren . [48], Z. Wang . [62], Tordesillas How [57], K.M.B. Lee . [25], similarly find a sequence of collision-free regions (safe corridors). These methods are popular for quadrotor navigation because they greatly accelerate trajectory optimization, making them suitable for onboard and even GPS-denied navigation [39]. Most safe corridor methods first plan a geometric path, then expand convex regions around the waypoints. S. Liu, Watterson . [31] first introduce safe corridors: overlapping collision-free polyhedra expanded around a path found via jump point search [14] on an OctoMap [16], with an optimal continuous trajectory found via quadratic programming (QP). Z. Wang . [62] accelerate optimization by introducing a closed-form trajectory parameterization enabling unconstrained optimization within safe corridors. Subsequent approaches [49, 48] speed computation using lighter local maps instead of an OctoMap. In particular, Ren . [48] build an efficient KD-Tree for proximity queries and use clearance information to build spherical bubbles along a geometric path. Our approach also builds spherical bubbles from clearance but directly searches for a sequence of them. In contrast to inflating corridors around a pre-computed path, few recent methods directly search for a sequence of corridors. Graph-of-convex-sets formulations [35, 34] jointly optimize corridor choice and the trajectory within them via mixed-integer optimization. However, these methods require a known corridor set, and mixed-integer optimization can be expensive. In aerial robotics, Gao . [11] search for a sequence of spherical corridors using a modified RRT⋆, enabling high-speed LiDAR-based navigation. Similarly, Funk . [10] find convex regions via RRT search with collision-checking against a multi-resolution SDF grid built from visual sensors [22]. Our prior work, K.M.B. Lee . [25], used a sampling-based formulation that first covers free space with a graph of bubbles and searches it via Dijkstra’s shortest-path algorithm. Here, we use a search-based formulation that improves efficiency by interleaving the graph construction and the search and by biasing the search towards the goal via a heuristic function, similarly to A⋆. Figure 2: Overview of OREN: a) We keep key frames with small overlap and those that maximize the surface coverage for training; b) with the selected key frames and the current frame, we generate three types of samples: surface points, perturbed points around the surface, and free-space points; c) to predict SDF, we first obtain an SDF prior dga()d_ga(v) with gradient-augmented interpolation in a semi-sparse octree, where each octant vertex has estimated SDF value and gradient; d) we also obtain an implicit neural feature for v by trilinear interpolation of implicit features stored at the voxel’s vertices, which is fed into an MLP decoder to obtain an SDF residual correction δd() _d(v), and another MLP decoder to predict occupancy; e) the SDF prior dga()d_ga(v) and the SDF residual δd() _d(v) are combined as the final SDF prediction d^()=dga()+δd() d(v)=d_ga(v)+ _d(v), and the parameters are trained with five loss functions: reconstruction loss, Eikonal loss, projection loss, occupancy loss and sign consistency loss. 3 Problem Statement Consider a 3D environment ℛ⊂ℝ3R ^3 with obstacles represented as a subset Ω⊂ℛ . The SDF d:ℝ3→ℝd:R^3 of Ω is defined as the shortest distance from any point ∈ℝ3v ^3 to the obstacle surface ∂Ω∂ , with a sign indicating whether v is inside or outside of Ω : d()=min∈∂Ω‖−‖2,∉Ω,−min∈∂Ω‖−‖2,∈Ω.d(v)= cases + _y∈∂ \|v-y \|_2,&v ∈ ,\\ - _y∈∂ \|v-y \|_2,&v∈ . cases (1) The SDF satisfies two key properties: 1) the obstacle surface is encoded as the zero-level set, d()=0d(v)=0, ∀∈∂Ω ∈∂ ; and 2) the gradient of d()d(v) is the unit vector pointing away from the nearest surface point and satisfies an Eikonal equation [44]: ∇d()=−∗d(),‖∇d()‖2=1,a.e.,∇ d(v)= v-v_*d(v), \|∇ d(v) \|_2=1,\;a.e., (2) where ∗∈argmin∈∂Ω‖−‖2v_*∈ _y∈∂ \|v-y \|_2. We consider a quadrotor robot, equipped with a range sensor (e.g., LiDAR or depth camera), operating in the environment. Given a stream of point clouds tP_t, our objective is to: 1) obtain an estimate d^:ℝ3→ℝ d:R^3 of the SDF of Ω and 2) plan a safe dynamically feasible trajectory for the robot. Let =(,,R,)∈:=ℝ3×ℝ3×SO(3)×ℝ3x=(p, ν,R, ω) :=R^3×R^3× SO(3)×R^3 be the quadrotor state, consisting of its position p and velocity ν in the inertial frame, orientation R∈SO(3)R∈ SO(3), and body angular velocity ω. Given control input =(F,)∈ℝ×ℝ3u=(F, τ) ×R^3, including the collective motor thrust F and body torque τ, the quadrotor dynamics are: ˙=()+()=˙=,¨=−g3+1mRF3,R˙=R^,˙=J−1(−^J), x\!=\!f(x)+G(x)u=\! cases p= ν,\\ p=-g\,e_3+ 1mRFe_3,\!\!\!\\ R=R\, ω,\\ ω=J^-1( τ- ωJ ω), cases (3) where m is the mass, J is the inertia matrix, 3=(0,0,1)⊤e_3=(0,0,1) , g is the gravitational acceleration, and ω is a skew-symmetric matrix formed from ω. The quadrotor dynamics (3) are differentially flat [36, 62]; there exists a flat output z such that the state and control can be expressed as algebraic functions of z and k of its derivatives, =Ψ(,˙,…,(k−1)),=Ψ(,˙,…,(k)).x= _x(z, z,…,z^(k-1)),\;u= _u(z, z,…,z^(k)). For a quadrotor, the flat output =(,ψ)z=(p,ψ) consists of its position p and yaw angle ψ. The state x and control u can be recovered from derivatives of the flat output up to order k=4k=4 with Ψ _x and Ψ _u known in closed form [36]. The yaw ψ can be determined separately, e.g., along the velocity direction, so motion planning reduces to designing a continuous position trajectory :[0,T]→ℝ3p:[0,T] ^3 from a start sp_s to a goal gp_g that remains collision-free and respects the vehicle dynamics. We express this as a trajectory optimization problem: min(⋅),T _p(·),\,T ∫0T‖(4)(t)‖22t+ρT _0^T\|p^(4)(t)\|_2^2\,dt+ρ\,T (4) s.t. (0)=s,(T)=g, (0)=p_s, (T)=p_g, d^((t))≥r,∀t∈[0,T], d(p(t))≥ r, ∀ t∈[0,T], ‖˙(t)‖2≤vmax,∀t∈[0,T], \| p(t) \|_2≤ v_ , ∀ t∈[0,T], ‖¨(t)‖2≤amax,∀t∈[0,T], \| p(t) \|_2≤ a_ , ∀ t∈[0,T], where the objective minimizes the trajectory snap ‖(4)‖22\|p^(4)\|_2^2 with ρ>0ρ>0 trading off smoothness against duration. In the constraints, r>0r>0 is a safety radius accounting for the robot size and errors in the SDF estimate d d, while vmaxv_ and amaxa_ are velocity and acceleration bounds. In summary, we consider an integrated mapping and planning problem. Given point cloud measurements, we estimate the SDF d d and plan a dynamically feasible trajectory (t)p(t) from the current robot position sp_s to a desired goal gp_g that maintains clearance d^((t))≥r d(p(t))≥ r for all t∈[0,T]t∈[0,T]. 4 Octree Residual Network for SDF Mapping We first focus on reconstructing the SDF in (1) from streaming point cloud measurements. We develop OREN, a hybrid model that combines an explicit octree prior with an implicit neural correction. We present an overview of OREN in Fig. 2. An octree data structure stores explicit SDF and gradient estimates, from which a coarse SDF prior is obtained by gradient-augmented interpolation (Sec. 4.1). To recover the geometric details that the octree resolution cannot capture, implicit neural features are stored at the octant vertices and are decoded by an MLP into a residual correction of the prior (Sec. 4.2). We also decode the implicit features with a second MLP to predict occupancy, which is used to supervise the SDF sign during online training and improve the robustness to sensor noise. The resulting non-truncated SDF estimate d d can subsequently be used in the UAV trajectory optimization problem in (4). 4.1 SDF Prior From Octree Interpolation OREN computes the SDF prior through interpolation of SDF values and gradients stored in an octree with sparse and semi-sparse layers. This allows efficient storage compared to a dense, regular grid. Of the N layers of our octree, the first M layers are designed to be semi-sparse in the sense that all siblings of an occupied child octant are created regardless of occupancy. The remaining N−MN-M layers are sparse, where only child octants containing surface points are populated. This is illustrated in Fig. 2c. Each octant vertex kv_k, with k∈1,…,8k∈\1,…,8\, stores learnable estimates dk∈ℝd_k and k∈ℝ3g_k ^3 of the SDF d(k)d(v_k) and its gradient ∇d(k)∇ d(v_k), and vertices are shared across neighboring octants at different tree depths to save memory. The semi-sparse layers cost extra memory but yield a more accurate prior, especially for query positions away from the surface, because creating sibling octants places vertices closer to an arbitrary query v and reduces the interpolation discontinuities at octant boundaries that arise in a purely sparse octree [6]. Using a semi-sparse octree of resolution ℓ , for a query near the surface we can locate an octant no larger than ℓ×2N−M × 2^N-M, while for distant queries a large empty octant suffices for an accurate prior under the gradient-augmented interpolation described next. (a) (b) (c) (d) (e) (f) Figure 3: 2D visualization of interpolation with and without gradient augmentation for one (red region, top row) and four obstacles (red regions, bottom row). Gradient-augmented interpolation produces a better SDF prior (b) with smaller error (d). Empirically, positions where the SDF gradient is not well defined (large Hessian spectral norm), as shown in (f), have small interpolation error with gradient augmentation as shown in (d). To produce an accurate enough prior for the residual network to only capture fine details, we use gradient-augmented trilinear interpolation. At the smallest octant containing a query position v, we first extrapolate from each vertex kv_k: dk()=dk+k⊤(−k),k∈1,…,8,d_k(v)=d_k+g_k (v-v_k),\ k∈\1,…,8\, (5) and combine the extrapolations into the gradient-augmented (gaga) interpolation dga()=1γ∑k=18wkdk(),γ=∑k=18wk,d_ga(v)= 1γ _k=1^8w_kd_k(v),\ γ= _k=1^8w_k, (6) where wk=1/|diag(−k)|w_k=1/| *diag(v-v_k)| is the trilinear interpolation weight. Unlike regular trilinear interpolation, which ignores the stored gradients, the gradient-augmented form admits a tighter error upper bound; we present the derivation in Dai, Qian . [6]. Fig. 3 illustrates the benefit of gradient-augmented interpolation in 2D scenes with one and four obstacles. Each row shows the ground-truth SDF (a), the interpolation results with (b) and without (c) gradient augmentation, the corresponding errors (d, e), and the Hessian spectral norm of the SDF (f). Gradient-augmented interpolation produces smaller errors, as seen in Fig. 3(d) and 3(e), and the improvement grows with the number of obstacles. Although the SDF gradient is not well defined on the medial axes, where the Hessian spectral norm is large (Fig. 3(f)), gradient-augmented interpolation still attains small error there in practice (Fig. 3(d)). The prior dga()d_ga(v) is thus computed from a semi-sparse octree with learnable SDF and gradient estimates dkd_k and kg_k at each vertex, which are optimized jointly with the residual network. In the experiments, we use the octree configuration of Dai, Qian . [6], with N=8N=8 total octree layers with M=5M=5 semi-sparse layers, and a resolution of ℓ=10 =10 cm. 4.2 SDF Residual From Implicit Feature Decoding The accuracy of the SDF prior is limited by the octree resolution, so it lacks geometric detail. To achieve high fidelity, we learn a residual correction with a neural network R(dga(),;kk,β)R(d_ga(v),v;\f_k\_k,β) that composes octree feature interpolation ()=∑kwkkf(v)= _kw_kf_k, using implicit neural features k∈ℝFf_k ^F stored at the octree vertices, with an MLP decoder DSDF(d,();β)D_SDF(d,f(v);β). Each octant vertex is assigned a feature kf_k, initialized to zero and optimized together with the decoder weights β. Octree expansion automatically allocates more features to the near-surface regions as smaller octants are created, enabling continual learning as the sensor moves. As shown in Fig. 2d, for a query point v we locate the leaf octant containing it, interpolate the feature ()=∑k=18wkkf(v)= _k=1^8w_kf_k with the same weights wkw_k as in (6), and decode the SDF residual δd()=DSDF(dga(),();β) _d(v)=D_SDF(d_ga(v),f(v);β). The final SDF prediction combines the prior and the residual, d^()=dga()+δd(). d(v)=d_ga(v)+ _d(v). (7) In our experiments F=3F=3 and the MLP has two 32-dimensional hidden layers with LeakyReLU activations. Extending Dai, Qian . [6], we add a second decoder MLP Docc(();η)D_occ(f(v);η) to predict the occupancy log-odds l^()∈ℝ l(v) , a continuous value that can be converted to an occupancy probability as σ(l^())σ( l(v)), where σ(l):=(1+e−l)−1σ(l):=(1+e^-l)^-1 is the sigmoid function. Since σ(l)>12σ(l)> 12 if and only if l>0l>0, a positive prediction l^()>0 l(v)>0 indicates ∈Ωv∈ , and l^()<0 l(v)<0 indicates ∉Ωv ∈ . Unlike the SDF branch, which decodes a residual correction to the octree prior, the occupancy decoder predicts l^() l(v) directly from the interpolated features ()f(v), without a prior. The occupancy prediction l^() l(v) is used to supervise the SDF sign as a regularization term, which significantly improves the robustness to noise. The occupancy labels are obtained by ray-casting the depth measurements. Samples along the ray between the sensor and the measured surface, including samples perturbed to lie in front of the surface, are labeled free (o=0o=0), while samples perturbed to lie behind the surface are labeled occupied (o=1o=1). The sample at the measured surface receives o=0.5o=0.5, which places the decision boundary σ(l^)=12σ( l)= 12 on the surface, aligned with the zero level-set of the SDF. We jointly train the octree parameters θ=dk,k,kkθ=\d_k,g_k,f_k\_k and the decoder weights β and η online following Dai, Qian . [6], with the extension of adding loss terms ℒoccL_occ and ℒsign consist.L_sign consist. for learning occupancy and enforcing its consistency with the predicted SDF sign: ℒocc(l^,o) _occ( l,o) =BCE(σ(l^),o), =BCE (σ( l),o ), (8) ℒsign consist.(l^,d^) _sign consist.( l, d) =|l^|>τmax(0,sd^), = 1_| l|>τ (0,s d ), (9) where BCE(⋅,⋅)BCE(·,·) is the binary cross-entropy loss, o∈0,1o∈\0,1\ is the ground truth of occupancy (0: free, 1: occupied), s=sign(l^)s=sign ( l ), and τ>0τ>0 is a confidence margin such that only occupancy predictions with enough confidence are used. In our experiments, τ=3τ=3, corresponding to σ(τ)≈0.95σ(τ)≈ 0.95, and both loss terms enter the total training loss with unit weight. Fig. 2 summarizes OREN. A compact set of key frames is maintained so that it covers the observed surface with little overlap between adjacent frames (Fig. 2a). From these key frames and the current frame, we generate a dataset of points that are: 1) on the surface, 2) perturbed, and 3) in the free-space (Fig. 2b). With the generated dataset, the model is optimized with a combination of reconstruction, Eikonal, projection, sign consistency, and occupancy losses (Fig. 2e). We refer the reader to Dai, Qian . [6] for the key-frame criterion, the sampling scheme, and the definitions and hyperparameters of the remaining losses. The result is a continuously updated implicit map that returns accurate, non-truncated distance and gradient at any query point in the explored workspace. Its continuous clearance and Eikonal regularity (2) are precisely the properties Bubble⋆ exploits next, turning signed-distance queries directly into safe, dynamically feasible flight corridors. 5 Distance-Accelerated Motion Planning In this section, we consider motion planning and trajectory optimization given an SDF representation of the environment. In order to solve (4), we split the problem into two parts: first finding a sequence of bubbles to the goal via global search to minimize path length, followed by local trajectory optimization within the bubble corridor to minimize the objective in (4). Since an SDF representation provides information not only about occupancy but also about the distance to the nearest occupied space, it can be used to accelerate motion planning by reducing the number of collision checks within large free-space regions. We refer to the ball of free space indicated by an SDF query as a bubble and develop a new search-based motion planning algorithm, Bubble⋆, to plan a sequence of bubbles from the start to the goal. Bubble⋆ constructs a graph of nodes on a grid, each associated with a bubble, and edges that connect to the bubble boundaries (Sec. 5.1). Using a heuristic similar to A⋆, Bubble⋆ expands the most promising node at each step by adding the boundary nodes as successors (Sec. 5.2). We prove completeness of Bubble⋆ under a mild clearance assumption (Sec. 5.3). The overlapping bubbles along the recovered path form a safe corridor that we use for trajectory optimization (Sec. 5.4). 5.1 Bubble Graph Construction For planning, we discretize the 3D environment of Sec. 3 using grid resolution Δ>0 >0 and define the set of grid nodes :=Δℤ3∩ℛV:= ^3 , where ℤ3Z^3 is the integer lattice in 3D. For each node ∈p , we define the associated grid cell CΔ():=+[−Δ2,Δ2]3C_ (p):=p+ [- 2, 2 ]^3, and the set of all grid cells Δ:=CΔ()∣∈C_ :=\C_ (p) \. We denote by :=CΔ()∈Δ∣CΔ()∩Ω≠∅O:=\\,C_ (p) _ C_ (p)∩ ≠ \,\ the occupied cells, i.e., those whose region intersects an obstacle, and by ℱ:=Δ∖F:=C_ the free cells. The corresponding set of free grid nodes is free:=∈∣CΔ()∈ℱV^free:=\p C_ (p) \. The free region can be represented explicitly using the SDF reconstructed using OREN in Sec. 4. By computing the SDF d()d(c) at a node ∈freec ^free, we define an open ball of radius at least Δ2 2. We refer to this obstacle-free region around the node as a bubble and denote it as =(,d())B_c=B(c,d(c)), where: (,r):=∈ℝ3∣‖−‖2<r.B(c,r):=\p ^3 \|p-c \|_2<r\.\!\! (10) For the graph search over grid nodes, we use the free grid nodes that lie inside the bubble: ℬ=ℬ(,d()):=∩free.B_c=B(c,d(c)):=B_c ^free. (11) Figure 4: CalculateSuccessors: Each successor selects a parent in the current bubble according to the minimum cost-to-come and updates its cost. The OPEN set then contains both existing (blue) and new (orange) nodes. We define a graph over the free grid nodes freeV^free, in which each bubble connects the nodes it contains to the nodes on its boundary. The boundary nodes are characterized using the axis-aligned neighbors of a node: 6():=±Δi∈∣i∈1,…,3,N_6(p):=\p± _i i∈\1,…,3\\, (12) where ii=13\e_i\_i=1^3 are the standard basis vectors of ℝ3R^3. The successor set of a bubble collects the boundary nodes, those with at least one axis-aligned neighbor (12) lying outside the bubble, as illustrated in Fig. 4: S(ℬ)=∈ℬ|∃∈6() s.t. ∉ℬ.S(B_c)= \p _c\; |\; _6(p) s.t. q _c \.\!\!\! (13) Two nodes ,∈freep,q ^free are connected by an edge if some bubble (11) contains p and has q on its boundary. That is, ∈ℬp _c and ∈S(ℬ)q∈ S(B_c) for some ∈freec ^free. Every edge is collision-free: the bubble B_c (10) is obstacle-free and convex, so it contains the straight line segment between the two nodes. 5.2 Bubble⋆ Search Algorithm 1Algorithm Bubble⋆ (sp_s, gp_g, d(⋅)d(·), h(⋅)h(·)) 2 OPEN←sOPEN \p_s\, CLOSED←∅CLOSED 3 g(s)=0g(p_s)=0, g()=∞∀≠sg(p)=∞\ \ _s 4 while OPEN≠∅OPEN≠ do 5 ←argmin∈OPEN(g()+h())c *arg\,min_p (g(p)+h(p) ) 6 OPEN←OPEN∖OPEN OPEN \c\ 7 ℬ←ℬ(,d())B_c B(c,d(c)) 8 if =gc=p_g then 9 return PathTo(gp_g) 10 11 S←S(ℬ)S_c S(B_c) 12 if g∈ℬp_g _c then 13 S←S∪gS_c S_c∪\p_g\ 14 15 CalculateSuccessors(ℬB_c, S_c, OPEN, CLOSED) 16 foreach ∈ℬp _c with ∉Sp∉ S_c do 17 CLOSED←CLOSED∪CLOSED CLOSED∪\p\ 18 19 CLOSED←CLOSED∪CLOSED CLOSED∪\c\ 20 21 return failure 22 23 Procedure CalculateSuccessors(ℬB_c, S_c, OPEN, CLOSED) 24 foreach ∈Sj∈ S_c with ∉CLOSEDj do 25 ⋆←argmin∈OPEN∩ℬ(g()+‖−‖2)k *arg\,min_k _c (g(k)+ \|j-k \|_2 ) 26 gmin←g(⋆)+‖−⋆‖2g_ g(k )+ \|j-k \|_2 27 if g()>gming(j)>g_ then 28 g()←gming(j) g_ 29 Parent()←⋆Parent(j) k , Bubble()←ℬBubble(j) B_c 30 if ∈OPENj then 31 update priority of j 32 33 else 34 OPEN←OPEN∪OPEN OPEN∪\j\ 35 36 Procedure PathTo(p) 37 Path←Path \p\ 38 BubblePath←ℬ(,d())BubblePath \\,B(p,d(p))\,\ 39 40 current←current p 41 while Parent(current)Parent(current) exists do 42 Path←Path∪currentPath Path∪\current\ 43 BubblePath←BubblePath∪Bubble(current)BubblePath BubblePath∪\Bubble(current)\ 44 current←Parent(current)current Parent(current) 45 46 return Path.reverse(),BubblePath.reverse()\Path.reverse(),BubblePath.reverse()\ 47 Algorithm 1 Bubble⋆ Planner We present the Bubble⋆ planner in Algorithm 1, which performs a heuristic graph search over bubbles to compute a collision-free path from the start node sp_s to the goal node gp_g. The algorithm expands bubbles constructed from SDF clearance, allowing large collision-free regions to be explored efficiently. This greatly reduces the required number of collision checks compared to other search-based planners. Bubble⋆ maintains two sets of nodes: an OPEN set containing candidate successor nodes to be expanded, and a CLOSED set containing nodes whose associated bubbles have already been explored. Each node ∈freep ^free is associated with a cost-to-come value g()g(p), representing the minimum path length from the start to p, a parent pointer Parent()(p) recording the predecessor node used to reach p, and a bubble pointer, Bubble()Bubble(p), recording the bubble that contains the segment from p to Parent()(p). Analogous to an A⋆ search, the OPEN set is prioritized according to the sum of the cost-to-come and an optional heuristic estimate of the distance to the goal. At each iteration, Bubble⋆ selects the node ∈OPENc with minimum priority and constructs the corresponding bubble ℬ=ℬ(,d())B_c=B(c,d(c)) defined in (11), along with its successor set S=S(ℬ)S_c=S(B_c) in (13). We refer to this as expanding c. If =gc=p_g, the search terminates. Otherwise, if the goal lies within ℬB_c, it is appended to the current successor set S_c, so that the termination condition =gc=p_g holds in a future iteration. The CalculateSuccessors procedure in Algorithm 1 processes each successor ∈Sj∈ S_c: it selects the predecessor ⋆k among nodes inside ℬB_c that minimizes g()+‖−‖2g(k)+ \|j-k \|_2 and updates g()g(j), Parent()(j), and Bubble()(j) whenever this improves the cost-to-come. Interior nodes of ℬB_c and its center c are then marked as CLOSED. This procedure assigns each successor node of the new bubble a parent node according to Line 1 of Algorithm 1. The search terminates when the goal gp_g is drawn from the open set (success), or if the open set is empty (failure). In the successful case, the parent pointers are followed to reconstruct a sequence of overlapping bubbles connecting the start and goal, which is done in the PathTo procedure. If the OPEN set becomes empty before reaching the goal, the algorithm reports failure. Because the parent candidate ⋆k may be any OPEN node inside the bubble, the recovered path can skip intermediate nodes unlike A⋆. Bubble⋆ therefore produces any-angle paths in that the nodes on the path are connected through one straight segment if they belong to the same bubble. Therefore, the resulting paths are no longer than the shortest path restricted to the grid and are typically shorter. 5.3 Termination, Completeness, and Failure Detection We now establish formal guarantees for Bubble⋆: it always terminates, it returns a path whenever one with sufficient clearance exists, and it reports failure otherwise. Throughout, we use the fact that the search space is bounded by ℛR, so there are finitely many nodes V, and that the start and goal are free grid nodes, s,g∈freep_s,p_g ^free. We assume the heuristic h is consistent, i.e., h(g)=0h(p_g)=0 and h()≤‖−′‖2+h(′)h(p)≤ \|p-p \|_2+h(p ) for adjacent ,′p,p , which holds for the Euclidean distance h()=‖−g‖2h(p)= \|p-p_g \|_2 used in our experiments. Definition 1 (Clear grid path). Let freeV^free be a set of free nodes with resolution Δ . A grid path from sp_s to gp_g is a finite sequence (0,1,…,N)⊂free(p_0,p_1,…,p_N) ^free with 0=sp_0=p_s, N=gp_N=p_g, and j+1∈6(j)p_j+1 _6(p_j) for all j. It is clear if the distance d(j)≥1.5Δd(p_j)≥ 1.5 for every j. The adjacency condition makes the sequence a connected walk on the grid, while the 1.5Δ1.5 clearance ensures each node’s bubble contains all of its grid neighbors. Because the axis-aligned neighbors lie at distance Δ and bubbles are open balls, the radius must satisfy d(j)>Δd(p_j)> . Among the clearance values admissible under our grid-occupancy model, 1.5Δ1.5 is the smallest. The completeness proof below relies on this property. Theorem 1 (Termination). Bubble⋆ (Algorithm 1) terminates after finitely many iterations. Proof. The grid V is finite and each bubble is determined by its center, so there are finitely many bubbles. With a consistent heuristic, the cost-to-come g()g(c) is optimal when c is expanded [15], so each node is expanded at most once and is never reinserted into OPEN after entering CLOSED. Each iteration removes one node from OPEN and inserts finitely many successors, so after at most |||V| expansions OPEN is empty or the goal is returned. ∎ Theorem 2 (Completeness). If a clear grid path from sp_s to gp_g exists, then Bubble⋆ (Algorithm 1) returns a valid path. Proof. By Theorem 1, the search terminates, so it either returns a path or reports failure. Suppose, for contradiction, that it reports failure. Then, OPEN is empty at termination. Let (0,…,N)(p_0,…,p_N) be the clear grid path from the hypothesis, with 0=sp_0=p_s, N=gp_N=p_g, j+1∈6(j)p_j+1 _6(p_j), and d(j)≥1.5Δd(p_j)≥ 1.5 for all j. We prove by induction that every jp_j lies in some bubble expanded during the search. For the base case, 0=sp_0=p_s is placed in OPEN at initialization. Since OPEN is empty at termination, it was popped and its bubble expanded, so 0p_0 lies in an expanded bubble. For the inductive step, suppose jp_j lies in an expanded bubble ℬB_c. If jp_j is interior to ℬB_c, that is j∉S(ℬ)p_j∉ S(B_c), then by (13) all grid neighbors of jp_j, including j+1p_j+1, lie in ℬB_c. Otherwise jp_j lies on the boundary, j∈S(ℬ)p_j∈ S(B_c), and was inserted into OPEN. Since OPEN is empty, it was also popped and its own bubble ℬjB_p_j is expanded. Because d(j)≥1.5Δ>Δd(p_j)≥ 1.5 > and j+1p_j+1 is a grid neighbor at distance Δ , we have j+1∈ℬjp_j+1 _p_j. In either case j+1p_j+1 lies in an expanded bubble, completing the induction. In particular, the goal N=gp_N=p_g lies in some expanded bubble ℬB_c. The goal test g∈ℬp_g _c in Algorithm 1 then inserts gp_g into the successor set, so CalculateSuccessors inserts it into OPEN with finite cost. Since OPEN is empty at termination, gp_g must have been popped. When a node equal to gp_g is popped, the algorithm returns PathTo(g)(p_g). This contradicts the failure assumption, hence, Bubble⋆ returns a valid path. ∎ Corollary 1 (Failure detection). Bubble⋆ (Algorithm 1) reports failure in finite time and only when no clear grid path connects sp_s and gp_g. Proof. Since Theorem 1 shows termination in finite time and Theorem 2 shows completeness, it follows that if no path exists, the algorithm terminates with failure in finite time. ∎ 5.4 Trajectory Optimization Within Bubble Corridor Given the sequence of bubbles returned by Bubble⋆, we compute a trajectory to solve (4) that lies within the convex bubble corridor. Pairs of consecutive bubbles define a convex overlap region through which the trajectory may pass. These overlap regions provide a sequence of safe sets that constrain the trajectory while preserving sufficient freedom for optimization. Bubble Overlap Construction Bubble⋆ returns a sequence of bubbles (10) along the path, which we index as i:=(i,ri)B_i:=B(c_i,r_i) with centers i∈ℝ3c_i ^3 and radii ri:=d(i)>0r_i:=d(c_i)>0. Consecutive bubbles iB_i and i+1B_i+1 overlap by construction, since Bubble⋆ generates each bubble center inside its predecessor. Their intersection is a lens whose widest cross-section is a disk in the plane perpendicular to the line between centers i:=i+1−ia_i:=c_i+1-c_i. We use this disk as a convex safe set linking the two bubbles. Its offset along ia_i, center, and radius are: λi _i =12+ri2−ri+122‖i‖2, = 12+ r_i^2-r_i+1^22 \|a_i \|^2, (14) i _i =i+λii, =c_i+ _ia_i, ρi _i =ri2−λi2‖i‖2. = r_i^2- _i^2 \|a_i \|^2. Let i=i/‖i‖ ν_i=a_i/ \|a_i \| be the unit normal of the disk’s plane and Bi=[1i2i]∈ℝ3×2B_i= bmatrixe_1^i&e_2^i bmatrix ^3× 2 an orthonormal basis of that plane. With the center io_i and radius ρi _i from (14), the widest overlapping cross-section is the disk i _i =i+Bi∣∈ℝ2,‖2≤ρi =\\,o_i+B_iw ^2,\ \|w \|_2≤ _i\,\ (15) ⊂i∩i+1. _i _i+1. MINCO Trajectory Representation We build upon the MINCO representation [62], which parameterizes a piecewise polynomial trajectory using intermediate waypoints and segment durations. Let the trajectory consist of N polynomial segments. MINCO parameterizes the trajectory using spatial variables =ii=1N−1 ξ=\ ξ_i\_i=1^N-1 and temporal variables =τii=1N τ=\ _i\_i=1^N, which determine the intermediate waypoints and segment durations, respectively. These variables are mapped to physical waypoints =()q=q( ξ) and segment durations =()T=T( τ), and the optimal polynomial coefficients c are uniquely determined from (,)(q,T). The trajectory optimization problem is formulated as min,((),())s.t.i(i)∈i,∀i, _ ξ, τJ(q( ξ),T( τ)) .t. _i( ξ_i) _i,\;∀ i, (16) where J includes the minimum-snap and time penalties of (4) as well as corridor violation penalties. The dynamics constraints are penalized through the cost, following Z. Wang . [62]. The clearance constraint in (4) is enforced by shrinking the radii of all bubbles in the corridor by the required clearance r, and the rest of the constraints can be written naturally in the MINCO problem formulation, so the optimization is (4) restricted to the MINCO polynomial class. We design a smooth unconstrained parameterization that automatically satisfies the constraint of each waypoint lying within its corresponding overlap region of (15), i.e., i∈iq_i _i. Specifically, we map unconstrained variables i∈ℝ2 ξ_i ^2 to constrained waypoints iq_i as: i _i =Bii1+‖Bii‖2, = B_i ξ_i 1+ \|B_i ξ_i \|^2, (17) i _i =i+ρii. =o_i+ _iu_i. Segment durations must satisfy the positivity constraint Ti>0T_i>0. Following the temporal constraint elimination scheme of MINCO [62], we introduce unconstrained temporal variables τi∈ℝ _i and define the mapping: Ti=τi22+τi+1,τi>0,(12τi2−τi+1)−1,τi≤0,T_i= cases _i^22+ _i+1,& _i>0,\\ ( 12 _i^2- _i+1 )^-1,& _i≤ 0, cases (18) which ensures positivity while preserving differentiability. Gradients with respect to τi _i are computed using the chain rule in conjunction with the gradients provided by the MINCO formulation. Gradient-Based Optimization MINCO provides gradients of the cost function with respect to waypoints and durations, ∂/∂ / and ∂/∂ / . These gradients are propagated through the spatial parameterization using ∂i=Bi⊤ρi(αI3×3−αii⊤)∂i, ∂ ξ_i=B_i _i (α I_3× 3- _iu_i ) _i, (19) where α=(1+‖Bii‖2)−1/2α=(1+ \|B_i ξ_i \|^2)^-1/2. To improve convergence, we first prune the bubbles whose waypoints iq_i make no progress toward the goal, and initialize the remaining waypoints at the centers of their overlap regions io_i. The optimization then runs in two stages: 1. Optimize the spatial variables ξ with the durations τ fixed to obtain a collision-free geometric path. 2. Jointly optimize ξ and τ to obtain a dynamically feasible trajectory. This two-stage optimization produces smooth dynamically feasible trajectories through the sequence of bubbles from the Bubble⋆ algorithm. 6 Evaluation Our central claim is that combining OREN and Bubble⋆ yields an efficient integrated mapping, planning, and trajectory optimization approach for UAVs that runs fully onboard. To support this claim, we first show that OREN provides an accurate continuous SDF representation with sufficient computational efficiency to permit real-time operation in simulated large-scale environments. Our prior work [6] compares OREN extensively against SDF mapping baselines, and Sec. 6.1 summarizes those results. The key remaining comparison is against the mapping approaches commonly used in autonomous flight, and we evaluate OREN in four large simulated environments against OctoMap [16], a widely used mapping library for quadrotors (Sec. 6.2). Then, building on the SDF reconstruction from OREN, another set of experiments shows that Bubble⋆ is more efficient than grid-based A⋆ and sampling-based (RRT, RRT⋆) planners (Sec. 6.3). Finally, we evaluate our approach on a real quadrotor with a Jetson Orin NX computer to show that it runs efficiently and fully onboard (Sec. 6.4). 6.1 Comparison with SDF Mapping Methods In our conference paper [6], OREN is evaluated on Replica [53] and Newer College [65] datasets, in comparison with four baselines H2H_2-Mapping [19], PIN-SLAM [46], HIO-SDF [59] and Voxblox [43]. OREN generates mesh results of quality similar to the baselines’ for small indoor Replica scenes and synthesized depth data. However, on the large outdoor Newer College scene with real LiDAR measurements, OREN reconstructs a much better mesh, as shown in Table 1. On the Newer College dataset, OREN improves over the best baselines by 29–68% across all seven mesh metrics (Completion +36.2%+36.2\%, Completion Ratio +29.3%+29.3\%, Recall +33.5%+33.5\%, Precision +40.3%+40.3\%, F1 +37.0%+37.0\%, Chamfer-L1 +56.7%+56.7\%, Accuracy +68.3%+68.3\%), averaging ≈43.1%≈ 43.1\%. As for SDF metrics, OREN outperforms the baselines by a larger margin on both Replica and Newer College datasets. As shown in Table 2, OREN provides at least 15%15\% more accurate SDF than the baselines, which is an essential factor for the success of our Bubble⋆ planner. Table 1: Mesh reconstruction metrics with δ=20δ=20 cm on the Newer College dataset [65]. Metric OREN H2H_2-Mapping PIN-SLAM HIO-SDF Voxblox Completion [cm] ↓ 10.66 21.94 16.71 72.86 21.30 Completion Ratio [<δ<δ]% ↑ 94.20 61.58 72.83 10.05 60.31 Recall [<δ<δ]% ↑ 93.99 57.96 70.40 4.72 56.64 Precision [<δ<δ]% ↑ 90.69 52.97 64.63 4.46 51.84 F1 Score [<δ<δ]% ↑ 92.31 55.35 67.39 4.59 54.14 Chamfer-L1 Distance [cm] ↓ 9.36 28.40 21.64 422.29 23.37 Accuracy [cm] ↓ 8.07 34.86 26.58 771.72 25.44 Table 2: Average improvement of OREN over other SDF estimation methods (the best baseline for each scene and metric). SDF MAE is the MAE of the predicted signed distance, and Gradient MAE is the MAE of the angle between the predicted and ground-truth SDF gradients. Metric Region Avg. ↑ SDF MAE All 22.0% Near 34.5% Far 15.0% Gradient MAE All 35.5% Near 54.1% Far 29.9% 6.2 Mapping in Large Simulated Environments The comparisons in Sec. 6.1 establish OREN’s accuracy against dedicated SDF mapping methods on standard benchmarks. This section evaluates the performance of OREN in an online setting with data streaming from a UAV in large simulated environments. We build four simulation environments, a forest, an underground garage, an industrial site, and a warehouse, and simulate a quadrotor flying through each, carrying a single onboard depth camera and building the map online from the streaming point clouds. These scenes form our testbed for the mapping-and-planning approach. Here, we evaluate the map representation and Sec. 6.3 evaluates planning in the same environments. With our focus being on online deployment of autonomous robots, we compare against OctoMap [16], an occupancy-grid mapping method widely used on compute-constrained platforms. OREN matches OctoMap’s occupancy prediction quality at a comparable update rate while providing the continuous distances that accelerate planning while recovering visually better surface meshes. Table 3: Comparison of OREN and OctoMap on 44 simulated environments. Both methods are compared against a ground-truth surface point cloud. Env Method Precision Recall F1 Warehouse OREN 0.6720.672 0.8840.884 0.7640.764 OctoMap 0.7800.780 0.6290.629 0.6960.696 Garage OREN 0.8620.862 0.9110.911 0.8860.886 OctoMap 0.8880.888 0.8190.819 0.8520.852 Forest OREN 0.6520.652 0.9480.948 0.7730.773 OctoMap 0.9000.900 0.3840.384 0.5390.539 Industrial OREN 0.5560.556 0.9010.901 0.6880.688 OctoMap 0.7870.787 0.6460.646 0.7100.710 Table 3 reports occupancy prediction quality with the Precision, Recall, and F1 metrics common in the mapping literature [19, 46, 6], evaluated against the ground-truth surface point cloud. OREN achieves better or comparable results across the four environments while additionally providing distance information and gradients. Fig. 5 visualizes the reconstructed surface meshes side by side in each scene, the marching-cubes mesh of the zero level-set of OREN’s SDF and the faces of OctoMap’s occupied cells. OctoMap builds a discrete occupancy grid of the free and occupied voxels at a fixed resolution. OREN instead represents the scene as a continuous SDF that provides the signed distance and gradient at every point (Sec. 4.2). Throughout the evaluation, both the occupancy predictions and the reconstructed meshes are derived from the SDF estimate d d alone. The occupancy decoder could provide occupancy directly, but we choose to measure the representational power of the SDF itself, though the occupancy information is used during online training to improve the SDF training. Compared to OctoMap, OREN produces a more accurate and complete reconstruction of the scene, with fewer holes and artifacts. (a) Forest (b) Garage (c) Industrial (d) Warehouse Figure 5: Map representations compared across four large-scale simulated environments. In each pair, OREN (left) reconstructs a continuous SDF surface and OctoMap [16] (right) a discretized occupancy grid of the same scene. Each map is built online from a single depth camera on a simulated quadrotor flown through a sequence of fixed waypoints. Figure 6: Average mapping update rate (Hz) of OREN and OctoMap [16] across the four simulated environments. The depth camera streams at 3030 Hz (dotted line). Both run in real time. OctoMap is faster, as updating an occupancy grid is lighter than fitting an implicit field, whereas OREN provides the smooth, differentiable SDF that answers the distance queries Bubble⋆ depends on. The continuous SDF also carries richer information for planning. It encodes the distance to the nearest obstacle that Bubble⋆ uses for its efficiency and safety. This added information comes at only a modest expense in computation time. As Fig. 6 shows, OREN yields an update frequency comparable to OctoMap’s, only around 11 Hz slower in two of the four environments (warehouse and industrial), and 44–1010 Hz slower in the others (garage and forest). The map update rate (19.119.1–28.428.4 Hz) remains amenable to real-time operation. Compared to the benefit of the continuous distance information, we regard the increase in computation as a small price to pay, since it enables Bubble⋆, which OctoMap cannot. (a) (b) Figure 7: 2D search-efficiency comparison between Bubble⋆ and A⋆. (a) Representative paths in a 2D environment; SDF clearance lets Bubble⋆ take any-angle shortcuts that grid-restricted A⋆ cannot. (b) Runtime over 1000 randomly sampled start–goal pairs at several grid resolutions. Boxes span the interquartile range, the red line marks the median, and whiskers extend to the minimum and maximum. 6.3 Planning Evaluation We evaluate the efficiency of Bubble⋆ by the number of collision checks the planner issues and by the total planning time, and report path length and tracking error to verify that efficiency does not come at the cost of trajectory quality. We first isolate search efficiency in a controlled 2D comparison against grid-based A⋆, and then evaluate the complete planner in the 3D industrial and forest environments of Sec. 6.2 against grid-based (A⋆) and sampling-based (RRT, RRT⋆) baselines. Search Efficiency in 2D We first evaluate Bubble⋆ against A⋆ in a 2D environment shown in Fig. 7. A⋆ binarizes the same SDF to determine occupancy and expands one neighboring node at a time, whereas Bubble⋆ uses the SDF magnitude to grow collision-free bubbles and expands only at their boundaries. Both planners use the Euclidean distance to the goal, h()=‖−g‖2h(p)= \|p-p_g \|_2, as the heuristic. Over 10001000 trials at several resolutions, Bubble⋆ performs 9191–99%99\% fewer collision checks than A⋆ and finds a shorter or equal path in every case. Fig. 7(b) shows the runtime distribution, where Bubble⋆ is about an order of magnitude faster, with a wider gap at finer resolutions. (a) Planner trajectories (b) Bubble⋆ safe corridor Figure 8: Planning in the simulated industrial environment of Fig. 5(c), all on the same OREN SDF. (a) Representative trajectories from Bubble⋆ (red), A⋆ (orange), RRT (magenta), and RRT⋆ (black). (b) The Bubble⋆ safe corridor: overlapping bubbles (red) grown along the optimized trajectory, whose large, mutually overlapping clearance gives the optimizer ample room and keeps the optimization fast (Table 4). Table 4: Planning comparison in the simulated industrial and forest environments of Fig. 5. All planners operate on the same SDF map. Columns report the planning time (Search), the trajectory-optimization time (Opt.), their sum (Total), the path length (Path), the root-mean-square position error of the executed trajectory relative to the planned trajectory (RMSE), the number of overlapping bubbles forming the safe corridor (Bubbles), and their mean radius (Mean r). Bold marks the best value in each column and underline the second best, per environment. For the Bubbles and Mean r columns, which characterize the corridor handed to the trajectory optimizer, fewer bubbles and larger mean radius are better. Bubble⋆ attains the lowest total planning time in both environments while producing a compact high-clearance corridor. Env Planner Search (ms) Opt. (ms) Total (ms) Path (m) RMSE (m) Bubbles Mean r (m) Industrial Bubble⋆ 485485 523 1008 86.086.0 0.2910.291 82 1.081.08 A⋆ 223223 10051005 12281228 90.390.3 0.2970.297 164164 0.550.55 RRT 2 60686068 60696069 102.5102.5 0.3270.327 82 1.171.17 RRT⋆ 50795079 927927 60066006 85.485.4 0.3140.314 123123 0.690.69 Forest Bubble⋆ 298 34783478 3776 87.287.2 0.2740.274 311 0.300.30 A⋆ 466466 36873687 41524152 89.589.5 0.2650.265 341341 0.270.27 RRT 29312931 3056 59875987 90.190.1 0.2810.281 348348 0.270.27 RRT⋆ 50505050 53185318 1036810368 94.794.7 0.3240.324 328328 0.280.28 Planning in 3D Environments We compare Bubble⋆ in 3D environments against three baselines: grid-based A⋆ and the sampling-based RRT and RRT⋆ planners. To generate dynamically feasible trajectories for a quadrotor from the baselines, we place bubbles along the geometric paths found by the baseline planners, and use the same optimization routine as in Sec. 5.4. All planners use the same 3D SDF obtained using OREN. We evaluate on the industrial site and the forest scene environments from Sec. 6.2. A representative trajectory from each planner in the industrial scene is shown in Fig. 8(a), and quantitative metrics for both scenes are reported in Table 4. In the industrial environment, Bubble⋆ achieves the lowest total planning time (1.01.0 s) while matching the shortest path within 1%1\% (86.086.0 m vs 85.485.4 m by RRT⋆), well below A⋆ (90.390.3 m) and RRT (102.5102.5 m). The marginally shorter path by RRT⋆ is expected because RRT⋆ routes arbitrarily close to obstacles in continuous space, whereas Bubble⋆ searches on a grid with fixed resolution and keeps its trajectory inside high-clearance bubbles, trading a fraction of length for larger clearance margin. The two planning stages, search and optimization, trade off differently across the methods. A⋆ searches quickly (223223 ms) but the high number of bubbles created around the path (164164) leads to a dense cell corridor and slow trajectory optimization (10051005 ms). RRT finds a discrete path almost instantly (22 ms). However, because the path is jagged, it takes a long time (60686068 ms) to optimize a continuous trajectory within bubbles centered at the RRT path. RRT⋆ requires a stopping criterion for search, and we chose one that is based on finding a path shorter than Bubble⋆, but this causes RRT⋆ to spend most of its budget on search (5.15.1 s). Bubble⋆ keeps both stages low (485485 ms search, 523523 ms optimization). Tracking error is comparable across all planners, with Bubble⋆ achieving the lowest tracking error (0.2910.291 m), confirming that its corridor does not compromise dynamic feasibility. By construction, Bubble⋆ produces a corridor of overlapping safe regions, which keeps the subsequent trajectory optimization fast. The Bubbles and Mean r columns of Table 4 quantify this: Bubble⋆ covers its path with 8282 overlapping bubbles of mean radius 1.081.08 m (Fig. 8(b)), whereas A⋆’s dense cell path requires 164164 bubbles of roughly half the radius (0.550.55 m). Fewer and larger bubbles leave the optimizer more room around each waypoint and fewer convex regions to stitch together, which is why Bubble⋆ optimizes in 523523 ms against the 10051005 ms A⋆ requires. Larger bubbles alone are not sufficient, however: RRT attains an even larger mean radius (1.171.17 m) with the same bubble count, yet its randomly sampled path threads them along an irregular route and is the slowest of all to optimize (6.16.1 s). Bubble⋆ is the only method that pairs a compact, high-clearance corridor with a smooth underlying path, which keeps both its search and its optimization fast. This pattern still holds in the more cluttered forest environment. Bubble⋆ again attains the lowest total planning time (3.83.8 s) and produces the shortest path (87.287.2 m), with the most compact, highest-clearance corridor among the four planners (311311 bubbles at a 0.300.30 m mean radius). The sampling-based planners remain the most expensive: RRT⋆ spends over 1010 s across search and optimization, and both produce longer paths than Bubble⋆. Across both experiments, the efficiency of Bubble⋆ follows directly from the tight coupling between map and planner: by reading clearance straight from OREN’s non-truncated SDF map and expanding whole collision-free bubbles rather than testing occupancy cell by cell, it issues far fewer signed-distance/collision queries than A⋆ while preserving the safety and completeness guarantees (Sec. 5.3). 6.4 Real-World Autonomous Flight (a) (b) Figure 9: Fully onboard flight in an indoor environment: (a) A quadrotor circles a set of obstacles with yaw fixed along the acceleration direction; (b) OREN reconstructs SDF online (shown as gray mesh extracted from the surface), Bubble⋆ plans a bubble corridor (cyan) and optimizes a quadrotor trajectory (red), all computed in real time. (a) (b) Figure 10: (a) Mesh extracted from OREN SDF onboard the quadrotor in real time and a looping trajectory (red) obtained by concatenating several Bubble⋆ plans into a single bubble sequence. (b) The robot executing the planned trajectory. We have shown that OREN produces a non-truncated SDF efficiently (Sec. 6.2) and Bubble⋆ plans safe dynamically feasible trajectories using the non-truncated SDF values (Sec. 6.3). We now validate our integrated approach in real-world flight, with OREN mapping and Bubble⋆ planning running onboard a quadrotor equipped with a Jetson Orin NX. The UAV navigates a previously unseen indoor environment, building the SDF online from streaming depth measurements and planning safe corridors in real time. Fig. 9(a) shows a representative deployment of our method. OREN runs at 77 Hz to provide the mesh shown in Fig. 9(b). Bubble⋆ uses the SDF values from OREN to generate the trajectory shown in Fig. 9(b). Beyond point-to-point planning, several Bubble⋆ plans can be concatenated into a single sequence of overlapping bubbles, letting the quadrotor follow a longer, more complex route while preserving the per-segment clearance guarantees of Sec. 5.3. Fig. 10(a) shows a multi-segment trajectory executed onboard, threading a looping path through the SDF mesh reconstructed during the flight. This trajectory is created by selecting three waypoints and sequentially planning from one to the next. We then concatenate these sequences of bubbles and find a single trajectory through the entire route. Table 5 shows statistics on computation time, clearances, and trajectory lengths for this multi-segment trajectory. The planner maintains a safe distance from obstacles as it navigates around them. Fig. 10(b) visualizes the robot flying this trajectory. These results show that combining an SDF map with a planner that exploits SDF to construct safe corridors for trajectory optimization makes safe autonomous flight tractable under tight compute and memory budgets. Table 5: Runtime and tracking performance for the trajectory shown in Fig. 10(b). Clearance values are shown after accounting for the robot footprint. Planning time (Bubble⋆) 76.9676.96 ms Optimization time 142.33142.33 ms Total plan time 219.30219.30 ms Min. obstacle distance, planned 0.3130.313 m Min. obstacle distance, flown 0.1690.169 m Flown clearance (p5 / median) 0.2970.297 / 0.8040.804 m Segments / pieces 33 / 3939 Trajectory duration 17.3817.38 s 7 Conclusion This paper developed an efficient unified approach for SDF reconstruction and SDF-accelerated motion planning for safe autonomous flight. Our mapping method, OREN, reconstructs differentiable non-truncated SDF online by combining an explicit octree prior with an implicit neural residual, attaining the accuracy of neural network methods at the memory and runtime efficiency of volumetric ones. Exploiting the SDF representation, Bubble⋆ constructs a graph of collision-free bubbles, which forms a safe corridor with guarantees of termination, completeness, and failure detection. Such a bubble corridor defines safety constraints for dynamically feasible trajectory optimization. Compared with baselines, Bubble⋆ is the only method that pairs a compact high-clearance corridor with a smooth underlying path, which keeps both its search and its trajectory optimization fast. We demonstrate the integrated mapping and planning approach running fully onboard a quadrotor in real time. This shows that an accurate implicit map representation makes autonomous flight tractable under tight onboard resources. In our experiments, OREN maintains real-time speed while supplying the continuous differentiable SDF that occupancy-grid mappers cannot, and Bubble⋆ exploits this representation to issue 9191–99%99\% fewer collision checks than A⋆ and to attain the lowest total planning time while matching the shortest path. Together, these results enable the complete mapping and planning loop to run efficiently onboard a Jetson Orin NX. Funding We gratefully acknowledge support from ARL DCIST CRA W911NF-17-2-0181 (N. Atanasov, Z. Dai), a research gift fund established by Shield AI (J. Stanley), and the Ministry of Trade, Industry and Energy (MOTIE), Korea, under the Strategic Technology Development Program, supervised by Korea Institute for Advancement of Technology (KIAT) [Grant No. P0026052] (K.M.B. Lee). Statements and Declarations Conflict of interest The authors have no competing interests to declare that are relevant to the content of this article. Data Availability A public demonstration of OREN and Bubble⋆, including code to run the integrated mapping and planning approach, is available at https://github.com/ExistentialRobotics/erl_oren_bubble_star_demo. Author Contributions OREN extension concepts: ZD, NA; Developing OREN: ZD, Q, TF; Planner concept: JS, KMBL; Developing planning algorithm: JS, TH; Quadrotor experiments: JS, TH, Q, S, CB; Writing main manuscript: JS, ZD; Writing, review and editing: KMBL, NA; Supervision: NA. References Agha-Mohammadi . [ 2011] 2011firmAPACrefauthorsAgha-Mohammadi, A ., Chakravorty, S. Amato, N.M. 2011. : Feedback controller-based Information-state RoadMap-a framework for motion planning under uncertainty FIRM: Feedback controller-based information-state roadmap-a framework for motion planning under uncertainty. 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems ( 4284–4291). Allen Pavone [ 2019] 2019realtimeAPACrefauthorsAllen, R.E. Pavone, M. 2019. real-time framework for kinodynamic planning in dynamic environments with application to quadrotor obstacle avoidance A real-time framework for kinodynamic planning in dynamic environments with application to quadrotor obstacle avoidance. and Autonomous Systems115174–193, APACrefDOI https://doi.org/10.1016/j.robot.2018.11.017 Brunner . [ 2022] _aerial_manipulationAPACrefauthorsBrunner, M., Rizzi, G., Studiger, M., Siegwart, R. Tognon, M. 2022. Planning-and-Control Framework for Aerial Manipulation of Articulated Objects A planning-and-control framework for aerial manipulation of articulated objects. Robotics and Automation Letters7410689-10696, APACrefDOI https://doi.org/10.1109/LRA.2022.3191178 Curless Levoy [ 1996] _volumetric_1996APACrefauthorsCurless, B. Levoy, M. 1996. Volumetric Method for Building Complex Models from Range Images A volumetric method for building complex models from range images. on Computer Graphics and Interactive Techniques (SIGGRAPH) Conference on Computer Graphics and Interactive Techniques (SIGGRAPH) ( 303–312). Dai, Fan . [ 2026] 2026kernelsdfAPACrefauthorsDai, Z., Fan, T., Amani, M., Seo, J., Lee, K.M.B., Oh, H. Atanasov, N. 2026. -SDF: An Open-Source Library for Real-Time Signed Distance Function Estimation Using Kernel Regression. Kernel-SDF: An open-source library for real-time signed distance function estimation using kernel regression. at https://arxiv.org/abs/2603.29227 Dai, Qian . [ 2026] _oren_2025APACrefauthorsDai, Z., Qian, Q., Fan, T. Atanasov, N. 2026. : Octree Residual Network for Real-Time Euclidean Signed Distance Mapping OREN: Octree Residual Network for Real-Time Euclidean Signed Distance Mapping. /RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Deits Tedrake [ 2015] 2015APACrefauthorsDeits, R. Tedrake, R. 2015. Large Convex Regions of Obstacle-Free Space Through Semidefinite Programming Computing large convex regions of obstacle-free space through semidefinite programming. H.L. Akin, N.M. Amato, V. Isler A.F. van der Stappen ( ), Foundations of Robotics XI: Selected Contributions of the Eleventh International Workshop on the Algorithmic Foundations of Robotics Algorithmic Foundations of Robotics XI: Selected Contributions of the Eleventh International Workshop on the Algorithmic Foundations of Robotics ( 109–124). International Publishing. Dharmadhikari . [ 2020] 2020motionprimitivesAPACrefauthorsDharmadhikari, M., Dang, T., Solanka, L., Loje, J., Nguyen, H., Khedekar, N. Alexis, K. 2020. Primitives-based Path Planning for Fast and Agile Exploration using Aerial Robots Motion primitives-based path planning for fast and agile exploration using aerial robots. International Conference on Robotics and Automation (ICRA) IEEE International Conference on Robotics and Automation (ICRA) ( 179-185). Faessler . [ 2018] 2018differentialAPACrefauthorsFaessler, M., Franchi, A. Scaramuzza, D. 2018 04. Flatness of Quadrotor Dynamics Subject to Rotor Drag for Accurate Tracking of High-Speed Trajectories Differential flatness of quadrotor dynamics subject to rotor drag for accurate tracking of high-speed trajectories. Robotics and Automation Letters32620–626, APACrefDOI https://doi.org/10.1109/LRA.2017.2776353 Funk . [ 2021] 2021multiresAPACrefauthorsFunk, N., Tarrio, J., Papatheodorou, S., Popović, M., Alcantarilla, P.F. Leutenegger, S. 2021April. -Resolution 3D Mapping with Explicit Free Space Representation for Fast and Accurate Mobile Robot Motion Planning Multi-resolution 3D mapping with explicit free space representation for fast and accurate mobile robot motion planning. Robotics and Automation Letters623553–3560, APACrefDOI https://doi.org/10.1109/LRA.2021.3061989 Gao . [ 2019] 2019flyingAPACrefauthorsGao, F., Wu, W., Gao, W. Shen, S. 2019. on point clouds: Online trajectory generation and autonomous navigation for quadrotors in cluttered environments Flying on point clouds: Online trajectory generation and autonomous navigation for quadrotors in cluttered environments. of Field Robotics364710-733, APACrefDOI https://doi.org/https://doi.org/10.1002/rob.21842 Gropp . [ 2020] _implicit_2020APACrefauthorsGropp, A., Yariv, L., Haim, N., Atzmon, M. Lipman, Y. 2020. Geometric Regularization for Learning Shapes Implicit Geometric Regularization for Learning Shapes. Conference on Machine Learning. International Conference on Machine Learning. . Han . [ 2019] _fiesta_2019APACrefauthorsHan, L., Gao, F., Zhou, B. Shen, S. 2019. : Fast Incremental Euclidean Distance Fields for Online Motion Planning of Aerial Robots FIESTA: Fast incremental Euclidean distance fields for online motion planning of aerial robots. /RSJ International Conference on Intelligent Robots and Systems (IROS) IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) ( 4423–4430). Harabor Grastien [ 2011] 2011jumppointsearchAPACrefauthorsHarabor, D. Grastien, A. 2011. Graph Pruning for Pathfinding on Grid Maps Online graph pruning for pathfinding on grid maps. of the Twenty-Fifth AAAI Conference on Artificial Intelligence (AAAI) Proceedings of the Twenty-Fifth AAAI Conference on Artificial Intelligence (AAAI) ( 1114–1119). Press. Hart . [ 1968] _basisAPACrefauthorsHart, P.E., Nilsson, N.J. Raphael, B. 1968. Formal Basis for the Heuristic Determination of Minimum Cost Paths A formal basis for the heuristic determination of minimum cost paths. Transactions on Systems Science and Cybernetics42100-107, APACrefDOI https://doi.org/10.1109/TSSC.1968.300136 Hornung . [ 2013] 13auroAPACrefauthorsHornung, A., Wurm, K.M., Bennewitz, M., Stachniss, C. Burgard, W. 2013. : An Efficient Probabilistic 3D Mapping Framework Based on Octrees OctoMap: An efficient probabilistic 3D mapping framework based on octrees. Robots343189-206, APACrefDOI https://doi.org/10.1007/s10514-012-9321-0 available at https://octomap.github.io Jacquet . [ 2025] 2025neuralAPACrefauthorsJacquet, M., Harms, M. Alexis, K. 2025. NMPC through signed distance field encoding for collision avoidance Neural NMPC through signed distance field encoding for collision avoidance. International Journal of Robotics Research, APACrefDOI https://doi.org/10.1177/02783649251401223 , December 13, 2025 Ji . [ 2021] _plannerAPACrefauthorsJi, J., Wang, Z., Wang, Y., Xu, C. Gao, F. 2021. -Planner: A Robust and Fast Planning Framework for Aggressive Autonomous Flight without Map Fusion Mapless-planner: A robust and fast planning framework for aggressive autonomous flight without map fusion. International Conference on Robotics and Automation (ICRA) IEEE International Conference on Robotics and Automation (ICRA) ( 6315-6321). Jiang . [ 2023] _h2-mapping_2023APACrefauthorsJiang, C., Zhang, H., Liu, P., Yu, Z., Cheng, H., Zhou, B. Shen, S. 2023. 2-Mapping: Real-Time Dense Mapping Using Hierarchical Hybrid Representation H2-Mapping: Real-time dense mapping using hierarchical hybrid representation. Robotics and Automation Letters8106787-6794, APACrefDOI https://doi.org/10.1109/LRA.2023.3313051 Karaman Frazzoli [ 2011] _samplingAPACrefauthorsKaraman, S. Frazzoli, E. 2011. -Based Algorithms for Optimal Motion Planning Sampling-based algorithms for optimal motion planning. International Journal of Robotics Research307846-894, APACrefDOI https://doi.org/10.1177/0278364911406761 Kähler . [ 2015] _very_2015APACrefauthorsKähler, O., Adrian Prisacariu, V., Yuheng Ren, C., Sun, X., Torr, P. Murray, D. 2015. High Frame Rate Volumetric Integration of Depth Images on Mobile Devices Very high frame rate volumetric integration of depth images on mobile devices. Transactions on Visualization and Computer Graphics (TVCG)21111241–1250, APACrefDOI https://doi.org/10.1109/TVCG.2015.2459891 Laina . [ 2025] 2025scalableAPACrefauthorsLaina, S.B., Boche, S., Papatheodorou, S., Tzoumanikas, D., Schaefer, S., Chen, H. Leutenegger, S. 2025. Outdoors Autonomous Drone Flight with Visual-Inertial SLAM and Dense Submaps Built without LiDAR Scalable outdoors autonomous drone flight with visual-inertial SLAM and dense submaps built without LiDAR. 2025 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) 2025 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) ( 5440-5447). LaValle Kuffner [ 2001] 2001rrtAPACrefauthorsLaValle, S.M. Kuffner, J.J. 2001. Kinodynamic Planning Randomized kinodynamic planning. International Journal of Robotics Research205378–400, APACrefDOI https://doi.org/10.1177/02783640122067453 B. Lee . [ 2019] 2019gpisAPACrefauthorsLee, B., Zhang, C., Huang, Z. Lee, D.D. 2019. Continuous Mapping Using Gaussian Process Implicit Surfaces Online continuous mapping using Gaussian process implicit surfaces. International Conference on Robotics and Automation (ICRA) IEEE International Conference on Robotics and Automation (ICRA) ( 6884–6890). K.M.B. Lee . [ 2024] 2024safebubblecovermotionAPACrefauthorsLee, K.M.B., Dai, Z., Le Gentil, C., Wu, L., Atanasov, N. Vidal-Calleja, T. 2024. Bubble Cover for Motion Planning on Distance Fields. Safe bubble cover for motion planning on distance fields. at https://arxiv.org/abs/2408.13377 Li, Chi . [ 2024] 2024configAPACrefauthorsLi, Y., Chi, X., Razmjoo, A. Calinon, S. 2024. Space Distance Fields for Manipulation Planning Configuration space distance fields for manipulation planning. : Science and Systems (RSS). Robotics: Science and Systems (RSS). Li, Zhang . [ 2024] 2024robotAPACrefauthorsLi, Y., Zhang, Y., Razmjoo, A. Calinon, S. 2024. Robot Geometry as Distance Fields: Applications to Whole-Body Manipulation Representing robot geometry as distance fields: Applications to whole-body manipulation. International Conference on Robotics and Automation (ICRA) IEEE International Conference on Robotics and Automation (ICRA) ( 15351-15357). Likhachev Ferguson [ 2009] 2009latticeAPACrefauthorsLikhachev, M. Ferguson, D. 2009. Long Dynamically Feasible Maneuvers for Autonomous Vehicles Planning long dynamically feasible maneuvers for autonomous vehicles. International Journal of Robotics Research288933–945, APACrefDOI https://doi.org/10.1177/0278364909340445 P. Liu . [ 2022] APACrefauthorsLiu, P., Zhang, K., Tateo, D., Jauhri, S., Peters, J. Chalvatzaki, G. 2022. Deep Signed Distance Fields for Reactive Motion Generation Regularized deep signed distance fields for reactive motion generation. /RSJ International Conference on Intelligent Robots and Systems (IROS) IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) ( 6673-6680). S. Liu, Atanasov . [ 2017] 2017searchAPACrefauthorsLiu, S., Atanasov, N., Mohta, K. Kumar, V. 2017. -based motion planning for quadrotors using linear quadratic minimum time control Search-based motion planning for quadrotors using linear quadratic minimum time control. /RSJ International Conference on Intelligent Robots and Systems (IROS) IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) ( 2872-2879). S. Liu, Watterson . [ 2017] _corridorAPACrefauthorsLiu, S., Watterson, M., Mohta, K., Sun, K., Bhattacharya, S., Taylor, C.J. Kumar, V. 2017. Dynamically Feasible Trajectories for Quadrotors Using Safe Flight Corridors in 3-D Complex Environments Planning dynamically feasible trajectories for quadrotors using safe flight corridors in 3-D complex environments. Robotics and Automation Letters231688-1695, APACrefDOI https://doi.org/10.1109/LRA.2017.2663526 Long . [ 2026] _sensor-basedAPACrefauthorsLong, K., Yi, Y., Dai, Z., Herbert, S., Cortés, J. Atanasov, N. 2026. -Based Distributionally Robust Control for Safe Robot Navigation in Dynamic Environments Sensor-based distributionally robust control for safe robot navigation in dynamic environments. International Journal of Robotics Research452328-351, APACrefDOI https://doi.org/10.1177/02783649251352000 Majumdar Tedrake [ 2017] 2017funnelAPACrefauthorsMajumdar, A. Tedrake, R. 2017. libraries for real-time robust feedback motion planning Funnel libraries for real-time robust feedback motion planning. International Journal of Robotics Research368947–982, APACrefDOI https://doi.org/10.1177/0278364917712421 Marcucci . [ 2024] 2024boxesAPACrefauthorsMarcucci, T., Nobel, P., Tedrake, R. Boyd, S. 2024. Path Planning Through Large Collections of Safe Boxes Fast path planning through large collections of safe boxes. Transactions on Robotics403795-3811, APACrefDOI https://doi.org/10.1109/TRO.2024.3434168 Marcucci . [ 2023] _motion_planningAPACrefauthorsMarcucci, T., Petersen, M., von Wrangel, D. Tedrake, R. 2023. planning around obstacles with convex optimization Motion planning around obstacles with convex optimization. Robotics884eadf7843, APACrefDOI https://doi.org/10.1126/scirobotics.adf7843 Mellinger Kumar [ 2011] APACrefauthorsMellinger, D. Kumar, V. 2011. Snap Trajectory Generation and Control for Quadrotors Minimum snap trajectory generation and control for quadrotors. International Conference on Robotics and Automation (ICRA) IEEE International Conference on Robotics and Automation (ICRA) ( 2520-2525). Mildenhall . [ 2020] 2020APACrefauthorsMildenhall, B., Srinivasan, P.P., Tancik, M., Barron, J.T., Ramamoorthi, R. Ng, R. 2020. : Representing Scenes as Neural Radiance Fields for View Synthesis NeRF: Representing scenes as neural radiance fields for view synthesis. Conference on Computer Vision (ECCV) European Conference on Computer Vision (ECCV) ( 405–421). Millane . [ 2024] _nvblox_2024APACrefauthorsMillane, A., Oleynikova, H., Wirbel, E., Steiner, R., Ramasamy, V., Tingdahl, D. Siegwart, R. 2024. : GPU-Accelerated Incremental Signed Distance Field Mapping nvblox: GPU-accelerated incremental signed distance field mapping. International Conference on Robotics and Automation (ICRA) IEEE International Conference on Robotics and Automation (ICRA) ( 2698-2705). Mohta . [ 2018] _gps_deniedAPACrefauthorsMohta, K., Watterson, M., Mulgaonkar, Y., Liu, S., Qu, C., Makineni, A. , V. 2018. , autonomous flight in GPS-denied and cluttered environments Fast, autonomous flight in GPS-denied and cluttered environments. of Field Robotics351101-120, APACrefDOI https://doi.org/https://doi.org/10.1002/rob.21774 Mueller . [ 2015] _motion_primitiveAPACrefauthorsMueller, M.W., Hehn, M. D’Andrea, R. 2015. Computationally Efficient Motion Primitive for Quadrocopter Trajectory Generation A computationally efficient motion primitive for quadrocopter trajectory generation. Transactions on Robotics3161294-1310, APACrefDOI https://doi.org/10.1109/TRO.2015.2479878 Museth . [ 2025] 25APACrefauthorsMuseth, K., Budsberg, J., Sirois-Vigneux, A., Hurst, G., Williams, F., Pradhana, A. , N. 2025. OpenVDB. of the Special Interest Group on Computer Graphics and Interactive Techniques Conference Courses. Proceedings of the Special Interest Group on Computer Graphics and Interactive Techniques Conference Courses. Newcombe . [ 2011] _kinectfusion_2011APACrefauthorsNewcombe, R.A., Izadi, S., Hilliges, O., Molyneaux, D., Kim, D., Davison, A.J. , A. 2011. : Real-Time Dense Surface Mapping and Tracking KinectFusion: Real-time dense surface mapping and tracking. International Symposium on Mixed and Augmented Reality (ISMAR) IEEE International Symposium on Mixed and Augmented Reality (ISMAR) ( 127-136). Oleynikova . [ 2017] _voxblox_2017APACrefauthorsOleynikova, H., Taylor, Z., Fehr, M., Siegwart, R. Nieto, J. 2017. : Incremental 3D Euclidean Signed Distance Fields for On-Board MAV Planning Voxblox: Incremental 3D Euclidean signed distance fields for on-board MAV planning. /RSJ International Conference on Intelligent Robots and Systems (IROS) IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) ( 1366–1373). Ortiz . [ 2022] _isdf_2022APACrefauthorsOrtiz, J., Clegg, A., Dong, J., Sucar, E., Novotny, D., Zollhoefer, M. Mukadam, M. 2022. : Real-Time Neural Signed Distance Fields for Robot Perception iSDF: Real-time neural signed distance fields for robot perception. : Science and Systems (RSS). Robotics: Science and Systems (RSS). Pan . [ 2022] _voxfield_2022APACrefauthorsPan, Y., Kompis, Y., Bartolomei, L., Mascaro, R., Stachniss, C. Chli, M. 2022. : Non-Projective Signed Distance Fields for Online Planning and 3D Reconstruction Voxfield: Non-projective signed distance fields for online planning and 3D reconstruction. /RSJ International Conference on Intelligent Robots and Systems (IROS) IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) ( 5331-5338). Pan . [ 2024] _pin-slam_2024APACrefauthorsPan, Y., Zhong, X., Wiesmann, L., Posewsky, T., Behley, J. Stachniss, C. 2024. -SLAM: LiDAR SLAM Using a Point-Based Implicit Neural Representation for Achieving Global Map Consistency PIN-SLAM: LiDAR SLAM using a point-based implicit neural representation for achieving global map consistency. Transactions on Robotics404045-4064, APACrefDOI https://doi.org/10.1109/TRO.2024.3422055 Park . [ 2019] _deepsdf_2019APACrefauthorsPark, J.J., Florence, P., Straub, J., Newcombe, R. Lovegrove, S. 2019. : Learning Continuous Signed Distance Functions for Shape Representation DeepSDF: Learning continuous signed distance functions for shape representation. /CVF Conference on Computer Vision and Pattern Recognition (CVPR) IEEE/CVF Conference on Computer Vision and Pattern Recognition (CVPR) ( 165-174). Ren . [ 2022] 2022bubbleplannerplanninghighspeedAPACrefauthorsRen, Y., Zhu, F., Liu, W., Wang, Z., Lin, Y., Gao, F. Zhang, F. 2022. Planner: Planning High-Speed Smooth Quadrotor Trajectories Using Receding Corridors Bubble planner: Planning high-speed smooth quadrotor trajectories using receding corridors. /RSJ International Conference on Intelligent Robots and Systems (IROS) IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) ( 6332-6339). Ren . [ 2025] 2025safetyAPACrefauthorsRen, Y., Zhu, F., Lu, G., Cai, Y., Yin, L., Kong, F. , F. 2025. -assured high-speed navigation for MAVs Safety-assured high-speed navigation for MAVs. Robotics1098eado6187, APACrefDOI https://doi.org/10.1126/scirobotics.ado6187 Richter . [ 2016] 2016APACrefauthorsRichter, C., Bry, A. Roy, N. 2016. Trajectory Planning for Aggressive Quadrotor Flight in Dense Indoor Environments Polynomial trajectory planning for aggressive quadrotor flight in dense indoor environments. M. Inaba P. Corke ( ), Research: The 16th International Symposium ISRR Robotics Research: The 16th International Symposium ISRR ( 649–666). International Publishing. APACrefURL https://doi.org/10.1007/978-3-319-28872-7_37 Ryll . [ 2019] _efficient_traj_planningAPACrefauthorsRyll, M., Ware, J., Carter, J. Roy, N. 2019. Trajectory Planning for High Speed Flight in Unknown Environments Efficient trajectory planning for high speed flight in unknown environments. Conference on Robotics and Automation (ICRA) International Conference on Robotics and Automation (ICRA) ( 732-738). Song . [ 2021] _rl_drone_racingAPACrefauthorsSong, Y., Steinweg, M., Kaufmann, E. Scaramuzza, D. 2021. Drone Racing with Deep Reinforcement Learning Autonomous drone racing with deep reinforcement learning. /RSJ International Conference on Intelligent Robots and Systems (IROS) IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) ( 1205-1212). Straub . [ 2019] 19arxivAPACrefauthorsStraub, J., Whelan, T., Ma, L., Chen, Y., Wijmans, E., Green, S. , R. 2019. Replica Dataset: A Digital Replica of Indoor Spaces. The Replica dataset: A digital replica of indoor spaces. at https://arxiv.org/abs/1906.05797 Sucan . [ 2012] _2012APACrefauthorsSucan, I.A., Moll, M. Kavraki, L.E. 2012. Open Motion Planning Library The Open Motion Planning Library. Robotics and Automation Magazine19472-82, APACrefDOI https://doi.org/10.1109/MRA.2012.2205651 Takikawa . [ 2021] _lod_2021APACrefauthorsTakikawa, T., Litalien, J., Yin, K., Kreis, K., Loop, C., Nowrouzezahrai, D. , S. 2021. Geometric Level of Detail: Real-Time Rendering with Implicit 3D Shapes Neural geometric level of detail: Real-time rendering with implicit 3D shapes. /CVF Conference on Computer Vision and Pattern Recognition (CVPR) IEEE/CVF Conference on Computer Vision and Pattern Recognition (CVPR) ( 11353-11362). Tian . [ 2025] 2025APACrefauthorsTian, Y., Cao, H., Kim, S. Atanasov, N. 2025. : Multiresolution Submap Optimization for Efficient Globally Consistent Neural Implicit Reconstruction MISO: Multiresolution submap optimization for efficient globally consistent neural implicit reconstruction. : Science and Systems (RSS). Robotics: Science and Systems (RSS). Tordesillas How [ 2022] 2022fasterAPACrefauthorsTordesillas, J. How, J.P. 2022. : Fast and Safe Trajectory Planner for Navigation in Unknown Environments FASTER: Fast and safe trajectory planner for navigation in unknown environments. Transactions on Robotics382922-938, APACrefDOI https://doi.org/10.1109/TRO.2021.3100142 Varadhan [ 1967] _behavior_1967APACrefauthorsVaradhan, S.R.S. 1967. the behavior of the fundamental solution of the heat equation with variable coefficients On the behavior of the fundamental solution of the heat equation with variable coefficients. on Pure and Applied Mathematics202431–455, APACrefDOI https://doi.org/10.1002/cpa.3160200210 Vasilopoulos . [ 2024] -sdf_2024APACrefauthorsVasilopoulos, V., Garg, S., Huh, J., Lee, B. Isler, V. 2024. -SDF: Hierarchical Incremental Online Signed Distance Fields HIO-SDF: Hierarchical incremental online signed distance fields. International Conference on Robotics and Automation (ICRA) IEEE International Conference on Robotics and Automation (ICRA) ( 17537-17543). P. Wang . [ 2021] _neus_2021APACrefauthorsWang, P., Liu, L., Liu, Y., Theobalt, C., Komura, T. Wang, W. 2021. : Learning Neural Implicit Surfaces by Volume Rendering for Multi-View Reconstruction NeuS: Learning neural implicit surfaces by volume rendering for multi-view reconstruction. Conference on Neural Information Processing Systems. International Conference on Neural Information Processing Systems. Hook, NY, USACurran Associates Inc. Z. Wang . [ 2025] _hotspot_2024APACrefauthorsWang, Z., Wang, C., Yoshino, T., Tao, S., Fu, Z. Li, T . 2025. : Signed Distance Function Optimization with an Asymptotically Sufficient Condition HotSpot: Signed distance function optimization with an asymptotically sufficient condition. /CVF Conference on Computer Vision and Pattern Recognition (CVPR) IEEE/CVF Conference on Computer Vision and Pattern Recognition (CVPR) ( 1276-1286). Z. Wang . [ 2022] APACrefauthorsWang, Z., Zhou, X., Xu, C. Gao, F. 2022. Constrained Trajectory Optimization for Multicopters Geometrically constrained trajectory optimization for multicopters. Transactions on Robotics3853259-3278, APACrefDOI https://doi.org/10.1109/TRO.2022.3160022 Wu . [ 2021] 2021loggpisAPACrefauthorsWu, L., Lee, K.M.B., Liu, L. Vidal-Calleja, T. 2021. Euclidean Distance Field from Log-Gaussian Process Implicit Surfaces Faithful Euclidean distance field from log-Gaussian process implicit surfaces. Robotics and Automation Letters622461-2468, APACrefDOI https://doi.org/10.1109/LRA.2021.3061356 Wu . [ 2025] _vdb-gpdf_2025APACrefauthorsWu, L., Le Gentil, C. Vidal-Calleja, T. 2025. -GPDF: Online Gaussian Process Distance Field with VDB Structure VDB-GPDF: Online Gaussian process distance field with VDB structure. Robotics and Automation Letters101374-381, APACrefDOI https://doi.org/10.1109/LRA.2024.3505814 Zhang . [ 2021] 2021APACrefauthorsZhang, L., Camurri, M., Wisth, D. Fallon, M. 2021. -Camera LiDAR Inertial Extension to the Newer College Dataset. Multi-camera LiDAR inertial extension to the Newer College dataset. at https://arxiv.org/abs/2112.08854 Zhou . [ 2019] _robust_efficientAPACrefauthorsZhou, B., Gao, F., Wang, L., Liu, C. Shen, S. 2019. and Efficient Quadrotor Trajectory Generation for Fast Autonomous Flight Robust and efficient quadrotor trajectory generation for fast autonomous flight. Robotics and Automation Letters443529-3536, APACrefDOI https://doi.org/10.1109/LRA.2019.2927938