更新:1、增加扫描模式配置项;
2、优化不必要的宏定义; 3、合并机扫和相扫版本; Signed-off-by: waiwaylee <waiwaylee@foxmail.com>
This commit is contained in:
@@ -72,11 +72,16 @@ int Data_Process::data_preprocess(struct DataRev Data_Input[150])
|
||||
RDP_RECORD_POINTS(rec_points);
|
||||
#endif
|
||||
|
||||
#ifdef PHASE_SCANNING
|
||||
// 相扫模式下,判断前后两帧波位号的大小,来判断是否扫描一周完成
|
||||
if(Data_Input[0].Beam_index_aiz <= last_beam_num) //TWS
|
||||
// 判圈:扫描模式由配置参数 scan_mode 决定(0=相扫,1=机扫),替代原编译期 PHASE_SCANNING/MECHANICAL_SCANNING 分支。
|
||||
// 相扫:判断前后两帧波位号的大小,来判断是否扫描一周完成(当前波位号 <= 上一帧波位号即判满圈);
|
||||
// 机扫:可能存在转台反转导致波位号变小但并未扫描一周,因此改为波位号为 0 时判满圈。
|
||||
const bool circle_done = (rdp_parameter.scan_mode == 0)
|
||||
? (Data_Input[0].Beam_index_aiz <= last_beam_num) //TWS 相扫
|
||||
: (Data_Input[0].Beam_index_aiz == 0); //TWS 机扫
|
||||
|
||||
last_beam_num = Data_Input[0].Beam_index_aiz;
|
||||
if(circle_done)
|
||||
{
|
||||
last_beam_num = Data_Input[0].Beam_index_aiz;
|
||||
circle_id++;
|
||||
// std::cout << Data_Input[0].CPI_time << std::endl;
|
||||
// RDP_LOG<<"CPI_time: "<<Data_Input[0].CPI_time<<std::endl;
|
||||
@@ -84,25 +89,8 @@ int Data_Process::data_preprocess(struct DataRev Data_Input[150])
|
||||
}
|
||||
else
|
||||
{
|
||||
last_beam_num = Data_Input[0].Beam_index_aiz;
|
||||
return 2;
|
||||
}
|
||||
#else
|
||||
// 机扫模式下,可能存在转台反转的情况,导致波位号变小,但并未扫描一周,因此改为判断波位号为0时,表示扫描一周完成
|
||||
if(Data_Input[0].Beam_index_aiz == 0) //TWS
|
||||
{
|
||||
last_beam_num = Data_Input[0].Beam_index_aiz;
|
||||
circle_id++;
|
||||
// std::cout << Data_Input[0].CPI_time << std::endl;
|
||||
// RDP_LOG<<"CPI_time: "<<Data_Input[0].CPI_time<<std::endl;
|
||||
return 1;
|
||||
}
|
||||
else
|
||||
{
|
||||
last_beam_num = Data_Input[0].Beam_index_aiz;
|
||||
return 2;
|
||||
}
|
||||
#endif
|
||||
}
|
||||
else if(Data_Input[0].point_type == 1) //tas数据
|
||||
{
|
||||
|
||||
Reference in New Issue
Block a user