Abstract
We present in this paper a robust online path planning method, which allows a micro rotorcraft drone to fly safely in GPS-denied and obstacle-strewn environments with limited onboard computational power. The approach is based on an efficiently managed grid map and a closed-form solution to the two point boundary value problem (TPBVP). The grid map assists trajectory evaluation whereas the solution to the TPBVP generates smooth trajectories. Finally, a top-level trajectory switching algorithm is utilized to minimize the computational cost. Advantages of the proposed approach include its conservation of computational resource, robustness of trajectory generation and agility of reaction to unknown environment. The result has been realized on actual drones platforms and successfully demonstrated in real flight tests. The video of flight tests can be found at: http://uav.ece.nus.edu.sg/robust-online-path-planning-Lai2015.html.
Similar content being viewed by others
References
K. Chu, M. Lee, M. M. Sunwoo. Local path planning for pffroad autonomous driving with avoidance of static obstacles. IEEE Transactions on Intelligent Transportation Systems, 2012, 13(4): 1599–1616.
C. Stachniss, W. Burgard. An integrated approach to goal-directed obstacle avoidance under dynamic constraints for dynamic environments. IEEE/RSJ International Conference on Intelligent Robots and Systems, Lausanne: IEEE, 2002: 508–513.
Z. Wang, L. Liu, T. Long, et al. Enhanced sparse A* search for UAV path planning using dubins path estimation. Proceedings of the 33rd Chinese Control Conference, Nanjing: IEEE, 2014: 738–742.
D. Mellinger, V. Kumar. Minimum snap trajectory generation and control for quadrotors. IEEE International Conference on Robotics and Automation, Shanghai: IEEE, 2011: 2520–2525.
S. K. Phang, K. Li, K. H. Yu, et al. Systematic design and implementation of a micro unmanned quadrotor system. Unmanned Systems, 2014, 2(2): 121–141.
K. Li, S. K. Phang, B. M. Chen, et al. Platform design and mathematical modeling of an ultralight quadrotor micro aerial vehicle. International Conference on Unmanned Aircraft Systems, Atlanta: IEEE, 2011: 2520–2525.
J. Cui, F. Wang, X. Dong, et al. Landmark extraction and state estimation for UAV operation in forest. Proceedings of the 32nd Chinese Control Conference, Xi’an: IEEE, 2013: 5210–5215.
P. Henry, M. Krainin, E. Herbst, et al. RGB-D mapping: using depth cameras for dense 3D modeling of indoor environments. Experimental Robotics, London: Springer, 2014: 477–491.
P. Henry, M. Krainin, E. Herbst, et al. RGB-D mapping: using Kinect-style depth cameras for dense 3D modeling of indoor environments. International Journal of Robotics Research, 2012, 31(5), 647–663.
G. Grisetti, C. Stachniss, W. Burgard. Improved techniques for grid mapping with Rao-Blackwellized particle filters. IEEE Transactions on Robotics, 2007, 23(1): 34–46.
S. Kohlbrecher, J. Meyer, O. von Stryk, et al. A flexible and scalable SLAM system with full 3D motion estimation. IEEE International Symposium on Safety, Security and Rescue Robotics, Kyoto: IEEE, 2011: 155–160.
J. Cui, S. Lai, X. Dong, et al. Autonomous navigation of UAV in foliage environment. Journal of Intelligent & Robotic Systems, 2015: DOI 10.1007/s10846-015-0292-1.
P. F. Felzenszwalb, D. P. Huttenlocher. Distance transforms of sampled functions. Theory of Computing, 2012, 8(19): 415–428.
J. Amanatides, A. Woo. A fast voxel traversal algorithm for ray tracing. Proceedings of the Conference held at Computer Graphics, London: Online Publications, 1987: 3–10.
S. K. Phang, S. Lai, F. Wang, et al. Systems design and implementation with jerk-optimized trajectory generation for UAV calligraphy. Mechatronics, 2015, 30: 65–75.
F. Augugliaro, A. Schoellig, R. D’Andrea. Generation of collisionfree trajectories for a quadrocopter fleet: a sequential convex programming approach. IEEE/RSJ International Conference on Intelligent Robots and Systems, Vilamoura: IEEE, 2012: 1917–1922.
M. Hehn. Quadrocopter trajectory generation and control. Proceedings of the 18th IFAC World Congress, Milano: IFAC, 2011: 1485–1491.
T. Kroger, F. Wahl. Online trajectory generation: basic concepts for instantaneous reactions to unforeseen events. IEEE Transactions on Robotics, 2010, 26(1): 94–111.
R. Haschke, E. Weitnauer, H. Ritter. On-line planning of time-optimal, jerk-limited trajectories. IEEE/RSJ International Conference on Intelligent Robots and Systems, Nice: IEEE, 2008: 3248–3253.
H. Maurer. On optimal control problems with bounded state variables and control appearing linearly. SIAM Journal on Control and Optimization, 1977, 15(3): 345–362.
T. Kroger, T.ger, A. Tomiczek, et al. Towards on-line trajectory computation. IEEE/RSJ International Conference on Intelligent Robots and Systems, Beijing: IEEE, 2006: 736–741.
J. J. Park, C. Johnson, B. Kuipers. Robot navigation with model predictive equilibrium point control. IEEE/RSJ International Conference on Intelligent Robots and Systems, Vilamoura: IEEE, 2012: 4945–4952.
Author information
Authors and Affiliations
Corresponding author
Additional information
Shupeng LAI received his B.Eng. degree from the Department of Electronic and Electrical Engineering, Nanyang Technological University in 2012. He is currently a Ph.D. candidate at National University of Singapore. His research interests lie in game theory and navigation of multiple unmanned systems.
Kangli WANG received his B.Eng. degree from the Department of Electrical and Computer Engineering (ECE) at National University of Singapore (NUS) in 2013. He has joined NUS UAV team since 2012 during his undergraduate studies. He is currently pursuing his Ph.D. degree in ECE at the NUS under presidential graduate fellowship scholarship. His main research area is design and development of unconventional UAV with vertical takeoff and landing and cruise fly ability. He is also interested in flight control system design.
Hailong QIN received his B.Eng. degree in Mechatronics from Harbin Institute of Technology, Harbin China, in 2011, and M.Eng. degree in Mechanical Engineering from Pohang University of Technology, Pohang Korea, in 2013. He is currently a research engineer and part-time Ph.D. candidate at National University of Singapore. His research interests includes 3D reconstruction and visual navigation.
Jinqiang CUI received his B.Sc. and M.Sc. degrees in Mechatronic Engineering from Northwestern Polytechnical University, Xi’an, China, in 2005 and 2008, respectively. He received his Ph.D. in Electrical and Computer Engineering from National University of Singapore (NUS) in 2015. In the Ph.D. study, his research interest is navigation of unmanned aerial vehicles (UAV) in GPS-denied environments, especially forest. Currently, he is a research scientist in the Control Science Group at NUS Temasek Laboratories. His research interests are GPS-less navigation using LIDAR and vision sensing technologies.
Ben M. CHEN is currently a Professor and Director of Control, Intelligent Systems & Robotics Area, Department of Electrical and Computer Engineering, National University of Singapore (NUS), and Head of Control Science Group, NUS Temasek Laboratories. His current research interests are in systems and control, unmanned aerial systems, and financial market modeling. Dr. Chen is an IEEE Fellow. He is the author/co-author of 10 research monographs includingH2 Optimal Control (Prentice Hall, 1995), Robust andHControl (Springer, 2000), Hard Disk Drive Servo Systems (Springer, 1st Edition, 2002; 2nd Edition, 2006), Linear Systems Theory (Birkh¨auser, 2004), Unmanned Rotorcraft Systems (Springer, 2011), and Stock Market Modeling and Forecasting (Springer, 2013). He had served on the editorial boards of a number of journals including IEEE Transactions on Automatic Control, Systems & Control Letters, and Automatica. He currently serves as an Editor-in-Chief of Unmanned Systems and a Deputy Editor-in-Chief of Control Theory & Technology.
Rights and permissions
About this article
Cite this article
Lai, S., Wang, K., Qin, H. et al. A robust online path planning approach in cluttered environments for micro rotorcraft drones. Control Theory Technol. 14, 83–96 (2016). https://doi.org/10.1007/s11768-016-6007-8
Received:
Revised:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s11768-016-6007-8