Research Article | Open Access

Yuqing He, Yingjun Zhou, Jianda Han, "Trajectory Evaluation of Rotor-Flying Robots Using Accurate Inverse Computation Based on Algorithm Differentiation", *Mathematical Problems in Engineering*, vol. 2014, Article ID 464056, 8 pages, 2014. https://doi.org/10.1155/2014/464056

# Trajectory Evaluation of Rotor-Flying Robots Using Accurate Inverse Computation Based on Algorithm Differentiation

**Academic Editor:**Fatih Yaman

#### Abstract

Autonomous maneuvering flight control of rotor-flying robots (RFR) is a challenging problem due to the highly complicated structure of its model and significant uncertainties regarding many aspects of the field. As a consequence, it is difficult in many cases to decide whether or not a flight maneuver trajectory is feasible. It is necessary to conduct an analysis of the flight maneuvering ability of an RFR prior to test flight. Our aim in this paper is to use a numerical method called algorithm differentiation (AD) to solve this problem. The basic idea is to compute the internal state (i.e., attitude angles and angular rates) and input profiles based on predetermined maneuvering trajectory information denoted by the outputs (i.e., positions and yaw angle) and their higher-order derivatives. For this purpose, we first present a model of the RFR system and show that it is flat. We then cast the procedure for obtaining the required state/input based on the desired outputs as a static optimization problem, which is solved using AD and a derivative based optimization algorithm. Finally, we test our proposed method using a flight maneuver trajectory to verify its performance.

#### 1. Introduction

The autonomous rotor-flying robot (RFR) is one of the frontier research topics in the field of robotics. Extensive research has been conducted on issues related to RFR, including flight control [1, 2], path/trajectory planning [3, 4], and intelligent navigation [5, 6].

Flight maneuvering is a very important ability for an RFR system because it can greatly extend the system’s field of applications. However, the flight maneuver control of an RFR is a challenging and absorbing problem in the field of autonomous RFR research [2]. This can be explained from the following two points. On the one hand, the model of an RFR system is an extremely complicated structure [7, 8], designing a suitable controller for which is very difficult. On the other hand, flight maneuvering requires that both the interval states (i.e., the attitude angles and the angular rates) and the control surfaces to have a large scope variation (or even approach the largest permitted value) [9]. This may produce a great deal of uncertainty and thus presents that this flight maneuvering is dangerous and difficult to be implemented and thus requires a much more robust controller than usual [10].

Most work on flight maneuver control, such as [11, 12], is based on successful flight demonstrations and grounded in learning techniques used to update the control laws. These methods have successfully pushed the envelope of what is possible with autonomous control, but they lack performance guarantees and are limited to situations where safety is not a critical concern. Thus, it is very important to assess the flight maneuvering ability of an RFR system prior to designing a controller and conducting tests. Some research has been conducted in this area. For instance, research in [2] is based on reachability analysis and explores aerobatic maneuvers and multiple vehicle collision avoidance of the RFR systems. This involves designing a sequence of modes and conducting safe transition from one to the next. However, reachability analysis is very time consuming, due to which the proposals in [2] are viable only for simplified models. Similarly, [9] involves a feasibility analysis of planned trajectories by using a greatly simplified dynamics model (without considering angular dynamics). Both the positions and attitude angles are predetermined and then used to evaluate the feasibility of the planned trajectories. Although the algorithm is simple and easily implemented, it is unfit for many planning algorithms since for which it is difficult to obtain the positions and attitude angles simultaneously.

In this paper, based on a full state dynamics model, we investigate the feasibility analysis problem of a flight maneuvering trajectory. This is actually an inverse computation problem, that is, to compute both the interval states and the inputs based on predetermined position, yaw angle, and their higher-order derivatives. In our work, we model it as a static optimization problem and then use a derivative-based optimization algorithm to obtain an accurate solution of it. We use algorithm differentiation (AD) to obtain precise higher-order derivatives of the nonlinear cost function. The advantages of our proposed algorithm are as follows: only with desired positions and their derivatives, which is the case for many planning algorithm, the feasibility of the trajectories (including inner states and inputs) can be evaluated; inverse computation can be very accurate because AD is a numerical algorithm that can precisely obtain the derivative of a nonlinear function. Thus, an accurate pointwise numerical feasibility analysis of planned trajectories becomes possible.

The remainder of this paper is organized as follows. We first present a model of the RFR system and show that it is flat by taking the three positions and the yaw angle as a group of flat outputs. This allows us to model the trajectory evaluation problem as an optimization problem by taking into account the dynamical model, which is solved by using the AD algorithm along with a derivative-based optimization algorithm. Finally, in order to test our proposed method, we use it to analyze a flight maneuvering trajectory.

#### 2. Dynamical Model of the RFR System

Usually, the complete dynamical model of an RFR system can be divided into three parts: the actuator dynamics, the aerodynamics, and the rigid body dynamics. In this paper, only the rigid body dynamics as shown in the following equation (1) is considered [3]: where and are translational position and velocity vector of the RFR in the inertia frame; is the rotation matrix between the body frame and the inertia frame; is angular velocity vector; is Euler angle vector; and are, respectively, the mass and inertia matrix of the RFR; Ψ is the transformation matrix from angular velocity vector in body frame to angular velocity vector in inertia frame; and and are force and moment of the RFR presented in body frame. Different kinds of RFR have very different aerodynamics, that is, the relationship between the force/moment and the control surfaces. Here we focus on the quadracopter flying robot, whose driving forces and moments can be denoted as follows: where , , , and are force produced by four rotors, respectively, and is the distance between each rotor center and the RFR’s center of gravity (see Figure 1).

Thus, define inputs as System (1) can be rewritten as

It can be easily shown that system (4) is input-to-state feedback linearizable through defining the following state vector: From (1) and (2), we have and the system can be transformed into the following linear form: with the feedback linearization controller where

That means system (1) is flat and that the are the corresponding flat outputs.

#### 3. Automatic Differential Algorithm Based Inverse Computation

AD is a numerical method that is effective to accurately compute the derivatives of some complicated nonlinear function. In this section, we will briefly introduce how to conduct the inverse computation of a nonlinear flat system using AD algorithm [13].

Consider the following nonlinear system:

It has been shown that the inverse computation problem of system (10), that is, to obtain a state vector with (a predefined output), is solvable if is a flat output of system (1) [14].

Derivatives of with respect to are necessary to effectively solve the preceding inverse problem. In the following contents of this section, the basic idea on how to obtain using AD algorithm will be introduced.

For this purpose, we firstly use the following Taylor series to denote the state vector : Provided that is times continuously differentiable, can also be expressed by Taylor series as follows:

It has been shown that each Taylor coefficient is uniquely determined by the coefficients as follows [15, 16]:

Thus, if in (11) are preknown, all can be obtained based on some derivatives, which can be computed by basic “forward mode” of AD [13]. Similarly, the following can also be derived using “reverse mode” of AD [13–15]:

Furthermore, based on (10), we have that is,

Through (16) and (13), we can easily compute all based on .

Define a new matrix as

From [15], we have

Thus, can be iteratively obtained as follows:

Furthermore, if we denote as

then the same process can be used to compute through the second equation of (10); that is, with a preknown , compute by forward mode and compute the following derivatives by reverse mode:

Also, it is not difficult to show that the derivatives of output with respect to the states can be denoted as follows:

Up to now, we have shown that, with a predefined state , both the corresponding outputs and its higher-order derivatives with respect to time, as well as the derivatives with respect to state (22), can be obtained through AD algorithm. These results can be further used to conduct the inverse computation of system (1), and the detailed steps are given as follows.

*AD Based Inverse Computation Algorithm*

*Initialization*. (the highest order of the outputs’ derivatives); (step length of searching algorithm); (iterative number).

*Step 1. *Compute the output vector using forward mode of AD algorithm at each time instant as a nonlinear map; that is,

*Step 2. *Based on (22), AD can be used to obtain the partial derivative of with respect to ; that is,

*Step 3. *Update the state using the following searching iteration:
where superscript “+” means the pseudoinverse of a matrix; that is,

*Step 4. *Go to Step 1 until the terminal conditions are satisfied.

If the system is nonautonomous, that is, it can be rewritten as following form,
We can first extend it into the following form:
and the new system can be rewritten as
where

Thus, the inverse computation can be conducted using the preceding algorithm.

As for the proposed quadrocopter system introduced in Section 2, this algorithm can be directly utilized through defining the following output vector:

#### 4. Evaluation of Circle Flying Maneuver

In this section, a so-called “Circle Maneuver,” that is, the RFR system flies along a circle as shown in the following equation (32) and Figure 2 [10], of the Quadrocopter is taken as an example to show the validity of the proposed algorithm. Consider where is the period of the circle maneuver.

The parameters of the RFR system are as follows:

The trajectory feasibility is decided by some constrains on both inputs and states. Here the following constrains are considered.

*Input Constrains*. Consider

*Angular Velocity Constrains*. Consider

*Attitude Constrains*. Consider

In this paper, the software toolbox LIEDRIVERS [17] based on ADOL-C is used as the basic AD algorithm, and the optimization searching is implemented using the golden sector algorithm, instead of the direct derivative-based algorithm as in Section 4. During the simulations, we test the circle maneuvers with different period , and the results are given in Figures 3, 4, and 5.

**(a)**

**(b)**

**(c)**

**(d)**

**(a)**

**(b)**

**(a)**

**(b)**

**(c)**

**(d)**

From these figures, we can obtain the following results.(1)For input constraints (Figures 3 and 5), only the maneuvering trajectories with are infeasible because the required dragging force is almost 210 N, larger than the maximum permitted value of 190.8 N, while the other inputs, that is, the three moments, are all much smaller than the maximum values.(2)For angular velocity constrains (Figure 5), again, only the maneuvering trajectories with are infeasible, and the maneuvering trajectories with are* dangerous* since the maximum angular velocity approaches the maximum value of the permitted angular velocity.(3)Based on the attitude constrains (Figure 4), the maneuvering trajectories with , 12.5 s, and 10 s are all infeasible.

Finally, from the preceding results, it can be seen that the circle maneuvers are really a highly dynamical maneuver, and the quantitative analysis prior to the flight test is useful and necessary to evaluate whether or not a maneuver trajectory is feasible or even dangerous.

#### 5. Conclusions

In this paper, the flight maneuvering trajectories evaluation problem is researched, and the algorithm differentiation (AD) is used to realize the inverse computation of the rotor-flying robot (RFR) system. This paper starts from constructing nonlinear dynamical model of an RFR system. Then, we show that the RFR system model is flat taking translational positions and yaw angle as flat outputs. After that, the scheme of AD based inverse computation is introduced, that is, computing the internal states and inputs based on the desired flat outputs. Finally, with the proposed scheme, a typical flight maneuver, that is, the circle maneuver, is analyzed.

The advantages of our proposed algorithm are as follows: only desired positions and their derivatives, which is the case for many planning algorithm, and the feasibility of the trajectories (including inner states and inputs) can be evaluated; inverse computation can be very accurate because AD is a numerical algorithm that can precisely obtain the derivative of a nonlinear function. Thus, an accurate pointwise numerical feasibility analysis of planned trajectories becomes possible.

The method proposed in this paper can be used to not only evaluate the feasibility and validity of the maneuver flying trajectories, but also realize the tracking control algorithm, where the computed internal states and inputs are useful for attenuating the online computational burden of the tracking controller and thus improving the closed loop performance. This will be one of our future’s works.

#### Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

#### Acknowledgments

The authors would like to present their thanks to Professor Klaus Röbenack at Technique University of Dresden (Germany) for the related discussion and suggestions on AD algorithm. This work is supported by the National Natural Science Foundation of China (Grants no. 61035005 and no. 61203340).

#### References

- Y. Q. He and J. D. Han, “Acceleration-feedback-enhanced robust control of an unmanned helicopter,”
*Journal of Guidance, Control, and Dynamics*, vol. 33, no. 4, pp. 1236–1250, 2010. View at: Publisher Site | Google Scholar - J. H. Gillula, G. M. Hoffmann, M. P. Vitus, and C. J. Tomlin, “Applications of hybrid reachability analysis to robotic aerial vehicles,”
*International Journal of Robotics Research*, vol. 30, no. 3, pp. 335–354, 2011. View at: Publisher Site | Google Scholar - F. Andert, F. Adolf, L. Goormann, and J. Dittrich, “Mapping and path planning in complex environments: an obstacle avoidance approach for an unmanned helicopter,” in
*Proceedings of the IE E E International Conference on Robotics and Automation*, pp. 745–750, Shanghai, China, May 2011. View at: Publisher Site | Google Scholar - G. Flores, S. T. Zhou, R. Lozano, and P. Castillo, “A vision and GPS-based real time trajectory planning for a MAV in unknown and low-sunlight environments,”
*Journal of Intelligent Robotic Systems*, vol. 74, pp. 59–67, 2014. View at: Google Scholar - P. Bristeau, E. Dorveaux, D. Vissière, and N. Petit, “Hardware and software architecture for state estimation on an experimental low-cost small-scaled helicopter,”
*Control Engineering Practice*, vol. 18, no. 7, pp. 733–746, 2010. View at: Publisher Site | Google Scholar - A. I. Mourikis, N. Trawny, S. I. Roumeliotis, A. E. Johnson, A. Ansar, and L. Matthies, “Vision-aided inertial navigation for spacecraft entry, descent, and landing,”
*IEEE Transactions on Robotics*, vol. 25, no. 2, pp. 264–280, 2009. View at: Publisher Site | Google Scholar - M. Bangura and R. Mahony, “Nonlinear dynamic modeling for high performance control of a quadrotor,” in
*Proceedings of the Australasian Conference on Robotics and Automation (ACRA '12)*, pp. 1–10, Wellington, New Zealand, December 2012. View at: Google Scholar - G. M. Hoffmann, H. Huang, S. L. Waslander, and C. J. Tomlin, “Precision flight control for a multi-vehicle quadrotor helicopter testbed,”
*Control Engineering Practice*, vol. 19, no. 9, pp. 1023–1036, 2011. View at: Publisher Site | Google Scholar - M. W. Mueller, M. Hehn, and R. D'Andrea, “A computationally efficient algorithm for state-to-state quadrocopter trajectory generation and feasibility verification,” in
*Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS '13)*, pp. 3480–3486, Tokyo, Japan, 2013. View at: Google Scholar - D. Song, J. Han, and G. Liu, “Active model-based predictive control and experimental investigation on unmanned helicopters in full flight envelope,”
*IEEE Transactions on Control Systems Technology*, vol. 21, no. 4, pp. 1502–1509, 2013. View at: Publisher Site | Google Scholar - O. Purwin and R. D'Andrea, “Performing aggressive maneuvers using iterative learning control,” in
*Proceedings of the IEEE International Conference on Robotics and Automation*, pp. 1731–1736, Kobe, Japan, May 2009. View at: Publisher Site | Google Scholar - S. Lupashin, A. Schöllig, M. Sherback, and R. D'Andrea, “A simple learning strategy for high-speed quadrocopter multi-flips,” in
*Proceedings of the IEEE International Conference on Robotics and Automation (ICRA '10)*, pp. 1642–1648, Anchorage, Alaska, USA, May 2010. View at: Publisher Site | Google Scholar - K. Röbenack and O. Vogel, “Computation of state and input trajectories for flat systems using automatic differentiation,”
*Automatica*, vol. 40, no. 3, pp. 459–464, 2004. View at: Publisher Site | Google Scholar | MathSciNet - G. Andreas and W. Andrea,
*Evaluating Derivatives: Principles and Techniques of Algorithm Differentiation*, Society for Industrial and Applied Mathematics, Philadelphia, Pa, USA, 2nd edition, 2008. View at: Publisher Site | MathSciNet - B. Christianson, “Reverse accumulation and accurate rounding error estimates for Taylor series coefficients,”
*Optimization Methods and Software*, vol. 1, no. 1, pp. 81–94, 1992. View at: Publisher Site | Google Scholar - K. Röbenack, “Automatic differentiation and nonlinear controller design by exact linearization,”
*Future Generation Computer Systems*, vol. 21, no. 8, pp. 1372–1379, 2005. View at: Publisher Site | Google Scholar - K. Röbenack, J. Winkler, and S. Q. Wang, “LIEDRIVERS—a toolbox for the efficient computation of Lie derivatives based on the object-oriented algorithmic differentiation package ADOL-C,” in
*Proceedings of the 4th International Workshop on Equation-Based Object-Oriented Modeling Languages and Tools*, ETH Zurich, Zurich, Switzerland, 2011. View at: Google Scholar

#### Copyright

Copyright © 2014 Yuqing He et al. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.