增加起track_init中航屏蔽区域
Signed-off-by: Yang Jianchao <yangjianchao999@126.com>
This commit is contained in:
@@ -1,6 +1,6 @@
|
||||
<?xml version="1.0" encoding="UTF-8"?>
|
||||
<!DOCTYPE QtCreatorProject>
|
||||
<!-- Written by QtCreator 4.0.2, 2022-05-27T22:33:05. -->
|
||||
<!-- Written by QtCreator 4.0.2, 2022-05-31T14:55:07. -->
|
||||
<qtcreator>
|
||||
<data>
|
||||
<variable>EnvironmentId</variable>
|
||||
|
||||
@@ -426,7 +426,7 @@ void Track_Init::tmp_track_to_trust_track(QVector <QVector<Trust_Track>> *tru
|
||||
int L=(*Iter).size();
|
||||
float range=(*Iter)[L-1].r;
|
||||
float azi=(*Iter)[L-1].azi/PI*180;
|
||||
if( ( L==Work_Parameter.track_start_point_num)) //按长度查找TRUST_TRACK_POINT
|
||||
if( ( L==Work_Parameter.track_start_point_num)&& track_init_prohibit(range,azi,Work_Parameter)==0) //按长度查找TRUST_TRACK_POINT
|
||||
{
|
||||
if(trust_track->size()<MAX_TRACK_INDEX)
|
||||
{
|
||||
@@ -593,6 +593,23 @@ void Track_Init::tmp_track_die(QVector <QVector<Temp_track>> *temp_track)
|
||||
|
||||
|
||||
|
||||
int Track_Init::track_init_prohibit(float r, float azi, struct RadarPara Work_Parameter)
|
||||
{
|
||||
|
||||
|
||||
for (int i=0;i<Work_Parameter.track_prohibite_area_num;i++)
|
||||
{
|
||||
if(r<Work_Parameter.R_max_track_prohibited[i] && r>Work_Parameter.R_min_track_prohibited[i] && azi<Work_Parameter.Azimuth_max_track_prohibited[i] && azi>Work_Parameter.Azimuth_min_track_prohibited[i])
|
||||
{
|
||||
return 1;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
Track_Init::Track_Init()
|
||||
|
||||
@@ -49,6 +49,8 @@ private:
|
||||
|
||||
double alpha_cal_track_init(float x0,float y0,float x1,float y1,float x2,float y2); //计算夹角
|
||||
|
||||
int track_init_prohibit(float r, float azi, struct RadarPara Work_Parameter); //判断目标是否位于航迹起始屏蔽区 是返回1 否返回0
|
||||
|
||||
Track_Ind_Mangement track_index_mangement;
|
||||
|
||||
};
|
||||
|
||||
Reference in New Issue
Block a user