增加起track_init中航屏蔽区域

Signed-off-by: Yang Jianchao <yangjianchao999@126.com>
This commit is contained in:
Yang Jianchao
2022-05-31 15:29:29 +08:00
parent 5e5ddf0d7b
commit 06938b23f6
3 changed files with 21 additions and 2 deletions
@@ -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>
+18 -1
View File
@@ -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()
+2
View File
@@ -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;
};