更新:1、kalman_filter_init_2dots函数中量测噪声协方差矩阵R中R[1][0]赋值错误;
2、数据预处理中波位号判断规则修改; 3、数据预处理中增加点迹数量限制,避免超过数组上限; 4、Dot_Coh_TAS::dot_coh_tas_process中增加容器非空判断; 5、d_cal_with_doppler中计算雅可比矩阵改为用预测值计算; 6、tmp_track_to_trust_track中数组索引为负的问题修复; 7、tmp_track_to_trust_track中对容器push_back后在修改元素可能导致无法修改容器中的元素; 8、修改部分参数,适配机扫模式; Signed-off-by: waiwaylee <waiwaylee@foxmail.com>
This commit is contained in:
@@ -257,14 +257,14 @@ void TAS_Ctrl::tas_beam_output(QVector<Trust_Track> *trust_track,
|
||||
double H_track;
|
||||
double X_now[6];
|
||||
for (int i=0;i<trust_track->size();i++ )
|
||||
{
|
||||
if((*trust_track)[i].Track_Index == tas_target_queue[0].Index)
|
||||
{
|
||||
if((*trust_track)[i].Track_Index == tas_target_queue[0].Index)
|
||||
{
|
||||
H_track = (*trust_track)[i].Height;
|
||||
for(int ii=0;ii<6;ii++)
|
||||
X_now[ii]=(*trust_track)[i].X[ii];
|
||||
}
|
||||
H_track = (*trust_track)[i].Height;
|
||||
for(int ii=0;ii<6;ii++)
|
||||
X_now[ii]=(*trust_track)[i].X[ii];
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
//预测目标位置 计算跟踪波束波位号 俯仰角
|
||||
|
||||
Reference in New Issue
Block a user