更新: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:
2026-07-06 14:21:49 +08:00
parent 28fcf06060
commit e9b8a3245a
9 changed files with 25 additions and 21 deletions
+6 -6
View File
@@ -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];
}
}
//预测目标位置 计算跟踪波束波位号 俯仰角