External Wrench Estimation, Collision Detection, and Reflex Reaction for Flying Robots

Flying in unknown environments may lead to unforeseen collisions, which may cause serious damage to the robot and/or its environment. In this context, fast and robust collision detection combined with safe reaction is, therefore, essential and may be achieved using external wrench information. Also, deliberate physical interaction requires a control loop designed for such a purpose and may require knowledge of the contact wrench. In principle, the external wrench may be measured or estimated. Whereas measurement poses large demands on sensor equipment, additional weight, and overall system robustness, in this paper we present a novel model-based method for external wrench estimation in flying robots. The algorithm is based on the onboard inertial measurement unit and the robot's dynamics model only. We design admittance and impedance controllers that use this estimate for sensitive and robust physical interaction. Furthermore, the performance of several collision detection and reaction schemes is investigated in order to ensure collision safety. The identified collision location and associated normal vector located on the robot's convex hull may then be used for sensorless tactile sensing. Finally, a low-level collision reflex layer is provided for flying robots when obstacle avoidance fails, also under wind influence. Our experimental and simulation results show evidence that the methodologies are easily implemented and effective in practice.

[1]  Michael Suppa,et al.  Stereo vision based indoor/outdoor navigation for flying robots , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Stefano Stramigioli,et al.  Variable impedance control for aerial interaction , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  Vincenzo Lippiello,et al.  Passivity-based control of VToL UAVs with a momentum-based estimator of external wrench and unmodeled dynamics , 2015, Robotics Auton. Syst..

[4]  Yoshihiko Nakamura,et al.  A Hybrid System Framework for Unified Impedance and Admittance Control , 2015, J. Intell. Robotic Syst..

[5]  Dario Floreano,et al.  Euler spring collision protection for flying robots , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Sami Haddadin,et al.  A unified framework for external wrench estimation, interaction control and collision reflexes for flying robots , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[7]  Stefano Stramigioli,et al.  Contact impedance estimation for robotic systems , 2005, IEEE Trans. Robotics.

[8]  Antonio Franchi,et al.  Reshaping the physical properties of a quadrotor through IDA-PBC and its application to aerial physical interaction , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Sami Haddadin,et al.  Simultaneous estimation of aerodynamic and contact forces in flying robots: Applications to metric wind estimation and collision detection , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[10]  Joris De Schutter,et al.  A hybrid pose / wrench control framework for quadrotor helicopters , 2012, 2012 IEEE International Conference on Robotics and Automation.

[11]  Lorenzo Marconi,et al.  Robust “blind” navigation for a miniature ducted-fan aerial robot , 2013, 2013 American Control Conference.

[12]  Tarek Hamel,et al.  Hardware and Software Architecture for Nonlinear Control of Multirotor Helicopters , 2013, IEEE/ASME Transactions on Mechatronics.

[13]  Claire J. Tomlin,et al.  Quadrotor Helicopter Trajectory Tracking Control , 2008 .

[14]  Robert E. Mahony,et al.  Aerodynamic power control for multirotor aerial vehicles , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[15]  Vincenzo Lippiello,et al.  Impedance control of VToL UAVs with a momentum-based external generalized forces estimator , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[16]  Neville Hogan,et al.  Impedance control - An approach to manipulation. I - Theory. II - Implementation. III - Applications , 1985 .

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

[18]  Neville Hogan,et al.  Impedance Control: An Approach to Manipulation: Part I—Theory , 1985 .

[19]  Dongjun Lee,et al.  Hybrid force/motion control and internal dynamics of quadrotors for tool operation , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  Alessandro De Luca,et al.  Collision detection and reaction: A contribution to safe physical Human-Robot Interaction , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[21]  Tarek Hamel,et al.  Introduction to Feedback Control of Underactuated VTOL Vehicles , 2013 .

[22]  Roland Siegwart,et al.  A synchronized visual-inertial sensor system with FPGA pre-processing for accurate real-time SLAM , 2014, ICRA 2014.

[23]  Christopher D. McKinnon,et al.  Unscented external force and torque estimation for quadrotors , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[24]  Teodor Tomic Evaluation of acceleration-based disturbance observation for multicopter control , 2014, 2014 European Control Conference (ECC).

[25]  Sami Haddadin,et al.  Towards Safe Robots - Approaching Asimov's 1st Law , 2013, Springer Tracts in Advanced Robotics.

[26]  Marc Pollefeys,et al.  An open source and open hardware embedded metric optical flow CMOS camera for indoor and outdoor applications , 2013, 2013 IEEE International Conference on Robotics and Automation.

[27]  Dario Floreano,et al.  Contact-based navigation for an autonomous flying robot , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[28]  Raffaello D'Andrea,et al.  Admittance control for physical human-quadrocopter interaction , 2013, 2013 European Control Conference (ECC).

[29]  Alessandro De Luca,et al.  Collision Detection and Safe Reaction with the DLR-III Lightweight Manipulator Arm , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[30]  Lorenzo Marconi,et al.  Modeling and control of a flying robot for contact inspection , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[31]  Sami Haddadin,et al.  The flying anemometer: Unified estimation of wind velocity from aerodynamic power and wrenches , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[32]  Seul Jung A Position-Based Force Control Approach to a Quad-rotor System , 2012, 2012 9th International Conference on Ubiquitous Robots and Ambient Intelligence (URAI).

[33]  Albert Albers,et al.  Semi-autonomous flying robot for physical interaction with environment , 2010, 2010 IEEE Conference on Robotics, Automation and Mechatronics.

[34]  Matteo Fumagalli,et al.  A modified impedance control for physical interaction of UAVs , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[36]  Teodor Tomic,et al.  Autonomous Vision‐based Micro Air Vehicle for Indoor and Outdoor Navigation , 2014, J. Field Robotics.

[37]  Lorenzo Marconi,et al.  Impedance control of an aerial manipulator , 2012, 2012 American Control Conference (ACC).