Image-Based Estimation, Planning, and Control of a Cable-Suspended Payload for Package Delivery

This letter presents an image-based approach that enables an aerial robot with a cable-suspended mechanism to find a payload with unknown mass, pick it up, transport it, and then put it down at a new location. The pick and place task is performed with minimum cable-swing angle. A new process is presented for state estimation, trajectory planning, and dynamic control using a single onboard camera and inertia measurement unit (IMU). Specifically, a new nonlinear observer, which does not require localization information from external sensors (such as a motion capture system), is created for controlling the robot's velocity. The outer position-control loop is designed in terms of the invariant image feature which is decoupled from the robot's attitude and is proved to be the flat outputs of the system. The combined estimation and control scheme is shown to be asymptotically stable in the Lyapunov sense, where damping due to air contributes to stabilizing the rates of the swing angle. The optimal trajectory of the Euclidean homography is efficiently generated to obtain dynamically-feasible trajectories for the image features. A least-square identification technique is employed to estimate the mass of each payload, and the input shaping technique is implemented to reduce payload swing motion. Finally, a practical package-delivery task is performed to validate the process, where it is shown that the robot can effectively pick up and deliver payloads on command with minimum cable-swing angle.

[1]  Rogelio Lozano,et al.  Swing-attenuation for a quadrotor transporting a cable-suspended payload. , 2017, ISA transactions.

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

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

[4]  Philippe Martinet,et al.  A generic fisheye camera model for robotic applications , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Patrick Rives,et al.  Single View Point Omnidirectional Camera Calibration from Planar Grids , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[6]  Daewon Lee,et al.  Geometric control of a quadrotor UAV transporting a payload connected via flexible cable , 2014, 1407.8164.

[7]  Davide Scaramuzza,et al.  Fast Trajectory Optimization for Agile Quadrotor Maneuvers with a Cable-Suspended Payload , 2017, Robotics: Science and Systems.

[8]  Michael Gassner,et al.  Dynamic collaboration without communication: Vision-based cable-suspended load transport with two quadrotors , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Vijay Kumar,et al.  Design, modeling, estimation and control for aerial grasping and manipulation , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Vijay Kumar,et al.  Aggressive Flight With Suspended Payloads Using Vision-Based Control , 2018, IEEE Robotics and Automation Letters.

[11]  Hesheng Wang,et al.  Nonlinear Vision-Based Observer for Visual Servo Control of an Aerial Robot in Global Positioning System Denied Environments , 2018, Journal of Mechanisms and Robotics.

[12]  François Chaumette,et al.  Optimal Camera Trajectory with Image-Based Control , 2003, Int. J. Robotics Res..

[13]  E. Malis,et al.  2 1/2 D Visual Servoing , 1999 .

[14]  William Singhose,et al.  Dynamics and Modeling of a Quadrotor with a Suspended Payload , 2018 .

[15]  Helder Araújo,et al.  Robust image-based visual servoing using invariant visual information , 2013, Robotics Auton. Syst..

[16]  Guilherme V. Raffo,et al.  Nonlinear robust control of a quadrotor UAV for load transportation with swing improvement , 2016, 2016 American Control Conference (ACC).

[17]  Hirohisa Kojima,et al.  Dynamics and command shaping control of quadcopters carrying suspended loads , 2018 .

[18]  Tom Duckett,et al.  WhyCon: an efficient, marker-based localization system , 2015 .

[19]  Olivier Faugeras,et al.  Motion and Structure from Motion in a piecewise Planar Environment , 1988, Int. J. Pattern Recognit. Artif. Intell..

[20]  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.

[21]  Evangelos A. Theodorou,et al.  Autonomous suspended load operations via trajectory optimization and variational integrators , 2017 .

[22]  Lydia Tapia,et al.  Automated aerial suspended cargo delivery through reinforcement learning , 2017, Artif. Intell..

[23]  François Chaumette,et al.  Potential problems of stability and convergence in image-based and position-based visual servoing , 1997 .