mirror of
https://github.com/gnss-sdr/gnss-sdr
synced 2024-11-16 06:44:57 +00:00
FIX: code error reset bug
This commit is contained in:
parent
1266127802
commit
aa07ba17fd
@ -1216,7 +1216,7 @@ void kf_tracking::run_Kf()
|
|||||||
// Kalman loop
|
// Kalman loop
|
||||||
|
|
||||||
// Prediction
|
// Prediction
|
||||||
d_x_old_old(0)=0; // reset error estimation because the NCO corrects the code phase
|
//d_x_old_old(0)=0; // reset error estimation because the NCO corrects the code phase
|
||||||
d_x_new_old = d_F * d_x_old_old;
|
d_x_new_old = d_F * d_x_old_old;
|
||||||
|
|
||||||
d_P_new_old = d_F * d_P_old_old * d_F.t() + d_Q;
|
d_P_new_old = d_F * d_P_old_old * d_F.t() + d_Q;
|
||||||
@ -1231,7 +1231,7 @@ void kf_tracking::run_Kf()
|
|||||||
|
|
||||||
// new code phase estimation
|
// new code phase estimation
|
||||||
d_code_error_kf_chips = d_x_new_new(0);
|
d_code_error_kf_chips = d_x_new_new(0);
|
||||||
|
d_x_new_new(0)=0; // reset error estimation because the NCO corrects the code phase
|
||||||
// new carrier phase estimation
|
// new carrier phase estimation
|
||||||
d_carrier_phase_kf_rad = d_x_new_new(1);
|
d_carrier_phase_kf_rad = d_x_new_new(1);
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user