Signed-off-by: Yang Jianchao <yangjianchao999@126.com>

2022-05-19 09:58:30 +08:00
commit 591fa491e2
1946 changed files with 442413 additions and 0 deletions
@@ -0,0 +1,149 @@
+#include "dot_coh.h"
+#include <qmath.h>
+#include"memory.h"
+#include <QVector>
+using namespace std;
+
+
+int Dot_Coh::dot_coh_process(QVector <PointRecv>                *data_input,
+                             int                                beam_input[3],
+                             QVector <QVector<PointRecv>>	    *point_recv,
+                            struct  RadarPara                   Work_Parameter)
+{
+
+    //数据移动一位
+    for (int i=0;i<data_buffer_2.size();i++)		//data_buffer_2 ---> point_recv
+    {
+        (*point_recv)[floor(data_buffer_2[i].beam_index/BEAM_NUM_DOT_SECTION)].push_back(data_buffer_2[i]);
+    }
+    QVector<PointRecv>().swap(data_buffer_2);
+
+
+
+    for (int i=0;i<data_buffer_1.size();i++)		//data_buffer_1 ---> data_buffer_2
+    {
+        data_buffer_2.push_back(data_buffer_1[i]);
+    }
+    QVector<PointRecv>().swap(data_buffer_1);
+
+
+
+    for (int i=0;i<data_input->size();i++)			//data_input ---> data_buffer_1
+    {
+        data_buffer_1.push_back((*data_input)[i]);
+    }
+
+
+    //凝聚data_buffer_1 data_buffer_2中的数据
+     QVector <PointRecv> data_buffer;
+
+     for (int i=0;i<data_buffer_1.size();i++)
+         data_buffer.push_back(data_buffer_1[i]);
+
+     for (int i=0;i<data_buffer_2.size();i++)
+         data_buffer.push_back(data_buffer_2[i]);
+
+     QVector<PointRecv>().swap(data_buffer_1);
+     QVector<PointRecv>().swap(data_buffer_2);
+
+
+    if(data_buffer.size()>1)
+    {
+
+        for (unsigned int loop_of_point=0; loop_of_point<data_buffer.size()-1;loop_of_point++ )
+        {
+            if( data_buffer[loop_of_point].Use_Flag!=1)
+            {
+                float point_0_R=data_buffer[loop_of_point].Range;
+                float point_0_V=data_buffer[loop_of_point].Velocity;
+                float point_0_F=data_buffer[loop_of_point].Azimuth;
+                float point_0_A=data_buffer[loop_of_point].Amplitude;
+                for (unsigned int i=loop_of_point+1;i<data_buffer.size();i++)
+                {
+                    if(data_buffer[loop_of_point].Use_Flag!=1)
+                    {
+                        float point_1_R=data_buffer[i].Range;
+                        float point_1_V=data_buffer[i].Velocity;
+                        float point_1_F=data_buffer[i].Azimuth;
+                        float point_1_A=data_buffer[i].Amplitude;
+
+                        //凝聚条件： 距离、方位接近
+//                        if(Work_Parameter.work_mode == 0)
+//                        {
+                            if( (fabs(point_0_R-point_1_R)<=DOT_COH_RANGE && fabs(point_0_F-point_1_F) <=DOT_COH_AZI/180.0*PI && fabs(point_0_V-point_1_V)<=DOT_COH_V)//
+                                &&  point_0_A <point_1_A  )//
+                            {
+                                point_0_R=data_buffer[i].Range;
+                                point_0_V=data_buffer[i].Velocity;
+                                point_0_A=data_buffer[i].Amplitude;
+                                point_0_F=data_buffer[i].Azimuth;
+                                data_buffer[loop_of_point].Use_Flag=1;
+                            }
+                            else if( (fabs(point_0_R-point_1_R)<=DOT_COH_RANGE && fabs(point_0_F-point_1_F) <=DOT_COH_AZI/180.0*PI && fabs(point_0_V-point_1_V)<=DOT_COH_V)//
+                                &&  point_0_A >= point_1_A)//
+                            {
+                                data_buffer[i].Use_Flag=1;
+                            }
+//                        }
+//                        else
+//                        {
+//                            if( (fabs(point_0_R-point_1_R)<=DOT_COH_RANGE && fabs(point_0_F-point_1_F) <=DOT_COH_AZI/180.0*PI )//
+//                                &&  point_0_A <point_1_A  )//
+//                            {
+//                                point_0_R=data_buffer[i].Range;
+//                                point_0_V=data_buffer[i].Velocity;
+//                                point_0_A=data_buffer[i].Amplitude;
+//                                point_0_F=data_buffer[i].Azimuth;
+//                                data_buffer[loop_of_point].Use_Flag=1;
+//                            }
+//                            else if( (fabs(point_0_R-point_1_R)<=DOT_COH_RANGE && fabs(point_0_F-point_1_F) <=DOT_COH_AZI/180.0*PI )//
+//                                &&  point_0_A >= point_1_A)//
+//                            {
+//                                data_buffer[i].Use_Flag=1;
+//                            }
+
+
+
+//                        }
+                    }
+                }
+            }
+        }
+    }
+
+
+    //删除凝聚点 和 量程范围外点
+    QVector <PointRecv>::iterator Iter;
+    for (Iter=data_buffer.begin(); Iter!=data_buffer.end();)
+    {
+        if((*Iter).Use_Flag==1 || (*Iter).Range <R_MIN  ||  (*Iter).Range > R_MAX   )
+        {
+            data_buffer.erase(Iter);
+            Iter=data_buffer.begin();
+        }
+        else
+        {
+            Iter++;
+        }
+    }
+
+    //凝聚后的数据分别存入data_buffer_1 data_buffer_2
+    for(int i=0;i<data_buffer.size();i++)
+    {
+        if(data_buffer[i].beam_index == beam_input[0]
+        || data_buffer[i].beam_index == beam_input[1]
+        || data_buffer[i].beam_index == beam_input[2])
+            data_buffer_1.push_back(data_buffer[i]);
+        else
+            data_buffer_2.push_back(data_buffer[i]);
+    }
+
+    return 0;
+}
+
+
+
+Dot_Coh::Dot_Coh(void)
+{
+
+}