Nonlinear Predictive Control of Mass Moment Aerospace Vehicles Based on Ant Colony Genetic Algorithm Optimization

Based on the mathematical model of the mass moment aerospace vehicles (MMAV), a coupled nonlinear dynamical system is established by rational simplification. The flight control system of MMAV is designed via utilizing nonlinear predictive control (NPC) approach. Aiming at the parameters of NPC is generally used the trial-and-error method to optimize and design, a novel kind ofNPCparameters optimization strategy based on ant colony genetic algorithm (ACGA) is proposed in this paper.Themethod for setting NPC parameters with ACA in which the routes of ants are optimized by the genetic algorithm (GA) is derived. And then, a detailed realized process of this method is also presented. Furthermore, this optimization algorithm of the NPC parameters is applied to the flight control system of MMAV. The simulation results show that the system not only meets the demands of timeresponse specifications but also has excellent robustness.


Introduction
The aerodynamic rudder control is generally used for the traditional flight missile in the atmosphere.But in upper air, especially in the exoatmospheric space above 30 kilometers, because of lower air density, the dynamic pressure becomes very low.In the far field of missile fighting, because the speed of missile reduces, the dynamic pressure is relatively low.This causes the dynamic characteristics of the missile to be decreased and the maneuverability to be weak.The weak maneuverability of the missile makes the missile miss the targets frequently and cannot meet the demands of precise guidance and control.This requests the new technical approach.In order to enhance the maneuverability, agility, and guidance precision of the antiaircraft missile, a new method of mass moment control is proposed in 2000 by USA.From the related literatures, the moving-mass-center control was studied by both Russia and USA.In the 1990s of the 20th century.But, because the maneuver control technology of the reentry warhead was kept secret extremely in the world, the public literatures and the related research are very few.The related research which can be seen in the literature has almost focused on reentry warhead at high Mach numbers.Several studies have suggested that mass moment control system (MMCS) appears to offer the greater design and cost advantages [1][2][3][4][5][6][7][8].There are some advantages of mass moment control as follows.(1) All the mechanism of MMCS is in aerospace vehicles, which will not affect the aerodynamic configuration and is better to accuracy of terminal attack.(2) The actuators of MMCS are internal moving masses, which decrease the thermal load of aerodynamic configuration and avoid the gap on the surface of the vehicle and ablation steering surface.(3) By using aerodynamic forces generated by high-speed flight of vehicle, we can decrease the energy consumption and get effective control avoiding conflict between fuel consumption and control moment generated by lateral jet engine.
The stability control mode of the three channels was used for MMAV in this paper.The two orthogonal moving masses were arranged on radial of MMAV, and another moving mass was arranged on axis.Each of the channels has strong coupled aerodynamic, control, inertia, and dynamics.So MMAV becomes one multivariable system model of the nonlinearity and uncertainty.A coupled nonlinear dynamic model is obtained by the rational simplification for this system.The nonlinear predictive control (NPC) of MMAV is investigated in the paper.By considering the insufficiency of NPC adjustment parameters, one parameter optimization method is proposed based on ant colony genetic algorithm (ACGA).With the merits of GA, this method has the global search ability, latent parallel computing, and simple computation process and can solve the contradiction of the optimal solution and the searching space.The contradiction of searching space and time performance is also overcome, which easy to convergent in nonglobal optimal solution and computing time too long when using ant colony algorithm (ACA) to solute optimization question.This method is applied to system design of flight control on MMAV.
During the last decade, much effort has been made in GA to investigate aerospace vehicles systems [9][10][11][12][13][14][15][16][17][18].For instance, [9] demonstrates the advantages of using a real coded genetic algorithm (GA) for aerospace engineering design applications.In [10], in order to realize the high precision attitude determination of the space crafts by star sensors, an optimization method of star map distorted model based on improved genetic algorithm is presented.Reference [12] presented a new method in hierarchical genetic algorithms (HGAs) to speed up the optimization of aerodynamic shapes.In [13], an improved GA for airfoil shape parameterization is presented which takes into consideration the characteristics of viscous transonic flow particularly around the trailing edge.In [14], a novel parsimonious genetic programming (PGP) algorithm together with a novel aeroengine optimum data-driven dynamic start process model based on PGP is proposed.In order to obtain the global solution efficiently, [15] proposed a hybrid optimizer combining the advantages of a floating-coded genetic algorithm and simplex method.In [16], an optimization process, based on a genetic algorithm, is used to meet the frequency domain handling qualities requirements for the longitudinal plane.It is well known that GA cannot make good use of system feedback information.It often results in a lot of redundancy and reduces the computing efficiency.In contrast, ant colony algorithm accumulates and renews the optimal path information continuously.It has the ability of parallel processing and global searching.Many scholars have researched the hybrid algorithm including GA and ACA and got some good results in applications.For example, [19] gave an application of ant colony, genetic algorithm, and data mining-based techniques for scheduling.[20] used the hybrid algorithm in the contrast of images.Reference [21] addressed the optimization of cloud database route scheduling based on combination of GA and ACA.More results can be found from [22][23][24][25][26][27][28].However, to the best of our knowledge, there are few works appeared to investigate the MMCS by the GA combined with ACA.This motivates the research in this paper.
This paper is organized as follows.The mathematical model of MMAV is derived in Section 2. In Section 3, nonlinear predictive control and its robustness analysis are employed to design MMCS.Ant colony genetic algorithm is applied to parameter optimization of MMCS in Section 4. In Section 5, simulation demonstrates the ability of the optimized controller to effectively control the MMAV's motion.Conclusion is given in Section 6.

The Mathematical Model of MMAV
2.1.The General Dynamics Model of the MMAV.The basic principle by which MMCS is able to control the vehicle's motion is to produce the control torque by using the aerodynamic forces and moving the masses within the MMAV to offset the c. m. of system.
Suppose that the MMAV includes  moving masses and the mass of MMAV's shell is   .The mass of the th moving mass is   .So, the total mass of MMAV is   =   +∑  =1   .The mass ratio of the th moving mass is   =   /  .The coordinates in the body fixed frame are  1 = ( 1 ,  1 ,  1 )  ,  = 1, 2, . . ., .In the ground frame, the velocity of the center of MMAV is   = δ  , and the acceleration is V  = δ  .Let the coordinates in the ground with the body fixed frame of the th moving mass be   and the coordinates in the ground frame   .There is the relationship The coordinates of MMAV's c. m. in the ground frame are given by After derivation, the translational equation of the MMAV in the ground frame can be presented below: Then, the translational equation of the MMAV in the body fixed frame is as follows: where  1 is the transformation matrix from the body fixed frame to the ground frame and ( 1 ) ×  is the antisymmetric matrix of the angular velocity of the MMAV in the ground frame.( 1 ) × 1 is the antisymmetric matrix of the angular velocity of the MMAV in the body fixed frame.Correspondingly, the force equation of the th moving mass in the body fixed frame is given by ) According to D'lembert principle, the rotational equation in body coordinates is obtained as follows: where  1 = − ∑  =1  1  1 ,  1 is the antisymmetric matrix of the th moving mass in the body fixed frame representing the position coordinates  1 .

The Dynamics Model of the MMAV with Three Moving
Masses.The structure diagram of the MMAV with three moving masses is shown in Figure 1.To quickly adjust the flying attitude and decrease coupling, one mass is fixed at axis in the body fixed frame.Other two masses are fixed at axis and -axis in radial direction through the MMAV's axis.
The mass of the MMAV's shell is   .The mass of axial moving mass  1 is  1 , and the coordinate in the body fixed frame is  11 .The mass of radial moving mass  2 is  2 , and the coordinate in the body fixed frame is  12 .The mass of radial moving mass  3 is  3 , and the coordinate in the body fixed frame is  13 .So, the total mass is   =   +  1 +  2 +  3 , and the mass ratios are  1 =  1 /  ,  2 =  2 /  , and  3 =  3 /  , respectively.
This section derives the equations of motion fully accounted for the dynamic coupling between the four bodies.The moving masses are allowed to translate with respect to the MMAV's shell but are not allowed to rotate with respect to the MMAV's shell.Both the MMAV and the moving masses are assumed to be rigid bodies.
In the body fixed frame, the interaction between axial moving mass  1 and MMAV is  11 , the interaction between radial moving mass  2 and MMAV is  12 , and the interaction between radial moving mass  3 and MMAV is  13 .Equation ( 4) can be presented below: The vector translational dynamics of MMAV can be obtained by (3) as follows: The rotational dynamics of MMAV obtained by ( 5) are given by where the antisymmetric matrixes of position coordinates of the three moving masses in the body fixed frame are  11 ,  12 , and  13 , respectively.Furthermore, the equations of motion of MMAV system also include some relative movement functions and nonlinear aerodynamic functions.The equations of motion clearly indicate that the MMCS is a complex nonlinear system which has the variable coefficients and large disturbances caused by the accelerations and velocities of masses.
Then the output tracking errors of the system are According to the mathematical model forms of MMAV, select function () is as follows: where ẋ 1 =  1 , ẋ 2 =  2 , and ẋ 3 =  3 .So, () can be as the linear combination of the output tracking error, its differential term, and its integral term.
Derivation of function () is In order to obtain the predictive control law, the quadratic objective function is chosen as follows: is a positive definite symmetric matrix,  is a positive semidefinite symmetric matrix, ℎ is a small positive number, and ( + ℎ) is the predictive value of  at time  + ℎ. ( + ℎ) is expanded approximately at  according to the first-order Taylor's series: In order to make () least, set / = 0 in (15).The control law is obtained below: when  = 0, and  −1 exist, substitute formula (17) into formula ( 16) and obtain formula (18) below: Obviously, when  → ∞, () tends to zero.When  ̸ = 0 and  −1 exist, () also tends to be boundary by simulation.Because () includes integral term of tracking error, the output tracking error tends to zero inevitably.

Robustness Analysis of the System. Consider the uncertain nonlinear system
where f() and ĝ() are the parts of the nominal system and Δ() and Δ() are the uncertainty parts of the system.
Suppose that f() and ĝ() are the known bounded continuous functions and Δ() and Δ() satisfy the following conditions: Then, each term in (17) can be written as the following form: where Â(), D(), and Ŝ() correspond to the known nominal system and Δ(), Δ(), and Δ() correspond to the uncertain parts of system.
Firstly, consider the situation is  = 0.According to the parameter of nominal system by formula (17), the control law is obtained by Substitute formula (21) and formula (22) into formula (14): Because of ‖ΔD D−1 ‖ < 1 and ‖Δ‖ < ‖‖,  also is boundary which should be known.
Set () as input and e as output.The transfer functions are obtained by (12): From formula (24), () is strict stability convergence, () is boundary input, and  is boundary output inevitably.
Because () includes the integral term of , (∞) should tend to zero ultimately.
To sum up, when  is equal to 0, the system has strong robustness.Similarly, when  ̸ = 0, the system still has strong robustness by analysis above.

Optimization Principle of Ant Colony Algorithm.
When ants in the nature seek foods or meet obstacles, they always can find one optimal route from their nests to food source or round the obstacles.The reason is that the ants can release one special secretion called pheromone on the roads which they pass through (pheromone, this material can volatilize gradually along with time); then the following ants may choose next route according to the pheromone which the fore ants leaved.The pheromone in one route is higher, and the number of times which should be selected is more.That is, the performance of this route will be superior, and the probability that the following ants choose this route will be larger.So, a positive feedback process of learning information is established by this way.At last, the optimal solution can be obtained [30][31][32].The ant colony algorithm is based on this principle.

Generation of Nodes and Routes
. By the inspiration of [33], the two parameters to be optimized are expressed in a plane for using the ant colony algorithm expediently.The graph is shown in Figure 2.
1 ∼ 5 and  6 ∼ 9 express  1 and  2 , respectively.According to the test results in [7], the initial value  1 is 200.00 and the initial value  2 is 10.00. 1 and  2 are calculated, respectively, by the formulas below:

Establishment of the Objective Function.
When the objective function is established, the dynamic performances of the system on establishing overload instructions should be made as basis according to system requests for design, which mainly consider system overshoot, the rise time, and the settling time.The objective function is defined as follows: where  0 ,  0 , and  0 are the overshoot, the rise time, and the settling time which guidance control system requested.  ,   , and   are the weight coefficients, respectively.Their values are 0.4, 0.2, and 0.4.

The Choice of the Route
Nodes.Suppose that it takes each ant the equal time to crawl from any node on line   to the next any node on line  +1 and has nothing to do with the distance between the nodes.Therefore, if all ants start from the origin of coordinates, they will simultaneously arrive at each line   ( = 1∼9).Finally, they will also simultaneously arrive at their end points on the line  9 .Then, one circulation is completed.Define (  ,  , , ) to express the remaining pheromone on node (  ,  , ) at .The pheromone is equal on each node in the initial time.In order to make the algorithm search more feasible solutions in the preliminary stage, (  , where the value  * , is obtained as the following method.In the first circulation of ant colony algorithm,  * , is given by the -coordinate value of each node which  1 and  2 map in Figure 2. In each circulation later,  * , is given by the coordinate value of each node in which  1 and  2 correspond to the optimal route produced in the previous circulation (the optimal performances in previous circulation) map in Figure 2.

Renewal and Limitation of the Pheromone.
Suppose that  = 0 at initial time; all ants are located at the origin of coordinates .After 9 units of time, all ants crawl from the initial point to the end point.The pheromone in the route may be adjusted by the following formula:  (  ,  , ,  + 9) =  (  ,  , , ) + Δ (  ,  , ) . (30) For using more optimal solution information during the running period of algorithm, the renewal and limitary mechanism of the pheromone can use the maximal minimal ant system (MMAS), in which only the one optimal ant can increase pheromone after each iterative.And there is (  ,  , ) ∈ [ min ,  max ]: best () represents the optimal objective function value in this circulation.It can be calculated by (27).

The Steps of Optimizing MMCS Parameter Using ACGA.
The hybridization of AC and GA has been studied in many works.The methods have been successfully applied to diverse combinatorial optimization problems including traveling salesman, quadratic assignment, vehicle routing, telecommunication networks, image processing, constraint satisfaction, and scheduling.Recently, researchers have been dealing with the relation of ACGA to the fields of optimal control and reinforcement learning, in which, with the merits of GA, this method has the global search ability, latent parallel computing, and simple computation process and can solve the contradiction of the optimal solution and the searching space.It also can overcome the contradiction of searching space and time performance, in contrast with easing to converge to nonglobal optimal solution and computing time too long when using AC to solute optimization question.So, the control parameters optimization method of MMAV is proposed based on ACGA.The goals are to meet the demands of time-response specifications and improve the robustness for MMCS.Several studies have suggested that MMCS appears to offer the greater design and cost advantages in flight vehicles control.We present the mathematical modeling process of MMAV and describe the method of nonlinear predictive control for MMCS.But it is very difficult to design the MMCS because there are many parameters to adjust manually.In this paper, a new method is proposed using ACGA, by which automatic parameter optimization can be realized instead of manually adjusting.
When the MMCS parameters are optimized by the ant colony algorithm, the variation operation of GA can be used for the second optimization of the obtained result [19,34].That is, to avoid to fall into partial optimal by using ant colony algorithm to obtain a group partial solution that makes the objective function expressed by formula ( 27) is minimal.Then, the coding is carried on (the binary system is used in this paper), and the variation of certain digits is caused stochastically.If the variation solution surpasses the original solution in genetic and variation process, then the variation solution is retained.Otherwise, the original solution is used.After this variation, seeking in the partial minimal region can be jumped out, and the quality of solutions can be enhanced; the convergence velocity of the optimal solution is speeded up.So, ACGA can realize the highly effective, fast, and complete seeking to the search space.
The basic steps to optimize MMCS parameters with ACGA are described as follows: Step 1. Initialize the MMCS parameters and the correlation ACGA parameters.The initial values of  1 and  2 can be seen above.
Step 2. Set ant number as .Define the one-dimensional array Routek including 9 elements for each ant.The coordinate values of 9 nodes which the ant will pass through are saved in this array, that is, the route of the ant crawling.
Step 3. Make time counter  = 0 and cycle number   = 0. Define the biggest cycle number and the pheromone values on each node at initial time; set Δ(  ,  , ) = 0. Put all the ants at the initial station .
Step 5. Compute the transfer probabilities that the ant moves to each node on the line   by formula (28).According to these probabilities, a node for each ant on the line   is chosen by roulette principle, and the ant also will be moved to this node.Simultaneously, the -coordinate value of this node is saved in th element of Routek.
Step 7.   1 and   2 corresponding to this route are calculated by formula (25) and formula (26) according to Routek, that is, the routes passed by the ants.The dynamic performances   ,    , and    can be calculated by carrying on computer simulation applying these parameters to the MMCS system of MMAV.Then, the objective function   corresponding to the ant  is calculated by formula (27), and  best () is obtained.The optimal solution is saved in this circulation.The MMCS parameters corresponding to these also are saved into  * 1 and  * 2 .Then, the second optimization is carried on by GA.The optimal solution from the original solution and the mutation solution is chosen.
Step 9.If   <   max and the whole ant colony is not convergent to one route, all ants will be put at the initial station  again, and then jump to Step 4. If   <   max , but the whole ant colony converges to one same route, the algorithm will be ended and the corresponding optimized MMCS parameters  * 1 and  * 2 are achieved.

Simulation Result and Discussion
Because the control performances of MMAV need to be realized through an axial moving mass and two-radial-movingmass to and fro movement on the guide rail, the control effects of the system directly are affected by the characteristics of servo system.So, in the design of MMCS, the dynamic characteristics of servo system have to be considered.
Considering the band width of the measure elements for system (accelerometer and rate gyro) is relatively large, the simplification model of the servo system is obtained by repeated test: where   = 0.01 and   = 0.8 to the axial moving mass,   = 0.005 and   = 0.8 to the radial moving mass.Simultaneously, the saturated constraints of the displacements should be considered for the whole design assigns when the system is tested.
According to the ant colony genetic algorithm proposed in this paper to carry on parameter optimization, the final parameters of MMAV in nonlinear predictive control system are shown in Figure 2. Simultaneously, 6DOF mathematical simulation of MMAV was carried on.The signals ẏ and ÿ  ( = 1, 2, 3) in the flight control system are obtained by the second-order filter.The simulation results in which the aerodynamic parameters have 50% uncertainty are shown at length of article limited and the system design results in nominal state as the foundation.The simulation graphs are shown in Figures 3 and 4, which are state responses of MMAV using NPC with the original GA and ACGA, respectively.The time response and system stability of ACGA are better than those of the original GA.The simulation curves of the normal overload and each control of MMAV are only shown in this paper (because the radial moving mass is symmetry, the displacement curves of  1 axis and  1 axis for the moving mass are the same).(Only the displacement curve of  1 axis for the moving mass is given).From the graphs, the displacement of the axial moving mass is limited in the scope ±0.16 m, and the displacements of the two radial moving masses are limited in the scope ±0.08 m.That flight control of MMAV may be realized by only very short displacement of the moving mass.The dynamic performances of control system for MMAV still satisfy the design requests although aerodynamic parameters have been changed 50% with their nominal values.
As shown in simulation results, the nonlinear predictive control is proposed to design MMCS, in which controller parameters are optimized with the original GA and ACGA.The simulation results show that MMCS with ACGA has better dynamic behavior and strong robustness than that with the original GA.This approach can improve the robustness of MMCS and make it work effectively.The theoretical analysis and the simulation results of the flight control system for MMAV show that the strategy of the NPC parameter optimization based on the ant colony genetic algorithm proposed in this paper is effective and feasible.The algorithm of the flight control system for MMAV designed by using NPC based on ACGA optimization is simple.Moreover, the dynamic performances of the system satisfy the design requests completely and also have strong robustness.Simultaneously, the time is saved.The optimization algorithm proposed in this paper does not rely on the precise mathematical model of MMAV and makes processing question more flexible, adaptable, and robust.This method can not only improve the quality of control system design but also reduce the design difficulty and may solve optimization problems of the control system parameters which are designed by other control methods.So, it has important reference value in the control engineering domain.

Conclusion
An autopilot for a nonlinear six-degree-of-freedom MMAV is introduced in this paper.Because the stability control system used by MMAV with three moving masses is three-channel, and the deduced mathematical model is too complicated, the dynamical model of MMAV is still a nonlinear system after reasonable simplification.Therefore, this control system is hard to design.The nonlinear predictive control method is proposed to design MMCS, in which controller parameters are optimized based on ACGA.This approach can improve the robustness of MMCS and make it work effectively.The simulation results show that MMCS has good dynamic behavior and strong robustness.As for the mechanism of mass moment control, it is very complicated and the related research is only in the beginning.The public references are insufficient; we only give some useful discussion about the control system design method of MMAV in this paper.

Figure 2 :
Figure 2: Schematic plot on the generation of nodes and routes.

Figure 3 :
Figure 3: State response of MMAV using NPC based on GA optimization.

Figure 4 :
Figure 4: State response of MMAV using NPC based on ACGA optimization.