Gao Tang, Weidong Sun, Kris Hauser: Enhancing Bilevel Optimization for UAV Time-Optimal Trajectory using a Duality Gap Approach. ICRA 2020: 2515-2521