# Development and simulations of aircraft guidance system using a 3-degree-of-freedom point mass model/ Skrydzio valdymo sistemos kurimas ir modeliavimas naudojant materialaus tasko modeli su trimis laisves laipsniais.

1. IntroductionOften navigation, guidance and control systems are developed separately and may even be accommodated on separate hardware units. For small aircraft like UAVs, the function of all three systems can be effectively merged into one single flight computer, but practice shows that separate engineers nevertheless develop in separate blocks or the algorithms of those systems.

To test navigation and guidance algorithms and carry out hardware-in-loop simulations of navigation hardware, a sophisticated model of the aircraft and environment has to be built. Compared to full 6-degreeof-freedom motion models, point mass models allow state integration with a much larger time step, thus requiring lower computing power, but providing high accuracy results. Another important aspect in favour of point mass model utilization is usually the limited availability of aerodynamic data and control actuator specifications required for the 6DOF model. For the point mass model the vehicle's attitude is given as an input.

In order to avoid numerical problems and simplify equations of motion, the simulation environment features equations of motion in the Cartesian coordinate system. A special set of transformations has to be applied in order to convert a vehicle's forces from body fixed reference frame to an inertial frame where integration of states takes place.

If the vehicle's attitude response information is approximately known (natural frequency, rate damping), it is possible to easily implement the effect of those characteristics in form of a state filter between commanded attitude and attitude output port from the guidance system. In this way, a point mass model becomes a perfect testbed for navigation and control system development and testing.

2. Guidance and navigation of vehicles

A navigation system utilizes certain measurable states in order to compute the other states.

Guidance and flight control systems may be virtually separated from each other, first considering inputs from navigation systems and giving orders to the flight control system, which takes care of an airplane's attitude by controlling the aerodynamic actuators and high lift devices (and the propulsion system).

Outputs of the guidance system-angle of attack, aerodynamic bank angle, and angle of slip--are sufficient to control the aircraft's trajectory. In case of exatmospheric vehicles, the attitude with respect to local horizon and inertial reference frames may also become significant.

The guidance system may also be partially responsible for high lift device control in the form of acceleration control or simply by help of some built-in logic, which, for instance, gives an order to activate high lift devices in takeoff and landing phases.

3. Manoeuvres and performance

This chapter illustrates that just just controlling flight path angle and heading in NED reference frame may achieve the goals of the guidance system. In some cases, velocity control must also be considered in order to keep certain aerodynamic characteristics.

Let us consider the basic equations of flight performance and manoeuvring.

4. Flight path angle control

For a general case if we neglect gravity, the flight path changes once a force perpendicular to the flight direction has been applied:

[??] = [[omega].sub.fp] = L/v (1)

In a realistic case, a gravity force bias exists and only excess lift can produce a change in the flight path angle. The following equation has no analytic solution and must be solved numerically inside the simulation.

[??] = L - W [sin.sub.[gamma]]/v (2)

This gravity component should be included as bias inside the guidance loop in order to provide equal control authority at various flight path angles.

The lift force depends on states like dynamic pressure and angle of attack, which usually defines the lift coefficient according to the polars:

L = 0,5[C.sub.L]S[rho][v.sup.2]

where [C.sub.L] = f([alpha])

and can usually be expressed as a linear relationship:

[C.sub.L] = [C.sub.L0] + [C.sub.L[alpha]][alpha]

for a typical wing, so that a can be used directly inside the loop in order to control [??].

5. Bank angle control and turns

In a level turn, the balance of the force in a turn is given by the following equations (Bandu 1998; Filippone 2006; Narayan et al. 2008; Schmidt 1998). Along normal:

L cos ([[phi].sub.A]) - W = 0;

Along binormal:

L sin ([[phi].sub.A]) = m [v.sup.2]/[R.sub.turn] (3)

or Lsin([[phi].sub.A]) - W[v.sup.2]/g[R.sub.turn] = 0 ;

The change in the flight path heading:

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII.] (4)

or

X = g/v [tan.sup.2]([[phi].sub.A]);

In general the equations of motion (Narayan et al. 2008):

Along the flight path:

T cos [beta]-D--W sin[gamma] = 0;

Along its normal:

Lcos [[phi].sub.A] - W cos[gamma] = 0 ;

Along its binormal:

2

v2

T sin [beta] + L sin [[phi].sub.A] -m [v.sup.2]/[R.sub.turn] [cos.sup.2][gamma] = 0 (5)

or T sin [beta] + L sin [[phi].sub.A] - (W[V.sup.2][cos.sup.2][gamma]/rR) = 0;

Resulting law for heading control (Filippone 2006):

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII.] (6)

Note: heading as definition of flight path direction loses meaning near vertical climb or dive due to singularity.

The equations prove that the bank angle can be directly used to control the heading of the aircraft, but rate of heading will also depend on angle of attack.

Use of high-lift devices and simulation of their effect is also possible by point mass simulation. High-lift

devices such as flaps and slats usually produce the specific value of [DELTA][C.sub.L] , [DELTA][C.sub.D] and [DELTA][C.sub.M] . [DELTA][C.sub.M] is not an input for the point mass simulation, but it may change the trimmed [alpha], and that effect should be considered inside the guidance and control law.

6. Attitude control inside the point mass model

The trajectory of a vehicle assumed as point mass depends on various perturbances, and the most significant are aerodynamic forces, gravity, and the thrust force produced by the power plant. Aerodynamic forces depend on the vehicle's relative motion with respect to the atmosphere (co-rotating with the earth), wind, and wind gusts (thermals, microbursts, rotors, and other turbulence). If the attitude is constrained by given aerodynamic angles, the aerodynamic and propulsive forces must be converted to an inertial or earth-fixed reference frame by a set of transformations.

7. Reference frames and force conversions

The aerodynamic attitude of the aircraft is described by angle of attack and angle of slip, which relates the body reference frame with the wind axis coordinate system by the transformation matrix [T.sub.BW]. Aerodynamic attitude has no direct relation with local horizon or any other planet-fixed reference frame (Fig 1).

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII.] (7)

[FIGURE 1 OMITTED]

Aerodynamic bank angle describes a vehicle's attitude with respect to the relative wind velocity vector and the local horizon plane. Only one roll angle is sufficient to relate the wind coordinate system with the velocity reference frame (it is vehicle carried reference frame which is always aligned with the velocity vector in NED frame) (Fig 2) (Sudars 2008a).

[FIGURE 2 OMITTED]

Transformation matrix:

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII.] (8)

If only angle of attack and aerodynamic bank angle is utilized for flight control inside the model, the slip angle is assumed 0, meaning the flight is assumed to be perfectly coordinated. In that case, the longitudinal aerodynamic model of the vehicle is completely sufficient (Regan 1984).

[T.sub.BW] = [T.sub.BW][T.sub.WV] (9)

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII.] (10)

where

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII.]

Body-to-NED relation:

[T.sub.BN] = [T.sub.BV] [T.sub.VN] (11)

8. Computation of relative wind velocity vector

Relative wind speed computation takes into account wind speed with respect to NED and wind gust speed with respect to NED.

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII.] (12)

The resulting vector [[[??]].sub.w] defines the reference direction for attitude specified by aerodynamic angles.

9. Equations of motion

The synthetic environment utilizes Newton's 2nd law in the Cartesian coordinate system fixed to the inertial reference frame:

[d.sup.2][[??]/[dt.sup.2] = [SIGMA]F/m (13)

where [SIGMA]F designates all modelled forces applied to the vehicle: aerodynamic, propulsive and gravity forces.

10. State integration

When the Cartesian coordinate system is utilized, states can usually be integrated with respect to a local reference frame (like runway fixed frame) or a global frame like ECI. The experiment described in the example utilized a full environment simulation tool working in ECI frame (J2000 epoch) (Sudars 2008b).

11. Implementation

The approach described can be implemented in any synthetic environment. Because the flight states are known, the forces produced can be easily converted by the previously mentioned conversion matrices (Fig 3).

[FIGURE 3 OMITTED]

12. Advantages and drawbacks

Since the attitude of the vehicle has been fixed to the relative wind velocity vector, rapid changes in that vector would cause the vehicle to make an abrupt change of attitude that may not correspond to a real situation. The model is therefore not valid for stalls, spins, bell manoeuvres, etc. but can be applicable to rolls, loops, etc., where velocity vector changes its direction much more gradually.

Wind gusts would cause rapid changes in attitude. In order to avoid these effects, the wind gust model should not be applied. The model works well with the constant wind model or changing wind with small time and space derivative. Here an alternative solution exists-separating relative wind vectors and utilizing the wind gust vector only for residual lift computation, but it does not have any good practical application.

Forces related to or originating from short period dynamics have been ignored.

13. Range of applications

The methodology mentioned has a certain range of applications. Some problems may be experienced when trajectory approaches singularity at flight path angle [gamma] = 90[degrees] or [gamma] =-90[degrees]. At these conditions, the aerodynamic bank angle cannot be specified. If the natural behaviour of the aircraft is to be kept, the bank angle jump has to be prevented by fixing the yaw angle with respect to the NED reference frame at the moment the flight path angle touches near [gamma] = 90[degrees] or [gamma] = -90[degrees] .

14. Simulation of UAV's guidance algorithm

The example given combines two tasks: control of velocity vector direction and following a certain predefined route specified by waypoints the vehicle must fly over at a given altitude. The vehicle must also maintain a given relative airspeed by adjusting the throttle.

The vehicle utilized was a generic model of a UAV representing an approximate model of a vehicle being developed at RTU Aviation Institute. The Simulink model has been utilized for FCS development in RTU Aviation Institute.

The attitude and velocity control laws considered in this UAV guidance example resulted in the trajectory given by the figures in this chapter (Figs 4-17).

Simulation utilized:

Time step of simulation: 1 second

Solver: Runga-Kutta ODE4;

Total time: 1880 sec (~ 31 min 20 sec).

State integration: ECI reference frame, Cartesian coordinate system.

Altitude control

Altitude control is done by control of the flight path angle (most common way in general aviation). This guidance law is simple:

[[gamma].sub.des] = arctan ([h.sub.tg] - [h.sub.means]/[d.sub.range])

[FIGURE 4 OMITTED]

[FIGURE 6 OMITTED]

[FIGURE 7 OMITTED]

[FIGURE 8 OMITTED]

[FIGURE 9 OMITTED]

[FIGURE 10 OMITTED]

The model described features very simple heading control; bank angle is obtained by PID controller from heading error. Since [??] ~ [[phi].sub.A] at small angles of [[phi].sub.A] and the flight path angle is not steep, a PID controller can be utilized directly between heading error and output aerodynamic bank angle. This approach is valid for ascents and descents that are not steep (<10 deg). For the simulation, the maximum bank angle has been limited to 15 degrees, which is a reasonable limit for aerial photography.

[FIGURE 11 OMITTED]

[FIGURE 12 OMITTED]

Velocity control

Velocity control has been implemented as a simple controller that maintains airspeed specified by a time schedule. The integral coefficient of the PID plays a major role in velocity control.

In this example, velocity is maintained constant, but can be adapted to provide maximum rate of climb, higher rate of sink, etc.

[FIGURE 13 OMITTED]

[FIGURE 14 OMITTED]

[FIGURE 15 OMITTED]

[FIGURE 16 OMITTED]

[FIGURE 17 OMITTED]

15. Effect of the timestep size on error and computation time

Let us consider a slightly different simulated flight with a different altitude profile.

The simulation was performed in the Matlab 2008a environment on the Windows Vista Business platform by a Fujitsu-Siemens E8410 computer (Intel T7500 processor).

Real mission time: 1981.5 seconds

Elapsed sim. time with [DELTA]t=1 sec: 3.486340 sec.

Elapsed sim. time with [DELTA]t=0.1 sec: 30.081938 sec.

A larger simulation time step does not allow translation dynamics of the vehicle and guidance controller to be captured and may result in highly oscillating or unstable behaviour (Figs 18-23).

[FIGURE 18 OMITTED]

[FIGURE 19 OMITTED]

[FIGURE 20 OMITTED]

[FIGURE 21 OMITTED]

[FIGURE 22 OMITTED]

The relative error of the simulated mission duration was between dt=0.1 and dt=1 sec: [[epsilon].sub.rel] = 0.20%.

[FIGURE 23 OMITTED]

16. Conclusions

This paper and the given example illustrated the efficiency and advantages of vehicle dynamic's simulations in form of a point mass body with its attitude specified in the described velocity reference frame. It is particularly suitable for simulations of airplane, airship, missile, or a re-entry vehicle.

The method allows directly specifying the attitude of the vehicle with respect to the relative wind velocity vector and local horizon, which makes it very suitable for trajectory computations even with a limited aerodynamic database available. The method allows assuming perfectly coordinated turns or specifying any other angle of slip for any particular purpose.

This kind of simulation is limited to vehicles that are not facing strong wind gusts or performing aerobatic manoeuvres or other manoeuvres involving rapid changes of velocity vector direction. However, for most aircraft and entry vehicles, it is a quick and high fidelity approach to the simulation.

The method is particularly suitable for integration in simulation environments utilizing the Cartesian coordinate system for state integration.

The method can be utilized inside the vehicle's onboard computer for online trajectory estimation and optimization.

Symbols and acronyms

Symbols

[C.sub.D]--drag coefficient

[C.sub.L]--lift coefficient

[C.sub.M]--pitch moment coefficient

[d.sub.range]--downrange to next waypoint

g--gravity acceleration at given altitude, latitude and longitude

h--altitude

[h.sub.tg]--flyover altitude of the next point

[h.sub.meas]--measured altitude

L--lift force

m--mass

[R.sub.turn]--radius of turn

[T.sub.AB]--transformation matrix from reference frame A to B

[u.sub.A]--x velocity in reference frame A

V--velocity in given reference frame

W--weight

[alpha]--angle of attack

[beta]--angle of slip

[DELTA]--difference, increment ([DELTA][C.sub.X]--increment of coefficient [C.sub.X])

[gamma]--flight path angle in North-East-Down reference frame

[[gamma].sub.des]--desired flight path angle

[lambda]--longitude

[mu]--latitude

X--flight path heading angle in North-East-Down reference frame

[phi]--roll angle with respect to NED reference frame

[[phi].sub.A]--aerodynamic bank angle with respect to local horizon

Indexes of vectors and matrices designating reference frames

B--body-fixed reference frame

E--Earth-Centred Earth-Fixed reference frame

I--Earth-Centred Inertial reference frame

N--North-East-Down reference frame

V--relative velocity-fixed reference frame

W--wind reference frame

Abbreviations

DOF--degrees of freedom

ECI--Earth-Centered Inertial (reference frame)

NED--North-East-Down (reference frame)

ODE--ordinary differential equation

PID--proportional-integral-derivative (controller)

UAV--unmanned aerial vehicle

VEL--velocity aligned reference frame

Note. This paper is based on the author's presentation entitled "Development and simulations of aircraft guidance system using a 3-degree-of-freedom point mass model" and made at a scientific conference at Riga Technical University Aviation Institute on 13.10.2008 in Riga, Latvia.

DOI: 10.3846/1648-7788.2009.13.35-43

Received 16 January 2009; accepted 5 May 2009

References

Bandu, P. N.1998. Performance, stability, dynamics and control of airplanes. In AIAA, United States.

Filippone, A. 2006. Performance of fixed and rotary wing aircraft, by elsavier aerospace engineering series. United States.

Narayan, P.; Campbell, D.; Walker, R. 2008. Multiobjective UAS flight management in time constrained low altitude local environments. In AIAA-2008-872. Brisbane, Australia: Queensland University of Technology.

Regan, F. J. 1984. Reentry vehicle dynamics. In AIAA, United States.

Schmidt, L. V. 1998. Introduction in aircraft flight dynamics. In AIAA.

Sudars, M. 2008a. FMST user manual. In Internal Document at BUSIT, Thales Alenia Space Italy, Turin.

Sudars, M. 2008b. Simulink based tool for aerospace vehicle flight mechanics numerical simulations. In Scientific Proceedings of Riga Technical University, Series 6 "Transport and Engineering. Transport. Aviation Transport", vol. 27. Riga: RTU.

Zipfel, P. H. 2001. Modeling and simulation of aerospace vehicle dynamics. In AIAA, United States.

Martins Sudars

Aviation Institute of Riga Technical University, Lomonosova 1, Riga, LV-1019

E-mail: msudars@yahoo.com

Martins SUDARS, Msc Eng

Education: Msc Eng Degree in Aeronautics from Aviation Institute, Riga Technical University, 2007.

Research Interest: advanced and intelligent flight control systems, GNC of UAVs, Flight mechanics of atmospheric and exatmospheric flight, re-entry vehicles.

Publications: author and co-author of five publications.

Present Position: PhD candidate at Aviation Institute of Riga Technical University, Latvia.

Fig 6. Definition of a generic UAV's route by specifying waypoints and flyover altitude lat long alt place init 57,15177 24,40836 10 Adazu poligons route 57,31 24,44 300 pie skultes 57,32129 24,40536 200 zvejniekciems 57,31656 24,40587 200 57,30478 24,40613 200 57,29697 24,40712 200 57,28629 24,41202 200 57,27242 24,41181 200 57,26266 24,40827 200 57,25319 24,40373 200 57,24303 24,39737 200 57,23067 24,38555 200 57,21357 24,36553 200 pie lilastes 57,2025 24,34974 200 57,18665 24,32399 200 57,1605 24,26665 200 57,1564 24,2573 200 57,14169 24,24048 200 pie carnikavas 57,13652 24,27558 300 final 57,15049 24.40742 30 Adazu poligons

Printer friendly Cite/link Email Feedback | |

Author: | Sudars, Martins |
---|---|

Publication: | Aviation |

Article Type: | Report |

Geographic Code: | 4EXLA |

Date: | Jun 1, 2009 |

Words: | 2992 |

Previous Article: | Fuselage test of a small aircraft according to CS-23 requirements/Mazo lektuvo liemens bandymai pagal CS-23 reikalavimus. |

Next Article: | Measuring surface geometry of airplane wing by means of two methods/Orlaivio sparno geometrijos matavimas dviem metodais. |

Topics: |