Skip to main content
Log in

A robust online path planning approach in cluttered environments for micro rotorcraft drones

  • Published:
Control Theory and Technology Aims and scope Submit manuscript

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.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Similar content being viewed by others

References

  1. 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.

    Article  Google Scholar 

  2. 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.

    Chapter  Google Scholar 

  3. 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.

    Google Scholar 

  4. D. Mellinger, V. Kumar. Minimum snap trajectory generation and control for quadrotors. IEEE International Conference on Robotics and Automation, Shanghai: IEEE, 2011: 2520–2525.

    Google Scholar 

  5. 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.

    Article  Google Scholar 

  6. 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.

    Google Scholar 

  7. 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.

    Google Scholar 

  8. 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.

    Chapter  Google Scholar 

  9. 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.

    Article  Google Scholar 

  10. 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.

    Article  Google Scholar 

  11. 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.

    Chapter  Google Scholar 

  12. 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.

    Google Scholar 

  13. P. F. Felzenszwalb, D. P. Huttenlocher. Distance transforms of sampled functions. Theory of Computing, 2012, 8(19): 415–428.

    Article  MathSciNet  Google Scholar 

  14. 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.

    Google Scholar 

  15. 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.

    Article  Google Scholar 

  16. 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.

    Google Scholar 

  17. M. Hehn. Quadrocopter trajectory generation and control. Proceedings of the 18th IFAC World Congress, Milano: IFAC, 2011: 1485–1491.

    Google Scholar 

  18. T. Kroger, F. Wahl. Online trajectory generation: basic concepts for instantaneous reactions to unforeseen events. IEEE Transactions on Robotics, 2010, 26(1): 94–111.

    Article  Google Scholar 

  19. 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.

    Google Scholar 

  20. 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.

    Article  MathSciNet  MATH  Google Scholar 

  21. 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.

    Google Scholar 

  22. 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.

    Google Scholar 

Download references

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Shupeng Lai.

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

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

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

Download citation

  • Received:

  • Revised:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s11768-016-6007-8

Keywords

Navigation