🛰️ Triangulação por GPS & Newton-Raphson 3×3

📐 1. Princípio da Trilateração

O posicionamento por satélite usa trilateração: mede distâncias entre o receptor e os satélites. Cada medição define uma esfera de posições possíveis.

          Geometria progressiva:

          🔹 1 satélite → Você está em algum ponto de uma esfera.

          🔹 2 satélites → Interseção de duas esferas = um círculo.

          🔹 3 satélites → Interseção do círculo com a 3ª esfera = 2 pontos.

          🔹 4+ satélites → Resolve a ambiguidade e o erro de relógio do receptor.

Para fins didáticos, trabalharemos com 3 satélites e relógio sincronizado, reduzindo o problema a 3 incógnitas espaciais $(x, y, z)$.

🧮 2. Formulação do Sistema Não Linear

Sejam $(x_i, y_i, z_i)$ as coordenadas do satélite $i$ e $d_i$ a distância medida até o receptor $(x, y, z)$:

$$ (x-x_i)^2 + (y-y_i)^2 + (z-z_i)^2 = d_i^2 $$

Para 3 satélites:

$$ \begin{cases} f_1 = (x-x_1)^2 + (y-y_1)^2 + (z-z_1)^2 - d_1^2 = 0 \\[6pt] f_2 = (x-x_2)^2 + (y-y_2)^2 + (z-z_2)^2 - d_2^2 = 0 \\[6pt] f_3 = (x-x_3)^2 + (y-y_3)^2 + (z-z_3)^2 - d_3^2 = 0 \end{cases} $$

Matriz Jacobiana $\mathbf{J} \in \mathbb{R}^{3\times 3}$:

$$ \mathbf{J} = \begin{bmatrix} 2(x-x_1) & 2(y-y_1) & 2(z-z_1) \\ 2(x-x_2) & 2(y-y_2) & 2(z-z_2) \\ 2(x-x_3) & 2(y-y_3) & 2(z-z_3) \end{bmatrix} $$

💻 3. Método de Newton-Raphson 3×3

Iteração matricial:

$$ \mathbf{x}_{k+1} = \mathbf{x}_k - \mathbf{J}^{-1}(\mathbf{x}_k)\, \mathbf{F}(\mathbf{x}_k) $$

Na prática, resolve-se o sistema linear:

$$ \mathbf{J}(\mathbf{x}_k)\, \Delta \mathbf{x} = \mathbf{F}(\mathbf{x}_k) \quad \Rightarrow \quad \mathbf{x}_{k+1} = \mathbf{x}_k - \Delta \mathbf{x} $$

          Algoritmo:
          Escolha chute inicial $\mathbf{x}_0$.
Avalie $\mathbf{F}(\mathbf{x}_k)$ e $\mathbf{J}(\mathbf{x}_k)$.
Resolva $\mathbf{J}\,\Delta\mathbf{x} = \mathbf{F}$ (eliminação gaussiana com pivotamento).
Atualize $\mathbf{x}_{k+1} \leftarrow \mathbf{x}_k - \Delta\mathbf{x}$.
Se $\|\Delta\mathbf{x}\| < \varepsilon$, convergiu. Senão, repita.

        

🔧 4. Simulador Interativo

Insira coordenadas e distâncias. O sistema calcula a posição do receptor automaticamente.

📡 Satélites (x, y, z em km)

Sat 1: x₁

Sat 1: y₁

Sat 1: z₁

Distância d₁

Sat 2: x₂

Sat 2: y₂

Sat 2: z₂

Distância d₂

Sat 3: x₃

Sat 3: y₃

Sat 3: z₃

Distância d₃

⚙️ Parâmetros

Chute x₀

Chute y₀

Chute z₀

Tolerância ε

Máx. Iterações

Derivadas

k	x	y	z	f₁	f₂	f₃	‖Δ‖

🌍 5. Visualização Geométrica 3D

Cada esfera é o lugar geométrico a distância $d_i$ do satélite $i$. A interseção define sua posição. Gire com o mouse.

Opacidade:

📖 6. Interpretação Física

No exemplo padrão, os satélites formam um triângulo no espaço. O método converge em 4 a 7 iterações para precisão centimétrica.

Dois pontos solução: O sistema gera 2 interseções. Uma no espaço, outra na superfície. O GPS descarta a espacial usando um 4º satélite ou modelo de altitude.
Geometria fraca (DOP alto): Satélites quase alinhados tornam $\mathbf{J}$ quase singular, amplificando erros de medição.
Implementação real: Receptores usam 4+ satélites e resolvem via Least Squares ponderado, considerando relógio do receptor como incógnita.

📚 Referências Bibliográficas

BURDEN, R. L.; FAIRES, J. D. Numerical Analysis. 10. ed. Boston: Cengage Learning, 2015.
CHAPRA, S. C.; CANALE, R. P. Numerical Methods for Engineers. 7. ed. New York: McGraw-Hill, 2015.
KELLEY, C. T. Solving Nonlinear Equations with Newton's Method. Philadelphia: SIAM, 2003.
PARKINSON, B. W.; SPILKER, J. J. (Eds.). GPS: Theory and Applications. Washington: AIAA, 1996. v. 1.

A formulação da Jacobiana, o algoritmo 3×3 e a análise de convergência seguem Burden & Faires (2015). A modelagem de trilateração esférica baseia-se em Parkinson & Spilker (1996).