From Field to Planning: Learning Temporal Polar Gradient Fields for Vision-based AAV Trajectory Planning in Dynamic Environments
Organizations: College of Intelligence Science and Technology, National University of Defense Technology, Changsha 410073, China · College of Automation Engineering, Nanjing University of Aeronautics and Astronautics, Nanjing 211106, China
Abstract
Autonomous Aerial Vehicle (AAV) trajectory planning requires real-time and accurate safety gradient guidance, especially in dynamic environments. Existing methods typically rely on static maps and dynamic obstacle tracking to construct gradient fields, imposing heavy computational burdens and yielding conservative trajectories. To address these limitations, we propose a two-stage Field-to-Planning (F2P) learning framework to provide accurate and efficient safety gradients for trajectory planning in dynamic environments. In the first stage, we introduce an Ego-centric Polar Occupancy (EPO) representation that naturally matches the geometry of the onboard camera frustum, while supporting unstructured scene modeling. Subsequently, we formulate a Temporal Polar Gradient Field (TPGF) via multi-kernel separable Gaussian convolution to provide unified safety gradients, without explicitly distinguishing between static and dynamic obstacles. To mitigate the inherent spatial ambiguity introduced by applying convolutions within the polar grid, we propose an ESDF-guided offline learning strategy that incorporates geometric priors into TPGF. In the second stage, we employ the calibrated TPGF to guide the trajectory planning policy in a self-supervised learning manner. Comparative results with other approaches demonstrate the superiority of our method. Extensive real-world experiments within various cluttered dynamic environments validate the real-time performance and robustness on resource-constrained onboard systems.
Figures & tables
| Config. ( ) | Frames | TPGF Runtime (ms) | ESDF Runtime (ms) | Speedup (ESDF / TPGF) |
| 1 | 0.454 | 1.854 | 4.09 | |
| 240 | 1.093 | 351.69 | 321.91 | |
| 960 | 3.515 | 1438.02 | 409.36 | |
| 3840 | 14.076 | 5695.21 | 404.90 |
| Configuration | Method | SR | TC | SPL | SNT | ET | RT |
| Scenario 1 25 Dynamic 75 Static Speed: 0.5 m/s | Ours | 1.00 | 0.00 | 0.96 | 0.75 | 29.75 | 4.77 |
| VIGO [ 7 ] | 0.96 | 1.00 | 0.93 | 0.44 | 58.12 | 45.58 | |
| IPD-MPC [ 10 ] | 0.76 | 7.00 | 0.68 | 0.72 | 27.75 | 25.20 | |
| YOPO [ 16 ] | 0.92 | 2.00 | 0.91 | 0.73 | 28.81 | 3.44 | |
| EGO-Planner [ 21 ] | 0.80 | 6.00 | 0.77 | 0.46 | 37.53 | 42.34 | |
| Scenario 2 75 Dynamic 25 Static Speed: 0.5 m/s | Ours | 0.96 | 1.00 | 0.92 | 0.73 | 29.00 | 4.65 |
| Method | Learned Parameters | Planning Performance | ||||
| SR | TC | SPL | SNT | ET | ||
| Core only | 0.20 | 48.00 | 0.18 | 0.16 | 28.32 | |
| Body only | 0.00 | 83.00 | 0.00 | 0.00 | 29.16 | |
| Halo only | 0.28 | 35.00 | 0.25 | 0.21 | 29.52 | |
| w/o | 0.04 | 66.00 | 0.03 | 0.03 | 28.79 | |
| w/o | 0.08 | 61.00 | 0.07 | 0.06 | 28.80 | |
UAV Navigation
Unmanned aerial vehicle (UAV) navigation develops methods for locating and guiding drones safely through known, unknown, and changing environments.
See all 272 papers