Use SGP4 Propagator for GPS #770
@ -11,6 +11,8 @@
|
||||
#include <cmath>
|
||||
#include <iostream>
|
||||
|
||||
#include "fsfw/serviceinterface.h"
|
||||
|
||||
template <typename T1, typename T2 = T1>
|
||||
class MathOperations {
|
||||
public:
|
||||
@ -158,7 +160,8 @@ class MathOperations {
|
||||
sif::debug << "c = " << c << std::endl;
|
||||
double w = (c - u) / 2;
|
||||
sif::debug << "w = " << w << std::endl;
|
||||
double d = sign(vector[2]) * sqrt(q) * (w + sqrt(sqrt(pow(t, 2) + v) - u * w - t / 2 - 1 / 4));
|
||||
double d =
|
||||
sign(vector[2]) * sqrt(q) * (w + sqrt(sqrt(pow(t, 2) + v) - u * w - t / 2 - 1. / 4.));
|
||||
sif::debug << "d = " << d << std::endl;
|
||||
double N = a * sqrt(1 + epsilon2 * pow(d, 2) / pow(b, 2));
|
||||
sif::debug << "N = " << N << std::endl;
|
||||
|
Loading…
Reference in New Issue
Block a user