#include "UWater_gp22_app.h" #include "UWater_lcd_app.h" #include "UWater_frame_app.h" #include "UWater_TemperatureCalculate_app.h" #include "UWater_gp22_driver.h" #include "UWater_rtcc_driver.h" //0-100℃对应的超声波速度 单位m/s const float sound_speed_in_water[101]= {1402.336, 1407.31196 ,1412.173988,1416.924022,1421.563966,1426.095691, 1430.521033,1434.841795,1439.059749,1443.176633,1447.194154, 1451.113987,1454.937777,1458.667135,1462.303645,1465.84886 , 1469.304301,1472.671463,1475.95181 ,1479.146777,1482.257772, 1485.286175,1488.233337,1491.100583,1493.889211,1496.600493, 1499.235674,1501.795973,1504.282585,1506.69668 ,1509.039401, 1511.311869,1513.515181,1515.65041 ,1517.718606,1519.720794, 1521.657981,1523.531149,1525.341257,1527.089246,1528.776035, 1530.40252 ,1531.969579,1533.478071,1534.928834,1536.322685, 1537.660427,1538.942839,1540.170687,1541.344717,1542.465656, 1543.534218,1544.551096,1545.51697 ,1546.432504,1547.298344, 1548.115124,1548.88346 ,1549.603957,1550.277204,1550.903775, 1551.484234,1552.01913 ,1552.508999,1552.954367,1553.355746, 1553.713636,1554.028529,1554.300904,1554.53123 ,1554.719965, 1554.86756 ,1554.974453,1555.041077,1555.067854,1555.055198, 1555.003516,1554.913207,1554.784663,1554.61827 ,1554.414405, 1554.173443,1553.89575 ,1553.581689,1553.231616,1552.845885, 1552.424843,1551.968835,1551.478204,1550.953285,1550.394416, 1549.801928,1549.176154,1548.517423,1547.826062,1547.102399, 1546.346762,1545.559476,1544.740868,1543.891267,1543.011 , }; #if WENDU_FANSUAN_OPEN /*-----------------------------------------------------------------------------*/ TEMP_IVVERSE_UNION_MSG temp_inverse_struct_msg;//温度反算对外消息联合体 Temp_Inverse_Data1 Temp_Inverse_Data;//反算温度对于单程时间处理 //单程时间滤波相关参数 u32 gp30_tof_up_down_head =0;// u32 gp30_tof_up_down_length=0; u32 gp30_tof_up_data[MAX_TEMP_NUM]; //用于采集up单程时间 2020-12-05 u32 gp30_tof_down_data[MAX_TEMP_NUM]; //用于采集up单程时间 2020-12-05 u32 gp30_tof_up_filter_value =0;//up滤波值 u32 gp30_tof_down_filter_value =0;//down滤波值 //单程时间校准插值相关参数 u8 gp30_tof_buchang_head =0; u8 gp30_tof_buchang_length =0; float gp30_tof_up_chazhi_filter_value =0;//up滤波值 float gp30_tof_down_chazhi_filter_value =0;//down滤波值 float gp30_tof_up_buchang_data[MAX_TOF_BUCHANG_NUM]={0}; float gp30_tof_down_buchang_data[MAX_TOF_BUCHANG_NUM]={0}; u8 tof_caliberate_state = TOF_BUCHANG_IDLE;//空闲状态不采集数据 //单程时间原始数据存储BUF static u32 s_g_fhl_tof_up_data[GP22_APP_TEMP_INVERSE_DATA_SIZE_FIVE]={0}; //FHL_TOF_UP采集队列 static u32 s_g_fhl_tof_down_data[GP22_APP_TEMP_INVERSE_DATA_SIZE_FIVE]={0}; //FHL_TOF_DOWN采集队列 u32 tof_down_data[MAX_TEMP_NUM]={0};//记录down的单程时间中与UP单程时间对应位置的数据 //继承变量 extern GP30_SYS_Date gp22_app_data; //gp22当前数据 extern GP30_SYS_Date gp22_test_data; //gp22检定状态下当前数据 extern GP30_APP_SAVE_DATA g_sample_save_data; //当前数据备份 extern u32 s_g_up_am[GP22_APP_TEMP_INVERSE_DATA_SIZE+GP22_APP_TEMP_INVERSE_DATA_SIZE]; //am采集队列 数组中前4个存储第4~第7个波形振幅，后4个存储第8~第11个波形振幅 extern u32 s_g_down_am[GP22_APP_TEMP_INVERSE_DATA_SIZE+GP22_APP_TEMP_INVERSE_DATA_SIZE]; //down采集队列 数组中前4个存储第4~第7个波形振幅，后4个存储第8~第11个波形振幅 extern float temp_calculate_last; /*-----------------------------------------------------------------------------*/ /*温度反算流程第一步：单程时间与振幅数据采集与处理*/ /**************************************************************** Function: void Tof_And_AM_Data_Collect(u8 i,u32 s_g_tof_am_pointer) Description: 采集GP30给的up和down单程时间、up和down对应的振幅 函数性质： 外部接口函数 *****************************************************************/ void Tof_And_AM_Data_Collect(u8 i,u32 s_g_tof_am_pointer) { u32 s_g_tof_am_data[GP22_APP_QUEUE_SIZE]={0}; s_g_tof_am_data[i] = s_g_tof_am_pointer; s_g_tof_am_data[i] = (s_g_tof_am_data[i] & 0x000000FFU) << 24 | (s_g_tof_am_data[i] & 0x0000FF00U) << 8 | (s_g_tof_am_data[i] & 0x00FF0000U) >> 8 | (s_g_tof_am_data[i] & 0xFF000000U) >> 24; //大小端转换 //温度反算传上来的TOF值和振幅值处理（详见设计文档里传输的数据内容） if((0==i%GP22_APP_TEMP_INVERSE_DATA_SIZE)&&(i!=GP22_APP_QUEUE_SIZE-1))//传输的第1 4 7 10 13个数据为FHL 5-9波的up单程时间 { s_g_fhl_tof_up_data[i/GP22_APP_TEMP_INVERSE_DATA_SIZE]=s_g_tof_am_data[i];//传输的第1 4 7 10 个数据为FHL 5-9波的up单程时间 } else if(1==i%GP22_APP_TEMP_INVERSE_DATA_SIZE)//传输的第2 5 8 11 14 个数据为FHL 5-9波的down单程时间 { s_g_fhl_tof_down_data[i/GP22_APP_TEMP_INVERSE_DATA_SIZE]=s_g_tof_am_data[i];//传输的第2 5 8 11 14 个数据为FHL 5-9波的down单程时间 } else if((2==i%GP22_APP_TEMP_INVERSE_DATA_SIZE)||(i==GP22_APP_QUEUE_SIZE-1))//传输的第3 6 9 12 15 16 个数据为FHL 5-10波的up(左移16位高16)|down(低16位)单程时间 { s_g_up_am[i/GP22_APP_TEMP_INVERSE_DATA_SIZE]=s_g_tof_am_data[i]>>16;//获取UP的振幅 if(0xF000==(s_g_up_am[i/GP22_APP_TEMP_INVERSE_DATA_SIZE]&0xF000))//如果振幅F开头说明是负的振幅，负振幅处理为0 { s_g_up_am[i/GP22_APP_TEMP_INVERSE_DATA_SIZE]=0; } s_g_down_am[i/GP22_APP_TEMP_INVERSE_DATA_SIZE]=s_g_tof_am_data[i]&0x0000FFFF;//获取DOWN的振幅 if(0xF000==(s_g_down_am[i/GP22_APP_TEMP_INVERSE_DATA_SIZE]&0xF000))//如果振幅F开头说明是负的振幅，负振幅处理为0 { s_g_down_am[i/GP22_APP_TEMP_INVERSE_DATA_SIZE]=0; } } } /**************************************************************** Function: void Tof_Calcuate_Average(u32 *tof_up, u32 *tof_down, u8 data_len) Description: 分别对up 和Down 单程时间求取平均值 函数性质： 内部函数 *****************************************************************/ void Tof_Calcuate_Average(u32 *tof_up, u32 *tof_down, u8 data_len) { u8 i = 0; u32 sum_tof_up=0,sum_tof_down=0; for(i = 0;i< data_len;i++) { sum_tof_up += tof_up[i];//求取UP单程时间均值 sum_tof_down += tof_down[i];//求取Down单程时间均值 } if((sum_tof_up!=0)&&(sum_tof_down!=0))//无水情况下 单程时间为零 { gp22_test_data.s.TOF_up = (sum_tof_up/data_len)-TOF_6_US;//将up的单程时间平均值与6us做差后给到TOF_UP gp22_test_data.s.TOF_down = (sum_tof_down/data_len)-TOF_6_US;//将up的单程时间平均值与6us做差后给到TOF_DOWN } else { gp22_test_data.s.TOF_up = 0; gp22_test_data.s.TOF_down=0; } } /**************************************************************** Function: AM_Calcuate_Average(u32 *up_am, u32 *down_am, u8 data_len) Description: 分别对up 和Down 振幅求取平均值 函数性质： 内部函数 *****************************************************************/ void AM_Calcuate_Average(u32 *up_am, u32 *down_am, u8 data_len) { u8 i = 0,down_am_cnt=0,up_am_cnt=0; u32 sum_am_up=0,sum_am_down=0; for(i = 0;i< data_len;i++) { if((s_g_up_am[i]>0)&&(s_g_up_am[i]0)&&(s_g_down_am[i]=tof_max)) { tof_max = tof_down_data[i]; } if((tof_down_data[i]<=tof_min)) { tof_min = tof_down_data[i]; } } //判定 for(i=0;imin_count) { len = max_count; sum = sum_max ; tof_current = sum / len;//计算本次单程时间滤波值 } else { len = min_count; sum = sum_min; tof_current = sum / len;//计算本次单程时间滤波值 } //先判断合法性，再进行赋值 if(tof_current!=0) { tof_down_last = tof_current; //存储上次的单程时间滤波值 } else { tof_current = tof_down_last; } return tof_current; } /**************************************************************** Function: 单程时间滤波函数 Description:*p 指向单程时间数组首地址 len 数据长度 flag 0:tof_up 1:tof_down 函数性质： 内部函数 *****************************************************************/ u32 Filter_FOR_TOFUP(u32 *tof_up, u32 *tof_down, u8 len) // { u8 i,max_count=0,min_count=0;//max_count:记录大数单程时间个数 min_count:记录小数单程时间个数 u32 sum=0,sum_max=0,sum_min=0,tof_max=0,tof_min=0,tof_dif_max=0,tof_dif_min=0,tof_current=0;/*sum:单程时间累加和;sum_max：大数单程时间之间累加和 sum_min：大数单程时间之间累加和 tof_max:最大单程时间 tof_min:最小单程时间 tof_dif_max：最大单程时间与各个单程时间的差值 tof_dif_min:最大单程时间与各个单程时间的差值 tof_current: 本次计算得到的单程时间*/ static u32 tof_up_last=0;//记录up和down的上次数值的单程时间 u32 temp_max[MAX_TEMP_NUM]={0},temp_min[MAX_TEMP_NUM]={0};//统计 tof_max = tof_up[0]; tof_min = tof_up[0]; if(len==1) { tof_current = tof_up[0]; tof_up_last = tof_current; //存储上次的单程时间滤波值 tof_down_data[0] = tof_down[0];// return tof_current; } //找到最大 最小值 for(i=0;i=tof_max)) { tof_max = tof_up[i]; } if((tof_up[i]<=tof_min)) { tof_min = tof_up[i]; } } //查看最大和最小值是否同为一个量级 for(i=0;imin_count) { len = max_count; sum = sum_max ; tof_current = sum / len;//计算本次单程时间滤波值 memcpy(tof_down_data,temp_max,MAX_TEMP_NUM*4); } else { len = min_count; sum = sum_min; tof_current = sum / len;//计算本次单程时间滤波值 memcpy(tof_down_data,temp_min,MAX_TEMP_NUM*4); } //先判断合法性，再进行赋值 if(tof_current!=0) { tof_up_last = tof_current; //存储上次的单程时间滤波值 } else { tof_current = tof_up_last; } return tof_current; } /*************************************************************** 函数名称： Gp30_TOF_and_DOWN_Data_Collect(void) 功 能； 单程时间采集与处理函数 1、单程时间采集 2、单程时间滤波 函数性质： 外部接口函数 ****************************************************************/ void Gp30_Tof_Collect_and_Deal() { Tof_Calcuate_Average(s_g_fhl_tof_up_data,s_g_fhl_tof_down_data,5);//对单程时间进行滤波 Gp30_Tof_Save();//存储滤波后的单程时间 gp30_tof_up_filter_value = Filter_FOR_TOFUP(gp30_tof_up_data,gp30_tof_down_data,gp30_tof_up_down_length);// gp30_tof_down_filter_value = Filter_FOR_TOFDOWN(tof_down_data,gp30_tof_up_down_length);// AM_Calcuate_Average(s_g_up_am,s_g_down_am,6);//振幅均值计算 } /*温度反算流程第二步：1、单程时间校准 2、校准后单程时间进行计算温度*/ /*************************************************************** 函数名称： 单程时间校准函数 功 能； time_dof_temp_float 用于计算流速 time_tof_up_float：Up单程时间 time_tof_up_float：Down单程时间 函数性质： 内部函数 ****************************************************************/ void Water_Meter_Caliberate(u32 time_dof,float time_tof_up_float,float time_tof_down_float) { float time_tof_up_xishu = 0,time_tof_down_xishu = 0; float temp_jiaozhun=0;//获取表计校准温度 float sound_speed_C = 0;//声速 float calculate_decimal ; //温度的小数部分 float time_tof_up_float_jiaozhun_value =0;//校准的UP单程时间 float time_tof_down_float_jiaozhun_value =0;//校准的DOWN单程时间 u8 calculate_num=0; float time_dof_temp_float=0; if(tof_caliberate_state==TOF_BUCHANG_START_SAMPLE)//表计如果处于采样状态就进行 { temp_jiaozhun = Get_Temperature_Caliberate();//获取台子下发的温度值---待接收接口函数 if((temp_jiaozhun < 0) || (temp_jiaozhun > 100)) //异常温度判断，防止数组越界 { sound_speed_C = sound_speed_in_water[20]; } else { calculate_num = (u8) (temp_jiaozhun); //查表位置 calculate_decimal = temp_jiaozhun - calculate_num; //温度的小数部分 sound_speed_C = sound_speed_in_water[calculate_num] + calculate_decimal * (sound_speed_in_water[calculate_num + 1] - sound_speed_in_water[calculate_num]); } time_dof_temp_float = Gp30DataToFloat(time_dof); //先把有效时间差转换成浮点数 time_dof_temp_float = time_dof_temp_float * (float)250;// 将us转换成真实的ns， /4 *1000=ns float ins_flow_rate_float = sound_speed_C * sound_speed_C * time_dof_temp_float * LEGENTH_SPEED_SOUND_DAOSHU;//C^2*(t2-t1)/2L---求得理论流速 m/s time_tof_up_float_jiaozhun_value = LEGENTH_SPEED_SOUND / (sound_speed_C+ins_flow_rate_float); //计算出UP单程时间us time_tof_down_float_jiaozhun_value = LEGENTH_SPEED_SOUND / (sound_speed_C-ins_flow_rate_float); //计算出DOWN单程时间us time_tof_up_xishu = time_tof_up_float-time_tof_up_float_jiaozhun_value;//表计实际的Up单程时间与理论单程时间进行做差 time_tof_down_xishu = time_tof_down_float-time_tof_down_float_jiaozhun_value;//表计实际的Down单程时间与理论单程时间进行做差 //以后需要添加分别Up和Down的合法性判断！！！ //合法性判断 if(((time_tof_down_xishu - time_tof_up_xishu)>(float)0.5)||((time_tof_down_xishu - time_tof_up_xishu)<(float)-0.5)) { time_tof_up_xishu = 0; time_tof_down_xishu = 0; } gp22_app_data.s.up_tof_dif.gp30_float = time_tof_up_xishu;//读取EE中存储的UP单程时间系数 gp22_app_data.s.down_tof_dif.gp30_float = time_tof_down_xishu;//读取EE中存储的DOWN单程时间系数 //补偿值进行滑动滤波----------------------- gp30_tof_up_buchang_data[gp30_tof_buchang_head] = gp22_app_data.s.up_tof_dif.gp30_float; //将单程时间存入到数组中 gp30_tof_down_buchang_data[gp30_tof_buchang_head]= gp22_app_data.s.down_tof_dif.gp30_float; //将单程时间存入到数组中 gp30_tof_buchang_head++; if(MAX_TOF_BUCHANG_NUM!=gp30_tof_buchang_head)//采样数组满了一次 { if(gp30_tof_buchang_length != MAX_TOF_BUCHANG_NUM)//当BUF中数据已经存满一次了 { gp30_tof_buchang_length = gp30_tof_buchang_head; } } else { gp30_tof_buchang_length = MAX_TOF_BUCHANG_NUM; } gp30_tof_buchang_head %= MAX_TOF_BUCHANG_NUM; //-------------防护收不到下发温度系数的情况发生!!!!!!! // if(gp30_tof_buchang_length == MAX_TOF_BUCHANG_NUM) // { // FrameClearMsgApp(MsgCaliberate);//清零单程时间校准标志 // GP30_tof_buchang_filter(NOT_ALLOW_CALIBREATE); // } } } /*************************************************************** 函数名称： 反算温度 功 能； time_dof_temp_float 用于计算流速 函数性质： 外部接口函数 ****************************************************************/ void Water_Meter_Temp_calculate(u32 time_dof_temp_float) { float time_tof_temp_float =0,temp_calculate_app=0,temp_buchang_chazhi=0,wendu=0;//time_tof_temp_float：up和Down 的单程时间倒数和变量 float time_tof_up_float =0,time_tof_down_float =0;//实时的单程时间 u32 heat_temp = 0; float heat_temp_xishu=0;//出口温度浮点数类型 if((gp22_test_data.s.TOF_up==0)||(gp22_test_data.s.TOF_down==0))//单程时间为0----认为是空管状态 { Temp_Inverse_Data.Temp_Inverse_Data.gp30_tof_up_filter_value_test = 0;//空管下UP单程时间清零 Temp_Inverse_Data.Temp_Inverse_Data.gp30_tof_down_filter_value_test = 0;//空管下DOWN单程时间清零 GP30_tof_buchang_filter(NOT_ALLOW_CALIBREATE);//这里可以有效预防NB上位机导致表计校准 return; } heat_temp = FrameCheckParaApp(FramePara_Tc0);//获取出口温度补偿系数 if(heat_temp >= 0x80000000)//判定补偿系数的正负号 { heat_temp &= 0x7FFFFFFF; heat_temp_xishu= 0- Gp30DataToFloat(heat_temp); } else { heat_temp_xishu = Gp30DataToFloat(heat_temp); } time_tof_up_float = Gp30DataToFloat(gp30_tof_up_filter_value)/(float)4; //UP单程时间---转化为us time_tof_down_float = Gp30DataToFloat(gp30_tof_down_filter_value)/(float)4;//Down单程时间---转化为us Water_Meter_Caliberate(time_dof_temp_float,time_tof_up_float,time_tof_down_float);//判断是否需要校准单程时间 //1、单程时间修正----- time_tof_up_float = time_tof_up_float - gp22_app_data.s.up_tof_dif.gp30_float; time_tof_down_float = time_tof_down_float - gp22_app_data.s.down_tof_dif.gp30_float; Temp_Inverse_Data.Temp_Inverse_Data.gp30_tof_up_filter_value_test = FloatToGp30Data(time_tof_up_float)*(float)4;//活塞台子的单程时间---GP30格式 Temp_Inverse_Data.Temp_Inverse_Data.gp30_tof_down_filter_value_test = FloatToGp30Data(time_tof_down_float)*(float)4;//活塞台子的单程时间---GP30格式 time_tof_temp_float = (float)1/time_tof_up_float+(float)1/time_tof_down_float;//单程时间转换 1/up + 1/down #if ROUND_LLGS_WDFS_DN15_BRASS_40KPA_GP30_32768 || Buxiugang_LLGS_WDFS_DN15_BXG_40KPA_GP30_32768 || Plastic_LLGS_WDFS_DN15_PALSTIC_40KPA_GP30_32768 if(time_tof_temp_float <= TOF_UP_DOWN_DAOSHUHE_LOW) //小于35度 { temp_calculate_app = (float)1164325060.28*time_tof_temp_float*time_tof_temp_float*time_tof_temp_float-(float)117666513.36*time_tof_temp_float*time_tof_temp_float + (float)3974951.33*time_tof_temp_float-(float)44879.30; } else if(time_tof_temp_float <= TOF_UP_DOWN_DAOSHUHE_MIDDLE) //35到45度 { temp_calculate_app = (float)18099447.719*time_tof_temp_float*time_tof_temp_float - (float)1264215.524*time_tof_temp_float +(float)22102.772; } else { temp_calculate_app = (float)93075924.43*time_tof_temp_float*time_tof_temp_float -(float)6658976.07*time_tof_temp_float +(float)119144.49; } #elif ROUND_LLGS_WDFS_DN20_BRASS_40KPA_GP30_32768 || Buxiugang_LLGS_WDFS_DN20_BXG_40KPA_GP30_32768 if(time_tof_temp_float <= TOF_UP_DOWN_DAOSHUHE_LOW) //小于35度 { temp_calculate_app = (float)1523999897.62*time_tof_temp_float*time_tof_temp_float*time_tof_temp_float-(float)147356593.93*time_tof_temp_float*time_tof_temp_float +(float) 4761092.78*time_tof_temp_float -(float)51396.5;//温度差值补偿 } else if(time_tof_temp_float <= TOF_UP_DOWN_DAOSHUHE_MIDDLE) //35到45度 { temp_calculate_app = (float)18709611.192*time_tof_temp_float*time_tof_temp_float -(float)1245577.831*time_tof_temp_float +(float)20757.105 ; } else { temp_calculate_app = (float)147329123.77*time_tof_temp_float*time_tof_temp_float -(float)10079793.85*time_tof_temp_float +(float)172450.97 ; } #endif temp_calculate_app = temp_calculate_app - temp_buchang_chazhi + heat_temp_xishu;//默认状况下温度系数为0 //3、温度合法性判断 temp_calculate_app = temp_calculate_app - wendu;//算出来温度---暂时不添加任何限制 if((temp_calculate_app<0)||(temp_calculate_app>60)) { temp_calculate_app = temp_calculate_last;// } else { #if Buxiugang_LLGS_WDFS_DN15_BXG_40KPA_GP30_32768 || Buxiugang_LLGS_WDFS_DN20_BXG_40KPA_GP30_32768 if(temp_calculate_app<(float)22.8) { temp_calculate_app=temp_calculate_app+((float)-0.05*temp_calculate_app+(float)1.54); //不锈钢22.8 - 0度之间需要进行补偿 } else { temp_calculate_app=temp_calculate_app+((float)-0.1296*temp_calculate_app+(float)3.3556); //不锈钢22.8 - 60度之间需要进行补偿 } #endif } temp_calculate_last = temp_calculate_app; // else // // { // temp_calculate_last = temp_calculate_app;//记录上次正常的温度数据-----从有水到无水时 用这个数据 // } } /******************************************************************************* * @fun_name: TempInverseSetMsgApp * @brief : 置起反算消息类型 * 函数性质 : 外部接口函数 ******************************************************************************/ void TempInverseSetMsgApp(TempInverse_MsgTypeDef msgType) { if(msgType3) { for(i=0;i=temp_max)) { temp_max = p[i]; } if((p[i]<=temp_min)) { temp_min = p[i]; } sum += p[i]; } tof_current = (sum-temp_min-temp_max) / (len-2);//计算本次单程时间差值滤波值 } else //用实时数据 { tof_current = p[len-1]; } return tof_current; } /**************************************** Function: GP30_tof_buchang_filter Description: 开启和关闭单程时间校准补偿 Return: 0 启动单程时间差值校准 1：停止单程时间差值校准 2：空管状态下清零校准 3:反算温度滤波 Others: 外部接口函数 ****************************************************************/ void GP30_tof_buchang_filter(u8 flag) { u8 i=0; switch (flag) { case START_CALIBREATE: { gp30_tof_buchang_head = 0;//数值指针头结点 gp30_tof_buchang_length = 0;//数据长度 gp30_tof_up_chazhi_filter_value =0;//up滤波值 gp30_tof_down_chazhi_filter_value =0;//down滤波值 gp22_app_data.s.up_tof_dif.gp30_float = 0;//清零单程时间差值数据 gp22_app_data.s.down_tof_dif.gp30_float = 0;//清零单程时间差值数据 for(i=0;iTOF_COMPENSATION_COEFFICIENT)||((gp30_tof_down_chazhi_filter_value)>TOF_COMPENSATION_COEFFICIENT)|| \ ((gp30_tof_up_chazhi_filter_value)< -TOF_COMPENSATION_COEFFICIENT)||((gp30_tof_down_chazhi_filter_value)<-TOF_COMPENSATION_COEFFICIENT)) { gp30_tof_up_chazhi_filter_value = 0; gp30_tof_down_chazhi_filter_value = 0; } gp22_app_data.s.up_tof_dif.gp30_float = gp30_tof_up_chazhi_filter_value; gp22_app_data.s.down_tof_dif.gp30_float = gp30_tof_down_chazhi_filter_value; } } break; } case NOT_ALLOW_CALIBREATE: { tof_caliberate_state = TOF_BUCHANG_IDLE;//空闲状态 gp22_app_data.s.up_tof_dif.gp30_float = g_sample_save_data.s.up_tof_dif.gp30_float;// gp22_app_data.s.down_tof_dif.gp30_float = g_sample_save_data.s.down_tof_dif.gp30_float; break; } default: { break; } } } /**************************************************************** Function: GetTemperatureCalculateParameter Description: 获取反算参数 包括up单程时间、down单程时间、up振幅均值、down振幅均值 函数性质： 外部接口函数 *****************************************************************/ u32 GetTemperatureCalculateParameter(u8 flag) { if(flag < TemperatureCalculateParameterTotal) { return Temp_Inverse_Data.Temp_Inverse[flag]; } else { return ERROR; } } /**************************************************************** Function: void Description: 反算校准超时查询函数 函数性质： 外部接口函数 *****************************************************************/ void FanSuan_Caliberate_Timeout(void) { if(TRUE == FrameCheckMsgApp(MsgCaliberate))//单程时间校准标志查询 { if(0==RtccCheckTimer(RTCC_TOF_CALIBERATE_TIME))//90s校准超时时间到 { FrameClearMsgApp(MsgCaliberate);//清零单程时间校准标志 GP30_tof_buchang_filter(NOT_ALLOW_CALIBREATE); } } } #endif