PART41 » History » Version 7

COLIN, Tony, 03/19/2016 06:32 PM

1 3 COLIN, Tony
h1. PART 4 : Position Estimation.
2 2 COLIN, Tony
3 2 COLIN, Tony
{{toc}}
4 2 COLIN, Tony
5 2 COLIN, Tony
p(. .......................
6 2 COLIN, Tony
7 2 COLIN, Tony
---
8 2 COLIN, Tony
9 7 COLIN, Tony
h2. 1 - Ephemeris.
10 2 COLIN, Tony
11 2 COLIN, Tony
h3. .......
12 1 COLIN, Tony
13 7 COLIN, Tony
---
14 1 COLIN, Tony
15 7 COLIN, Tony
h2. 2 - Navigation computation.
16 7 COLIN, Tony
17 7 COLIN, Tony
h3. a - Reminder about the impairments.
18 7 COLIN, Tony
19 4 COLIN, Tony
The following figure gives the impairments affecting the range in case of the GPS system as well as the correction process :
20 4 COLIN, Tony
21 4 COLIN, Tony
p=. !003.PNG!
22 1 COLIN, Tony
*Figure 4.1 :* Pseudo-range measurement extracted from *[2]*
23 7 COLIN, Tony
24 7 COLIN, Tony
h3. b - Demonstration of the Pseudo-ranges with Least Square method.
25 7 COLIN, Tony
26 7 COLIN, Tony
Starting from the fact that can determine most of the elements within the pseudo-range measurement PR_sat(i) from the information provided by each satellite, we have the equation : 
27 7 COLIN, Tony
28 7 COLIN, Tony
p=. !Pos1.png!
29 7 COLIN, Tony
*Equation 1*
30 7 COLIN, Tony
31 7 COLIN, Tony
or put in another way,
32 7 COLIN, Tony
33 7 COLIN, Tony
p=. !Pos2.png!
34 7 COLIN, Tony
*Equation 2*
35 7 COLIN, Tony
36 7 COLIN, Tony
Indeed 4 measurements are needed, providing 4 equations with 4 unknows which are the receiver coordinates and the clock bias of the receiver. As the equation is highly non-linear, it is important to proceed to a linearization such as the Taylor expansion :
37 7 COLIN, Tony
38 7 COLIN, Tony
p=. !Pos3.png!
39 7 COLIN, Tony
*Equation 3*
40 7 COLIN, Tony
41 7 COLIN, Tony
Hence,
42 7 COLIN, Tony
43 7 COLIN, Tony
p=. !Pos4.png!
44 7 COLIN, Tony
*Equation 4*
45 7 COLIN, Tony
46 7 COLIN, Tony
or in matrix equation form,
47 7 COLIN, Tony
48 7 COLIN, Tony
p=. !Pos5.png!
49 7 COLIN, Tony
*Equation 5*
50 7 COLIN, Tony
51 7 COLIN, Tony
which can be expressed as :
52 7 COLIN, Tony
53 7 COLIN, Tony
p=. !Pos6.png!
54 7 COLIN, Tony
*Equation 6*
55 7 COLIN, Tony
56 7 COLIN, Tony
with the Least Square solution :
57 7 COLIN, Tony
58 7 COLIN, Tony
p=. !Pos7.png!
59 7 COLIN, Tony
*Equation 7*
60 7 COLIN, Tony
61 7 COLIN, Tony
_Note that all unknowns are depicted in red color_
62 5 COLIN, Tony
63 5 COLIN, Tony
---
64 5 COLIN, Tony
65 5 COLIN, Tony
*References :* 
66 5 COLIN, Tony
*[1]* K. Borre, D. M. Akos, N. Bertelsen, P. Rinder, S. H. Jensen, A software-defined GPS and GALILEO receiver
67 5 COLIN, Tony
*[2]* Position Estimation Workshop, March 2016