6 Dof
6 Dof
Framework
Achraf khelifi touhami
November 11, 2025
Contents
1 List of Abbreviations 3
2 Abstract 4
3 Introduction 4
3.1 Equations of Motion Block . . . . . . . . . . . . . . . . . . . . . . . . . . . . 5
3.2 Translational Dynamics . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 7
3.3 Rotational Dynamics . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 7
3.4 Euler and Quaternion Kinematics . . . . . . . . . . . . . . . . . . . . . . . . 8
3.5 NED Position Rates . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 8
3.6 Body-Fixed Velocities . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 8
4 Actuator Models 8
4.1 Control Surface Actuators . . . . . . . . . . . . . . . . . . . . . . . . . . . . 8
4.2 Thrust Vector Control System . . . . . . . . . . . . . . . . . . . . . . . . . . 10
4.3 Control Input Constraints . . . . . . . . . . . . . . . . . . . . . . . . . . . . 10
1
7 Aerodynamic Force and Moment 15
7.1 Aerodynamic Force . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 15
7.2 Aerodynamic Moment . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 16
8 Thrust Vectoring 16
8.1 Force Components . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 17
8.2 Induced Moments . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 17
9 Sensors Model 17
11 Simulation Setup 20
12 Results 21
13 Conclusion 23
14 References 24
2
1 List of Abbreviations
• V : Airspeed (m/s)
• α: Angle of attack (rad)
• β : Sideslip angle (rad)
• γ : Flight-path angle (rad)
• µ : Bank angle (rad)
• p, q, r : Body angular rates (rad/s)
• ϕ, θ, ψ : Euler angles (rad)
• χ : Heading angle (rad)
• u, v, w : Body-axis velocities (m/s)
• xE , yE , zE : Earth-fixed NED position (m)
• q0 , q1 , q2 , q3 : Quaternion components
• D, L, Y : Drag, lift, side forces (N)
• La , Ma , Na : Aerodynamic moments (N·m)
• Tx , Ty , Tz : Thrust force components (N).
• LT , MT , NT : Thrust-induced moments (N·m).
• uturb , vturb , wturb : Dryden turbulence velocity components (m/s).
• pturb , qturb , rturb : Angular turbulence velocity components (rad/s).
• σu , σv , σw : Turbulence intensity parameters (m/s).
• Lu , Lv , Lw : Turbulence length scales (m).
• m : Mass (kg)
• g : Gravity (9.81 m/s2 )
• Ixx , Iyy , Izz , Ixz : Inertia tensor elements (kg·m2 )
• ∆ : Ixx Izz − Ixz
2
3
2 Abstract
This project presents a comprehensive high-fidelity open-loop simulation framework for the
F-16 Fighter jet, integrating six degrees of freedom (6DOF) flight dynamics. The simulation
captures complex nonlinear flight behaviour through a 22-state dynamic model while incor-
porating realistic sensor measurements from inertial measurement units (IMU),The sensor
models provide realistic measurement data incorporating systematic errors and stochastic
noise. The framework features translational and rotational dynamics, quaternion-based at-
titude representation, aerodynamic force and moment modelling, actuator dynamics with
physical constraints, thrust vector control (TVC) effects, and atmospheric turbulence mod-
elling using the Dryden turbulence model. The simulation environment, developed in MAT-
LAB/Simulink, employs fourth-order Runge-Kutta (RK4) numerical integration. The frame-
work enables a comprehensive evaluation of flight control systems under realistic operational
conditions.
3 Introduction
The F-16 stands as one of the most versatile and widely deployed fighter aircraft in modern
aviation history. Its exceptional manoeuvrability, coupled with sophisticated flight control
systems, has established it as a benchmark for high-performance military aircraft design.
Understanding and accurately modelling the complex flight dynamics of such aircraft, along
with their associated systems, is paramount for advancing aerospace engineering, developing
next-generation control systems, and ensuring mission success in demanding operational
environments.
Modern fighter aircraft rely heavily on integrated sensor systems to provide accurate
state estimation for flight control, navigation, and mission systems. These sensors, including
inertial measurement units (IMU), GNSS reicievers, barometric altimeter and others must
operate reliably across diverse flight conditions while maintaining precision in the presence
of various error sources.
Flight dynamics simulation of high-performance aircraft presents unique challenges due
to the inherently nonlinear, coupled, and multivariable nature of aerodynamic phenomena,
particularly at extreme flight conditions. The F-16’s capability to operate across a wide
flight envelope, including high angles of attack and aggressive manoeuvring scenarios, ne-
cessitates sophisticated mathematical models that capture the intricate interplay between
aerodynamic forces, inertial effects, control system dynamics, sensor measurements and ac-
tuator dynamics.
This report presents a comprehensive open-loop simulation framework for the F-16 air-
craft, employing a high-fidelity 22-state nonlinear mathematical model that encompasses
complete six-degree-of-freedom dynamics. The simulation architecture integrates transla-
tional and rotational motion equations, quaternion-based attitude representation to avoid
singularities, detailed actuator dynamics with realistic physical constraints, advanced thrust
vector control capabilities, comprehensive atmospheric turbulence modelling, and sophisti-
cated sensor models incorporating both systematic bias and stochastic noise components.
4
The mathematical foundation is based on the first principles of Newtonian mechan-
ics, incorporating the Newton-Euler equations of motion along with appropriate coordinate
transformations between principal reference frames. The sensor models follow established
s-domain transfer function representations with a dual-noise architecture that captures both
low-frequency bias drift and high-frequency measurement noise characteristic of real sensor
systems.
The simulation environment, developed within MATLAB’s Simulink framework, provides
a robust computational platform for numerical integration using different Numerical Solvers
to solve a set of ordinary differential equations (ODEs), including the Euler Forward and
fourth-order Runge-Kutta schemes. In this simulation, the 4th-order Runge-Kutta solver
has been chosen as it is more accurate than the Euler forward solver, but at a higher com-
putational cost.
The model architecture is designed with modularity in mind, facilitating future exten-
sions for closed-loop flight control system development and validation. Instead of using
built-in Simulink blocks to model the 6-DOF nonlinear dynamics, a user-defined function
(MATLAB Function Block) was used to provide design freedom for implementing various
design concepts. Figure 1 illustrates the input-output structure of the developed simulation
framework, demonstrating the interconnected nature of the various subsystems.
5
• Body-Fixed Frame: The body axis system is rigidly affixed to the aircraft’s center
of gravity (CG) and adheres to conventional aerospace definitions. The positive Xb
axis extends forward through the aircraft nose, the positive Yb axis projects laterally
toward the starboard wingtip, and the positive Zb axis points downward perpendicular
to the aircraft’s longitudinal-lateral plane.
• Wind Frame: The wind axis system is aligned with the aircraft’s velocity vector rel-
ative to the surrounding air mass. The positive Xw axis is collinear with the velocity
vector (pointing in the direction of flight), the positive Zw axis lies in the plane of sym-
metry perpendicular to Xw (pointing downward), and the positive Yw axis completes
the right-handed orthogonal system (pointing to the right). This frame is particularly
advantageous for aerodynamic force representation, as the drag force acts along the
negative Xw axis and the lift force along the negative Zw axis.
These coordinate systems, along with their associated transformation matrices, form
the mathematical foundation for expressing the complete six-degree-of-freedom motion of
the aircraft, encompassing both translational and rotational dynamics in three-dimensional
space.
6
3.2 Translational Dynamics
7
3.4 Euler and Quaternion Kinematics
4 Actuator Models
The actuators are critical components of the flight control system, providing the motive
power needed to move the flight control surfaces and manage thrust vectoring. The F-16
flight control system encompasses both conventional aerodynamic control surfaces (aileron,
elevator, rudder) and advanced thrust vector control (TVC) capabilities for enhanced ma-
noeuvrability.
8
Figure 3: F-16 aerodynamic control surfaces
The actuator mathematical models for the control surfaces are represented as second-
order transfer functions with pure time delay
where:
• K: steady-state gain,
• ζ: damping ratio.
• τ : time delay .
For implementation, the delay term e−sτ can be approximated using 1-order Padé expansions
as:
1 − τ2 s
e−sτ ≈ (19)
1 + τ2 s
for K = 1 , ωn = 75 rad/s, ζ = 0.7 and τ = 0.008 s. We will have
752 1 − 0.008
δi (s) 2
ss
= (20)
δi,com (s) 1 + 0.004 s s2 + 105 s + 752
9
4.2 Thrust Vector Control System
In addition to conventional control surfaces, the F-16 model incorporates thrust vector con-
trol capabilities through one movable engine nozzle. The TVC system provides two degrees
of freedom: pitch vectoring (δz ) and yaw vectoring (δy ), enabling direct thrust-based control
moments that are particularly effective at high angles of attack where aerodynamic control
authority may be reduced.
The magnitude of engine thrust TE and the deflection angles of the nozzle are controlled
through dedicated actuator systems with similar dynamic characteristics but with a delay
in time.
The enhanced actuator model framework with first-order Padé approximation:
752 1 − 0.005
δy (s) 2
s
= 1.0 · 0.005
(21)
δy,com (s) 1+ 2
s (s2 + 2(0.7)(75)s + 752 )
752 1 − 0.005
δz (s) 2
s
= 1.0 · (22)
1 + 0.005
δz,com (s) 2
s (s2 + 2(0.7)(75)s + 752 )
502 1 − 0.012
TE (s) 2
s
= 1.0 · (23)
1 + 0.012
TE,com (s) 2
s (s2 + 2(0.8)(50)s + 502 )
The TVC actuator parameters are:
• Nozzle deflection actuators (δy , δz ): ωn = 75 rad/s, ζ = 0.7, K = 1, τ = 8 ms
U = [δa , δe , δr , δy , δz , TE ]T (24)
These saturation limits are enforced in the simulation to prevent unrealistic control com-
mands and ensure the actuator responses remain within their physical capabilities. The
combination of conventional control surfaces and thrust vectoring provides the F-16 with
exceptional control authority across its entire flight envelope.
10
Figure 4 illustrates the Simulink implementation of the actuation system.
11
5.1 Reference Constants
The ISA model uses the following sea-level reference conditions:
T0 = 288.15 K (sea-level temperature) (31)
P0 = 101325 Pa (sea-level pressure) (32)
R = 287.05 J/(kg·K) (specific gas constant for air) (33)
g = 9.80665 m/s2 (standard gravity) (34)
γ = 1.4 (heat capacity ratio) (35)
r
2Lu 1
Gug (s) = σu · (46)
πV 1 + LVu s
r √
2Lv 1 + 2 V3Lv s
Gvg (s) = σv · 2 (47)
πV 1 + 2L v
s
V
r √
2Lw 1 + 2 V3Lw s
Gwg (s) = σw · 2 (48)
πV 1 + 2Lw sV
13
lation framework. This transformation preserves the essential spectral characteristics while
ensuring numerical stability at the chosen integration timestep.
The bilinear transformation s = dt2 z+1
z−1
is applied to each transfer function, resulting in
discrete-time difference equations suitable for real-time implementation. The transformed
filters maintain appropriate filter memory states to ensure continuity and realistic temporal
correlation in the generated turbulence sequences.
The magnitude of the relative velocity and the aerodynamic angles are computed from
the perturbed velocity components:
q
Vrel = u2rel + vrel
2 2
+ wrel (52)
wrel
α = arctan (53)
urel
vrel
β = arcsin (54)
Vrel
where α is the angle of attack and β is the sideslip angle, both modified by the presence
of atmospheric turbulence.
14
MIL-STD-1797A:
π
pgust = (wturb − vturb ) (55)
4b
π
qgust = wturb (56)
3b
π
rgust = (vturb + wturb ) (57)
4b
where b is the aircraft wingspan and pgust , qgust , rgust represent roll, pitch, and yaw rate
disturbances, respectively. These angular perturbations modify the effective body angular
rates experienced by the aerodynamic surfaces, thereby affecting the damping and rate-
dependent moment contributions.
The relative angular rates become:
prel = p − pgust (58)
qrel = q − qgust (59)
rrel = r − rgust (60)
prel b rrel b
CY = CYβ β + CYp + C Yr + CYδa δa + CYδr δr (67)
2Vrel 2Vrel
15
7.2 Aerodynamic Moment
The aerodynamic moments about the aircraft center of gravity are similarly computed using
the relative velocity and angular rates.
The aerodynamic moments about the body-fixed axes are:
Laero = qbar S b Cℓ (68)
Maero = qbar S c̄ Cm (69)
Naero = qbar S b Cn (70)
where b is the wingspan and c̄ is the mean aerodynamic chord.
Cl ,Cm , Cn are the moment coefficients represented as:
prel b rrel b
Cℓ = Cℓβ β + Cℓp + Cℓr + Cℓδa δa + Cℓδr δr (71)
2Vrel 2Vrel
qrel c̄
Cm = Cm0 + Cmα α + Cmq + Cmδe δe (72)
2Vrel
prel b rrel b
Cn = Cnβ β + Cnp + Cnr + Cnδa δa + Cnδr δr (73)
2Vrel 2Vrel
8 Thrust Vectoring
Modern fighter aircraft like the F-16 employ thrust vectoring systems to enhance manoeu-
vrability and control authority. The thrust vectoring system redirects the engine exhaust
flow through movable nozzles, creating additional control forces and moments which pro-
vide additional control authority, particularly beneficial during high-angle-of-attack flight or
when aerodynamic control surfaces become less effective.
16
8.1 Force Components
The thrust vector components in the body frame are calculated based on the nozzle deflection
angles. The thrust force decomposed into body-axis components according to the nozzle
orientation:
where δy and δz are the nozzle deflection angles in the yaw and pitch planes, respectively,TE
is the engine thrust magnitude, and ζf is the combined nozzle loss coefficient accounting for
efficiency losses in the vectoring system.
LT = yE Tz − zE Ty (77)
MT = zE Tx − xE Tz (78)
NT = xE Ty − yE Tx (79)
where (xE , yE , zE ) represents the engine location relative to the centre of gravity in body
coordinates.
9 Sensors Model
Modern fighter aircraft are critically dependent on integrated sensor systems to provide
accurate state estimation for flight control, navigation, and mission systems. The F-16
simulation framework incorporates a comprehensive multisensor model that includes inertial
measurement units (IMU) with realistic error characteristics and dynamic responses.
17
5. Time delay: latency due to digital processing and communication.
where H represents the sensor transfer function, K is the scale factor, u(t) the true input,
T the pure time delay, b(t) the bias process, and n(t) the additive measurement noise.
In the Laplace domain:
i.e. the delay operator e−sT applies to the complete processed signal.
B(s) 1
= . (83)
W (s) τs + 1
18
10.3.1 Accelerometer
The accelerometer measurement vector is modelled as
ωn2
Hacc (s) = , (87)
s2 + 2ζωn s + ωn2
and bias dynamics governed by the Gauss-Markov model in which each axis follows the same
form as (3). Typical parameter values (representative) are:
10.3.2 Gyroscope
The gyroscope measurement is modelled as
19
Figure 5 illustrates the Simulink implementation of this architecture for the gyroscope,
demonstrating the cascaded processing stages from true altitude input to corrupted mea-
surement output.
11 Simulation Setup
The simulation has been implemented in MATLAB R2011a with the following initial condi-
tions and parametres:
• u = 200, v = w = 0.
• Aircraft: m = 9000 kg; Ixx = 12875, Iyy = 15673, Izz = 20552, Ixz = 1031, g = 9.80.
• Turbulence: Dryden model with light intensity, filter initialisation at zero states.
20
12 Results
The following results showcase both the flight dynamic response.
21
Figure 9: Body linear vertical velocity w.
22
Figure 10: Altitude h.
13 Conclusion
This work presents a comprehensive high-fidelity simulation framework for the F-16 fighter
aircraft, successfully integrating six-degree-of-freedom nonlinear flight dynamics with realis-
tic sensor models and atmospheric disturbances. The implementation demonstrates several
key achievements that establish a robust foundation for advanced flight control research.
The numerical architecture, employing fourth-order Runge-Kutta integration with 1 ms
timestep, maintained stable behaviour throughout extended simulation periods without nu-
merical instabilities. The adoption of quaternion-based attitude representation effectively
eliminated the gimbal lock singularities inherent to Euler angle formulations, ensuring stable
flight across the entire attitude envelope, including extreme pitch conditions near ±90.
The actuator subsystem accurately captures the physical constraints and dynamic char-
acteristics of modern flight control systems. Position and rate saturation limits, combined
with second-order transfer function dynamics and realistic time delays, provide authentic
representations of control surface and thrust vectoring behaviour during aggressive manoeu-
vring scenarios. The observed oscillatory responses in the angular rates (p, q, r), angle of
attack (α), and side angle (β) reflect the expected behavior of the open-loop system in the
absence of stabilising feedback control.
Integration of atmospheric turbulence through the discrete-time Dryden model success-
fully introduces realistic disturbances while maintaining numerical stability via bilinear trans-
formation. Turbulence forces and moments provide essential environmental excitation for a
complete validation of the control system under operational conditions.
The multi-sensor architecture implements a sophisticated dual-noise error model captur-
ing both systematic bias drift through Gauss-Markov processes and high-frequency mea-
surement noise. The integration of the IMU model with realistic transfer function dynamics,
scale factor errors, and time delays provides authentic measurement data.
This framework provides a robust testbed for advanced research in flight control design,
23
sensor fusion, enabling rigorous evaluation of control architectures under realistic operational
conditions such as high-fidelity dynamics, realistic actuator constraints and environmental
disturbances, etc..
14 References
1. Liu, J., Sun, M., Chen, Z., & Sun, Q. High AOA decoupling control for aircraft based
on ADRC.
3. Liu, J., Sun, M., Chen, Z., & Sun, Q. High AOA decoupling control for aircraft based
on ADRC.
4. Liu, J., Sun, M., Chen, Z., & Sun, Q. Output feedback control for aircraft at high
angle of attack based upon fixed-time extended state observer.
5. Ijaz, S., Fuyang, C., Hamayun, M. T., & Anwaar, H. Adaptive integral-sliding-mode
control strategy for manoeuvring control of the F16 aircraft subject to aerodynamic
uncertainty.
9. Eduardo Pedó Gutkoski. Noise modelling in low-cost MEMS IMU sensors using ex-
perimental data, 2022.
24