Path Planning Followed by Kinodynamic Smoothing for Multirotor Aerial Vehicles (MAVs)

We explore path planning followed by kinodynamic smoothing while ensuring the vehicle dynamics feasibility for MAVs. We have chosen a geometrically based motion planning technique "RRT*" for this purpose. In the proposed technique, we modified original RRT* introducing an adaptive search space and a steering function which help to increase the consistency of the planner. Moreover, we propose multiple RRT* which generates a set of desired paths, provided that the optimal path is selected among them. Then, apply kinodynamic smoothing, which will result in dynamically feasible as well as obstacle-free path. Thereafter, a b spline-based trajectory is generated to maneuver vehicle autonomously in unknown environments. Finally, we have tested the proposed technique in various simulated environments.

[1]  Marco Pavone,et al.  An asymptotically-optimal sampling-based algorithm for Bi-directional motion planning , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[2]  James E. Bobrow,et al.  Optimal Robot Path Planning Using the Minimum-Time Criterion , 2022 .

[3]  Feng Lin,et al.  BIT*-based path planning for micro aerial vehicles , 2016, IECON 2016 - 42nd Annual Conference of the IEEE Industrial Electronics Society.

[4]  Torsten Bertram,et al.  Kinodynamic trajectory optimization and control for car-like robots , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[5]  Jur P. van den Berg,et al.  Iterated LQR smoothing for locally-optimal feedback control of systems with non-linear dynamics and non-quadratic cost , 2014, 2014 American Control Conference.

[6]  Fei Gao,et al.  Robust and Efficient Quadrotor Trajectory Generation for Fast Autonomous Flight , 2019, IEEE Robotics and Automation Letters.

[7]  Ahmad A. Masoud,et al.  Kinodynamic Motion Planning , 2010, IEEE Robotics & Automation Magazine.

[8]  Antonin Guttman,et al.  R-trees: a dynamic index structure for spatial searching , 1984, SIGMOD '84.

[9]  S. LaValle.  Rapidly-exploring random trees : a new tool for path planning , 1998 .

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

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

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

[13]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[14]  Domenico Prattichizzo,et al.  Geometric insight into discrete-time cheap and singular linear quadratic Riccati (LQR) problems , 2002, IEEE Trans. Autom. Control..

[15]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[16]  Jur P. van den Berg,et al.  Extended LQR: Locally-Optimal Feedback Control for Systems with Non-Linear Dynamics and Non-Quadratic Cost , 2013, ISRR.

[17]  Leslie Pack Kaelbling,et al.  LQR-RRT*: Optimal sampling-based motion planning with automatically derived extension heuristics , 2012, 2012 IEEE International Conference on Robotics and Automation.

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

[19]  Pierre Feyzeau,et al.  Path planning: A 2013 survey , 2013, Proceedings of 2013 International Conference on Industrial Engineering and Systems Management (IESM).

[20]  Claudio Melchiorri,et al.  B-spline based filters for multi-point trajectories planning , 2010, 2010 IEEE International Conference on Robotics and Automation.

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

[22]  Roman Fedorenko,et al.  Real-Time Long Range Trajectory Replanning for MAVs in the Presence of Dynamic Obstacles , 2020, 2020 5th Asia-Pacific Conference on Intelligent Robot Systems (ACIRS).

[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]  Alireza Babaei,et al.  Optimal Trajectory-Planning of UAVs via B-Splines and Disjunctive Programming , 2018 .

[25]  Russ Tedrake,et al.  A quadratic regulator-based heuristic for rapidly exploring state space , 2010, 2010 IEEE International Conference on Robotics and Automation.

[26]  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).