dengcy
/
micro_climate
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

补偿FIR滤波器的相位延时

This commit is contained in:
hua buduo 2024-11-15 22:23:20 +08:00
parent 44d1520ac2
commit 3d1d4ef834
3 changed files with 10 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
App/Src/anemometer_dev.c
View File

@ -121,9 +121,9 @@ float32_t cal_tof(q15_t* x,uint32_t len)
/*****************滤波器**********/
arm_mean_q15(x,50,&dc_offset);
// 信号减去直流分量
arm_offset_q15(x,-dc_offset,x,len);
// arm_mean_q15(x,50,&dc_offset);
// // 信号减去直流分量
// arm_offset_q15(x,-dc_offset,x,len);
// 转换成浮点数
// arm_q15_to_float(x,buf,len);
@ -423,8 +423,8 @@ void wind_task(void const * argument)
// dtof = 0;
}else{
// 计算成us
tofx = (tofx/ADC_SAMP_RATE_MHz)+REV_MUTE_DELAY_US-1.0f/DRIVE_FREQ_MHz+0.0001f;
tofy = (tofy/ADC_SAMP_RATE_MHz)+REV_MUTE_DELAY_US-1.0f/DRIVE_FREQ_MHz+0.0001f;
tofx = ((tofx-FIR_PHASE_DELAY)/ADC_SAMP_RATE_MHz)+REV_MUTE_DELAY_US-1.0f/DRIVE_FREQ_MHz+0.0001f;
tofy = ((tofy-FIR_PHASE_DELAY)/ADC_SAMP_RATE_MHz)+REV_MUTE_DELAY_US-1.0f/DRIVE_FREQ_MHz+0.0001f;
// 通过各通道渡越时间求时间差
dtof = tofx-tofy;
@ -470,8 +470,8 @@ void wind_task(void const * argument)
}else{
// 计算成us
tofx = tofx/ADC_SAMP_RATE_MHz+REV_MUTE_DELAY_US-1.0f/DRIVE_FREQ_MHz+0.000001f;
tofy = tofy/ADC_SAMP_RATE_MHz+REV_MUTE_DELAY_US-1.0f/DRIVE_FREQ_MHz+0.000001f;
tofx = ((tofx-FIR_PHASE_DELAY)/ADC_SAMP_RATE_MHz)+REV_MUTE_DELAY_US-1.0f/DRIVE_FREQ_MHz+0.000001f;
tofy = ((tofy-FIR_PHASE_DELAY)/ADC_SAMP_RATE_MHz)+REV_MUTE_DELAY_US-1.0f/DRIVE_FREQ_MHz+0.000001f;
// 通过各通道渡越时间求时间差
dtof = tofx-tofy;
}
@ -509,7 +509,7 @@ void wind_task(void const * argument)
av_speed = 0;
av_angle = 0;
}
/// term_printf("x:%.2f y:%.2f win_speed %.2f m/s angle %.2f \r\n",av_speedx,av_speedy,av_speed,av_angle);
term_printf("x:%.2f y:%.2f win_speed %.2f m/s angle %.2f \r\n",av_speedx,av_speedy,av_speed,av_angle);
}
///term_printf("win_speed %.2f \r\n",weather_info.wind_velocity);

2
Core/Src/main.c
View File

@ -121,7 +121,7 @@ void Flash_EnableReadProtection(void)
* @brief The application entry point.
* @retval int
*/
int main(void)
int main(void)
{
/* USER CODE BEGIN 1 */

1
Drivers/Filter/FIR.h
View File

@ -9,6 +9,7 @@
#define numTaps 60
#define FIR_PHASE_DELAY ((numTaps-2)/2)
//const float B[numTaps] = {
// 0.01000739448,-0.0008298238972,-0.002934818622,-0.005351484753,-0.006882067304,
// -0.006692492869,-0.004794952925,-0.002162534744,-0.000337747857,-0.0006400240236,