• No results found

Single Point Positioning with GPS Pseudoranges

In document Localization Precise in Urban Area (Page 39-43)

Mass market GNSS receivers tend to only use pseudorange measurements for position and time offset computation due to the difficulty to use carrier phase measurements (low robustness of tracking mechanism, cycle slipping, ambiguous measurement, etc.). As a consequence, in this section, the estimation of a stand-alone user’s position using only GPS pseudorange measurements is illustrated to provide an overview of GNSS navigating. The performance of a single-frequency standard positioning GPS user can observe better than 10 m, 95% positioning and 20-ns, 95% timing accuracy worldwide autonomously using broadcast orbits and clocks [2], [5], [39]. In this section, the basic technique of Leas-Squares estimation (LSE) is implemented.

Least Squares Estimation

Let us define a generic linear system in the form of π‘Œπ‘˜= π»π‘˜π‘‹π‘˜+ πœ–π‘˜ where

ο‚· π‘Œπ‘˜ represents the observables vector at instant k,

ο‚· π‘‹π‘˜ represents the states vector to be estimated at instant k,

ο‚· π»π‘˜ is the design matrix linking π‘Œπ‘˜ and π‘‹π‘˜,

39

ο‚· πœ–π‘˜ represents the Gaussian white observation noise, with π‘…π‘˜ the variance-covariance (VC-) matrix.

LSE is an optimal estimation process to find the best solution which fits the above linear system when the observation noise is Gaussian [37]. It uses the criterion of minimizing the sum of squared residuals:

π‘šπ‘–π‘›π‘‹Μ‚π‘˜ β€–π‘Œπ‘˜βˆ’ π‘ŒΜ‚π‘˜β€–Β² (2-33)

Inside the equation, π‘ŒΜ‚π‘˜= π»π‘˜π‘‹Μ‚π‘˜ is the estimation of observables based on states estimates π‘‹Μ‚π‘˜. The weighted version of LSE gives the best solution in the form:

π‘‹Μ‚π‘˜= (π»π‘˜π‘‡π‘Šπ‘˜π»π‘˜)βˆ’1π»π‘˜π‘‡π‘Šπ‘˜π‘Œπ‘˜ (2-34) where π‘Šπ‘˜ is the weighting matrix which modulates the importance of each observation.

A common option is to use the inverse of the VC-matrix π‘…π‘˜ of measurements as weights: π‘Šπ‘˜= π‘…π‘˜βˆ’1. Measurements with lower noise level should be highly weighted. In such case, the VC-matrix of the solution π‘‹Μ‚π‘˜ is finally given by

π‘ƒπ‘˜= (π»π‘˜π‘‡π‘Šπ‘˜π»π‘˜)βˆ’1 (2-35)

The measurements residuals, π‘Ÿπ‘˜, are thus formulated as:

π‘Ÿπ‘˜= π‘Œπ‘˜βˆ’ π‘ŒΜ‚π‘˜ = π‘Œπ‘˜βˆ’ π»π‘˜π‘‹Μ‚π‘˜ (2-36) In the quality assessment of an estimation, the measurement residuals play an important role.

Estimation of Position and Time

The previous estimation theory is based on the construction of a linear system. However, the measurement models between GNSS observables and the desired states, i.e. the user position and clock, is not a linear system. Therefore, an extended form of LSE should be applied in which a linearization is needed.

We denote 𝑃𝑒𝑗 the measured pseudorange between the 𝑗-th satellite and the receiver 𝑒, with 𝑗 ∈ [1, 𝐾].

𝐾 is the total number of satellites visible in view of the receiver 𝑒 . Let vectors 𝑿𝒖(π‘₯, 𝑦, 𝑧) and 𝑿𝒋(π‘₯𝑗, 𝑦𝑗, 𝑧𝑗), represent respectively the ECEF coordinates of the receiver’s phase center and the ECEF coordinates of the 𝑗-th satellite in orbit. The true user-to-satellite geometric range is thus

πœŒπ‘’π‘— = √(π‘₯ βˆ’ π‘₯𝑗)Β² + (𝑦 βˆ’ 𝑦𝑗)Β² + (𝑧 βˆ’ 𝑧𝑗)Β² = β€–π‘Ώπ’–βˆ’ 𝑿𝒋‖ (2-37) After applying the correction of the atmosphere effects and the satellite clock delays, the simplified form of the pseudorange then becomes

𝑃𝑒𝑗 = πœŒπ‘’π‘— + π‘π‘™π‘˜π‘’+ πœ–π‘ƒ

𝑒𝑗 (2-38)

with

ο‚· π‘π‘™π‘˜π‘’ the receiver clock delay in meter with respect to the time reference system and

ο‚· πœ–P

𝑒

𝑗 the combined effect of the residual errors including the residual satellite clock delays, the residual atmosphere delays, the potential multipath errors, etc. Note that due to the model now

40

𝑗 and 𝑿𝒖 is non-linear. The basic idea is to linearize the system around an approximate value of the state parameters, solve for the system, and then adjust the system in an iterative way. As a consequence, let us define π‘ΏπŸŽ(π‘₯0, 𝑦0, 𝑧0) and π‘π‘™π‘˜0 the first state guesses. The difference between the true and the approximated values are denoted as

πœΉπ‘Ώπ’–,𝟎= π‘Ώπ’–βˆ’ π‘ΏπŸŽ (2-39)

π›Ώπ‘π‘™π‘˜0= π‘π‘™π‘˜ βˆ’ π‘π‘™π‘˜0 (2-40)

The position bias πœΉπ‘Ώπ’–,𝟎 is generally negligible compared to the distance β€–π‘Ώπ’–βˆ’ 𝑿𝒋‖ between the satellite and the rover on the ground which is usually of order 1000 km. According to the first-order approximation, the residual measurement 𝛿P𝑒,0𝑗 is expressed as

𝛿P𝑒,0𝑗 = Pπ‘’π‘—βˆ’ P𝑒,0𝑗

= (β€–π‘ΏπŸŽ+ πœΉπ‘Ώπ’–,𝟎 βˆ’ 𝑿𝒋‖ + π‘π‘™π‘˜) βˆ’ (β€–π‘ΏπŸŽβˆ’ 𝑿𝒋‖ + π‘π‘™π‘˜0) + πœ€Μƒπ‘ƒ,𝑒𝑗

β‰ˆ βˆ’ π‘Ώπ’‹βˆ’π‘ΏπŸŽ

β€–π‘Ώπ’‹βˆ’π‘ΏπŸŽβ€–. πœΉπ‘Ώπ’–,𝟎+ π›Ώπ‘π‘™π‘˜0+ πœ€Μƒπ‘ƒ,𝑒𝑗

= βˆ’π’†π’‹. πœΉπ‘Ώπ’–,𝟎+ π›Ώπ‘π‘™π‘˜0+ πœ€Μƒπ‘ƒ,𝑒𝑗

where π’†πŸŽπ’‹ is the estimated line-of-sight (LOS) unit vector along the direction pointing from the initial estimate user position to the satellite, π’†πŸŽπ’‹ =β€–π‘Ώπ’‹βˆ’π‘ΏπŸ

πŸŽβ€–(π‘₯π‘—βˆ’π‘₯0, π‘¦π‘—βˆ’π‘¦0, π‘§π‘—βˆ’π‘§0).

A set of 𝐾 linear equations, representing the K measurements, can be presented as:

πœΉπ‘·πŸŽ=

The matrix 𝑯 is referred to be the geometry matrix describing the user-satellite geometry. The bias state vector [πœΉπ‘Ώπ’–,𝟎, π›Ώπ‘π‘™π‘˜0]𝑇 is then resolved according to Eq.(2-34) and added to the first state guess [π‘ΏπŸŽ, π‘π‘™π‘˜0]𝑇 to refine new state estimate [π‘ΏπŸ, π‘π‘™π‘˜1]𝑇. The whole estimation process iterates with the new state estimate until the solution converges, e.g. norm([πœΉπ‘Ώπ’–,𝟎, π›Ώπ‘π‘™π‘˜0]) ≀ 1𝑒-5.

The stochastic performance of the GNSS positioning highly depends on two factors:

ο‚· The number and distribution of the tracked satellites in the sky with respect to the user position, which is referred to as the dilution of precision (DOP);

ο‚· The quality of the generated GNSS measurements, which is referred to as user equivalent range error (UERE). UERE is the total error budget representing the measurement model errors with respect to this system..

Consider a simplified case that the measurement VC-matric π‘…π‘˜ has only diagonal components identical to the square of the satellite UERE, noted πœŽΒ²π‘ˆπΈπ‘…πΈ. The VC-matrix of states 𝑃𝑋 is then expressed as stated in Eq.(2-35):

𝑃𝑋= πœŽΒ²π‘ˆπΈπ‘…πΈ(𝑯𝑻𝑯)βˆ’1

41

Note that under the consumption that πœŽΒ²π‘ˆπΈπ‘…πΈ related to satellites is invariant, the state quality is determined by the matrix 𝑷 = (𝑯𝑻𝑯)βˆ’1= (𝑃𝑖𝑗)𝑖,π‘—βˆˆ{π‘₯,𝑦,𝑧,𝑑}. 𝑷 only depends on the number of satellites and the relative geometry between the satellites and the user. To describe the translation of measurement noise level πœŽπ‘ˆπΈπ‘…πΈ to the state noise level, the construction of the DOP terms, i.e. the geometric DOP (GDOP), the position DOP (PDOP) and the time DOP (TDOP), are given by

𝐺𝐷𝑂𝑃 = βˆšπ‘ƒπ‘₯,π‘₯+ 𝑃𝑦,𝑦+ 𝑃𝑧,𝑧+ 𝑃𝑑,𝑑

𝑃𝐷𝑂𝑃 = βˆšπ‘ƒπ‘₯,π‘₯+ 𝑃𝑦,𝑦+ 𝑃𝑧,𝑧 𝑇𝐷𝑂𝑃 = βˆšπ‘ƒπ‘‘,𝑑

Intuitively with the same number of visible satellites, a lower PDOP value and consequently a more accurate solution are expected with a good satellite distribution. In Figure 2-13, an illustration of a good distribution of satellites on the left side and a bad one on the right wide with satellites clustered in one side is provided.

When the position is resolved in a local ENU frame, the horizontal DOP (HDOP) and the vertical DOP (VDOP) describing respectively the precision in the horizontal plane and the vertical plane are introduced,

𝐻𝐷𝑂𝑃 = βˆšπ‘ƒπ‘’,𝑒+ 𝑃𝑛,𝑛; 𝑉𝐷𝑂𝑃 = βˆšπ‘ƒπ‘’,𝑒

Figure 2-13. Good (left) and bad (right) GDOP cases (adopted from [43])

42

Precise Positioning and the Problem Raised by Urban

In document Localization Precise in Urban Area (Page 39-43)