Full text
Robotics and Autonomous Systems 175 (2024) 104643 Available online 7 February 2024 0921-8890/© 2024 The Author(s). Published by Elsevier B.V. This is an open access article under the CC BY license (http://creativecommons.org/licenses/by/4.0/). Contents lists available at ScienceDirect Robotics and Autonomous Systems journal homepage: www.elsevier.com/locate/robot Modelling and identification methods for simulation of cable-suspended dual-arm robotic systems✩ Giancarlo D’Ago a,b,∗, Mario Selvaggio b, Alejandro Suarez c, Francisco Javier Gañán c, Luca Rosario Buonocore a, Mario Di Castro a, Vincenzo Lippiello b, Anibal Ollero c, Fabio Ruggiero b aEuropean Organization for Nuclear Research, CERN, Espl. des Particules 1, Meyrin, 1211, Switzerland bPRISMA Lab, Department of Electrical Engineering and Information Technology, University of Naples Federico II, Via Claudio 21, Naples, 80125, Italy cGRVC Robotics Labs, University of Seville, Camino de los Descubrimientos, Seville, 41092, Spain ARTICLE INFO Keywords: Robotics in Hazardous fields Aerial systems Applications ABSTRACT This paper proposes rigid-body modelling and identification procedures for long-reach dual-arm manipulators in a cable-suspended pendulum configuration. The proposed model relies on a virtually constrained open kinematic chain and lends itself to be simulated through the most commonly used robotic simulators without explicitly account for the cables constraints and flexibility. Moreover, a dynamic parameters identification procedure is devised to improve the simulation model fidelity and reduce the sim-to-real gap for controllers deployment. We show the capability of our model to handle different cable configurations and suspension mechanisms by customising it for two representative cable-suspended dual-arm manipulation systems: the LiCAS arms suspended by a drone and the CRANEbot system, featuring two Pilz arms suspended by a crane. The identified dynamic models are validated by comparing their evolution with data acquired from the real systems showing a high (between 91.3% to 99.4%) correlation of the response signals. In a comparison performed with baseline pendulum models, our model increases the simulation accuracy from 64.4% to 85.9%. The simulation environment and the related controllers are released as open-source code. 1. Introduction Cable-suspended long-reach manipulators have classically being utilised to perform inspection and maintenance tasks over large but difficult-to-access workspaces in hazardous industrial scenarios. Only recently, their use has been extended to the execution of challenging operations in remote high-altitude areas (e.g., maintenance of power lines, inspection of remote infrastructures, etc.) where the direct access of humans is dangerous or costly [1–3]. These robots are typically constituted by a suspension platform that transports an articulated lower platform in a cable-suspended pendulum configuration, as shown in Fig. 1. One or multiple cables connect the two parts and are employed to: (i) decrease the weight of the overall robotic system compared to using rigid links; (ii) provide orders of magnitude larger end-effector workspace without affecting the weight of the manipulators’ base; and (iii) exhibit superior resilience in absorbing external disturbances such as impacts and collisions. Long-reach aerial manipulators, equipped with flexible links or multi-cable structures, are being developed to ✩The research leading to these results has been supported by the AERIAL-CORE project (Horizon 2020 Grant Agreement No. 871479). The authors are solely responsible for its content. ∗Corresponding author at: European Organization for Nuclear Research, CERN, Espl. des Particules 1, Meyrin, 1211, Switzerland. E-mail address: [email protected] (G. D’Ago). additionally increase the distance between the aerial platform and the environmental obstacles, thus lowering down the risk of impacts of the rotor blades [4–7]. In this case, the presence of cables has minimal impact on the overall aerial robot weight and enables to safely operate in constrained environments without affecting its energetic autonomy level. The accurate simulation and, consequently, the development and the deployment of model-based control strategies for cable-suspended long-reach manipulators, is hindered by the lack of models that accurately capture the system’s behaviour. Indeed, despite the numerous advantages, the presence of passive cables generally makes the modelling of these robotic systems more involved, since low-mass and flexible elements introduce an uncontrolled second-order dynamics oscillatory behaviour and impose intricate unilateral constraints between the platforms. In aerial transportation of non-actuated loads through passive flexible links, the cable system is generally modelled as a single rigid link [9], by using finite elements methods [10], https://doi.org/10.1016/j.robot.2024.104643 Received 17 October 2023; Received in revised form 5 January 2024; Accepted 25 January 2024
Robotics and Autonomous Systems 175 (2024) 104643 2 G. D’Ago et al. Fig. 1. The two dual-arm manipulation systems considered in this work as examples of cable-suspended robots. On the left, the LiCAS robotic arms suspended by a drone for aerial manipulation tasks [8]; on the right, the CRANEbot system with two Pilz arms suspended by a crane for industrial tasks at CERN. or, to account for all the possible deformation modes, via Cosserat rod theory [11,12]. When dealing with actuated loads instead, only approximate single or double pendulum models have been proposed and adopted so far [13,14]. However, these models prove inadequate in capturing the intricate dynamic effects that appear when the articulated suspended system is an actuated robotic manipulator, failing to account for the dynamic coupling between the two platforms. For these reasons, more comprehensive modelling approaches are required. Moreover, the deployment of model-based control strategies is usually hindered by the absence of realistic simulation environments, which are helpful for their development, testing and sim-to-real transfer [15]. Indeed, existing rigid-body dynamic simulators (e.g., Gazebo [16]) do not offer the possibility of simulating cable-suspended robotic systems due to the difficulty of: (i) simulating deformable structures as infinite dimensional systems require approximate or finite elements models; (ii) handling constraints embedded in closed-chain structures created by the presence of multiple cables. Motivated by this, here we propose modelling, identification, and simulation methods to tackle these open problems in cable-suspended dual-arm robotic manipulation. The two systems shown in Fig. 1 are considered as case studies to show and validate the generality of the proposed approach. The system on the left is an aerial cable-suspended dual-arm system used to install bird diverters on high-voltage power lines [2,8,17]. In that system, four belts, tied in a parallel pattern to a drone and a lower platform, hold two four-DoF (Degree of Freedom) LiCAS manipulators. The system on the right is the CRANEbot, a bimanual system designed by the European Organization for Nuclear Research (CERN) for inspecting and maintaining particle acceleratorrelated infrastructures [3,18]. In this case, a set of pulleys and steel ropes, coupled through a hook to a lower platform, serves as a lifting mechanism to hoist an articulated system (two Pilz©PRBT6 arms) from an overhead crane. In the following we show that the proposed modelling and identification methodology can handle the two cable configurations with minor modifications and can be easily extended to a wider variety of cable-suspended robotic systems. The main contribution of this work can be thus summarised as follows: •We propose a simplified open-chain rigid-body dynamic model of multi-cable-suspended robotic structures that can be readily integrated into standard physics-based robot simulators. This is the first work proposing such a modelling approach for this kind of robotic systems, up to the authors’ knowledge. •We developed a model identification procedure for such systems to reduce the sim-to-real gap when developing and deploying control methods for such systems (e.g., oscillations suppression techniques [19]). The proposed method overcomes the lack of one-to-one joints correspondence between the model and the real system maximising the similarity of their oscillatory behaviour. Moreover it takes into account constraints imposed by the presence of cables. •We released the environment and the related source code to simulate cable-suspended dual-arm manipulators with the developed realistic models. The rest of the paper is organised as follows: Section 2provides an overview of the pertinent literature in the field; Section 3discusses the system model while Section 4its identification procedure; Section 5 encompasses the experiments conducted and their respective outcomes; Section 6compares simulation with baseline modelling approaches, while Section 7concludes the paper by discussing open challenges. 2. Related works The focus of this section is to provide an overview of modelling and simulation methods for long-reach robotic systems featuring nonactuated, flexible cables. As stated in the Introduction, long-reach features are generally provided to robots to access large but difficult-to-access workspaces. When the inspection site is accessible from above, it can be convenient to use robot manipulators suspended to an upper platform through one or multiple cables. This enlarges the robot workspace while also reducing dynamic coupling effects possibly caused by the interaction of the manipulator with hard environments [5,6,8]. This proves particularly useful in aerial systems, where articulated manipulators rigidly attached to a drone may not suffice to keep a safe distance between the rotors and the inspected areas [4,20,21], and where unavoidable impacts and overloads may destabilise the position control of the aerial platform [22]. Thus, inserting spring elements in the manipulator’s joints and/or using flexible suspension cables can help alleviating these problems [23–25]. Although cable-suspended robotic systems proved to be inherently safe, the second-order pendulum dynamics resulting from the presence of non-actuated flexible elements may result in an oscillatory behaviour that needs to be accounted for. With the assumption of rigid bodies and inextensible cables, this dynamics can be mathematically captured by lumped mass models following three alternative baseline approaches [13,14,26]: (i) single pendulum, where the lower manipulation platform is thought of as a single suspended mass; (ii) double pendulum, where the first portion is represented by the hoisting cables and the second by the lower platform; and (iii) multi-cable models, used when the constraints imposed by the cable system cannot be approximated with those of a single one. The latter approach is more realistic but requires imposing holonomic constraints in the entire system dynamic model that accounts for the presence of the cables [27]. Although useful for controller design, the constrained model cannot be easily simulated through classical rigid-body dynamic engines. Moreover, none of the above-listed approaches is able to capture the dynamic coupling effects arising when the motion of the cable-suspended load is actuated, as in the examined case studies. Thus, modelling the entire structure using one of these methods is undoubtedly erroneous. The development of more accurate models may pave the way towards the development of model-based control techniques useful to e.g. reduce oscillations [13,28,29] exploiting the suspended manipulators’ motion [30,31] and/or the actuation of the suspension platform [32]. Physics-based simulation provides an accelerated and safe avenue for developing, verifying, and testing robotic control algorithms and prototype design [15]. Robots are typically represented in simulation as a collection of rigid bodies connected through joints whose dynamics are computed via rigid-body algorithms [33]. This approach is unsuitable when the robot features flexible elements such as cables. As a matter of fact, researchers have started applying rigid-body dynamic modelling approaches also to flexible robots, such as soft robotic arms,
Robotics and Autonomous Systems 175 (2024) 104643 3 G. D’Ago et al. Fig. 2. The proposed generic kinematic model of dual-arm manipulator systems in cable-suspended pendulum configuration. 𝑖denotes the 𝑖th joint. to exploit simulation and control architectures from the rigid-body literature [34,35]. This simplifies the process of testing control software in simulation and transferring it onto the physical system [36]. However, this requires the simulation to accurately emulate the realworld environment. To realise this, the robot model dynamics must be accurately identified via suitable identification procedures. To date, there is no published work about identification methods purposely designed for robots endowed with cables. As matter of fact, dynamic simulation of an aerial cable-suspended dual-arm manipulator can be achieved in this way only accepting a large sim-to-real gap [5]. 3. System model A cable-suspended robotic manipulation system can be built in many different ways. Therefore, deriving a general model of such a system requires a more in-depth analysis of its main components. Looking at Fig. 1, four key elements can be recognised: (𝑎)an upper suspension platform, (𝑏)a cable system, (𝑐)a lower platform, and (𝑑) one or more manipulators. The upper platform, which supports the entire system, can be a drone, an overhead crane, or the overall system can hang directly from the ceiling. Cables come in various shapes and sizes: for lifting systems, one can either utilise polyester straps or ropes made of a metal core (typically steel) wrapped in strands. Some possibilities for connecting the cables to (𝑎)and (𝑐)include winding them into pulleys, tying them with hook-and-loop joints, or knotting them at the ends. The payload is represented by (𝑐)and (𝑑), and their combination constitutes a robotic system with the lower platform acting as the manipulators’ mechanical basis. The conveyance of cable-suspended robotic systems necessitates precise control of the suspension platform, such as drones or cranes, which must operate at low speeds and avoid sudden changes in direction. Furthermore, this transportation process typically does not entail interactions with the surrounding environment. Consequently, it is reasonable to assume that the cable remains consistently taut and non-extensible in such circumstances. The proposed generic model of a cable-suspended robotic system, shown in Fig. 2, is described below and later customised for the particular systems considered in this paper. Since the real cable structure forms a closed kinematic chain, an equivalent open kinematic chain is adopted to simulate these systems using customary rigid-body dynamic software. The equivalence between the adopted open kinematic chain and the real system is later established by enforcing cable kinematic constraints and maximising the similarity of their dynamic response, as explained in the following. Suspension platforms are assumed to have 6DoFs, allowing unrestricted movement in three-dimensional space. Consequently, the motion of the suspension platform can be represented by a combination of three prismatic and three revolute joints, with each joint followed by a link representing the platform. The cables’ motion can be represented by an additional 6DoFs achieved by employing spherical joints at the interfaces with the upper and lower platforms. Three revolute joints with coincident origins and perpendicular axes are utilised to replace the upper spherical joint, followed by links that represent the cables. Similarly, the lower spherical joint is substituted by three revolute joints, where the subsequent link symbolises the lower platform. These 12 degrees of freedom (DoFs) can be appropriately coupled or virtually constrained/eliminated to align with the kinematics of the specific system. For instance, unless a fully actuated hexacopter is employed, multirotor attitude-translational coupling reduces the number of DoFs. Similarly, an overhead crane restricts its motion to a plane, resulting in only two translational DoFs. The manipulators, which typically consist of prismatic and/or revolute joints, already have known kinematics. Considering 𝑀as the number of joints in the manipulation system, the complete model of the cable-suspended system encompasses 𝑁= 12 + 𝑀DoFs. It is important to note that joints 1…6 and 13 …𝑁are generally mechanically actuated (active), while joints 7…12, representing the cables, are non-actuated (passive). Once the kinematics has been defined, its dynamic model can be deduced through the following equation 𝑩(𝒒) 𝒒+𝒏(𝒒, 𝒒) = 𝒖−𝒖𝑒. (1) On the left side 𝒒(𝑡), 𝒒(𝑡), 𝒒(𝑡) ∈ R𝑁are respectively the joints position, velocity, and acceleration vectors, 𝑩(𝒒) ∈ R𝑁×𝑁is the inertia matrix, and 𝒏(𝒒, 𝒒) ∈ R𝑁is the vector collecting centrifugal, Coriolis, and gravitational terms. On the right side, 𝒖(𝑡) ∈ R𝑁is the generalised joints actuation vector, while 𝒖𝑒(𝑡) ∈ R𝑁is the vector of the torques and forces at the joints induced by the interaction with the environment, defined as 𝒖𝑒(𝑡) = 𝑱(𝒒)𝑇𝒉𝑒(𝑡), where 𝑱(𝒒)∈R𝑁×6 is the Jacobian matrix and 𝒉𝑒(𝑡) ∈ R6denotes the vector of forces and moments exerted by the manipulators’ end-effectors on the environment. Controlling the motion of a system means determining 𝒖(𝑡)such that 𝒒(𝑡) = 𝒒𝑑(𝑡)and 𝒒(𝑡) = 𝒒𝑑(𝑡)where 𝒒𝑑(𝑡) ∈ R𝑁and 𝒒𝑑(𝑡) ∈ R𝑁describe the desired trajectory. For our purposes, 𝒖(𝑡)has been chosen as a set of proportional–derivative (PD) controllers, i.e. 𝒖=𝑲𝑑 𝒒+𝑲𝑝 𝒒,(2) where 𝒒(𝑡) = 𝒒𝑑− 𝒒and 𝒒(𝑡) = 𝒒𝑑−𝒒are the velocity and position error, respectively, while 𝑲𝑝=diag{𝑘𝑝,1,…𝑘𝑝,𝑛} ∈ R𝑁×𝑁and 𝑲𝑑=diag {𝑘𝑑,1,…𝑘𝑑,𝑛} ∈ R𝑁×𝑁are semi positive-definite diagonal gain matrices with the physical interpretation of springs and dampers respectively, acting on the 𝑖th joint. This choice has a threefold motivation: (i) concerning active joints, robot manipulators are often equipped with position and velocity controllers, hence a feedback of those signal is always available; (ii) for the passive ones, although they are not actuated, they usually exhibit elastic and viscous friction behaviours, which can be replicated through such gains; (iii) it allows easy implementation of the virtual constraints to tie the generic model to the particular system, as shown in Section 5.2. 4. Model parameters identification In the proposed open-chain rigid-body model described by Eqs. (1)– (2), each link is characterised by ten parameters, including mass, inertia tensor, and centre of mass position. Similarly, each joint is described by two parameters for friction (using the Coulomb-viscous model) and two parameters for proportional–derivative gains. To accurately represent a real cable-suspended system, the model requires knowledge of the parameter set 𝒑∈R𝑃mentioned earlier. Parameters associated with rigid components, such as manipulators and platforms, are typically either already known or can be estimated using conventional identification methods (see e.g. [37,38]). These methods leverage the linearity property of the manipulator’s dynamic model by utilising measurements of position, velocity, and torque, which are typically available
Robotics and Autonomous Systems 175 (2024) 104643 4 G. D’Ago et al. (or reconstructable) from the sensors on the manipulators actuation system. However, estimating parameters for non-rigid parts (cables) and passive joints is challenging because: (i) they lack of one-to-one correspondence in the real system since, as seen in Section 3, the cable suspension system is modelled as set of connected rigid-links through rotational joints with the same origin; (ii) passive joint measures (position, velocity, torque) are not available unlike their active counterpart; (iii) there is the need to capture the intricate kinematic and dynamic constraints imposed by the presence of cables. Consequently, classical identification approaches are unsuitable, necessitating the proposal of an alternative procedure. The proposed technique allows the determination of the value of unknown model parameters utilising measurements obtained during the execution of oscillatory motions imposed on the system through manual changes to the initial state and through manipulator movements. With reference to Section 3, the values to be determined and referred to hereafter are therefore those related to the joints 7…12, and the corresponding virtual links and PD controllers. We assume that, during a set of experiments involving the generation of oscillations of the suspended system, a data recording mechanism (motion capture, fiducial markers, GPS, etc.) is used to determine the time series of poses of the lower platform in a given reference frame. The identification procedure consists in solving an optimisation problem to find the set of parameters 𝒑∈R𝑃to minimise the deviation between the actual recorded behaviour of the system, assessed through a number 𝑁𝑒of measured trajectories 𝑁𝑒measures, and the forward simulated model, maximising their similarity. The number 𝑵𝒆of acquired trajectories must be chosen beforehand, finding a compromise between the accuracy of the parameter identification procedure and its computational burden. We define this optimisation problem as follows 𝒑= arg max 𝒑 1 𝑁𝑒 𝑁𝑒 ∑ 𝑖=1 𝑅(𝒙𝑖 𝑚,𝒙𝑖 𝑠(𝒑)) s.t. 𝒑≤𝒑≤𝒑, (3) where 𝒙𝑖 𝑚= {𝒙𝑖 𝑚(0),𝒙𝑖 𝑚(𝑑𝑡),…,𝒙𝑖 𝑚(𝑇)} is the trajectory of the system’s state recorded during the 𝑖th experiment (with 𝑑𝑡 and 𝑇denoting the time step and trajectory duration, respectively), 𝒙𝑖 𝑠(𝒑)denotes the corresponding trajectory signal obtained from the forward simulated model, while 𝑅(⋅)represents a metric of similarity between the two sets of signals. Lower and upper bound constraints, 𝒑and 𝒑, are respectively necessary to guarantee the physical consistency of the optimisation result (e.g., the links’ mass must always be positive, as well as the friction coefficients and the control gains) and to ensure a fast convergence while preventing unnecessary computational effort. Hereafter, the time dependence 𝑡and the apex 𝑖will be omitted for clarity. Vectors 𝒙𝑚and 𝒙𝑠embed measured/simulated state trajectory of the system, i.e., the pose trajectory of the lower platform in a three-dimensional space. The presence of cables restricts the set of poses the lower platform can assume, rendering its trajectories similar to those of a spherical pendulum. In particular For this reason, the data of interest are the x-y position 𝑟𝑥, 𝑟𝑦and orientation around the vertical axis 𝜙𝑧of the platform with respect to its initial rest state, i.e., 𝒙𝑚=[𝑟𝑥 𝑚𝑟𝑦 𝑚𝜙𝑧 𝑚]𝑇and 𝒙𝑠=[𝑟𝑥 𝑠𝑟𝑦 𝑠𝜙𝑧 𝑠]𝑇. At the 𝑘th instant of time, 𝒙𝑠(𝑘)is a function of the system state (i.e., joints position and velocity vectors) that depends on the set 𝒑of the model dynamic parameters, according to 𝒙𝑠(𝑘) = 𝒈(𝒒(𝑘, 𝒑)). More specifically, with 𝐿 being the cables’ length 𝒈(𝒒(𝑘, 𝒑))=[𝐿sin 𝑞8(𝑘), 𝐿 sin 𝑞9(𝑘), 𝑞7(𝑘) + 𝑞10(𝑘)]𝑇.(4) A forward-Euler integration scheme is employed to derive 𝒒(𝑘+1,𝒑) from the direct dynamics of the system, i.e., 𝒒(𝑘, 𝒑) =𝑩(𝒒(𝑘))−1 [𝑲𝑑 𝒒(𝑘) + 𝑲𝑝 𝒒(𝑘) −𝒏(𝒒(𝑘), 𝒒(𝑘))−𝑱𝑇(𝒒(𝑘))𝒉𝑒(𝑘)]. (5) Fig. 3. Setup of the LiCAS A1 in 4-cable-suspended configuration. Integrating equation (5) and using Eq. (4) the symbolic trajectory 𝒙𝑠(𝒑) can be constructed as function of the unknown parameters 𝒑to be then used in Eq. (3). When evaluated numerically, the model initial conditions 𝒒0and 𝒒0have to be set consistently with the state of the physical system at the beginning of the experiments. Similarly, it is essential that 𝒒𝑑and 𝒒𝑑align with the real trajectories applied to the manipulators to induce the oscillatory movements. At this point, our objective is to maximise the similarity between the real measured signals 𝒙𝑚and the output of the model. To this end, a metric of similarity must be chosen. A metric of similarity numerically quantifies how closely related data samples are. Values range between zero (indicating low similarity or dissimilarity) and one (indicating high similarity or likeness). Regarding the metric for signals similarity in the definition of the cost function of Eq. (3), the Pearson product-moment cross-correlation coefficient has been employed. Cross-correlation provides indeed information on the similarity between two different time series and the Pearson correlation coefficient is its normalised version. The Pearson cross-correlation is a metric that measures the linear relationship between two time-series while considering both amplitude and time shifts. It is a variant of the more general cross-correlation metric. It is beneficial when examining the similarity between two signals while accounting for potential time lags. Given two sampled time-series signals 𝑥(𝑡)and 𝑦(𝑡), the coefficient 𝜌(𝑥, 𝑦)is defined as 𝜌(𝑥, 𝑦) = 1 𝑁− 1 𝑁 ∑ 𝑘=1(𝑥(𝑘) − 𝜇𝑥 𝜎𝑥)(𝑦(𝑘) − 𝜇𝑦 𝜎𝑦)(6) where 𝑁is the number of samples, 𝜇𝑥and 𝜎𝑥are the mean and standard deviation of 𝑥, and 𝜇𝑦and 𝜎𝑦are the mean and standard deviation of 𝑦. The possible range for 𝜌is [−1,1], the closer the value is to 1, the more closely the sets of signals are identical. Vectors 𝒙𝑚and 𝒙𝑠typically contain multiple signals. Each element of the vector is then compared independently, and the mean correlation value is computed, i.e., 𝑅(𝒙𝑚,𝒙𝑠) = 1 3[𝜌(𝑟𝑥 𝑚, 𝑟𝑥 𝑠) + 𝜌(𝑟𝑦 𝑚, 𝑟𝑦 𝑠) + 𝜌(𝜙𝑧 𝑚, 𝜙𝑧 𝑠)].(7) Finally, regarding the parameters to be identified, the procedure involves inputting the known links parameters (articulated robotic system and lower platform) into the model and allowing the optimisation process to yield the parameters pertaining to the cable-representative links as well as the values of friction and gains of the PD virtual controllers on joints 7…12. 5. Experimental setup and validation results As explained in Section 4, parameter estimation (identification) entails the utilisation of one or more experiments. Once an estimate is obtained, the parameters are substituted into the model, and the
Robotics and Autonomous Systems 175 (2024) 104643 5 G. D’Ago et al. behaviour of the simulated system is compared with a fresh set of experiments (validation). This section describes the two experimental setups used to retrieve the measurement data (Section 5.1), the necessary customisation of the generic model of Eq. (1) and (2) for each of the systems (Section 5.2), and the identification procedure validation (Section 5.3). 5.1. Experimental setup The modelling and identification methods described previously have been tested on the two long-reach dual-arm robotic platforms shown in Fig. 1. The first platform is a lightweight and compliant anthropomorphic dual-arm system (LiCAS) in a 4-Cable Suspended configuration, shown in Fig. 3. The human-size and human-like arms employ Herkulex DRS- 0402/0602 smart servos assembled in a customised frame manufactured in aluminium and carbon fibre. Four harnesses support the arms’ shoulder structure (0.7 kg weight) by 1m long / 250 mm separated cables, as depicted in Fig. 3. The arms are fed by a 3S1600 mAh LiPo battery and controlled through a C/C++ program executed on a Raspberry Pi Model 3connected to the WiFi network of the OptiTrack™testbed to log the positioning data and the data from the BNO 055 inertial measurement unit (IMU) also integrated into the shoulder structure. The second platform, the CRANEbot, is lifted by overhead cranes, which allows operations to be carried out from above, performing remote procedures in radioactive areas at CERN that cannot be reached by ordinary ground robots. The load (190 kg), lifted through to the overhead crane lifting system at the height of 3.897 m via a crane hook adapter, is equipped with an on-board camera system and two six-axis Pilz©PRBT 6manipulator arms mounted at a horizontal distance of 380 mm, controlled through a C++ framework executed on an Intel® on-board computer and powered by 8Lead-gel 13000 mAh rechargeable batteries, arranged in the central body together with modules for WiFi/4G connection. The lower platform was equipped with a set of ArUco markers for the experiments, whose pose was detected through external Axis®PTZ high-resolution IP cameras. To capture the cable system dynamics and its coupling with the actuated load, in the following, the suspension platforms are left out of the model and will be included in future work. For this reason, the drone for LiCAS has been directly substituted by a testbed, and the crane for CRANEBot is kept stationary in its initial configuration. In order to excite the oscillatory dynamics of the systems, two types of experiments were conducted: unforced oscillations (Section 5.3.1) and arms-induced oscillations (Section 5.3.2). In the first case, an operator manually modifies the lower platform’s starting position causing a displacement from its rest state (see Fig. 4), while in the second, the arms move following a trajectory which is a sum of cubic polynomials so as to generate oscillations of the suspension structure. Motion tracking systems record the pose of the lower platforms during the generated oscillatory behaviour. 5.2. Customisation of the dynamic model The generic model expressed by Eq. (1) and (2) has been customised for the two addressed case studies. The LiCAS system results in 𝑀= 8 (two 4-DoFs manipulators) and 𝑁= 20. Since the testbed is stationary, the first six joints do not enter into the model. LiCAS exhibits some notable behaviours: (𝑖)if the lower platform rotates around the vertical axis, it returns to its initial configuration according to a damped elastic behaviour (see Fig. 5(b)); (𝑖𝑖)the parallel arrangement of the four cables ensures the lower platform to stay always parallel to the ground (see Fig. 5(a)). For the elastic return to the vertical rest position, two PD controllers as in Eq. (2) have been adopted for 7and 10, i.e., 𝑘𝑑,7, 𝑘𝑝,7, 𝑘𝑑,10, 𝑘𝑑,10 ≠0and 𝑞𝑑 7, 𝑞𝑑 7, 𝑞𝑑 10, 𝑞𝑑 10 = 0. Two PD controllers on 11 and 12 are inserted to model the horizontal behaviour of the lower platform. From geometrical considerations, it is easy to Fig. 4. Experimental setup for the identification measurements: manual modification of the starting condition for LiCAS (left) and CRANEbot (right). Fig. 5. (a) Lower platform stays parallel to the ground along a lateral displacement; (b) Rotation about the vertical axis of the lower platform, before elastically returning to its rest position; (c) Detail of the suspension system and mechanical block of the hook’s rotation with respect to the pulleys during a lateral movement of the arms. understand that the platform stays parallel to the ground if 11 and 12 have the same and opposite motion as 8and 9respectively, as a consequence 𝑘𝑑,11, 𝑘𝑑,12, 𝑘𝑝,11, 𝑘𝑝,12 ≠0and 𝑞𝑑 11 =𝑞8,𝑞𝑑 11 =𝑞8,𝑞𝑑 12 =𝑞9 and 𝑞𝑑 12 =𝑞9. For CRANEbot instead, 𝑀= 12 (two 6-DoFs manipulators) and 𝑁= 24. Again, since the crane is stationary, the first six DoFs do not enter the model. This system exhibits the following remarkable behaviours: (𝑖)as before a damped elastic behaviour occurs when the lower platform rotates around the vertical axis; (𝑖𝑖)the coupling between the pulley and hook blocks any tilting movement of the lower platform (see Fig. 5(c)), which remains mechanically paired to the cables system. For the elastic return to the vertical rest position, the same approach of using PD controllers for 7and 10 applies. Rotation about the lower platform can instead be virtually blocked by inserting PD controllers as in Eq. (2) on 11 and 12, commanding the joints to track their zero position, i.e., 𝑘𝑑,11, 𝑘𝑝,11, 𝑘𝑑,12, 𝑘𝑝,12 ≠0, and 𝑞𝑑 11, 𝑞𝑑 12, 𝑞𝑑 11, 𝑞𝑑 12 = 0. 5.3. Identification and validation results The entire implementation of the identification framework has been executed in MATLAB®. A nonlinear programming solver (fmincon) has been adopted for the optimisation. Among the available minimisation algorithms, the active-set was chosen to facilitate more substantial steps, enhancing convergence speed compared to the alternatives. The code was executed using the Parallel Computing Toolbox™to expedite the computations. The integration step for the model was set to 1 ms. The outcomes deriving from unforced oscillation for LiCAS and armsinduced for CRANEbot will be shown. The following experimental
Robotics and Autonomous Systems 175 (2024) 104643 6 G. D’Ago et al. Fig. 6. Comparison between simulated model (grey line) and validation signals (black line) with unforced oscillations: (a)–(c) involve a modification of the position along 𝑥,𝑦and 𝑧axes respectively while (d) involves a combined motion along the 𝑥and 𝑦axes. The dotted line shows the error between simulation and real data. Pearson cross-correlation coefficient 𝜌and maximum error |𝑒|values are shown in the bottom right box. results focus on main axis motions, but due to system nonlinearity, unforced or arms-induced oscillations involve all axes. The measures include oscillations along all axes for identification and validation despite the main axis emphasis. 5.3.1. Unforced oscillations In these experiments, an operator manually adjusts the robot’s initial pose by pulling the lower platform (see Fig. 4). To perform LiCAS identification, three measurement pairs were employed. Each pair involves a modification of a single component that determines the initial configuration of the platform, precisely the position along 𝑥-axis (𝑟𝑥), the position along 𝑦-axis (𝑟𝑦), and the orientation around 𝑧-axis (𝜙𝑧), as illustrated in Fig. 3. Additionally, the validation process encompasses four additional measurements. Three of these measurements follow the configuration above, while the last involves a combined motion along the 𝑥and 𝑦axes. Because of the removal of the suspension platform, the subsequent discussion will focus on the remaining joints. First, it will address the dynamic parameters featured in Eq. (1). Then, the controller gains as outlined in Eq. (2). Concerning the dynamic parameters, the ones related to the manipulators and the lower platform, i.e., masses (𝑚10 …𝑚20), centres of mass (𝒍10 …𝒍20), inertia tensors (𝑰10 …𝑰20), and friction coefficients (𝑓𝑣,10 …𝑓𝑣,20) are known and can be directly substituted into the model. The ones instead related to cables (𝑚7…𝑚9,𝒍7…𝒍9,𝑰7…𝑰9, and 𝑓𝑣,7…𝑓𝑣,9) are unknown and need to be identified. Note that 𝑚7and 𝒍7do not enter into the model since they are irrelevant to the rotational dynamics around joint 7. Finally, it was assumed that the centres of mass of the cable links have components solely along the cables’ vertical axis, i.e., 𝒍𝑖=[0 0 𝑙𝑧 𝑖]𝑇 with 𝑖= 8,9, and that their inertia tensors 𝑰7,𝑰8,𝑰9are all diagonal matrices in the form diag{𝑖𝑥𝑥, 𝑖𝑦𝑦, 𝑖𝑧𝑧}. Regarding the controller gains in Eq. (2), the values for manipulator controllers, i.e., joints 13 …20, are known and can be directly substituted. Joints 8and 9do not show any peculiar behaviour, so their gains are null. On the other hand, joints 7,10,11,12 exhibit peculiar behaviours modelled through PD controllers, so their values need to be identified. Table 5 shows the list of parameters 𝒑included in the identification process, together with their initial value 𝒑0(starting point of the optimisation algorithm), the upper bound 𝒑, and the estimate 𝒑. The lower bound 𝒑values were all set to zero for physical consistency. At the end of the identification process, the cost function yields a total value of 0.9715. Fig. 6 compares the validation measurements and the signals obtained from the simulation after incorporating the estimated parameters into the model. Every graph within the analysis Fig. 7. (a) Sinusoidal joints reference 𝑞𝑑 𝑥𝑦 for the generation of three oscillations of different amplitudes around 𝑥and 𝑦axes. The joint reference maximum amplitude has been set to 11.5 deg for the first trajectory 𝑞𝑑′ 𝑥𝑦 , to 17 deg for 𝑞𝑑′′ 𝑥𝑦 and to 20 deg for 𝑞𝑑′′′ 𝑥𝑦 . (b) Sinusoidal joints reference 𝑞𝑑 𝑧for the generation of three oscillations of different amplitudes around 𝑧axis. The joint reference maximum amplitude has been set to 2.85 deg for the first trajectory 𝑞𝑑′ 𝑧, to 5.7 deg for 𝑞𝑑′′ 𝑧and to 8.6 deg for 𝑞𝑑′′′ 𝑧. Fig. 8. Comparison between simulated model (grey line) and validation signals (black line) with arms-induced oscillations: (a)–(c) involve a modification of the position along 𝑥,𝑦and 𝑧axes respectively. The dotted line shows the error between simulation and real data. Pearson cross-correlation coefficient 𝜌and maximum error |𝑒|values are shown in the bottom right box. Table 1 MAE and MRE for LiCAS identification. exp X exp Y exp Z exp XY Abs err 0.0204 m 0.0126 m 4.867◦0.013 m / 0.010 m Rel err % 27.08 18.45 15.89 16.04 / 16.25 showcases the Pearson cross-correlation coefficient 𝜌that quantifies the similarity between the measurement and simulation data, along with the absolute maximum error value |𝑒|between the respective signals. Specifically, the correlation values obtained are 95.5%, 98.9%, and 96.8% for the first three experiments, while the 𝑥and 𝑦positions in the final experiment exhibit correlations of 98.5% and 99.4% respectively, accompanied by errors of |𝑒𝑥|= 0.039 m and |𝑒𝑦|= 0.023 m. Finally, the corresponding Mean Absolute Error (MAE) and Mean Relative Errors (MRE) are reported in Table 1.
Robotics and Autonomous Systems 175 (2024) 104643 7 G. D’Ago et al. Table 2 MAE and MRE for CRANEBot identification. exp X exp Y exp Z Abs err 0.0072 m 0.0046 m 2.610◦ Rel err % 31.8 42.71 39.3 5.3.2. Arms-induced oscillations In these experiments, oscillations are induced by the movements of the arms. For the identification of the CRANEbot parameters, three pairs of measurement were utilised, with each pair corresponding to one of the axes shown in Fig. 4. Furthermore, three additional experiments, one for each axis, were conducted for validation. To excite cable-suspended oscillations, sinusoidal trajectories (see Fig. 7) were commanded to the second and third Pilz manipulator joints, with varying amplitudes and a frequency matching the system’s resonance frequency. Specifically, the 𝑥and 𝑦axes were driven at a frequency of 0.25 Hz, while the 𝑧-axis oscillated at 0.33 Hz.Fig. 7 shows the joint’s sinusoidal reference trajectories employed for the aforementioned experiments. Each experiment has been performed by modifying the amplitude of the commanded trajectory. Similar considerations and assumptions can be made for the identification of this cable-suspended robot. The crane is fixed, and its joint dynamics do not enter the model. The parameters of the manipulators and the lower platform are known, cable centres of mass lie solely along the vertical axis, and inertia tensors have a diagonal form. Gains to be identified are only those related to the peculiar behaviours affecting the movement of the lower platform and the damped-elastic rotation around the vertical. Details on the configuration of the optimisation problem and the identified parameters 𝒑can be found in Table 5. The cost function after the identification process for CRANEbot is 0.9472. Fig. 8 presents a visual comparison between the three pairs of measurements utilised for validation and the corresponding simulation data, after incorporating the estimated parameters into the model. The images exhibit a notable conformity of the oscillatory signals, showcasing that the movement of the arms elicits a simulated response that closely mirrors that of the physical system. This observation underscores the successful identification process, affirming that the simulated behaviour accurately captures the dynamic response of the actual system. In particular, for the validation, the correlation values 𝑥and 𝑦axes are 95.9% and 92.6% respectively, with maximum errors in the order some centimetres (|𝑒𝑥|= 0.022 m and |𝑒𝑦|= 0.012 m), while for the 𝑧-axis the correlation is 91.3% with a maximum error |𝑒𝑧|= 9.066◦. Again, the corresponding Mean Absolute Error (MAE) and Mean Relative Errors (MRE) are reported in Table 2. 6. Simulation Simulation can provide an amenable venue to preliminary test control strategies, which must rely upon the manipulation system or oscillation suppression control. Therefore, once the model customisation and identification are complete, the obtained parameters can be directly replaced in the simulator. The results in Section 4hold valuable significance as they enable the simulation of a model that faithfully reproduces the behaviour of the real-world system by reducing the sim-to-real gap. To build the simulation model shown in Figs. 9 and 10, we employed an open kinematic chain with 6revolute joints to represent the cable structure as explained in Section 3. The model is described in URDF format and is endowed with a Gazebo model plugin that realises the dynamic behaviour resulting from the unilateral constraints imposed by cables. As a result, the lower platform can displace maintaining the horizontal configuration and exhibit an elastic behaviour around the vertical axis. The identification procedure illustrated in Section 4leads to physically consistent dynamic parameters as used in this model. The equivalence of exhibited dynamic behaviour between Table 3 LiCAS arms: Inertia tensors. 𝑖𝑥𝑥 𝑖𝑥𝑦 𝑖𝑥𝑧 𝑖𝑦𝑦 𝑖𝑦𝑧 𝑖𝑧𝑧 𝑰10 …𝑰12 3.02e−3 0 0 8.64e−4 0 3.39e−3 𝑰13,𝑰14 3.53e−2 0 0 3.01e−2 9.04e−3 1.87e−2 𝑰15,𝑰16 3.58e−2 0 0 3.22e−3−1.45e−3 3.66e−2 𝑰17,𝑰18 2.06e−2 0 0 1.08e−2−5.36e−3 1.63e−2 𝑰19,𝑰20 6.79e−3 0 0 4.91e−3 2.67e−3 3.40e−3 Table 4 CRANEBot arms: Inertia tensors. 𝑖𝑥𝑥 𝑖𝑥𝑦 𝑖𝑥𝑧 𝑖𝑦𝑦 𝑖𝑦𝑧 𝑖𝑧𝑧 𝑰13,𝑰14 3.53e−2 0 0 3.01e−2 9.04e−3 1.87e−2 𝑰15,𝑰16 3.58e−2 0 0 3.22e−3−1.45e−3 3.66e−2 𝑰17,𝑰18 2.06e−2 0 0 1.08e−2−5.36e−3 1.63e−2 𝑰19,𝑰20 6.79e−3 0 0 4.91e−3 2.67e−3 3.40e−3 𝑰21,𝑰22 7.37e−3 0 0 5.87e−3−1.71e−3 3.96e−3 𝑰23,𝑰24 0 0 0 0 0 0 Fig. 9. Simulation in Gazebo of LiCAS while performing unforced oscillation. Fig. 10. Simulation in Gazebo of CRANEbot while performing an arms-induced oscillation. the real and the simulated systems can be better appreciated in the video accompanying this paper, both in the case of unforced and arm-induced oscillations. A comparison between our proposed model in Section 3and two baseline pendulum models has been performed as supplementary evidence supporting the proposed approach. Fig. 11 shows the error on the LiCAS lower platform pose between a Gazebo simulation of an unforced oscillation experiment on 𝑦-axis and (𝑖)a single pendulum model (𝑖𝑖)a double pendulum model (𝑖𝑖𝑖)the proposed model endowed with identified parameters. The employment of model (𝑖𝑖𝑖)ensured a maximum error reduction of respectively 64.4% and 85.9% when compared to (𝑖)and (𝑖𝑖).Fig. 12 compares a CRANEbot simulation by making it start from a non-rest state and simultaneously moving the arms. The baseline models clearly cannot capture the dynamic coupling due to the movement of the arms, which is instead taken
Robotics and Autonomous Systems 175 (2024) 104643 8 G. D’Ago et al. Table 5 Dynamic model parametersa. 𝑝Description LiCAS CRANEBot 𝑝0𝑝 𝑝 𝑝0𝑝 𝑝 𝑚1…𝑚6Mass links 1 … 6 Drone left out from the model Crane left out from the model 𝑚7Mass link 7 Does not enter into the model Does not enter into the model 𝑚8(⋆)Mass link 8 1.0 10.0 4.237 30.0 45.0 35.55 𝑚9(⋆)Mass link 9 1.0 10.0 5.032 30.0 45.0 35.55 𝑚10 …𝑚12 Mass lower platform × × 0.639 × × 156.25 𝑚13, 𝑚14 Mass arm first link × × 0.233 × × 7.1 𝑚15, 𝑚16 Mass arm second link × × 0.246 × × 1.7 𝑚17, 𝑚18 Mass arm third link × × 0.214 × × 4.8 𝑚19, 𝑚20 Mass arm fourth link × × 0.106 × × 0.9 𝑚21, 𝑚22 Mass arm fifth link ×××××2.6 𝑚23, 𝑚24 Mass arm sixth link ×××××0.2 𝒍1…𝒍6CoM vectors links 1 … 6 Drone left out from the model Crane left out from the model 𝒍7CoM vector link 7 Does not enter into the model Does not enter into the model 𝑙𝑧 8(⋆)CoM link 8: [0 0 −𝑙𝑧 8] 0.1 1.0 0.174 0.1 3.5 1.894 𝑙𝑧 9(⋆)CoM link 9: [0 0 −𝑙𝑧 9] 0.1 1.0 0.824 0.1 3.5 1.894 𝒍10 …𝒍12 CoM lower platform × × [0, 0, 0] × × [0, 0, −0.521] 𝒍13,𝒍14 CoM arm first link × × [0, 0.0236, −0.00946] × × [0, 0.026, 0.051] 𝒍15,𝒍16 CoM arm second link × × [0, 0.04, 0] × × [0, 0.162, −0.134] 𝒍17,𝒍18 CoM arm third link × × [−0.015, 0, −0.1] × × [0, 0.043, −0.027] 𝒍19,𝒍20 CoM arm fourth link × × [0, 0, −0.143] × × [0, 0.061, −0.204] 𝒍21,𝒍22 CoM arm fifth link ×××××[0, 0.021, −0.032] 𝒍23,𝒍24 CoM arm sixth link ×××××[0, 0, 0] 𝑰1…𝑰6Inertia tensors 1 … 6 Drone left out from the model Crane left out from the model 𝑖𝑥𝑥 (⋆)Inertia links 7 … 9 (𝑥𝑥) 0.0 2.0 0.313 0.0 100.0 35.37 𝑖𝑦𝑦 (⋆)Inertia links 7 … 9 (𝑦𝑦) 0.0 2.0 0.363 0.0 100.0 58.23 𝑖𝑧𝑧 (⋆)Inertia links 7 … 9 (𝑧𝑧) 0.8 5.0 0.745 0.0 100.0 5.807 𝑰10 …𝑰12 Inertia lower platform Values presented in Table 3 Values presented in Table 4 𝑰13,𝑰14 Inertia arm first link Values presented in Table 3 Values presented in Table 4 𝑰15,𝑰16 Inertia arm second link Values presented in Table 3 Values presented in Table 4 𝑰17,𝑰18 Inertia arm third link Values presented in Table 3 Values presented in Table 4 𝑰19,𝑰20 Inertia arm fourth link Values presented in Table 3 Values presented in Table 4 𝑰21,𝑰22 Inertia arm fifth link ××× Values presented in Table 4 𝑰23,𝑰24 Inertia arm sixth link ××× Values presented in Table 4 𝑓𝑣,7(⋆)Viscous friction 70.2 2.0 0.517 0.2 2.0 0.9 𝑓𝑣,8(⋆)Viscous friction 80.1 3.0 1.33 1.0 600.0 485.3 𝑓𝑣,9(⋆)Viscous friction 90.1 3.0 1.311 50.0 100.0 52.7 𝑓𝑠,7(⋆)Static friction 70.0 1.0 0.0 0.0 1.0 0.01 𝑓𝑠,8(⋆)Static friction 80.0 1.0 0.0 0.0 1.0 0.767 𝑓𝑠,9(⋆)Static friction 90.0 1.0 0.0 0.0 1.0 0.0 𝑘𝑑,7(⋆)D gain virtual controller 71.0 5.0 0.0 1.0 5.0 0.0 𝑘𝑝,7(⋆)P gain virtual controller 715.0 50.0 17.86 40.0 50.0 30.92 𝑘𝑑,10 (⋆)D gain virtual controller 10 1.0 5.0 0.556 1.0 5.0 0.0 𝑘𝑝,10 (⋆)P gain virtual controller 10 10.0 50.0 0.021 1.0 50.0 0.041 𝑘𝑑,11 (⋆)D gain virtual controller 11 1.0 5.0 0.01 1.0 5.0 0.0 𝑘𝑝,11 (⋆)P gain virtual controller 11 100.0 1000 682.4 100.0 1000 953.2 𝑘𝑑,12 (⋆)D gain virtual controller 12 1.0 5.0 0.01 1.0 5.0 0.0 𝑘𝑝,12 (⋆)P gain virtual controller 12 100.0 1000 712.3 100.0 1000 891.5 aValues are presented in the following units: masses (kg), centres of mass (m), inertias (kgm2). (⋆) Parameters identified. Fig. 11. Simulation in Gazebo of an arms-induced oscillation for LiCAS. Error between simulation data and (𝑖)double pendulum model, (𝑖𝑖)single pendulum model, (𝑖𝑖𝑖) proposed model. into account in the proposed model. This last reduces the maximum error of respectively 80.4% and 84.3% compared to single and double pendulum modelling approaches. The environment and the related source code to simulate cablesuspended dual-arm manipulators are free at https://github.com/pris ma-lab/cable-suspended-robots. 7. Conclusion This paper proposed a rigid-body model of cable-suspended dualarm robotic manipulators in a pendulum configuration. A dynamic parameters identification procedure was devised for the presented model to reduce the sim-to-real gap. Two cable-suspended dual-arm manipulation systems were used to assess the capability of the proposed model in handling different cable configurations and suspension mechanisms.
Robotics and Autonomous Systems 175 (2024) 104643 9 G. D’Ago et al. Fig. 12. Simulation in Gazebo of an arms-induced oscillation for CRANEbot. Error between simulation data and (𝑖)double pendulum model, (𝑖𝑖)single pendulum model, (𝑖𝑖𝑖)proposed model. The simulated and real response signals showed a high (from 91.3% to 99.4%) correlation, while the comparison between the proposed model and baseline pendulum modelling approaches shows a significantly increased simulation accuracy (from 64.4% to 85.9%). The proposed approach allows building realistic simulation environments useful for controller design, testing, and training of machine learning methods which are promising future works on the topic. CRediT authorship contribution statement Giancarlo D’Ago: Conceptualization, Data curation, Formal analysis, Investigation, Methodology, Resources, Software, Validation, Visualization, Writing – original draft, Writing – review & editing. Mario Selvaggio: Conceptualization, Investigation, Supervision, Writing – review & editing. Alejandro Suarez: Resources, Supervision. Francisco Javier Gañán: Data curation. Luca Rosario Buonocore: Project administration, Supervision. Mario Di Castro: Funding acquisition, Supervision. Vincenzo Lippiello: Funding acquisition, Supervision. Anibal Ollero: Funding acquisition. Fabio Ruggiero: Conceptualization, Investigation, Project administration, Supervision, Writing – original draft, Writing – review & editing. Declaration of competing interest The authors declare that they have no known competing financial interests or personal relationships that could have appeared to influence the work reported in this paper. Data availability Shared in the github repository linked in the manuscript. Appendix A. Supplementary data Supplementary material related to this article can be found online at https://doi.org/10.1016/j.robot.2024.104643. References [1] F. Ruggiero, V. Lippiello, A. Ollero, Aerial manipulation: A literature review, IEEE Robot. Autom. Lett. 3 (3) (2018) 1957–1964. [2] A. Ollero, G. Heredia, A. Franchi, G. Antonelli, K. Kondak, A. Sanfeliu, A. Viguria, J.R. Martinez-de Dios, F. Pierri, J. Cortés, et al., The aeroarms project: Aerial robots with advanced manipulation capabilities for inspection and maintenance, IEEE Robot. Autom. Mag. 25 (4) (2018) 12–23. [3] M. Di Castro, M. Ferre, A. Masi, CERNTAURO: A modular architecture for robotic inspection and telemanipulation in harsh and semi-structured environments, IEEE Access 6 (2018) 37506–37522. [4] A. Suarez, P. Sanchez-Cuevas, M. Fernandez, M. Perez, G. Heredia, A. Ollero, Lightweight and compliant long reach aerial manipulator for inspection operations, in: 2018 International Conference on Intelligent Robots and Systems, 2018, pp. 6746–6752. [5] A. Suarez, F. Real, V.M. Vega, G. Heredia, A. Rodriguez-Castaño, A. Ollero, Compliant bimanual aerial manipulation: Standard and long reach configurations, IEEE Access 8 (2020) 88844–88865. [6] A. Suarez, R. Salmoral, P.J. Zarco-Periñan, A. Ollero, Experimental evaluation of aerial manipulation robot in contact with 15 kV power line: Shielded and long reach configurations, IEEE Access 9 (2021) 94573–94585. [7] Y.S. Sarkisov, M.J. Kim, D. Bicego, D. Tsetserukou, C. Ott, A. Franchi, K. Kondak, Development of SAM: Cable-suspended aerial manipulator, in: IEEE International Conference on Robotics and Automation, 2019, pp. 5323–5329. [8] I. Armengol, A. Suarez, G. Heredia, A. Ollero, Design, integration and testing of compliant gripper for the installation of helical bird diverters on power lines, in: 2021 Aerial Robotic Systems Physically Interacting with the Environment, IEEE, 2021, pp. 1–8. [9] K. Klausen, T.I. Fossen, T.A. Johansen, Nonlinear control of a multirotor UAV with suspended load, in: 2015 International Conference on Unmanned Aircraft Systems, ICUAS, 2015, pp. 176–184. [10] P. Kotaru, K. Sreenath, Multiple quadrotors carrying a flexible hose: dynamics, differential flatness and control, IFAC-PapersOnLine 53 (2) (2020) 8832–8839. [11] Z. Samadikhoshkho, S. Ghorbani, F. Janabi-Sharifi, Modeling and control of aerial continuum manipulation systems: A flying continuum robot paradigm, IEEE Access 8 (2020) 176883–176894. [12] P. Tempel, Dynamics of Cable-Driven Parallel Robots with Elastic and Flexible, Time-Varying Length Cables, Fraunhofer Verlag, Stuttgart, 2019. [13] R. Miyazaki, H. Paul, T. Kominami, K. Shimonomura, Wire-suspended device control based on wireless communication with multirotor for long reach-aerial manipulation, IEEE Access 8 (2020) 172096–172104. [14] P. Schlott, O. Sawodny, Decoupling control for a gantry crane with an actuated load, in: 2012 7th IEEE Conference on Industrial Electronics and Applications, ICIEA, 2012, pp. 1610–1615. [15] C.K. Liu, D. Negrut, The role of physics-based simulators in robotics, Ann. Rev. Control Robot. Autonomous Syst. 4 (1) (2021) 35–58. [16] N. Koenig, A. Howard, Design and use paradigms for gazebo, an open-source multi-robot simulator, in: 2004 International Conference on Intelligent Robots and Systems, Vol. 3, 2004, pp. 2149–2154 vol.3. [17] J. Cacace, S.M. Orozco-Soto, A. Suarez, A. Caballero, M. Orsag, S. Bogdan, G. Vasiljevic, E. Ebeid, J.A.A. Rodriguez, A. Ollero, Safe local aerial manipulation for the installation of devices on power lines: AERIAL-CORE first year results and designs, Appl. Sci. 11 (13) (2021) 6220. [18] M. Di Castro, L.R. Buonocore, M. Ferre, S. Gilardoni, R. Losito, G. Lunghi, A. Masi, et al., A dual arms robotic platform control for navigation, inspection and telemanipulation, in: 16th International Conference on Accelerator and Large Experimental Control Systems, Barcelona, Spain, 2017, pp. 8–13. [19] G. D’Ago, M. Lefebvre, L.R. Buonocore, F. Ruggiero, M. Di Castro, V. Lippiello, Modelling and control of a variable-length flexible beam on inspection ground robot, in: 2022 International Conference on Robotics and Automation, ICRA, IEEE, 2022, pp. 8224–8230. [20] J. Lee, R. Balachandran, Y.S. Sarkisov, M. De Stefano, A. Coelho, K. Shinde, M.J. Kim, R. Triebel, K. Kondak, Visual-inertial telepresence for aerial manipulation, in: 2020 IEEE International Conference on Robotics and Automation, 2020, pp. 1222–1229. [21] Z. Ouyang, R. Mei, Z. Liu, M. Wei, Z. Zhou, H. Cheng, Control of an aerial manipulator using a quadrotor with a replaceable robotic arm, in: 2021 IEEE International Conference on Robotics and Automation, 2021, pp. 153–159. [22] T. Bartelds, A. Capra, S. Hamaza, S. Stramigioli, M. Fumagalli, Compliant aerial manipulators: Toward a new generation of aerial robotic workers, IEEE Robot. Autom. Lett. 1 (1) (2016) 477–483. [23] A. Suarez, G. Heredia, A. Ollero, Design of an anthropomorphic, compliant, and lightweight dual Arm for aerial manipulation, IEEE Access 6 (2018) 29173–29189. [24] G. Loianno, V. Spurny, J. Thomas, T. Baca, D. Thakur, D. Hert, R. Penicka, T. Krajnik, A. Zhou, A. Cho, et al., Localization, grasping, and transportation of magnetic objects by a team of mavs in challenging desert-like environments, IEEE Robot. Autom. Lett. 3 (3) (2018) 1576–1583. [25] M. Mohammadi, D. Bicego, A. Franchi, D. Barcelli, D. Prattichizzo, Aerial telemanipulation with passive tool via parallel position/force control, Appl. Sci. 11 (19) (2021). [26] K.-S. Hong, U.H. Shah, Dynamics and Control of Industrial Cranes, Springer, 2019. [27] C. Gabellieri, Y.S. Sarkisov, A. Coelho, L. Pallottino, K. Kondak, M.J. Kim, Compliance control of a cable-suspended aerial manipulator using hierarchical control framework, in: 2020 International Conference on Intelligent Robots and Systems, 2020, pp. 7196–7202. [28] R. Miyazaki, R. Jiang, H. Paul, Y. Huang, K. Shimonomura, Long-reach aerial manipulation employing wire-suspended hand with swing-suppression device, IEEE Robot. Autom. Lett. 4 (3) (2019) 3045–3052. [29] M.J. Kim, J. Lin, K. Kondak, D. Lee, C. Ott, Oscillation damping control of pendulum-like manipulation platform using moving masses, IFAC-PapersOnLine 51 (22) (2018) 465–470. [30] R. Lampariello, J. Heindl, R. Koeppe, G. Hirzinger, Reactionless control for two manipulators mounted on a cable-suspended platform, in: 2006 International Conference on Intelligent Robots and Systems, 2006, pp. 91–97. [31] H. Osumi, M. Saitoh, Control of a redundant manipulator mounted on a base plate suspended by six wires, in: 2006 International Conference on Intelligent Robots and Systems, 2006, pp. 73–78.