Real-time trajectory replanning for MAVs using uniform B-splines and a 3D circular buffer

In this paper, we present a real-time approach to local trajectory replanning for microaerial vehicles (MAVs). Current trajectory generation methods for multicopters achieve high success rates in cluttered environments, but assume that the environment is static and require prior knowledge of the map. In the presented study, we use the results of such planners and extend them with a local replanning algorithm that can handle unmodeled (possibly dynamic) obstacles while keeping the MAV close to the global trajectory. To ensure that the proposed approach is real-time capable, we maintain information about the environment around the MAV in an occupancy grid stored in a three-dimensional circular buffer, which moves together with a drone, and represent the trajectories by using uniform B-splines. This representation ensures that the trajectory is sufficiently smooth and simultaneously allows for efficient optimization.

[1]  John Amanatides,et al.  A Fast Voxel Traversal Algorithm for Ray Tracing , 1987, Eurographics.

[2]  Panagiotis Tsiotras,et al.  On-Line Path Generation for Unmanned Aerial Vehicles Using B-Spline Path Templates , 2008 .

[3]  Kaihuai Qin General matrix representations for B-splines , 2014, The Visual Computer.

[4]  Roland Siegwart,et al.  Voxblox: Incremental 3D Euclidean Signed Distance Fields for on-board MAV planning , 2016, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[5]  Wolfram Burgard,et al.  A benchmark for the evaluation of RGB-D SLAM systems , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Wolfram Burgard,et al.  OctoMap: an efficient probabilistic 3D mapping framework based on octrees , 2013, Autonomous Robots.

[7]  Jorge Nocedal,et al.  On the limited memory BFGS method for large scale optimization , 1989, Math. Program..

[8]  Vijay Kumar,et al.  Minimum snap trajectory generation and control for quadrotors , 2011, 2011 IEEE International Conference on Robotics and Automation.

[9]  Taeyoung Lee,et al.  Geometric tracking control of a quadrotor UAV on SE(3) , 2010, 49th IEEE Conference on Decision and Control (CDC).

[10]  Siddhartha S. Srinivasa,et al.  CHOMP: Covariant Hamiltonian optimization for motion planning , 2013, Int. J. Robotics Res..

[11]  D. Dolgov Practical Search Techniques in Path Planning for Autonomous Driving , 2008 .

[12]  Dan Gazebo Sebagai,et al.  Robot Operating System (ROS) , 2020, Studies in Computational Intelligence.

[13]  Charles Richter,et al.  Polynomial Trajectory Planning for Aggressive Quadrotor Flight in Dense Indoor Environments , 2016, ISRR.

[14]  M. Cox The Numerical Evaluation of B-Splines , 1972 .

[15]  Roland Siegwart,et al.  Continuous-time trajectory optimization for online UAV replanning , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[16]  Daniel Cremers,et al.  Volumetric 3D mapping in real-time on a CPU , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[17]  Roland Siegwart,et al.  Real-time visual-inertial mapping, re-localization and planning onboard MAVs in unknown environments , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[18]  P. Tsiotras,et al.  On-line Path Generation for Small Unmanned Aerial Vehicles Using B-Spline Path Templates , 2008 .

[19]  Roland Siegwart,et al.  Voxblox: Building 3D Signed Distance Fields for Planning , 2016, ArXiv.

[20]  C. D. Boor,et al.  On Calculating B-splines , 1972 .

[21]  Anis Koubaa Robot Operating System (ROS): The Complete Reference (Volume 1) , 2016 .

[22]  Soon-Jo Chung,et al.  Motion primitives and 3D path planning for fast flight through a forest , 2015, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[23]  O. SIAMJ.,et al.  A CLASS OF GLOBALLY CONVERGENT OPTIMIZATION METHODS BASED ON CONSERVATIVE CONVEX SEPARABLE APPROXIMATIONS∗ , 2002 .

[24]  Raffaello D'Andrea,et al.  A computationally efficient algorithm for state-to-state quadrocopter trajectory generation and feasibility verification , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[25]  Daniel P. Huttenlocher,et al.  Distance Transforms of Sampled Functions , 2012, Theory Comput..

[26]  Matthias Nießner,et al.  Real-time 3D reconstruction at scale using voxel hashing , 2013, ACM Trans. Graph..

[27]  Roland Siegwart,et al.  Motion‐ and Uncertainty‐aware Path Planning for Micro Aerial Vehicles , 2014, J. Field Robotics.