更新:1、航迹关联时增加高度门限判断,同时加大统计距离门限,提高机动目标关联概率;
2、修复TAS波束控制时,数据率判断有误的问题; 3、更新文档; Signed-off-by: waiwaylee <waiwaylee@foxmail.com>
This commit is contained in:
@@ -263,6 +263,7 @@ void TAS_Ctrl::tas_beam_output(std::vector<Trust_Track> *trust_track
|
||||
long long CPI_time = 0;
|
||||
long long earliest_CPI_time = LLONG_MAX;
|
||||
float delta_T = 0;
|
||||
float delta_T_last_track = 0;
|
||||
double H_track = 0;
|
||||
int earliest_track_idx=-1;
|
||||
int earliest_tas_queue_idx=-1;
|
||||
@@ -281,13 +282,14 @@ void TAS_Ctrl::tas_beam_output(std::vector<Trust_Track> *trust_track
|
||||
if((*trust_track)[track_idx].Track_Index == tas_target_queue[tas_idx].Index)
|
||||
{
|
||||
CPI_time = (*trust_track)[track_idx].T_track;
|
||||
delta_T = (latest_timestamp - CPI_time) / 1000.0f;
|
||||
|
||||
//查找最早的CPI时间, 航迹时间与当前最新时间戳的差值大于 DATA_RATE_TAS 时才输出TAS跟踪波束
|
||||
if(CPI_time < earliest_CPI_time && (latest_timestamp - tas_target_queue[tas_idx].last_track_time) / 1000.0f > Work_Parameter.DATA_RATE_TAS && delta_T > Work_Parameter.DATA_RATE_TAS)
|
||||
delta_T_last_track = (latest_timestamp - tas_target_queue[tas_idx].last_track_time) / 1000.0f;
|
||||
|
||||
//查找CPI时间最早,且满足TAS数据率的目标
|
||||
if(CPI_time < earliest_CPI_time && (delta_T_last_track > Work_Parameter.DATA_RATE_TAS))
|
||||
{
|
||||
earliest_CPI_time = CPI_time;
|
||||
H_track = (*trust_track)[track_idx].Height;
|
||||
delta_T = (latest_timestamp - CPI_time) / 1000.0f;
|
||||
|
||||
earliest_track_idx = track_idx;
|
||||
earliest_tas_queue_idx = tas_idx;
|
||||
@@ -295,7 +297,6 @@ void TAS_Ctrl::tas_beam_output(std::vector<Trust_Track> *trust_track
|
||||
for(int ii=0;ii<6;ii++){
|
||||
X_now[ii]=(*trust_track)[track_idx].X[ii];
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
break;
|
||||
|
||||
Reference in New Issue
Block a user