增加起track_init中航屏蔽区域
Signed-off-by: Yang Jianchao <yangjianchao999@126.com>
This commit is contained in:
@@ -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()
|
||||
|
||||
Reference in New Issue
Block a user