Full text
Received August 11, 2020, accepted August 18, 2020, date of publication September 2, 2020, date of current version September 17, 2020. Digital Object Identifier 10.1109/ACCESS.2020.3021126 Aerial Manipulator With Rolling Base for Inspection of Pipe Arrays ALEJANDRO SUAREZ , ALVARO CABALLERO , AMBAR GAROFANO , PEDRO J. SANCHEZ-CUEVAS , (Associate Member, IEEE), GUILLERMO HEREDIA , (Member, IEEE), AND ANIBAL OLLERO , (Fellow, IEEE) GRVC Robotics Labs, University of Seville, 41092 Sevilla, Spain Corresponding author: Guillermo Heredia ([email protected]) This work was supported in part by the HYbrid FLying-rolling with-snakE-aRm robot for contact inspection (HYFLIERS) under Grant H2020-ICT-25-2017-779411 and the AERIAL COgnitive integrated multi-task Robotic system with Extended operation range and safety (AERIAL-CORE) under Grant H2020-2019-871479 projects funded by the European Commission, in part by the Aerial Robotic Manipulation System with Terrestrial Locomotion to Increase Efficiency and Endurance in Maintenance Applications (ARM-EXTEND) under Grant DPI2017-89790-R and Aerial Robots for Tunnel Inspection by Contact (ARTIC) under Grant RTI2018-102224-B-I00 projects funded by the Spanish Ministerio de Economia, Industria, y Competitividad, and in part by the 2018 FPI Program of the Spanish Ministerio de Ciencia, Innovación y Universidades. ABSTRACT This paper considers the inspection by contact of long arrays of pipe structures in hard-to-reach places, typical of chemical plants or oil and gas industries, presenting the design of a hybrid rolling-aerial platform capable of landing and moving along the pipes without wasting energy in the propellers during the inspection. The presented robot overcomes the limitation in terms of operation time and positioning accuracy in the application of flying robots to industrial inspection and maintenance tasks. The robot consists of a hexa-rotor platform integrating a rolling base with velocity and direction control, and a 5-DOF (degree of freedom) robotic arm supported by a 1-DOF linear guide system that facilitates the deployment of the arm in the array of pipes to inspect their contour once the platform has landed. Given a set of points to be inspected in different arrays of pipes, the path of the multirotor and the rolling platform is planned with a hybrid RRT∗(Rapidly-exploring Random Tree) based algorithm that minimizes the energy consumption. The performance of the system is evaluated in an illustrative outdoor scenario with two arrays of pipes, using a laser tracking system to measure the position of the robot from the ground control station. INDEX TERMS Aerial manipulation, inspection and maintenance, rolling platform, path planning. I. INTRODUCTION The application of aerial manipulation robots to inspection and maintenance operations [1] in industrial scenarios like oil and gas refineries [2], [3], wind turbines [4], or bridges [5], [6] is motivated by the convenience to reduce the required time and cost with respect to conventional solutions carried out nowadays by human operators deployed on cranes and other infrastructures. The ability of multirotors [7], [8] and autonomous helicopters [9], [10] to reach quickly and easily high altitude workspaces [11]–[13] can be useful in the installation [14], [15] and retrieval [14], [16] of sensors devices in polluted areas, transportation operations [17], inspection by contact [18], [19], crack repair [20], valve turning [21] and other torsional manipulation tasks [22], or in those tasks requiring the use of tools [23]. The associate editor coordinating the review of this manuscript and approving it for publication was Yue Cao . Despite the evident benefits of aerial manipulation robots, their application in large outdoor scenarios like chemical or solar plants is severely affected by two main factors. First, the effective operation time is relatively low due to the limitation imposed by the batteries (around 10 – 20 min for a nominal payload) and the energy consumption required to maintain the aerial platform on flight during the realization of the task. In this sense, a metric of interest to be maximized is the ratio between the effective operation time in which the robot conducts the task, and the deployment time, that is, the time required to reach the workspace. It is interesting to note that most works in aerial manipulation [2]–[23] assume that the robot operates on flight, without considering the possibility to land or perch. In order to avoid the waste of energy, some perching mechanisms have been proposed [24], allowing the realization of manipulation tasks while suspending from cables or poles [25]. Second, the success in the realization of manipulation tasks on flight is closely related with the positioning accuracy of the manipulator and the platform, 162516 This work is licensed under a Creative Commons Attribution 4.0 License. For more information, see https://creativecommons.org/licenses/by/4.0/ VOLUME 8, 2020
A. Suarez et al.: Aerial Manipulator With Rolling Base for Inspection of Pipe Arrays FIGURE 1. Aerial manipulator with rolling base inspecting an array of pipes. taking into account that the reaction wrenches caused by the arm [7], [8] may induce position errors above its reach. This reinforces the idea of conducting the inspection task once the aerial robot has landed, using a wheeled base [26] to move the robot along the area of interest. The synergistic combination of the wheeled base with the aerial platform has been already considered in works like [27], [28]. Ground-based manipulator arms are used nowadays in multiple areas. Precision motion control allows for high accuracy dynamic positioning, which is essential in many industrial applications [29]. Furthermore, the estimation of the inertial parameters of the payload [30] is of increasing importance since it can be used for better model compensation in motion control, collision detection and contact force estimation for human interaction [31]. On the other hand, manipulator arms mounted on aerial platforms for aerial manipulation have severe design constraints coming from the aerial platform payload limitations and dynamic coupling with the movement of the arm [7], [37]. Several lightweight robotic arms with different kinematic configurations and morphologies have been designed for its integration in multirotor platforms [7], [16], [32], demonstrating the possibility to conduct tasks like object grasping [33], structure construction [34], or inspection by contact [3]. Since most aerial manipulators are intended to operate on flight, it is expected that impacts and collisions with the environment arise due to the unavoidable position deviations in the floating base, what has motivated the development of compliant manipulators [15], [16], [35], [36] that integrate an elastic element in the joints or links to prevent that either the manipulator is damaged or the aerial platform is destabilized. However, this mechanical feature increases the weight and reduces the positioning accuracy at the end effector [37], complicating the realization of the inspection task. The main contribution of this paper is the design, development, and experimental validation of an aerial manipulation robot, shown in Fig. 1, intended to inspect long arrays of pipe structures in hard-to-reach places typical of chemical plants, replacing the landing gear by a rolling base that allows the robot to move along the pipes without wasting energy in the propellers. This wheeled-aerial robot consists of a hexarotor platform equipped with a 5-DOF robotic arm supported by a 1-DOF linear guide system, the rolling base with velocity and direction control, and the onboard computer. The paper firstly describes the application scenarios, considering the usual requirements in industrial inspection operations, presenting then the proposed technological solution, which comprises the design of the rolling base, the manipulator, and the integration in the aerial platform. Given a set of points to be inspected located in different arrays of pipes, a planning method based on the RRT∗algorithm is developed to compute the reference path of the multirotor and the rolling base in such a way that the energy required in the task is minimized. The application of the developed system is validated in an inspection task carried out in an illustrative outdoor scenario. The rest of the paper is organized as follows. Section II describes the intended application and the developed system. Section III covers the modelling and control, whereas Section IV is focused on the planning method. Experimental results in outdoors are shown in Section V, summarizing in Section VI the conclusions of this work. II. SYSTEM DESIGN A. PROBLEM STATEMENT As stated in the introduction, this paper is focused on the inspection of long arrays of pipe structures in chemical plants, like the one illustrated in Fig. 2. The inspection task carried out by a human operator typically consists of placing a sensor device in different points of interest along the surface of the pipes to measure the thickness [2], [3] or detect leaks at the bottom of the pipes. Although the execution of the operation itself is relatively simple, most of the time is devoted to reaching the workspace safely following a strict protocol to reduce the risk of accidents. In this sense, the use of aerial inspection robots simplifies significantly the realization of FIGURE 2. Illustrative industrial scenario with several arrays of pipe structures. VOLUME 8, 2020 162517
A. Suarez et al.: Aerial Manipulator With Rolling Base for Inspection of Pipe Arrays this kind of operations, reducing the time and cost. The idea is to integrate the inspection device in a lightweight robotic arm capable of reaching the contour of the pipe. However, there are two main limitations in the practical application of this technology in industrial scenarios. Firstly, most of the inspection devices commercially available are designed for human operation, so they are not suitable for their integration in an aerial platform in terms of weight or size. Secondly, the limited capacity of the batteries and the lack of positioning accuracy on flight makes convenient the use of more efficient mobile platforms like wheeled bases [26], [27] in order to extend the endurance of the operation, trying to avoid the battery swap. In order to overcome these problems, the paper proposes the use of a hybrid rolling-aerial platform. B. INSPECTION OPERATION The proposed approach for the inspection of pipe arrays with the rolling-aerial manipulation robot is represented in Fig. 3. The system comprises two actors and three components: •The human operator, who determines the inspection points and supervises the operation of the robot. •The safety pilot, responsible of the aerial platform. •The rolling-aerial manipulation robot that performs the inspection of the pipes with the robotic arm. •The positioning system (RTK GPS, laser tracker) used to measure accurately the position of the drone. FIGURE 3. Flow diagram of the inspection operation. FIGURE 4. Rendered view of the rolling-aerial manipulator. •The Ground Control Station (GCS) laptop from which the operation of the aerial robot is controlled. Given a map or model of the environment, the operator selects in the first place the sequence of inspection points to be checked. The mission planner (Section IV), executed in the onboard computer, generates the reference path that is transferred to the multirotor controller before the start of the operation. Once the inspection robot and the GCS are set up in the take-off area, the operation is conducted according to the flow diagram depicted in Fig. 3. The inspection task consists of reaching the point of interest with the rolling base, deploy the manipulator in the gap between the pipes, and track the contour of the pipe with the end effector. If a defect in the surface is detected by the sensor, it is marked on the map. Then, the arm is recovered and the rolling platform moves to the next inspection point. C. ROLLING-AERIAL PLATFORM The rolling-aerial platform consists of a hexarotor platform manufactured at the GRVC Robotics Labs and a customized rolling base that replaces the conventional landing gear. The hexarotor (116 ×116 cm size, 2.4 kg weight) is built with a carbon fiber frame structure that supports the six Antigravity MN4006 brushless motors with 15 ×5’’ propellers, providing 3 kg payload and around 30 min flight time with no load. The multirotor integrates a Pixhawk autopilot and a Raspberry Pi 3B+to implement the control architecture described in Section II-E. Fig. 4 shows a rendered view of the platform integrating the manipulator, described in next subsection. As done in [5], the position of the multirotor is measured with a Leica MS50 robotic total station and the GRZ101 360◦Mini-prism placed on the multirotor frame. This allows achieving accuracies of 1 cm during the flight and less than 0.1 cm when the platform is landed and carrying out the inspection, which is better than the accuracy of a GPS-RTK typically employed in outdoors. The rolling base is designed to facilitate the displacement of the robot along arrays of two or more pipes of sections up to 20 cm Ø and identical separation. Two rollers (60 cm length) are attached to a carbon fiber base: one for the longitudinal 162518 VOLUME 8, 2020
A. Suarez et al.: Aerial Manipulator With Rolling Base for Inspection of Pipe Arrays motion, actuated by a continuous rotation RC servo (Power HD AR-3606HB, 6.7 kg·cm rated torque, 71 rpm), and other to control the direction using a Herkulex DRS-0402 (50 kg·cm rated torque, 125 g weight). These components are illustrated in Fig. 5, indicating in Table 1 their features. FIGURE 5. Assembly of the rolling platform (up) and detailed view of the rollers (down). The rollers consist of a number of PLA (polylactic acid) plastic disks and a filaflex tire, all made by 3D printing. The external coating of the rollers has been manufactured in filaflex to facilitate the accommodation of the roller to the contour of the pipes. In addition, as detailed in Fig. 5, the tire has a rough surface to enhance adhesion and avoid slipping. The PLA disks are inserted in a carbon fiber tube supported by a pair of ball bearings. Other materials such as wood, aluminum or steel have been employed in the prototype. Wood has been used to create plates to support the aerial platform and rollers. Aluminum is present in the crank-crank mechanism and in the spacers, and steel in the screws and nuts. The mass density of each of the materials used is shown in Table 1. The total weight of the rolling base is 1.3 kg, showing its mass distribution in Fig. 6. FIGURE 6. Mass distribution on the rolling platform. TABLE 1. Mass density of the different components used in the rolling base. As can be seen, a significant fraction of the total weight is devoted to the filaflex tires. As mentioned before, the landing gear is replaced by the two rollers of length 605 mm and 48 mm Ø, with a separation of 220 mm between them. The height of the rolling base w.r.t. the multirotor base is 174 mm. The center of rotation of the direction servo (Herkulex DRS-0402) is located at the mid-point of the base plate, at 110 mm from the axis of rotation of the rollers, using a double bar-lever transmission to rotate the direction roller with a maximum amplitude of 30 degrees. Fig. 7 shows the representative distances of the developed prototype. D. ROBOTIC ARM FOR INSPECTION OF PIPE ARRAYS The robotic manipulator to be deployed on the pipe arrays is designed to facilitate the access to the contour of the pipes from the sides and from below, where the defects are usually concentrated. The developed prototype, depicted in Fig. 1 and Fig. 8, consists of a lightweight robotic arm with three joints for end-effector positioning, two joints for wrist orientation, and an actuated linear guide system that allows the transverse displacement of the arm to access the gap between the pipes. The arm implements partially the anthropomorphic kinematic configuration described in [15], removing the shoulder roll joint to reduce the total weight. A customized frame structure manufactured in anodized aluminum supports the Herkulex DRS-0101 servos of the shoulder and elbow joints, as well as the customized micro servo VOLUME 8, 2020 162519
A. Suarez et al.: Aerial Manipulator With Rolling Base for Inspection of Pipe Arrays FIGURE 7. Front and side view of the rolling base, including the representative distances. actuators built with the Pololu micro metal gear motors used in the wrist joints. Fig. 9 shows in more detail the developed micro servo, comprising the three polymer frame parts (the bearing and the cases), the Murata SV01-A potentiometer used to measure the rotation angle, the Pololu micro metal gear motor 250:1, and the microcontroller board. The actuator, weighing 25 grams, with a size of 22 ×22 ×35 mm, provides a maximum torque around 0.2 Nm with a maximum speed of 300 deg/s [41]. The linear guide system that supports the arm is built with the igus NS-01-17-600 profile and the NW-02-17 carriage, using a timing pulley-belt mechanism driven by a Pololu micro-motor to move the arm transversally. Fig. 10 illustrates the assembly of the different structures of the manipulator, indicating in Table 2 the mass of the different parts. TABLE 2. Mass distribution of the manipulator. E. COMPONENTS AND ARCHITECTURE The architecture of the rolling-aerial manipulation robot comprises three main systems, as represented in Fig. 11. The multirotor integrates the Pixhawk autopilot that implements the position/trajectory controller, and the Raspberry Pi 3B+ computer on which the different software modules are executed. These are the mission planner, the manipulator control FIGURE 8. 5-DOF inspection arm supported by a 1-DOF linear guide system. 162520 VOLUME 8, 2020
A. Suarez et al.: Aerial Manipulator With Rolling Base for Inspection of Pipe Arrays FIGURE 9. Customized micro-servo actuator employed in the linear guide system and in the wrist joints of the manipulator. FIGURE 10. Assembly of the structures of the manipulator, including their weight. program, and the aerial platform control interface [39], [40]. The rolling base has two servos, the speed servo and the direction servo, using a STM32 microcontroller board to interface them with the Raspberry Pi 3B+through an USART interface. The robotic manipulator contains two groups of servos: three Herkulex DRS-0101 actuators used for end-effector positioning, and the customized micro servos of the linear guide and the wrist joints [41]. Both groups are connected in daisy chain to the RPi through the respective USART interfaces. III. MODELLING AND CONTROL A. REFERENCE FRAMES AND MODELLING Four reference frames are defined for convenience in the formulation of the pipe inspection task: the Earth-fixed frame {E}(inertial), the multirotor base frame {B}attached to the IMU, the manipulator frame {0}attached to the base of the support structure, and the local frame of the i-th pipe array {Pi}, whose origin corresponds to the landing point, with the XPi axis pointing in the direction of the array. These can be FIGURE 11. Components and architecture of the rolling-aerial manipulation robot. identified in Fig. 12. The multirotor position referred to the Earth-fixed frame and with respect to the pipe array frame will be denoted by ErBand PirB, respectively, whereas EpIP (a,k) represents the position of the inspection points where the arm is deployed to inspect the pipe contour. Sub-indices (a,k) indicate the array and the particular inspection point in the array. The orientation of the multirotor is represented by the roll, pitch and yaw angles, η=[φ, θ, ψ]T. Finally, the four coordinate systems can be related through the homogeneous transformation matrices ETB,ETPi, and BT0∈ <4×4. B. ROLLING PLATFORM KINEMATICS AND CONTROL The rolling platform extends the mobility of the inspection robot w.r.t. our previous aerial manipulation prototypes [7], [15], allowing the displacement along the pipes with velocity and direction control using the servos identified in Fig. 5. The kinematic model of the rolling base can be assimilated to the classical tricycle configuration [42], [43], as illustrated in Fig. 13, assuming that the steering angle γis relatively small so the speed along the longitudinal section of the rollers does not significantly vary. The mechanical construction of the rollers constraints the motion of the platform on the pipes to the plane defined by the XPiYPiaxes, representing its position by the coordinates (xB,yB) relative to the pipe local frame {Pi}. The rotation angle of the direction roller, that is, the steering angle, is represented by γ, whereas ψBis the yaw orientation angle relative to the pipe frame. The linear speed of the platform is given by the angular speed of the continuous rotation servo, ω, and the radius rof the rollers, v=r·ω. The intersection of the dashed lines along the rollers in Fig. 13 defines the Instantaneous Center of Rotation (ICR) of the platform, VOLUME 8, 2020 162521
A. Suarez et al.: Aerial Manipulator With Rolling Base for Inspection of Pipe Arrays FIGURE 12. Reference frames and vectors associated to the inspection task. FIGURE 13. Kinematic model of the rolling base corresponding to the tricycle configuration. which determines the rate of change in the orientation angle as function of the forward speed and the steering angle: ˙ ψB=v R=v `tan(γ) (1) Here Ris the radius of curvature and `is the distance between the front and rear rollers. The trajectory followed by the rolling base is obtained integrating the components of the velocity vector, given by: Pi˙xB=cos(γ)·cos (ψB)·v(2) Pi˙yB=cos(γ)·sin (ψB)·v(3) FIGURE 14. Tracking a path of the rolling base. In order to reach the particular inspection point indicated by the operator (see Fig. 3) from the landing position in the pipe array, the rolling platform will take as reference the path provided by the mission planner, represented as a sequence of way points {xref B,yref B, ψref B}. This is illustrated in Fig. 14. The control scheme of the rolling base consists of two independent controllers: a proportional-integral controller (PI) with anti wind-up to regulate the forward speed, and a proportional (P) controller for the direction servo [44]: vref =vmax ifep>eth p Kpep+KiRepdt if ep≤eth p(4) γref =Kheψ,Kh>0 (5) Here vref and γref are the references given to the servos, epis the position error, whereas eψis the orientation error: ep=rxref B−xB2+yref B−yB2(6) 162522 VOLUME 8, 2020
A. Suarez et al.: Aerial Manipulator With Rolling Base for Inspection of Pipe Arrays eψ=tan−1 yref B−yB xref B−xB!−ψB(7) The control scheme of the rolling platform is depicted in Fig. 15. The mission planner provides the reference position and orientation relative to the pipe local frame. The errors given by Eq. (6) and (7) are taken as input by the PI and P controllers, generating the velocity and direction references for the forward and direction servos. FIGURE 15. Control scheme of the rolling platform. C. MANIPULATOR KINEMATICS AND CONTROL As indicated in Section II-D, the manipulator integrated into the rolling-aerial platform provides six degrees of freedom for end-effector positioning and orientation. The kinematic configuration, illustrated in Fig. 16, consists of the linear guide (1-DOF) at the base, the shoulder (2-DOF) and elbow (1-DOF) joints, and the wrist (2-DOF). For convenience, the origin of the manipulator reference frame, {0}, is placed at the midpoint of the support structure, with the X0axis pointing forwards. The prismatic joint d0corresponds to the FIGURE 16. Kinematic/geometric model of the inspection arm and pipe array. transversal displacement along the Y0axis that allows the arm to be deployed in the gap between the pipes of the array. Note that for this purpose, the arm must be lifted above the array through the shoulder joint to avoid the collision with the pipes (see Section V-C). The arm implements partially the anthropomorphic kinematics [15] with three joints for end-effector positioning and two for wrist orientation: shoulder pitch (q1), shoulder yaw (q2), elbow pitch (q3), wrist roll (q4) and wrist pitch (q5). The shoulder roll joint is removed to reduce the weight and because it is not essential for the intended operation. The analytical resolution of the forward-inverse kinematics of the arm can be found in [15] (imposing that the shoulder roll angle is zero), defining here the mapping functions that relate the joint variables with the tool center point (TCP) position: 0rTCP =FK (d0,q1,q2,q3)(8) q1 q2 q3 =IK 0rTCP,d0(9) The idea of the linear guide system and the corresponding degree of freedom represented by the displacement d0is to facilitate the access of the end effector to the bottom of the pipes through the gap between two consecutive pipes in the array. Since the rolling platform cannot be moved laterally, this mechanism can be used by the operator or the controller to accurately positioning the manipulator. Note that d0can be considered as a redundant joint for the TCP positioning, whose value will be determined by the separation and the section of the pipes, Spipe and Dpipe respectively. Assuming that the manipulator is aligned with the array (X0parallel to XPi), and denoting by 1yBthe displacement of X0w.r.t. the midpoint of the closest pipe measured along the YPiaxis, then this value is given by: d0=Dpipe +Spipe 2−1yB(10) The full pose of the end effector relative to the base frame can be obtained from the transformation matrices of the arm: 0TTCP = 1 Y i=5 i−1Ti(qi)=0RTCP 0rTCP 01×31(11) where 0RTCP is the rotation matrix of the tool center point. Since in practice the inspection points may be expressed in the Earth fixed frame (EpIP (a,k)), it is necessary to apply a sequence of transformations to compute these coordinates in the manipulator local frame: 0pIP (a,k) 1=0TB·BTE·EpIP (a,k) 1(12) For the realization of the pipe inspection task described in Section V-C, three control modes are implemented: •Positioning: the linear guide drives the arm to the gap between the pipes before its deployment. VOLUME 8, 2020 162523
A. Suarez et al.: Aerial Manipulator With Rolling Base for Inspection of Pipe Arrays •Rotation sequence: the servos generate a predefined sequence of rotations to deploy and retrieve the arm through the gap between the pipes. •Trajectory tracking: the inspection task consists of tracking the contour of the pipe given by a sequence of waypoints. The contour of two adjacent pipes can be parametrized by a three-segment curve (green dashed line in Fig. 16) defined in three time intervals, 0 ≤t<TA,TA≤t<TB, and TB≤t<TC: x y z = x0 Spipe 2+A+A·cos πt TA z0−A·sin πt TA (13) x y z = x0 Spipe 2−Spipe ·t−TA TB−TA z0 (14) x y z = x0 −Spipe 2−A+A·cos πt−TB TC−TB z0−A·sin πt−TB TC−TB (15) In the experiment described in Section V-C, the following parameters were taken: Spipe =0.1[m], A=0.1[m], TA=3[s], TB=5[s], and TC=8[s]. The proposed control scheme of the manipulator, depicted in Fig. 17, relies on the embedded position controller of the Herkulex servos [7], [15] and the forward/inverse kinematic model [15] to track the contour trajectory given by Eq. (13) – (15). Each of the servos takes as input the goal position and playtime, that is, the required time to reach FIGURE 17. Control scheme of the manipulator based on the inverse kinematic model. the angular reference from the current position. The servo, characterized by a first order dynamics [38], gives as output the position feedback along with the joint speed or PWM (pulse width modulation) signal, which can be used for estimating the motor torque [7] or detecting overloads due to collisions. The trajectory generator block provides the sequence of Cartesian position references at 50 Hz, transformed into the joint space through the inverse kinematic model given by Equation (9), and sent at the midpoint of the trapezoidal velocity profile to ensure the smooth trajectory tracking. This avoids undesired acceleration peaks in the arm. The TCP position error, εTCP, obtained from the position reference and the current TCP position given by Eq. (8), is taken as input by the Collision Detector block, which monitors the position error to detect and react against unexpected collisions with the pipe array, protecting in this way the actuators. A similar procedure is applied for the wrist actuators, since the customized micro-servos also implement an embedded position controller [41]. D. MULTIROTOR CONTROL The kinematic and dynamic model of the multirotor vehicle can be found in [7], [15]. Note that, since the manipulator only operates once the platform has landed, the dynamics of the aerial platform is not affected by reaction wrenches caused by the arm, as occurs in [7], [8]. The multirotor controller is an adapted version of the PX4 firmware [39] implemented in a Pixhawk autopilot. The system employs a Raspberry Pi model 3B+running the UAV Abstraction Layer [40] to select and swap between different control modes (position, velocity, trajectory), and other basic functionalities (take-off, landing). From the control point of view, in this system the multirotor controller is not affected by endogenous or exogenous wrenches induced by the manipulator [7] as this does not operate on flight. The arm only moves when the platform is landed on the pipes. This means that the dynamic model of the multirotor can be formulated in the usual matrix form: M(ξ)¨ ξ+C˙ ξ,ξ˙ ξ+G=F+Fe(16) where ξ∈<6is the vector of generalized coordinates, defined as ξ=[rB, φ, θ, ψ]T,M∈ <6×6is the generalized inertia matrix, C∈<6represents centrifugal and Coriolis forces, G∈<6the gravitational terms, Fe∈<6includes the external wrenches that are not known or modelled, whereas, Fis the vector of generalized forces. Those forces can be expressed as: F=ERB03×3 03×3I3×3 0 0 FB (17) where FB=Uz,Uφ,Uθ,UψTrepresents the thrust and moments produced by the rotors, which can be expressed in 162524 VOLUME 8, 2020
A. Suarez et al.: Aerial Manipulator With Rolling Base for Inspection of Pipe Arrays REFERENCES [1] A. Ollero, J. Cortes, A. Santamaria-Navarro, M. A. T. Soto, R. Balachandran, J. Andrade-Cetto, A. Rodriguez, G. Heredia, A. Franchi, G. Antonelli, K. Kondak, A. Sanfeliu, A. Viguria, J. R. Martínez-de-Dios, and F. Pierri, ‘‘The AEROARMS project: Aerial robots with advanced manipulation capabilities for inspection and maintenance,’’ IEEE Robot. Autom. Mag., vol. 25, no. 4, pp. 12–23, Dec. 2018. [2] M. Trujillo, J. R. Martínez-de-Dios, C. Martín, A. Viguria, and A. Ollero, ‘‘Novel aerial manipulator for accurate and robust industrial NDT contact inspection: A new tool for the oil and gas inspection industry,’’ Sensors, vol. 19, no. 6, p. 1305, Mar. 2019. [3] M. Tognon, H. A. T. Chavez, E. Gasparin, Q. Sable, D. Bicego, A. Mallet, M. Lany, G. Santi, B. Revaz, J. Cortes, and A. Franchi, ‘‘A truly-redundant aerial manipulator system with application to push-and-slide inspection in industrial plants,’’ IEEE Robot. Autom. Lett., vol. 4, no. 2, pp. 1846–1851, Apr. 2019. [4] Aerones Drone for Wind Turbine Cleaning. Accessed: Sep. 4, 2020. [Online]. Available: https://www.youtube.com/watch?v=eBVRQDR Y5mY [5] A. E. Jimenez-Cano, P. J. Sanchez-Cuevas, P. Grau, A. Ollero, and G. Heredia, ‘‘Contact-based bridge inspection multirotors: Design, modeling, and control considering the ceiling effect,’’ IEEE Robot. Autom. Lett., vol. 4, no. 4, pp. 3561–3568, Oct. 2019. [6] T. Ikeda, T. Ikeda, S. Yasui, M. Fujihara, K. Ohara, S. Ashizawa, A. Ichikawa, A. Okino, T. Oomichi, and T. Fukuda, ‘‘Wall contact by octo-rotor UAV with one DoF manipulator for bridge inspection,’’ in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst. (IROS), Vancouver, BC, Canada, Sep. 2017, pp. 5122–5127. [7] A. Suarez, A. E. Jimenez-Cano, V. M. Vega, G. Heredia, A. Rodriguez-Castaño, and A. Ollero, ‘‘Design of a lightweight dual arm system for aerial manipulation,’’ Mechatronics, vol. 50, pp. 30–44, Apr. 2018. [8] F. Ruggiero, M. A. Trujillo, R. Cano, H. Ascorbe, A. Viguria, C. Perez, V. Lippiello, A. Ollero, and B. Siciliano, ‘‘A multilayer control for multirotor UAVs equipped with a servo robot arm,’’ in Proc. IEEE Int. Conf. Robot. Automat. (ICRA), Seattle, WA, USA, May 2015, pp. 4014–4020. [9] P. E. I. Pounds, D. R. Bersak, and A. M. Dollar, ‘‘The yale aerial manipulator: Grasping in flight,’’ in Proc. IEEE Int. Conf. Robot. Automat., Shanghai, China, May 2011, pp. 2974–2975. [10] K. Kondak, F. Huber, M. Schwarzbach, M. Laiacker, D. Sommer, M. Bejar, and A. Ollero, ‘‘Aerial manipulation robot composed of an autonomous helicopter and a 7 degrees of freedom industrial manipulator,’’ in Proc. IEEE Int. Conf. Robot. Automat. (ICRA), Hong Kong, May 2014, pp. 2107–2112. [11] K. Mohta, M. Watterson, Y. Mulgaonkar, S. Liu, C. Qu, A. Makineni, K. Saulnier, K. Sun, A. Zhu, J. Delmerico, K. Karydis, N. Atanasov, G. Loianno, D. Scaramuzza, K. Daniilidis, C. J. Taylor, and V. Kumar, ‘‘Fast, autonomous flight in GPS-denied and cluttered environments,’’ J. Field Robot., vol. 35, no. 1, pp. 101–120, 2018. [12] T. Tomic, M. Maier, and S. Haddadin, ‘‘Learning quadrotor maneuvers from optimal control and generalizing in real-time,’’ in Proc. IEEE Int. Conf. Robot. Automat. (ICRA), Hong Kong, May 2014, pp. 1747–1754. [13] F. Duchoň, D. Huňady, M. Dekan, and A. Babinec, ‘‘Optimal navigation for mobile robot in known environment,’’ Appl. Mech. Mater., vol. 282, pp. 33–38, Jan. 2013. [14] S. Hamaza, I. Georgilas, M. Fernandez, P. Sanchez, T. Richardson, G. Heredia, and A. Ollero, ‘‘Sensor installation and retrieval operations using an unmanned aerial manipulator,’’ IEEE Robot. Autom. Lett., vol. 4, no. 3, pp. 2793–2800, Jul. 2019. [15] A. Suarez, G. Heredia, and A. Ollero, ‘‘Design of an anthropomorphic, compliant, and lightweight dual arm for aerial manipulation,’’ IEEE Access, vol. 6, pp. 29173–29189, 2018. [16] A. Suarez, F. Real, V. M. Vega, G. Heredia, A. Rodriguez-Castano, and A. Ollero, ‘‘Compliant bimanual aerial manipulation: Standard and long reach configurations,’’ IEEE Access, vol. 8, pp. 88844–88865, 2020. [17] A. Caballero, A. Suarez, F. Real, V. M. Vega, M. Bejar, A. Rodriguez-Castano, and A. Ollero, ‘‘First experimental results on motion planning for transportation in aerial long-reach manipulators with two arms,’’ in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst. (IROS), Madrid, Spain, Oct. 2018, pp. 8471–8477. [18] M. Fumagalli, R. Naldi, A. Macchelli, F. Forte, A. Q. L. Keemink, S. Stramigioli, R. Carloni, and L. Marconi, ‘‘Developing an aerial manipulator prototype: Physical interaction with the environment,’’ IEEE Robot. Autom. Mag., vol. 21, no. 3, pp. 41–50, Sep. 2014. [19] A. Suarez, P. Sanchez-Cuevas, M. Fernandez, M. Perez, G. Heredia, and A. Ollero, ‘‘Lightweight and compliant long reach aerial manipulator for inspection operations,’’ in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst. (IROS), Madrid, Spain, Oct. 2018, pp. 6746–6752. [20] P. Chermprayong, K. Zhang, F. Xiao, and M. Kovac, ‘‘An integrated delta manipulator for aerial repair: A new aerial robotic system,’’ IEEE Robot. Autom. Mag., vol. 26, no. 1, pp. 54–66, Mar. 2019. [21] C. Korpela, M. Orsag, and P. Oh, ‘‘Towards valve turning using a dualarm aerial manipulator,’’ in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst. (IROS), Sep. 2014, pp. 3411–3416. [22] S. Shimahara, S. Leewiwatwong, R. Ladig, and K. Shimonomura, ‘‘Aerial torsional manipulation employing multi-rotor flying robot,’’ in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst. (IROS), Daejeon, South Korea, Oct. 2016, pp. 1595–1600. [23] H.-N. Nguyen, S. Park, and D. Lee, ‘‘Aerial tool operation system using quadrotors as rotating thrust generators,’’ in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst. (IROS), Sep. 2015, pp. 1285–1291. [24] C. E. Doyle, J. J. Bird, T. A. Isom, J. C. Kallman, D. F. Bareiss, D. J. Dunlop, R. J. King, J. J. Abbott, and M. A. Minor, ‘‘An avianinspired passive mechanism for quadrotor perching,’’ IEEE/ASME Trans. Mechatronics, vol. 18, no. 2, pp. 506–517, Apr. 2013. [25] H. Paul, K. Ono, R. Ladig, and K. Shimonomura, ‘‘A multirotor platform employing a three-axis vertical articulated robotic arm for aerial manipulation tasks,’’ in Proc. IEEE/ASME Int. Conf. Adv. Intell. Mechatronics (AIM), Auckland, New Zealand, Jul. 2018, pp. 478–485. [26] K. H. Cho, H. M. Kim, Y. H. Jin, F. Liu, H. Moon, J. C. Koo, and H. R. Choi, ‘‘Inspection robot for hanger cable of suspension bridge: Mechanism design and analysis,’’ IEEE/ASME Trans. Mechatronics, vol. 18, no. 6, pp. 1665–1674, Dec. 2013. [27] B. Arbanas, A. Ivanovic, M. Car, M. Orsag, T. Petrovic, and S. Bogdan, ‘‘Decentralized planning and control for UAV-UGV cooperative teams,’’ Auton. Robots, vol. 42, no. 8, pp. 1601–1618, Dec. 2018. [28] S. Zhao, F. Ruggiero, G. A. Fontanelli, V. Lippiello, Z. Zhu, and B. Siciliano, ‘‘Nonlinear model predictive control for the stabilization of a wheeled unmanned aerial vehicle on a pipe,’’ IEEE Robot. Autom. Lett., vol. 4, no. 4, pp. 4314–4321, Oct. 2019. [29] W. K. Chung, L. C. Fu, and T. Kröger, ‘‘Motion control,’’ in Springer Handbook of Robotics, B. Siciliano and O. Khatib, Eds. Cham, Switzerland: Springer, 2016. [30] N. Mavrakis and R. Stolkin, ‘‘Estimation and exploitation of objects ’ inertial parameters in robotic grasping and manipulation: A survey,’’ Robot. Auton. Syst., vol. 124, Feb. 2020, Art. no. 103374. [31] J. Hu, C. Li, Z. Chen, and B. Yao, ‘‘Precision motion control of a 6- DoFs industrial robot with accurate payload estimation,’’ IEEE/ASME Trans. Mechatronics, vol. 25, no. 4, pp. 1821–1829, Aug. 2020, doi: 10.1109/TMECH.2020.2994231. [32] C. D. Bellicoso, L. R. Buonocore, V. Lippiello, and B. Siciliano, ‘‘Design, modeling and control of a 5-DoF light-weight robot arm for aerial manipulation,’’ in Proc. 23rd Medit. Conf. Control Automat. (MED), Torremoli, Spain, Jun. 2015, pp. 853–858. [33] S. Kim, S. Choi, and H. J. Kim, ‘‘Aerial manipulation using a quadrotor with a two DOF robotic arm,’’ in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst., Tokyo, Japan, Nov. 2013, pp. 4990–4995. [34] R. Cano, C. Pérez, F. Pruano, A. Ollero, and G. Heredia, ‘‘Mechanical design of a 6-DOF aerial manipulator for assembling structures using UAVs,’’ in Proc. 2nd RED-UAS Workshop Res., Educ. Develop. Unmanned Aerial Syst., 2013, pp. 1–7. [35] T. Bartelds, A. Capra, S. Hamaza, S. Stramigioli, and M. Fumagalli, ‘‘Compliant aerial manipulators: Toward a new generation of aerial robotic workers,’’ IEEE Robot. Autom. Lett., vol. 1, no. 1, pp. 477–483, Jan. 2016, doi: 10.1109/LRA.2016.2519948. [36] B. Yuksel, S. Mahboubi, C. Secchi, H. H. Bulthoff, and A. Franchi, ‘‘Design, identification and experimental testing of a light-weight flexiblejoint arm for aerial physical interaction,’’ in Proc. IEEE Int. Conf. Robot. Automat. (ICRA), Seattle, WA, USA, May 2015, pp. 87–870. [37] A. Suarez, V. M. Vega, M. Fernandez, G. Heredia, and A. Ollero, ‘‘Benchmarks for aerial manipulation,’’ IEEE Robot. Autom. Lett., vol. 5, no. 2, pp. 2650–2657, Apr. 2020. [38] A. Suarez, G. Heredia, and A. Ollero, ‘‘Physical-virtual impedance control in ultralightweight and compliant dual-arm aerial manipulators,’’ IEEE Robot. Autom. Lett., vol. 3, no. 3, pp. 2553–2560, Jul. 2018. VOLUME 8, 2020 162531
A. Suarez et al.: Aerial Manipulator With Rolling Base for Inspection of Pipe Arrays [39] L. Meier, D. Honegger, and M. Pollefeys, ‘‘PX4: A node-based multithreaded open source robotics framework for deeply embedded platforms,’’ in Proc. IEEE Int. Conf. Robot. Automat. (ICRA), Seattle, WA, USA, May 2015, pp. 6235–6240. [40] F. Real, A. Torres-González, P. Ramon-Soria, J. Capitan, and A. Ollero, ‘‘UAL: An abstraction layer for unmanned aerial vehicles,’’ in Proc. 2nd Int. Symp. Aerial Robot., 2018, pp. 1–5. [41] A. Suarez, P. Grau, G. Heredia, and A. Ollero, ‘‘Winged aerial manipulation robot with dual arm and tail,’’ Appl. Sci., vol. 10, no. 14, p. 4783, Jul. 2020. [42] C. C. de Wit, B. Siciliano, and G. Bastin, Eds., Theory of Robot Control. Berlin, Germany: Springer-Verlag, 2012. [43] J. A. Batlle and A. Barjau, ‘‘Holonomy in mobile robots,’’ Robot. Auton. Syst., vol. 57, no. 4, pp. 433–440, Apr. 2009. [44] P. Cork, Robotics, Vision and Control, vol. 118. Berlin, Germany: Springer- Verlag, 2017. [45] S. Karaman and E. Frazzoli, ‘‘Sampling-based algorithms for optimal motion planning,’’ Int. J. Robot. Res., vol. 30, no. 7, pp. 846–894, Jun. 2011. ALEJANDRO SUAREZ received the degree in telecommunication engineering, the M.Sc. degree in automation and robotics, and the Ph.D. degree in robotics from the University of Seville, Spain, in 2012, 2013, and 2019, respectively. He was employed in the Robotics, Vision and Control Group, since 2012, working in the FP7 ECSAFEMOBIL project, and in the PERIGEO and CLEAR Spanish projects. In 2014, he received the FPU Grant from the Spanish Ministry of Education, Culture and Sport for supporting, as a Ph.D. Student. His research activity includes the frame of the AEROARMS H2020 project. He stayed for three months at the Robotics and Mechatronics Institute of the DLR, Oberpfaffenhofen. He is currently working in the AERIAL-CORE H2020 Project and in the ERC Advanced GRIFFIN Project. His research interests include humanoid robots and the development of anthropomorphic, compliant, and lightweight robotic arms. ALVARO CABALLERO received the degree in aerospace engineering with specialization in aerospace vehicles and the M.Sc. degree in aeronautical engineering from the University of Seville, Spain, in 2014 and 2016, respectively. He is currently pursuing the Ph.D. degree, supported by a FPI Grant from the Spanish Ministry of Science, Innovation and Universities. Since 2014, he has been with the GRVC Robotics Lab, University of Seville, involved in the FP7 EC-SAFEMOBIL Project, in the MBZIRC 2017 International Robotics Challenge, and in the H2020 AEROARMS and HYFLIERS projects. His main research interests include motion planning for aerial manipulation in inspection and maintenance. AMBAR GAROFANO received the degree in aerospace engineering from the University of Cadiz, in 2016, and the M.S. degree in aeronautical engineering from the University of Seville. Since 2018, she has been with the Robotics, Vision and Control Group, University of Seville, involved in the AEROARMS and HYFLIERS projects. She is currently pursuing the Ph.D. degree with the Department of Systems and Automatic Control Engineering, University of Seville. Her current research interests include mechanical design and development of multirotors, analysis of aerodynamics effect in rotary wing UAV, and computational fluid dynamics (CFD). PEDRO J. SANCHEZ-CUEVAS (Associate Member, IEEE) was born in Villanueva de la Serena, Badajoz, Spain, in 1992. He received the B.S. degree in aerospace engineering and the M.S. in aeronautical engineering from the University of Seville, Spain, in 2014 and 2018, respectively. He is currently pursuing the Ph.D. degree in aerial robotics with the University of Seville. He got an internship at the Spanish Air Force Army, Moron de la Frontera, in the Summer of 2013. Since 2014, he has been with the GRVC – Robotics Lab, Seville of the University of Seville, actively working in several H2020 projects (ARCAS, AEROARMS, AEROBI, SAFEDRONE, GAUSS, RESIST, and PILOTING) and national projects. In 2016, he received the FPU Grant from the Spanish Ministry of Education, Culture and Sport for supporting his Ph.D. degree. In 2020, he was part of the Iberian Robotics Team that won the third challenge of the MBZIRC 2020 Competition in Abu Dhabi. GUILLERMO HEREDIA (Member, IEEE) is currently a Full Professor with the University of Seville, Spain. He was a Visiting Researcher with the Field Robotics Centre, Carnegie Mellon University, Pittsburgh, USA, and worked for an international automobile manufacturer (General Motors). He participated as a Senior Researcher in 65 Research and Development projects (E.U., NASA, and national projects), leading or co-leading 12 of them, including the FP7 ECSAFEMOBIL and the H2020 AEROBI and HYFLIERS projects. He is author or coauthor of more than 100 publications on aerial robotics, aerial manipulation, autonomous vehicles and fault detection, and reconfiguration. ANIBAL OLLERO (Fellow, IEEE) is currently a Full Professor and the Head of the GRVC, University of Seville, and a Scientific Advisor of the Center for Advanced Aerospace Technologies, Seville, Spain. He has been a Full Professor with the Universities of Santiago and Malaga, Spain, a Researcher with the Robotics Institute of Carnegie Mellon University, Pittsburgh, USA, and the LAAS-CNRS, Toulouse, France. He authored more than 750 publications, including nine books and 200 journal articles and led about 160 projects, transferring results to many companies. He has received the ERC Advanced Grant GRIFFIN and has participated in 25 European Projects being coordinator of seven, including the FP7-EC integrated projects ARCAS and ECSAFEMOBIL, the H2020 AEROARMS, and the current AERIAL-CORE. He was a recipient of 24 awards, including the Overall Winner of the European Commission Innovation Radar Award and the Spanish Jaume I in New Technologies, has supervised 45 Ph.D. Thesis and is IEEE Fellow, for contributions to the development and deployment of aerial robots. He is currently the Co-Chair of the ‘‘IEEE Technical Committee on Aerial Robotics and Unmanned Aerial Vehicles,’’ a Coordinator of the ‘‘Aerial Robotics Topic Group’’ de euRobotics, and has been a member of the ‘‘Board of Directors’’ of euRobotics, until March 2019. He has also been the Founder and President of the Spanish Society for the Research and Development in Robotics (SEIDROB), until November 2017. 162532 VOLUME 8, 2020