diff --git a/src/algorithms/PVT/libs/vtl_engine.cc b/src/algorithms/PVT/libs/vtl_engine.cc index e5ecfc5d1..1359531e6 100755 --- a/src/algorithms/PVT/libs/vtl_engine.cc +++ b/src/algorithms/PVT/libs/vtl_engine.cc @@ -367,9 +367,9 @@ bool Vtl_Engine::model3DoF(double &acc_x,double &acc_y,double &acc_z,arma::mat k double densidad=1.0; double ballistic_coef = 0.007; //vector velocidad - kf_x.print("kf_x: "); + u_vec = kf_x.rows(3, 5); - // u_vec.print("u_vec"); + u_vec.print("u_vec"); // double u=sqrt(pow(kf_x(4),2)+pow(kf_x(5),2)+pow(kf_x(6),2)); //modulo de la velocidad @@ -377,6 +377,7 @@ bool Vtl_Engine::model3DoF(double &acc_x,double &acc_y,double &acc_z,arma::mat k if(u>4){ t_disparo=t_disparo+dt; + cout<<"t_disparo: "<