• No results found

Position Velocity

4.3.3 Environmental models .1 Trajectory generator

A trajectory generator has been developed with the help of a student so as to compute the position of the centre of gravity of a civil aviation aircraft along an RNAV/GNSS approach. An example of RNAV/GNSS procedure is shown in Figure 17.

Figure 17: RNAV/GNSS procedure for LILLE Lesquin airport [SIA,2010]

This type of procedures has standardized shapes which are “Y” and “T” approaches. The generator is currently only able to generate “T” approaches. The trajectory is expressed in the north-east-down coordinate frame centred at the runway threshold. The characteristics are fully customizable so as to allow representing a wide variety of airports. An example trajectory generated with this module is represented in Figure 18 and Figure 19.

The trajectory generated takes into account the velocity profile of the aircraft along the approach.

Below can be found an example of generated trajectory:

Figure 18: Lateral simulated trajectory profile

Figure 19: Vertical simulated trajectory profile

Aircraft Behaviour:

The behaviour of the aircraft along its trajectory has been taken into account. It means that we modelled the attitude of the aircraft that is to say pitch, roll and yaw angles. Raised cosine functions were used so as to generate continuous evolutions of these angles. An example is shown in Figure 20.

-122.55 -122.5 -122.45 -122.4 -122.35 -122.3

-0.08 -0.07 -0.06 -0.05 -0.04 -0.03 -0.02 -0.01

LONGITUDE in DEG

LATITUDE in DEG

GROUND PROFILE OF TRAJECTORY

0 50 100 150 200 250 300

0 100 200 300 400 500 600

METERS

SECONDS VERTICAL PROFILE OF TRAJECTORY

Figure 20: Raised Cosine for attitude angles simulation

Knowing the position of the centre of gravity of the aircraft, the attitude of the aircraft and the relative position of the receiver antenna with respect to the gravity centre, we are able to compute the position of the GNSS receiver antenna along the RNAV GNSS approach. This trajectory is used as the reference position in our simulations.

One additional feature of the trajectory generator is that it is also capable to compute the position of the wings of the aircraft. This information can be used to detect signal outages due to wings during turns for example.

4.3.3.2 Satellite Position

Satellites position and velocities are generated on the basis of GALILEO and GPS almanacs. As presented in [SPILKER,1996], almanacs provide a reduced precision set of the ephemeris parameters used to compute position of GNSS satellites. For simulation purpose, it is sufficient to reproduce realistic positions and dynamics of the space vehicles that will generate the observation of the most significant geometry configurations. We remind here the algorithm used to compute GPS and GALILEO satellites position using almanacs.

The algorithm used in the case of almanacs is based on the user algorithm for ephemeris determination published in [ARINC, 2004]. Some of the parameters necessary for positioning using ephemeris are considered null in the case of almanacs thus resulting in far simpler equations and therefore an easier implementation.

Different formats of almanacs exist but in this PhD we used YUMA almanacs which have the following structure:

Phase 1 Phase 2 Phase 3 Maximum

Amplitude

Initial Amplitude

𝑀0 Mean Anomaly at Reference Time

∆𝒏 Mean Motion Difference From Computed Value 𝒑 Eccentricity

√𝑨 Square Root of the Semi-Major Axis

𝛀𝟎 Longitude of Ascending Node of Orbit Plane at Weekly Epoch 𝐢𝟎 Inclination Angle at Reference Time

𝝎 Argument of Perigee 𝛀̇ Rate of Right Ascension IDOT Rate of Inclination Angle

𝐂𝒖𝒄 Amplitude of the Cosine Harmonics Correction Term to the Argument of Latitude

𝐂𝒖𝒔 Amplitude of the Sine Harmonics Correction Term to the Argument of Latitude 𝐂𝒑𝒄 Amplitude of the Cosine Harmonics Correction Term to the Orbit Radius 𝐂𝒑𝒔 Amplitude of the Sine Harmonics Correction Term to the Orbit Radius

𝐂𝒊𝒄 Amplitude of the Cosine Harmonics Correction Term to the Angle of Inclination 𝐂𝒊𝒔 Amplitude of the Sine Harmonics Correction Term to the Angle of Inclination 𝐭𝒑𝒑 Reference Time Ephemeris

IODE Issue of Data

Table 14: YUMA almanacs parameters

To compute SVs positions we have to use the ephemeris algorithm with the following additional assumptions:

- Sinusoidal corrections are null i.e. : 𝛿𝑢𝑘 = 𝛿𝑟𝑘 = 𝛿𝑖𝑘 = 0

- For the inclination angle, a nominal value of 0.30 semicircles is implicit, only the correction to the inclination 𝛿1 is transmitted.

We remind here the user algorithm for ephemeris determination which gives the space vehicle antenna phase centre position in WGS-84 Earth-centred, Earth fixed reference frame [ARINC, 2004]:

𝜇 = 30986005. 1014 𝑚3/𝑖2 WGS-84 value of the Earth’s

universal gravitational parameter Ω̇e= 7.2921151467. 10−5 𝑟𝑎𝑟/𝑖 WGS-84 value of the Earth’s rotation

rate

𝐴 = �√𝐴�2 Semi major axis

𝑛0= �𝜇 𝐴3

Computed mean motion – rad/s

𝑡𝑘= 𝑡 − 𝑡𝑜𝑣 Time from ephemeris reference

epoch

𝑛 = 𝑛0+ ∆𝑛 Corrected mean motion

𝑀𝑘 = 𝑀0+ 𝑛. 𝑡𝑘 Mean anomaly

𝜋 = 3.1415926535898 GPS standard value for 𝜋

𝑀𝑘 = 𝐸𝑘− 𝑒. sin 𝐸𝑘 Kepler’s equation for the eccentric

anomaly 𝐸𝑘 – rad

𝜈𝑘 = 𝑡𝑎𝑛−1cos 𝜈sin 𝜈𝑘

𝑘�=𝑡𝑎𝑛−1√1−𝑣(𝑐𝑜𝑠 𝐸2sin 𝐸𝑘(1−𝑣.𝑐𝑜𝑠 𝐸𝑘)

𝑘−𝑣) (1−𝑣.𝑐𝑜𝑠 𝐸 𝑘) � True anomaly 𝜈𝑘 as a function of the eccentric anomaly

𝐸𝑘 = 𝑐𝑜𝑖−1� 𝑒 + cos 𝜈𝑘

1 + e. cos 𝜈𝑘� Eccentric anomaly

Φk= 𝜈𝑘+ 𝜔 Argument of Latitude

𝛿𝑢𝑘 = 𝐶𝑢𝑠sin 2Φk+ 𝐶𝑢𝑐cos 2Φk Argument of latitude correction 𝛿𝑟𝑘 = 𝐶𝑣𝑠sin 2Φk+ 𝐶𝑣𝑐cos 2Φk Radius correction

𝛿𝑖𝑘 = 𝐶𝑖𝑠sin 2Φk+ 𝐶𝑖𝑐cos 2Φk Inclination correction

𝑢𝑘 = Φk+ 𝛿𝑢𝑘 Corrected argument of latitude

𝑟𝑘 = 𝐴(1 − 𝑒. cos 𝐸𝑘) + 𝛿𝑟𝑘 Corrected radius

𝑖𝑘 = 𝑖0+ 𝛿𝑖𝑘 + (𝐼𝐷𝑂𝑇). 𝑡𝑘 Corrected inclination

𝑥𝑘= 𝑟𝑘. cos 𝑢𝑘

Satellite position in orbital plane 𝑦𝑘 = 𝑟𝑘. sin 𝑢𝑘

Ωk = Ω0+ �Ω̇ − Ω̇e�𝑡𝑘− Ω̇et𝑜𝑣 Corrected longitude of ascending node

𝑥𝑘 =𝑥𝑘. cosΩk𝑦𝑘. cos 𝑖𝑘. sin Ωk 𝑦𝑘 = 𝑥𝑘. sin Ωk+ 𝑦𝑘. cos 𝑖𝑘. cos Ωk

𝑧𝑘 = 𝑦𝑘. sin 𝑖𝑘

Satellite position in Earth-centred, Earth-fixed coordinates

Table 15: Ephemeris equations [ARINC, 2004]

To compute an estimate of the space vehicles velocities we derivate the expressions presented previously. Here are the equations allowing computing the Space Vehicle velocities in the WGS-84 coordinate frame.

𝑀𝑘̇ = 𝑛 𝐸𝑘̇ = 𝑀𝑘̇

(1 − 𝑒. cos 𝐸𝑘)

𝜈𝑘̇ = sin 𝐸𝑘 . 𝐸𝑘̇ 1 + 𝑒. cos 𝜈𝑘 sin 𝜈𝑘. (1 − 𝑒. cos 𝐸𝑘) 𝑢𝑘̇ =𝜈𝑘̇ + 2(𝐶𝑢𝑠. cos 2𝑢𝑘− 𝐶𝑢𝑐. sin 2𝑢𝑘). 𝜈𝑘̇ 𝑟𝑘̇ = 𝐴. 𝑒. 𝑛. sin 𝐸𝑘

1 − 𝑒. cos 𝐸𝑘 + 2(𝐶𝑣𝑠. cos 2𝑢𝑘− 𝐶𝑣𝑐. sin 2𝑢𝑘). 𝜈𝑘̇ 𝚤𝑘̇ = 𝐼𝐷𝑂𝑇 + 2(𝐶𝑖𝑠. cos 2𝑢𝑘− 𝐶𝑖𝑐. sin 2𝑢𝑘). 𝜈𝑘̇

(𝑥𝑘̇ =) 𝑟𝑘̇ cos 𝑢𝑘𝑦𝑘. 𝑢𝑘̇

(𝑦𝑘̇ = 𝑟) 𝑘̇ sin 𝑢𝑘+𝑥𝑘.𝑢𝑘̇ Ωk̇ = �Ω̇ − Ω̇e

Satellites velocity in Earth-centred, Earth-fixed coordinates:

𝑥𝑘̇ = �(𝑥𝑘̇)𝑦𝑘cos(𝑖𝑘) Ωk̇ �. cosΩk𝑥𝑘.Ωk̇ + (𝑦𝑘̇ cos𝑖) 𝑘− 𝑦𝑘sin(𝑖𝑘) 𝚤𝑘̇ �sinΩk

𝑦𝑘̇ = �(𝑥𝑘̇)𝑦𝑘cos(𝑖𝑘) Ωk̇ �. sinΩk+𝑥𝑘.Ωk̇ + (𝑦𝑘̇ cos(𝑖) 𝑘) − 𝑦𝑘sin(𝑖𝑘) 𝚤𝑘̇ �cosΩk

𝑧𝑘̇ = (𝑦𝑘̇ sin𝑖) 𝑘+ 𝑦𝑘cos(𝑖𝑘) 𝚤𝑘̇

Table 16: Ephemeris Velocity Equations

4.3.3.2.1 Distance computation

The different models gathered in this section are used so as to build a realistic true distance between an aircraft receiver and GNSS satellites. The true geometrical distance can be written as:

𝜌𝑖(𝑘) = �(𝑋𝑠𝑖 (𝑘) − 𝑋𝑣(𝑘))2+ (𝑌𝑠𝑖(𝑘) − 𝑌𝑣(𝑘))2+ (𝑍𝑠𝑖(𝑘) − 𝑍𝑣(𝑘))2

(4-57)

Where:

- �𝑋𝑠𝑖 , 𝑌𝑠𝑖 , 𝑍𝑠𝑖 � is the position of satellite 𝑖 - (𝑋𝑣, 𝑌𝑣, 𝑍𝑣) is the receiver position

We have already presented the two modules which provide the satellites positions and the user position. The next step is to provide the obtained distance to the IQ generator.