更新:1、修复kalman.cpp中部分参数命名冲突的问题;
2、TWS点迹关联时增加点航距离门限,限制部分突然关联到很远的点迹的问题。 Signed-off-by: waiwaylee <waiwaylee@foxmail.com>
This commit is contained in:
@@ -6,7 +6,7 @@
|
||||
#include "parameters.h"
|
||||
#include "struct.h"
|
||||
#include <QVector>
|
||||
|
||||
#include <QDebug>
|
||||
using namespace std;
|
||||
|
||||
|
||||
@@ -15,8 +15,7 @@ using namespace std;
|
||||
class Track_Asso
|
||||
{
|
||||
public:
|
||||
int track_asso_process(QVector<PointRecv> *point_recv_1, //点迹文件
|
||||
QVector<PointRecv> *point_recv_2,
|
||||
int track_asso_process(QVector <PointRecv> *point_recv, //点迹文件
|
||||
QVector <Trust_Track> *trust_track, //航迹文件
|
||||
struct Track Trust_Track_Output[MAX_TRACK_NUM][10], //更新航迹信息
|
||||
int *Trust_track_num_Output, //更新航迹数
|
||||
@@ -41,18 +40,18 @@ private:
|
||||
|
||||
void model_output(QVector <Trust_Track> *trust_track ); //模型输出
|
||||
|
||||
void IMM_d_cal(float v_track,
|
||||
float X1[6], float P1[6][6],
|
||||
float X2[6], float P2[6][6],
|
||||
float X3[6], float P3[6][6],
|
||||
float Z[3], float prt,float freq_ind,
|
||||
float delta_T,
|
||||
float *d1,float *d2,float *d3,
|
||||
void IMM_d_cal(double v_track,
|
||||
double X1[6], double P1[6][6],
|
||||
double X2[6], double P2[6][6],
|
||||
double X3[6], double P3[6][6],
|
||||
double Z[3], double prt,double freq_ind,
|
||||
double delta_T,
|
||||
double *d1,double *d2,double *d3,
|
||||
struct RadarPara Work_Parameter);
|
||||
|
||||
void IMM_F_Q_gen(float v_track, float delta_T,float F[6][6], float Q1[6][6], float Q2[6][6], float Q3[6][6],struct RadarPara Work_Parameter);
|
||||
void IMM_F_Q_gen(double v_track, double delta_T,double F[6][6], double Q1[6][6], double Q2[6][6], double Q3[6][6],struct RadarPara Work_Parameter);
|
||||
|
||||
float Pt[3][3]; //模型转移概率
|
||||
double Pt[3][3]; //模型转移概率
|
||||
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user