更新:1、TAS航迹不关联时间戳更早的TWS点迹,但标记点迹已使用,避免生成TWS航迹;
2、调整目录结构,将过期的文档都放到archived_docs文件夹中留档; Signed-off-by: waiwaylee <waiwaylee@foxmail.com>
This commit is contained in:
@@ -612,36 +612,9 @@ void Track_Asso:: model_filter(std::vector <Trust_Track> *trust_track,struct Ra
|
|||||||
|
|
||||||
if (delta_T <= 0)
|
if (delta_T <= 0)
|
||||||
{
|
{
|
||||||
|
// RDP_LOG<<"delta_T <= 0, track_index: "<<track_index<<", point_index: "<<point_index<<", delta_T: "<<delta_T<<std::endl;
|
||||||
RDP_LOG<<"delta_T <= 0, track_index: "<<track_index<<", point_index: "<<point_index<<", delta_T: "<<delta_T<<std::endl;
|
|
||||||
// 乱序/重复时间戳:不作为有效关联,不标记点迹已使用、不刷新航迹新鲜度
|
// 乱序/重复时间戳:不作为有效关联,不标记点迹已使用、不刷新航迹新鲜度
|
||||||
for (int ii=0;ii<associated_num;)
|
}else{
|
||||||
{
|
|
||||||
if(associated_info[ii].track_index==track_index)
|
|
||||||
{
|
|
||||||
associated_info.erase(associated_info.begin()+ii);
|
|
||||||
associated_num=associated_info.size();
|
|
||||||
}
|
|
||||||
else
|
|
||||||
ii++;
|
|
||||||
}
|
|
||||||
associated_num=associated_info.size();
|
|
||||||
for (int ii=0;ii<associated_num;)
|
|
||||||
{
|
|
||||||
if(associated_info[ii].point_index==point_index)
|
|
||||||
{
|
|
||||||
associated_info.erase(associated_info.begin()+ii);
|
|
||||||
associated_num=associated_info.size();
|
|
||||||
}
|
|
||||||
else
|
|
||||||
ii++;
|
|
||||||
}
|
|
||||||
associated_num=associated_info.size();
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
if(delta_T>0)
|
|
||||||
{
|
|
||||||
double X1_filter[6],X2_filter[6],X3_filter[6],P1_filter[6][6],P2_filter[6][6],P3_filter[6][6];
|
double X1_filter[6],X2_filter[6],X3_filter[6],P1_filter[6][6],P2_filter[6][6],P3_filter[6][6];
|
||||||
double S1[3][3] = {{0}},S2[3][3] = {{0}},S3[3][3] = {{0}};
|
double S1[3][3] = {{0}},S2[3][3] = {{0}},S3[3][3] = {{0}};
|
||||||
kalman Kalman;
|
kalman Kalman;
|
||||||
@@ -723,10 +696,10 @@ void Track_Asso:: model_filter(std::vector <Trust_Track> *trust_track,struct Ra
|
|||||||
//更新高度
|
//更新高度
|
||||||
track_hight_update(track_index,point_index,trust_track);
|
track_hight_update(track_index,point_index,trust_track);
|
||||||
|
|
||||||
}
|
|
||||||
(*trust_track)[track_index-1].Extrapolate_round = 0; //连续未用实点更新时间
|
(*trust_track)[track_index-1].Extrapolate_round = 0; //连续未用实点更新时间
|
||||||
(*trust_track)[track_index-1].point_flag=1; //实点
|
(*trust_track)[track_index-1].point_flag=1; //实点
|
||||||
(*trust_track)[track_index-1].associate_point_number = (*trust_track)[track_index-1].associate_point_number+1; //关联点数+1
|
(*trust_track)[track_index-1].associate_point_number = (*trust_track)[track_index-1].associate_point_number+1; //关联点数+1
|
||||||
|
}
|
||||||
|
|
||||||
//删除associated_info中关联上的航迹 点迹信息
|
//删除associated_info中关联上的航迹 点迹信息
|
||||||
for (int ii=0;ii<associated_num;)
|
for (int ii=0;ii<associated_num;)
|
||||||
|
|||||||
Reference in New Issue
Block a user