更新:1、回调TWS外推时间差计算方法,避免TAS时同步出现TWS航迹的问题;

Signed-off-by: waiwaylee <waiwaylee@foxmail.com>
This commit is contained in:
2026-10-13 14:49:48 +08:00
parent e98280409e
commit b4aed8a37b
2 changed files with 22 additions and 24 deletions
+1 -1
View File
@@ -10,7 +10,7 @@
/**********************************版本信息*************************************************/ /**********************************版本信息*************************************************/
#define MAJOR_VERSION 1 #define MAJOR_VERSION 1
#define MINOR_VERSION 5 #define MINOR_VERSION 5
#define PATCH_VERSION 6 #define PATCH_VERSION 7
#ifdef PHASE_SCANNING #ifdef PHASE_SCANNING
#define VERSION_INFO "PS" #define VERSION_INFO "PS"
#else #else
+20 -22
View File
@@ -730,29 +730,27 @@ void Track_Asso:: model_filter(std::vector <Trust_Track> *trust_track,struct Ra
if((*trust_track)[i].Extrapolate_round <= MAX_EXTRAPOLATE_NUM) if((*trust_track)[i].Extrapolate_round <= MAX_EXTRAPOLATE_NUM)
{ {
double v_track = sqrt(pow((*trust_track)[i].X[1],2)+pow((*trust_track)[i].X[4],2)); double v_track = sqrt(pow((*trust_track)[i].X[1],2)+pow((*trust_track)[i].X[4],2));
double delta_T = 0;
// double delta_T = (latest_timestamp - (*trust_track)[i].T_track)/1000.0;
// if (delta_T <= 0)
// continue;
double delta_T = (latest_timestamp - (*trust_track)[i].T_track)/1000.0; if(Work_Parameter.work_mode == 0)
if (delta_T <= 0) {
continue; delta_T = Work_Parameter.DATA_RATE_SHORT;
}
// else if(Work_Parameter.work_mode == 1)
// {
// if(Work_Parameter.work_mode == 0) delta_T = Work_Parameter.DATA_RATE_MIDDLE;
// { }
// delta_T = Work_Parameter.DATA_RATE_SHORT; else if(Work_Parameter.work_mode == 2)
// } {
// else if(Work_Parameter.work_mode == 1) delta_T = Work_Parameter.DATA_RATE_FAR;
// { }
// delta_T = Work_Parameter.DATA_RATE_MIDDLE; else
// } {
// else if(Work_Parameter.work_mode == 2) delta_T = Work_Parameter.DATA_RATE_SHORT;
// { }
// delta_T = Work_Parameter.DATA_RATE_FAR;
// }
// else
// {
// delta_T = Work_Parameter.DATA_RATE_SHORT;
// }
double F[6][6], Q1[6][6], Q2[6][6], Q3[6][6]; double F[6][6], Q1[6][6], Q2[6][6], Q3[6][6];
IMM_F_Q_gen( v_track, delta_T, F, Q1, Q2, Q3,Work_Parameter); IMM_F_Q_gen( v_track, delta_T, F, Q1, Q2, Q3,Work_Parameter);