Abstract

Obstacles of some trees within the electric power transmission line channel are of great threat to the electricity supply. Nowadays, the tasks of clearing threatening tree branches are still mostly operated by hand and simple tools. In this article, an aerial tree-pruning robot with a novel structure is designed to improve the pruning operation efficiency and enhance the safety of the staff. However, the long arm of the pruning tool results in much higher rotational inertia of the robot, which brings difficulties for the robot to remain stable. Therefore, a control scheme based on model predictive control is proposed for the aerial tree-pruning robot and to deal with an uncertain system during the pruning operation period. One of the main contributions is that an ADMM (alternating direction method of multipliers) algorithm that solves the constrained QP (quadratic programming) is adopted to implement the model predictive control on embedded computers with limited computational power. The dynamic model of the pruning robot is firstly presented. Then, the control scheme of MPC for the pruning robot is presented. Moreover, the QP problem of robot control is addressed with ADMM. Finally, simulation experiments of attitude tracking as well as the antidisturbances capability verification have been conducted. Results for the system of aerial tree-pruning robot are given to demonstrate the effectiveness of the developed attitude tracking control scheme using ADMM-based MPC.

1. Introduction

Aerial robots with task tools conducting contact forces with the environment are of typical complex systems, of which the dynamics analysis and control have become emerging hot topics [1]. And as the nonlinear complexity of robot model grows, the optimization control strategy has shown a huge superiority. Electric power transmission system is the key infrastructure to ensure our living and producing. Therefore, the national security would encounter threat once the system encounters a breakdown. Trees and branches beside the high-voltage line are among the most hazardous factors that would cause the fault and accident of electric power transmission. So, the tree barriers clean up is the priority among priorities in the operation and maintenance of the electric power facilities. And most of the work has to be implemented by the close cooperation of human and ground equipment. However, power supply companies have been suffering severely from the low operation efficiency and continuously increasing labor costs.

The aerial tree-pruning robot would be a promising replacement for the task of trees barrier clean up.

The advantages of the aerial tree-pruning robot utilization are as follows. First, the flying pruning robot could reach the operation spot very rapidly, whereas, during manual work, operators always have to carry up and down by lifting machines. Second, greater working space enable the robot to implement tasks at much higher and distant position, but lifting machines, by contrast, have limited arm length and working space.

Third, the robot is friendlier to the environment as it consumes no fossil fuel. Finally, low cost is one of the most impressive advantages, whereas electric power companies have been suffering a lot from the trees pruning by labor.

The most challenging task of tree pruning for the aerial robot would be accomplishing the attitude and position control onto the large yaw-inertia aerial robot with the model uncertainty and external disturbance as the pruning operation causes great and sophisticated contact forces.

Therefore, to build an efficient control algorithm for the robot is the prior option before implementing the pruning operation for the robot.

As there is very little research on pruning robot [2] and the new robot is a sort of multirotor with special structural configuration, it is well reasoned that we consider the method of the pruning robot control from the state-of-the-art literature of the control for quadrotors and aircrafts.

Until now, the control problem of quadrotor has been addressed successfully with various approaches, such as PID control [3], backstepping control [4, 5], sliding mode control [6], ADRC [7], dynamic inversion [8], and H∞ control [9]. However, model predictive control (MPC) is the most widespread modern control approach applied in industrial process [10], with PID the most popular classical control method. From a certain perspective, the problem of UAV control can be solved by the idea of optimizing control, and model predictive control is aimed right at control problems with optimization requirements. The success of predictive control in complex industrial processes has fully demonstrated its great potential for handling complex optimization control problems with constrains. People put forward higher and higher requirements for control and are no longer satisfied with the traditional stabilization design but hope that the control system can obtain better performance through optimization and model predictive control could just handle this issue. MPC is competent in not only large-scale systems, such as traffic [11], energy [12], environment [13], and material synthesis [14] but also fast dynamic systems, such as power electronic converters [15], electrical motor drives [16], torque-split for hybrid vehicle [17], and so on. For instance, a signal-split control approach with explicit model predictive control (EMPC) has been proposed to reduce the complexity of online optimization in the field of transportation system and to increase the applicability for real transportation system [11].

MPC has also been applied successfully in aerospace research like quadrotor or fixed-wing UAVs where path planning [1822] and attitude control problems [2327] are the two main issues that involve MPC.

Concerning the path planning, a fast MPC method is introduced to obtain a UAVs’ path, where collision avoidance between UAVs and the change of communication topology among UAVs are taken into account [19]. Moreover, model predictive control with sequential linear quadratic (SLQ) solver has been applied to compute feasible and optimal trajectory and to operate a multirotor with a suspended load in dynamic environments [28]. At the same time, regarding the position and attitude control, Alexis [2935] promotes great progresses in MPC-based quadrotor control research for the last decade. a real-time robust model predictive control scheme in various challenging conditions have been proposed and experimentally evaluated to addresses the problem of robust flight control of unmanned rotorcrafts, which aims to capture the demanding nature of the potential requirements for their efficient and safe integration in real-life operations [32]. Also, the hardware implementation of MPC was accomplished based on a Matrice 100 quadrotor from DJI alongside its ROS C++ Software Development Kit (SDK) [36].

MPC involves finding cost function values for optimization; therefore, the optimizing efficiency is one of the most essential issues to be tackled. Also, as our goal of the project of the aerial pruning robot is to cut out the tree branches in the field rather than just implement the robot simulation on desktop, real-time computing on the embedded computer with limited computational power should be guaranteed. However, the majority of the optimization problems are tackled with commercial solvers like Gurobi, SNOPT, MOSEK, and so on, which is not suitable for the MPC application on embedded computers which are installed in the aerial robot and responsible for outputting the right command signals to keep the attitude stability and follow the desired trajectories. The reason includes that commercial solvers are always having large code size, higher demand for working memory, and heavy library dependency.

ADMM (Alternating Direction Method of Multipliers) is an optimal problem-solving method that splits complex problem into some relatively simpler problems that could be solved by computers with limited power like embedded microprocessor. Researchers have been reported applying ADMM in several fields like traffic signal control [37] and microgrids (MGs) [38]. Also, ADMM is adopted to realize parallelism of the distributed model predictive control (DMPC) of waterborne AGVs (automated guided vessels) which is modeled with independent dynamics and objectives but coupling collision avoidance constraints [39]. Furthermore, the ADMM-based distributed model predictive flow control (DMPFC) approach has been utilized to the planning of the cooperative synchromodal freight transport [40].

Nonetheless, to the best of our knowledge, ADMM-based MPC has hardly been used to quadrotor control, not to speak of the aerial tree-pruning robots.

Motivated by above discussion and analysis, in this paper, we will present an ADMM algorithm that solves a constrained QP (quadratic programming) to implement the Model Predictive Control for the aerial tree-pruning robots. The remainder of this paper is organized as follows. The dynamic model of the pruning robot is presented first. Then, the control scheme of MPC for the pruning robot is described. Moreover, the QP problem of robot control is addressed with ADMM. Finally, the simulation experimental implementation of the ADMM-based MPC control onto the aerial pruning robot is given.

2. Problem Description

To begin with, modelling of aerial robot should be considered when conducting the problem description. In our previous work, a tree-pruning robot was designed, and its modelling and LQR control were also presented. Here we followed the modelling methods of our published paper [41].

The floating base robot with 6 DoF (degrees of freedom), has 3 main modules which are multi-rotor aircraft with thrust-ducted propellers, a robot arm (no joints for now) and operation devices (shown in Figure 1). This enables the robot DoF to be listed as elevation, sway, surge, roll, pitch, and yaw.

2.1. Robot Kinematics and Dynamics

The coordinate systems of the robot are built with two coordinates, the world inertial coordinate and the robot body coordinate as shown in Figure 2. The translational position of the robot body is denoted as world coordinate variable elevation, sway, and surge . The robot attitude is defined in the world coordinate, which is expressed by the Euler angles (roll, pitch, and yaw).

In the kinematics representation, transforming coordinates from to is necessary. Therefore, the rotation matrix is defined aswhere , , and are the rotation matrixes along their corresponding axis.

The center of mass of the robot is described by the vector in the inertial coordinate system . The total thrust produced by the six propellers in Figure 1 is the direct factor that causes the translation and attitude acceleration of the robot. The advantage of the new structure of the robot in this paper is that two ducted thrusters are installed under the robot, which could achieve “zero pitch angle” forward and backward translation, completing forward translation and accurately stop without the cooperation of attitude angle. The dynamics of translation in the inertial frame are described aswhere is the acceleration generated by the Earth gravity and is the vector sum of the rotor forces that act to the robot mass .

The control inputs to the tree-pruning robot are the mass-normalized thrust of the rotor forces sum , and the desired forces sum are specified by the desired rotational rates along the body axes of the tree-pruning robotb, which is shown in Figure 1.

Also, there exists a relationship between the angular velocity vector ω of the robot body and the rate of change of the robot attitude:

Not only each rotor of the aerial tree-pruning robot produces a force , in the positive direction of or , but also the propellers generate reaction torques , which are perpendicular to the plane of rotor blade rotation as shown below:where is the coefficient of the reaction torque from the propeller. is the rotate speed of the propeller.

As shown in Figure 1, Rotors 1 and 3 rotate to the positive direction, resulting in moments that act in the direction of the negative . Meanwhile, Rotors 2 and 4 rotate to the negative direction, which causes the reaction torques to the positive direction [42]. Also, Rotors 5 and 6 rotate to the negative and positive direction, respectively, and cause the reaction torques, too. However, Rotors 5 and 6 rotate with the same speed. So, their reaction torques sum to 0.

Given the inertia matrix with respect to the center of mass and the robot body coordinate , the rotational dynamics of the body-fixed frame could be obtained.where is the distance between two adjacent lifting rotors which are arranged in a square. is the distance between the center of mass and the boosters (Rotors 5 and 6) along the axis. refers to the moment of inertia matrix referenced to the center of mass.

2.2. Nonlinear System of the Aerial Tree-Pruning Robot

During the operation of tree barriers cleaning, the contact force significantly affects the attitude of the flying robot, which could not be ignored when the control system is designed. For the convenience of the control with system uncertainty and time-varying disturbance, it is necessary to formulate the robot model in the MIMO nonlinear system below:where , , , and . and are the system uncertainties, and is the unknown disturbance.

3. Model Predictive Control of the Aerial Tree-Pruning Robot

3.1. Model Predictive Control

In order to keep the research proceed, discretization process is conducted to the state-space model of the aerial pruning robot, which is shown below:where represents the pruning robot’s state of attitude, and refers to the robot input generated from the MPC controller, at time , and denote the system matrix and input matrix, respectively. The core of the pruning robot MPC is to specify a cost function of the time step and find its minimum value. The cost function of the finite horizon optimal control problem is shown aswhere , , and usually are positive semi-definite matrices, namely , , and . Specifically, determines the penalty degree of the robot state’s deviation at the end of the prediction horizon . And, represents the penalty degree of the robot state’s deviation over the entire horizon. affects the proportion of the robot control inputs in the cost function. denotes the predicted state vector at time and is acquired by result from the sequence of input . The state maximum and the state minimum form the constraint of the state variable . And, the constraint of the input variable is similarly defined composed of the input maximum and the input minimum .

The main idea of the model predictive control is as follows. A sequence of control inputs are generated at the time step , at which time the state of the pruning robot is . And by assigning as the initial state to cost function (9) with constraints (10), the sequence of optimal control input could be obtained. Nevertheless, the receding horizon framework refers that not all the generated control input elements of the sequence would be applied to the robot control. Instead, only the first element is adopted, with all the rest ones culled. This comes to an end of the work procedure at time step , and the new initial state would be obtained after the effect of the optimal input. Similarly, the new selected optimal input at step time is acquired.

3.2. Alternating Direction Method of Multipliers (ADMM)

The alternating direction method of multipliers (ADMM) is a brilliant method that solves the problems of convex optimization. The main idea of ADMM is that a global optimization problem could be ingeniously broken into some smaller pieces which could be able to be solved relatively much easier [43].

The standard form of optimizing problems that ADMM could effectively handle could be presented aswhere and must be convex. And for the specific application to the pruning robot control, the optimization problem has another form to be rewritten, which is,where has an indicator function , and the constraint becomes the subtraction of a primal variable and a separate variable . Then, the augmented Lagrangian equation which is an obvious element of ADMM is assigned aswhere a scaled dual variable is introduced and acts as a positive penalty parameter. The general method of the augmented Lagrange multiplier could be summarized as finding the minimum of w.r.t. both and . However, the direct minimizing of is hard, and the obvious separable character of the objective function is not well utilized. Thus, in order to accomplish minimality, ADMM tactfully have the global problem decomposed into two separate optimization subproblems. The mathematical expression of the above process could be shown as

For the beginning, several steps of the robot model, we have the state equations as

So according to a deduction, the robot state at time is could be reckoned as

To transform the objective function into a typical QP form, the elements in the deduction formula could be expanded as follows:

Let and ; then,

Thus the robot state is obtained as

The transposition of is

Expand using the above equation, we havewhere

Similarly, could be rewritten using the expansion method above. Therefore, we have the MPC optimization problem transformed to a QP problem whose objective function is presented aswhere

As for the constraints of the pruning robot’s MPC problem, there exists

Also, a definition is made:

Take the equation of above intowhich becomes

So by solving the inequation above, is limited bywhich is disassembled as a set of inequalities as

A combination is taken to the inequation group above, the QP constraints could be described aswhere

The stop criterion of ADMM reaching convergence is obtained as

The algorithm of ADMM is shown as a pseudo code in Algorithm 1.

Initialize;
Repeat
;
  ;
  ;
;
Until
;
  ;
Return: optimal control input ;

4. Simulation and Experiment Results

The efficiency and efficacy of the control scheme proposed in this paper is investigated using some simulation study whose main idea is to check the trajectory tracking performance under the contact force from saw-tree interaction and system uncertainty. Therefore, the following experiments were organized to verify the control algorithm to the robot. Firstly, the robot attitude control performance under ADMM-MPC control is discussed through the pitch, roll, and yaw tracking of desired trajectories. The second part of experiment is designed to check the cutting force effects during the robot operation where 3 continuous forces were added to the robot along 3 difference axis respectively. The simulation results are then shown about the pruning operation where the contact forces generated between the saws and tree branches are significant disturbances to the aerial robot. Finally, considering the large inertia of the robot pitch and yaw that could challenge our control algorithm, the inertia is then increased to check the regulating performance. Also, the optimization performance is presented as well.

In terms of evaluating the performance of the robot attitude tracking, some parameters must be specified as one of the prerequisites. Table 1 gives the physical information including kinematic variables. The reference trajectories of the robot attitude are specified as

Under the developed control scheme, the simulation results for aerial tree-pruning robot are shown in Figures 36. Meanwhile, in order to examine the control performance of the robot being impacted by the cutting forces, we specified respectively two pulse disturbances along the robot Y and Z axes which acts from 3 to 3.25 s, as shown in Figure 7.

Figures 35 show the robot attitude tracking results, where the cyan solid lines indicate the real trajectories, and the blue dashed lines indicate the desired trajectories. Obviously, the tracking performance of system is satisfactory; meanwhile, the tracking errors always be maintained between the prescribed performance bounds. Figure 6 shows the body angular velocities of the aerial tree-pruning robot.

It can be shown from these simulation results of the numerical example that the closed-loop system for the nonlinear system of the aerial tree-pruning robot with input saturation and parametric uncertainties is asymptotically stable. Therefore, the conclusion could be given that the proposed robust control method is valid. And the robot has performed satisfactorily during the period of cutting operation, which has proved strong robustness of the control scheme.

In order to demonstrate the optimization performance of the MPC control based on ADMM for the pruning robot. Figure 8 shows the cost function values of each step during the control process. The blue “x” listed in the same column represent the cost function value changes of one control step. Only in the very beginning, the cost value is pretty big, and the values converged exponentially to values around the steady-state value just within 0.5 second.

The running time of optimization in each step is one of the most common variables that could embody the optimization performance. Figure 9 shows the optimization running time of each step during the robot control. In the first several steps, it took relatively longer time for the optimizing completion because much larger number of iteration is needed to find optimized solutions, which is also very common in other algorithm of optimization.

Figure 10 shows the iteration number of each step of the simulation. The iteration number of optimization means the number of trial to obtain successively closer approximations to the best control input of the aerial pruning robot. In the very beginning of the simulation, up to 40 iterations have been taken to get the optimization result, and the number sharply converges to a relatively steady state remaining less than eight, which means an excellent optimizing capability of the algorithm.

As the aerial pruning robot features much larger inertia in the pitch and yaw channel than that of normal multirotor aircraft, the proposed control algorithm’s ability of the large inertia tolerance is necessary to be verified here. We increased the moment of inertia along three axes of the robot by 25% to check whether the control algorithm could still handle the trajectory tracking on the robot with the same hardware and software configuration. The simulation result is shown in Figure 11, which presents the comparison of the attitude trajectory tracking before and after the robot moment of inertia increases.

The change of moment of inertia does not cause a failure of the control for the pruning robot, as the robot is still able to reach the desired attitude although in a relatively slower way. As in Figure 11, the tracking performance of the pitch channel looks less satisfying because of the increase of the moment of inertia, in which it is obvious to see that the MPC controller’s adjusting time increases. But, it is still considered as a valid tracking control, as the controller could always make the robot attitude tracking the desired values.

However, the moment of inertia could not be increased ceaselessly because of the hardware restriction of the pruning aerial robot.

5. Conclusion

This paper mainly focuses on the design and validation of model predictive control for the aerial tree-pruning robot. A robust model predictive control scheme has been designed to achieve the trajectory tracking for an aerial tree-pruning robot in this article. Based on ADMM, the optimization solving problem has been issued through the MPC QP resolving. Finally, simulation results have been given to illustrate tracking performance of the proposed attitude and position control approach. The future research is going to consider a more calculation efficient solving method for aerial tree-pruning robot with operational external disturbances.

Data Availability

All data used to support the findings of this study are included within the article or generated from experiments.

Conflicts of Interest

The authors declare that there are no conflicts of interest.

Acknowledgments

This work was supported by the Guizhou Provincial Science and Technology Projects (Guizhou-Sci-Co-Supp[2020]2Y044), the Science and Technology Projects of China Southern Power Grid Co. Ltd. (066600KK52170074), the Key Laboratory Projects of Aeronautical Science Foundation of China (201928052006 and 20162852031), the Project Funded by the Priority Academic Program Development of Jiangsu Higher Education Institutions, the Natural Science Research Project of Higher Education of Education Department of Jiangsu Province (19KJD520007), and the Research Innovation Program for Postgraduates of Universities in Jiangsu Province (KYLX16_0380).