Trajectory Optimization and Replanning Framework for a Micro Air Vehicle in Cluttered Environments

In the present study, we propose a trajectory optimization and replanning algorithm for micro air vehicles (MAVs) in cluttered environments. To generate the path of an MAV in a cluttered environment, we first design an offline global path optimization algorithm. This algorithm generates a global trajectory for safe aerial delivery; this trajectory enables an MAV to avoid static obstacles marked in the navigation map and satisfies the MAV’s initial and arrival velocities. The MAV’s trajectory is replanned by exploiting dynamic movement primitives (DMPs) and a time adjustment algorithm to enable computationally efficient unknown obstacle avoidance in local path planning. To validate the applicability of the proposed algorithm, we compare simulation results with those obtained using an existing approach based on DMPs. Furthermore, an autonomous flight is demonstrated in an outdoor environment using a custom-made MAV driven by the proposed approach.

[1]  Sven Behnke,et al.  Fast Autonomous Flight in Warehouses for Inventory Applications , 2018, IEEE Robotics and Automation Letters.

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

[3]  Fei Gao,et al.  Online quadrotor trajectory generation and autonomous navigation on point clouds , 2016, 2016 IEEE International Symposium on Safety, Security, and Rescue Robotics (SSRR).

[4]  Tamás Vicsek,et al.  Optimized flocking of autonomous drones in confined environments , 2018, Science Robotics.

[5]  Lydia E. Kavraki,et al.  The Open Motion Planning Library , 2012, IEEE Robotics & Automation Magazine.

[6]  Jur P. van den Berg,et al.  Kinodynamic RRT*: Asymptotically optimal motion planning for robots with linear dynamics , 2013, 2013 IEEE International Conference on Robotics and Automation.

[7]  Jun Nakanishi,et al.  Dynamical Movement Primitives: Learning Attractor Models for Motor Behaviors , 2013, Neural Computation.

[8]  Vijay Kumar,et al.  Mixed-integer quadratic program trajectory generation for heterogeneous quadrotor teams , 2012, 2012 IEEE International Conference on Robotics and Automation.

[9]  Hyeonbeom Lee Path Optimization and Re-generation Algorithm for Indoor Mobile Robots in Obstacle Environments , 2019 .

[10]  Emilio Frazzoli,et al.  Optimal kinodynamic motion planning using incremental sampling-based methods , 2010, 49th IEEE Conference on Decision and Control (CDC).

[11]  H. Jin Kim,et al.  An Integrated Framework for Cooperative Aerial Manipulators in Unknown Environments , 2018, IEEE Robotics and Automation Letters.

[12]  Marco Pavone,et al.  A convex optimization approach to smooth trajectories for motion planning with car-like robots , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

[13]  Claire J. Tomlin,et al.  Robust Trajectory Planning for a Multirotor against Disturbance based on Hamilton-Jacobi Reachability Analysis , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[14]  Robin Deits,et al.  Aggressive quadrotor flight through cluttered environments using mixed integer programming , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[15]  Kurt Konolige,et al.  The Office Marathon: Robust navigation in an indoor office environment , 2010, 2010 IEEE International Conference on Robotics and Automation.

[16]  Yao Yu,et al.  Nonlinear Robust Compensation Method for Trajectory Tracking Control of Quadrotors , 2019, IEEE Access.

[17]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[18]  H. Jin Kim,et al.  Planning and Control for Collision-Free Cooperative Aerial Transportation , 2018, IEEE Transactions on Automation Science and Engineering.

[19]  Roland Siegwart,et al.  Safe Local Exploration for Replanning in Cluttered Unknown Environments for Microaerial Vehicles , 2017, IEEE Robotics and Automation Letters.

[20]  Shaojie Shen,et al.  An Efficient B-Spline-Based Kinodynamic Replanning Framework for Quadrotors , 2019, IEEE Transactions on Robotics.

[21]  H. Jin Kim,et al.  Collision-Free Path Planning for Cooperative Aerial Manipulators Under Velocity and Curvature Constraints , 2019, IEEE Access.

[22]  Ji Zhang,et al.  LOAM: Lidar Odometry and Mapping in Real-time , 2014, Robotics: Science and Systems.

[23]  Daniel Cremers,et al.  Real-time trajectory replanning for MAVs using uniform B-splines and a 3D circular buffer , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[24]  Siddhartha S. Srinivasa,et al.  CHOMP: Gradient optimization techniques for efficient motion planning , 2009, 2009 IEEE International Conference on Robotics and Automation.

[25]  Stjepan Bogdan,et al.  Aerial-ground robotic system for autonomous delivery tasks , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[26]  Siddhartha S. Srinivasa,et al.  Informed RRT*: Optimal sampling-based path planning focused via direct sampling of an admissible ellipsoidal heuristic , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[27]  Suseong Kim,et al.  Cooperation in the Air: A Learning-Based Approach for the Efficient Motion Planning of Aerial Manipulators , 2018, IEEE Robotics & Automation Magazine.

[28]  Steven Lake Waslander,et al.  Planning Paths for Package Delivery in Heterogeneous Multirobot Teams , 2015, IEEE Transactions on Automation Science and Engineering.

[29]  Teng Long,et al.  Matrix Structure Driven Interior Point Method for Quadrotor Real-Time Trajectory Planning , 2019, IEEE Access.

[30]  Jongbeom Her,et al.  Robust Autonomous Navigation of Unmanned Aerial Vehicles (UAVs) for Warehouses’ Inventory Application , 2020, IEEE Robotics and Automation Letters.

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