增加起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
+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()