Abstract
Traditional quadrotor navigation often relies on open-loop trajectory tracking, which struggles with unpredictable external disturbances. We introduce SwordRiding, a navigation framework that implements a "closed-loop" paradigm by converting discretized B-spline paths into Online Guiding Vector Fields (GVFs). This creates a continuous guidance "flow" that pulls the drone back to its safe trajectory regardless of its position in space. Our method decouples geometric path planning from algebraic constraints, enabling real-time, robust flight in unknown, cluttered environments. Experimental results in both simulation and real-world scenarios demonstrate a 92% success rate under heavy disturbances, significantly outperforming existing state-of-the-art planners.
Introduction: The Open-Loop Challenge
Most modern drone navigation systems follow an open-loop planning paradigm. A high-level planner generates a time-indexed trajectory, and a low-level controller attempts to track it. While efficient, this approach is fragile: if a drone is pushed off-course by a gust of wind or a physical collision, the high-level plan remains "unaware," often leading to jerky corrections or total navigation failure.
Existing solutions like Guiding Vector Fields (GVF) offer a "closed-loop" alternative where the robot is guided by a vector field pointing toward the path from any position. However, traditional GVF methods require paths defined by simple mathematical functions (like circles or lines), making them difficult to apply to the complex, real-time paths generated in unknown environments.
The SwordRiding Framework
SwordRiding bridges the gap between flexible path planning and robust GVF guidance through a multi-stage pipeline:
- Perception & Mapping: Using LiDAR-based SLAM (FAST-LIO2), the system builds a Euclidean Signed Distance Field (ESDF), providing real-time distance-to-obstacle data.
- Trajectory Optimization: A global planner finds a collision-free path, which is then smoothed via uniform B-splines to ensure physical feasibility.
- Incremental GVF Construction: This core innovation discretizes the B-spline path and uses the ESDF to calculate inward normal vectors (pointing to the path) and tangential vectors (pointing along the path) via local polynomial fitting.
- Closed-Loop Guidance: These vectors form a field that automatically generates commands to steer the drone back to its path if displaced, without needing a manual reset or replanning.
Key Insights
- Decoupling Geometry from Algebra: By using distance transforms on a discretized path, SwordRiding turns arbitrary, jagged paths into smooth guiding fields without needing explicit mathematical equations.
- Inherent Disturbance Rejection: Navigation commands are derived from the drone's current position relative to the field, baking "correction" directly into the high-level guidance.
- Edge Efficiency: The entire pipeline—from mapping to vector field generation—runs at 20Hz on embedded hardware (NVIDIA Orin NX), proving that complex closed-loop planning is viable for real-time flight.
Experimental Results
The framework was evaluated against Fast Planner and Ego Planner in both simulation and real-world tests.
- Robustness to Disturbance: In simulations with external force perturbations (simulating 1.5 m/s² acceleration), SwordRiding maintained a 92% success rate, while competitors dropped to ~23% as they could not recover from being pushed off-trajectory.
- Real-World Recovery: In "Manual Dragging" tests, researchers physically moved the drone mid-flight. Upon release, the GVF immediately re-oriented and guided the drone back to its original path without manual intervention.
- Performance: Average planning time was approximately 9.9 ms, ensuring high responsiveness to environmental changes.
Conclusion
SwordRiding demonstrates that closed-loop vector field navigation is not only possible but highly effective for quadrotors in complex environments. While current work focuses on robustness, future iterations will aim to improve tracking precision at high speeds and adapt the framework for underwater robotics, where unpredictable currents make robust guidance even more critical.
Summary updated