通过AD7606采集信号测通道信号频率

想通过AD7606采集信号，然后测频率，芯片是STM32F405; 但测不准，下面是代码（纯萌新，望大神指点）频率是0-15KHZ

void AD7606_SetRange(uint8_t range)//选择1=10v或0=5v
{
	if(range == 1)
	{
		AD7606_RANG_H();//10v
	}
	else AD7606_RANG_L();//5v
}


void AD7606_Reset(void)//复位
{
	AD7606_RST_L();
	
	AD7606_RST_H();
	AD7606_RST_H();
	AD7606_RST_H();
	AD7606_RST_H();
	AD7606_RST_H();
	
	AD7606_RST_L();

}

void AD7606_Init(void)//初始化
{
	AD7606_SetRange(0);//选择1=10v或0=5v
	AD7606_Reset();//复位
  AD7606_COV_H();//CONVSTA/B  置高电平,AD转换开始
	AD7606_CS_H();//拉高片选，暂时不接收
	AD7606_Read();
}

void AD7606_Start(void)//启动转换信号
{	
	AD7606_COV_L();
	AD7606_COV_L();
	Step_delay(10);
	
	AD7606_COV_H();
	AD7606_COV_H();
}

uint16_t AD7606_ReadByte(void)//读2字节  16位的AD7606  读16位 一个通道的数据 调用前要判断BUSY是否为低电平
{
	uint16_t ReadData = 0;
	uint8_t i; 
	for (i = 0; i < 16; i++)
	{	
    
		AD7606_CLK_L();          // 时钟拉低
    Step_delay(10);          // 保持低电平时间
		ReadData = ReadData << 1;
		if(READ_AD7606_OUTA())//只通过AD7606_DOUTA-->PA1读取
		{
			ReadData += 1; // 设置最低位
		}
		AD7606_CLK_H(); 
		Step_delay(10);
	}
	return ReadData;		
}

void AD7606_Read(void)
{
	uint8_t j=0;
  
	AD7606_CS_L();//拉低片选  开始读取	
	for(j=0;j<8;j++)//分了AB 两个同时读最大为4  此处只用A为  8
		{
			AD7606_Hexdata[j] = AD7606_ReadByte();//将数据移到AD7606_Hexdata[j]数组
		}
	AD7606_CS_H();//拉高片选  停止读取	
  AD7606_Start();		
 
}


void AD7606_DataTreat(void)//将源数据转为电压数据
{
	 uint8_t fushu_flag = 0;
	 for(uint8_t i=0;i<8;i++)
			{
				if(AD7606_Hexdata[i] >> 15 == 1)//判断最高位是否为1
				{
					fushu_flag = 1;//负数标志位置1
				}
				AD7606_Hexdata[i] &= 0x7fff;//将最高位屏蔽掉
				AD7606_Voltagedata[i] = (AD7606_Hexdata[i] * 5.0) / 32767;//5V量程 将数据转换为电压
				if(fushu_flag == 1)//对正负数进行判断
				{
					fushu_flag = 0;
					AD7606_Voltagedata[i] = -AD7606_Voltagedata[i];
				}
			}

}

//将100的电压数据放在float AD7606_Voltagedata_TS[8][100]里面
void AD7606_CollectSamples(uint16_t sample_count) //uint16_t sample_count采集指定次数
{
	
    for (uint16_t i = 0; i < sample_count; i++) 
	{
        // 等待BUSY信号为低电平（确保数据就绪）
        while (READ_AD7606_BUSY() == SET);  // 等待BUSY为低
        
        AD7606_Read();          // 读取原始数据到AD7606_Hexdata
        AD7606_DataTreat();     // 转换为电压数据到AD7606_Voltagedata
        
        // 将当前电压数据存入临时存储数组
        for (uint8_t ch = 0; ch < 8; ch++) 
		    {
            AD7606_Voltagedata_TS[ch][i] = AD7606_Voltagedata[ch];
        }
        
   }
}

// 函数：基于过零检测计算频率
void AD7606_CalculateFrequency(float sampling_interval) //float sampling_interval  采样间隔
{
    for (uint8_t ch = 0; ch < 8; ch++) {  // 遍历8个通道
        int zero_crossings = 0;           // 过零次数计数器
        
        // 遍历100个样本，检测过零事件
        for (int i = 1; i < 100; i++) {
            float prev = AD7606_Voltagedata_TS[ch][i-1];
            float current = AD7606_Voltagedata_TS[ch][i];
            
            // 检测正到负或负到正的过零
            if ((prev > 0 && current < 0) || (prev < 0 && current > 0)) {
                zero_crossings++;
            }
        }
        
        // 计算频率（单位：Hz）
        if (zero_crossings > 2) {  // 确保有效过零次数
            float total_time = 100 * sampling_interval;      // 总采样时间
            float cycles = zero_crossings / 2.0;             // 完整周期数（每个周期两次过零）
            AD7606_Frequency[ch] = cycles / total_time;      // 频率 = 周期数 / 总时间
        } else {
            AD7606_Frequency[ch] = 0.0;  // 无有效信号
        }
    }
}