mirrors/gnss-sdr
1
0
Fork 0
mirror of https://github.com/gnss-sdr/gnss-sdr synced 2024-11-15 22:34:58 +00:00
Code Issues Releases Wiki Activity

FORMAT: clang

Browse Source
This commit is contained in:
M.A. Gomez 2023-06-18 23:47:24 +02:00
parent 352ded5036
commit 3f33a0fdd4
1 changed files with 8 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
src/algorithms/PVT/libs/vtl_engine.cc
View File

@ -300,7 +300,6 @@ void Vtl_Engine::kf_H_fill(arma::mat &kf_H, int sat_number, arma::colvec ax, arm
void Vtl_Engine::kf_F_fill(arma::mat &kf_F, double kf_dt, arma::mat &kf_x) void Vtl_Engine::kf_F_fill(arma::mat &kf_F, double kf_dt, arma::mat &kf_x)
{ {
double densidad = 1.0; double densidad = 1.0;
double ballistic_coef = 0.007; double ballistic_coef = 0.007;
double diam_cohete = 120.0e-3; // 120 mm double diam_cohete = 120.0e-3; // 120 mm
@ -323,14 +322,14 @@ void Vtl_Engine::kf_F_fill(arma::mat &kf_F, double kf_dt, arma::mat &kf_x)
kf_F(4, 7) = kf_dt; kf_F(4, 7) = kf_dt;
kf_F(5, 8) = kf_dt; kf_F(5, 8) = kf_dt;
kf_F(6, 3) = -beta*(vx*vx/u+u); kf_F(6, 3) = -beta * (vx * vx / u + u);
kf_F(7, 4) = -beta*(vy*vy/u+u); kf_F(7, 4) = -beta * (vy * vy / u + u);
kf_F(8, 5) = -beta*(vz*vz/u+u); kf_F(8, 5) = -beta * (vz * vz / u + u);
kf_F(9, 10) = kf_dt; kf_F(9, 10) = kf_dt;
} }
void Vtl_Engine::obsv_calc(arma::mat &rho_pri, arma::mat &rhoDot_pri, arma::mat &rhoDot2_pri,arma::colvec &ax, arma::colvec &ay, arma::colvec &az, int sat_number, arma::mat sat_p, arma::mat sat_v, arma::mat kf_x) void Vtl_Engine::obsv_calc(arma::mat &rho_pri, arma::mat &rhoDot_pri, arma::mat &rhoDot2_pri, arma::colvec &ax, arma::colvec &ay, arma::colvec &az, int sat_number, arma::mat sat_p, arma::mat sat_v, arma::mat kf_x)
{ {
for (int32_t i = 0; i < sat_number; i++) // neccesary quantities for (int32_t i = 0; i < sat_number; i++) // neccesary quantities
{ {