Locally optimal trajectory planning for aerial manipulation in constrained environments

Aerial manipulation tasks necessitate a reliable trajectory planning algorithms to perform complicated tasks. This paper provides a method of developing the locally optimal trajectory for aerial manipulation in constrained environments. We first show differential flatness of the aerial manipulation system when the inertial effect due to equipped robotic arm is compensated with the aid of a robust controller. To find the locally optimal path, we parameterize flat outputs as polynomials of time, and formulate a sequential quadratic programming (SQP) problem. Given a convex mesh representation of environment, we obtain a collision-free trajectory in almost real time, by imposing constraints based on a signed distance metric. We also conduct an experiment of operating an object located in a confined space, which validates effectiveness of the proposed algorithm.

[1]  H. Jin Kim,et al.  Motion planning with movement primitives for cooperative aerial transportation in obstacle environment , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[2]  Hao Jiang,et al.  Planning and Control of Aggressive Maneuvers for Perching on Inclined and Vertical Surfaces , 2015 .

[3]  Pieter Abbeel,et al.  Finding Locally Optimal, Collision-Free Trajectories with Sequential Convex Optimization , 2013, Robotics: Science and Systems.

[4]  Christer Ericson,et al.  Real-Time Collision Detection , 2004 .

[5]  Vincenzo Lippiello,et al.  Hybrid Visual Servoing With Hierarchical Task Composition for Aerial Manipulation , 2016, IEEE Robotics and Automation Letters.

[6]  Antonio Franchi,et al.  Differential flatness and control of protocentric aerial manipulators with any number of arms and mixed rigid-/elastic-joints , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[7]  Aníbal Ollero,et al.  Control of a multirotor outdoor aerial manipulator , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Aníbal Ollero,et al.  Experiments on behavioral coordinated control of an Unmanned Aerial Vehicle manipulator system , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Christian Kirches,et al.  qpOASES: a parametric active-set algorithm for quadratic programming , 2014, Mathematical Programming Computation.

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

[11]  Markus Hehn,et al.  A Computationally Efficient Motion Primitive for Quadrocopter Trajectory Generation , 2015, IEEE Transactions on Robotics.

[12]  Vijay Kumar,et al.  Trajectory Generation and Control for Precise Aggressive Maneuvers with Quadrotors , 2010, ISER.

[13]  Matko Orsag,et al.  Towards valve turning using a dual-arm aerial manipulator , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  Roland Siegwart,et al.  Fast nonlinear Model Predictive Control for unified trajectory optimization and tracking , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[15]  Suseong Kim,et al.  Operating an unknown drawer using an aerial manipulator , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[16]  Antonio Franchi,et al.  A nonlinear force observer for quadrotors and application to physical interactive tasks , 2014, 2014 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[17]  Jean Lévine,et al.  A Flatness-Based Iterative Method for Reference Trajectory Generation in Constrained NMPC , 2009 .

[18]  Seungwon Choi,et al.  Aerial manipulation using a quadrotor with a two DOF robotic arm , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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