Vision-based minimum-time trajectory generation for a quadrotor UAV

In this paper, we address the problem of using a camera with limited field of view for controlling the motion of a quadrotor in aggressive flight regimes. We present a minimum time trajectory planning method that guarantees visibility of the image features while allowing the robot to undertake aggressive motions for which the usual near-hovering assumption is violated. We exploit differential flatness and B-Splines to parametrize the system trajectories in terms of a finite number of control points, which can then be optimized by Sequential Quadratic Programming (SQP). The control strategy is similar to a Receding Horizon Control (RHC) approach for modifying online the reference trajectory in order to account for noise, disturbances and any non-modeled effect. The algorithm is validated in a physically realistic simulation environment.

[1]  A. Benallegue,et al.  Exact linearization and noninteracting control of a 4 rotors helicopter via dynamic feedback , 2001, Proceedings 10th IEEE International Workshop on Robot and Human Interactive Communication. ROMAN 2001 (Cat. No.01TH8591).

[2]  Gregory D. Hager,et al.  Dynamic sensor planning in visual servoing , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[3]  Heinrich H. Bülthoff,et al.  An Open-Source Hardware/Software Architecture for Quadrotor UAVs , 2013 .

[4]  Giuseppe Oriolo,et al.  Aerial grasping of a moving target with a quadrotor UAV , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Carl de Boor,et al.  A Practical Guide to Splines , 1978, Applied Mathematical Sciences.

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

[7]  Vijay Kumar,et al.  Toward autonomous avian-inspired grasping for micro aerial vehicles , 2014, Bioinspiration & biomimetics.

[8]  Nicholas R. Gans,et al.  Stable Visual Servoing Through Hybrid Switched-System Control , 2007, IEEE Transactions on Robotics.

[9]  M. Fliess,et al.  Flatness and defect of non-linear systems: introductory theory and examples , 1995 .

[10]  Alkis Gotovos,et al.  Efficient visual exploration and coverage with a micro aerial vehicle in unknown environments , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[11]  Olivier Kermorgant,et al.  Dealing With Constraints in Sensor-Based Robot Control , 2014, IEEE Transactions on Robotics.

[12]  Nicholas M. Patrikalakis,et al.  Shape Interrogation for Computer Aided Design and Manufacturing , 2002, Springer Berlin Heidelberg.

[13]  Agostino Martinelli,et al.  Vision and IMU Data Fusion: Closed-Form Solutions for Attitude, Speed, Absolute Scale, and Bias Determination , 2012, IEEE Transactions on Robotics.

[14]  Peter I. Corke,et al.  Inspection of pole-like structures using a vision-controlled VTOL UAV and shared autonomy , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Albert S. Huang,et al.  Visual Odometry and Mapping for Autonomous Flight Using an RGB-D Camera , 2011, ISRR.

[16]  Robert E. Mahony,et al.  Image-Based Visual Servo Control of the Translation Kinematics of a Quadrotor Aerial Vehicle , 2009, IEEE Transactions on Robotics.

[17]  François Chaumette,et al.  Visual servo control. I. Basic approaches , 2006, IEEE Robotics & Automation Magazine.

[18]  François Chaumette,et al.  Dynamic visual servoing with image moments for a quadrotor using a virtual spring approach , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

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

[21]  Antonio Franchi,et al.  The TeleKyb framework for a modular and extendible ROS-based quadrotor control , 2013, 2013 European Conference on Mobile Robots.

[22]  Giuseppe Oriolo,et al.  Dynamic IBVS control of an underactuated UAV , 2012, 2012 IEEE International Conference on Robotics and Biomimetics (ROBIO).

[23]  Robert E. Mahony,et al.  A port-Hamiltonian approach to image-based visual servo control for dynamic systems , 2012, Int. J. Robotics Res..

[24]  Vijay Kumar,et al.  Information-theoretic mapping using Cauchy-Schwarz Quadratic Mutual Information , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[25]  Robert E. Mahony,et al.  A Practical Visual Servo Control for an Unmanned Aerial Vehicle , 2008, IEEE Transactions on Robotics.

[26]  D. Mayne,et al.  Robust receding horizon control of constrained nonlinear systems , 1993, IEEE Trans. Autom. Control..

[27]  Erkan Zergeroglu,et al.  Vision-based nonlinear tracking controllers with uncertain robot-camera parameters , 2001 .

[28]  Giuseppe Oriolo,et al.  An Adaptive Scheme for Image-Based Visual servoing of an underactuated UAV , 2014, Int. J. Robotics Autom..

[29]  Zhihao Cai,et al.  Minimum jerk trajectory generation of a quadrotor based on the differential flatness , 2016, Proceedings of 2014 IEEE Chinese Guidance, Navigation and Control Conference.

[30]  Raffaello D'Andrea,et al.  A model predictive controller for quadrocopter state interception , 2013, 2013 European Control Conference (ECC).

[31]  Peter I. Corke,et al.  Multirotor Aerial Vehicles: Modeling, Estimation, and Control of Quadrotor , 2012, IEEE Robotics & Automation Magazine.

[32]  Rafik Mebarki,et al.  Nonlinear Visual Control of Unmanned Aerial Vehicles in GPS-Denied Environments , 2015, IEEE Transactions on Robotics.

[33]  Marin Kobilarov,et al.  Optimal Visual Servoing for differentially flat underactuated systems , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[34]  Rs Roel Pieters,et al.  Visual Servo Control , 2012 .

[35]  Mark B. Milam,et al.  Real-Time Optimal Trajectory Generation for Constrained Dynamical Systems , 2003 .

[36]  Estelle Courtial,et al.  A FLAT MODEL PREDICTIVE CONTROLLER FOR TRAJECTORY TRACKING IN IMAGE BASED VISUAL SERVOING , 2007 .

[37]  Anthony Tzes,et al.  Model predictive quadrotor indoor position control , 2011, 2011 19th Mediterranean Conference on Control & Automation (MED).

[38]  Nicolas Mansard,et al.  A Qualitative Visual Servoing to ensure the Visibility Constraint , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[39]  Roland Siegwart,et al.  Monocular Vision for Long‐term Micro Aerial Vehicle State Estimation: A Compendium , 2013, J. Field Robotics.