写在前面:(转载文章,若有不妥,通知后我会立即删除)
最近看了大神刘权写的《BLE4.0低功耗蓝牙协议总结》,感觉收获颇丰;
其中有一节是讲解蓝牙的自适应调频算法的,但是代码实现不方便阅读,原文是这样的:
小生不才,斗胆做了一下调整,还望大神海涵~
下面是整理之后的代码:
/*
* 函数名:
Data_Frequency_Channel_Choose -RADIO 调频计算函数,效果是计算出下一个频率通道和白化初始值
* 参数:
* -无
* 返回值:
* -无
*/
void Data_Frequency_Channel_Choose(void)
{
Data_frequency_map.Current_unmappedChannel = (Data_frequency_map.Last_UnmappedChannel + Data_frequency_map.Hop_Increment) % 37 ;
//这里得到的是接下来的频率通道号,能不能用?需要和 MAP 进行比较
Data_frequency_map.Last_UnmappedChannel = Data_frequency_map.Current_unmappedChannel ; //上一次的频道等于当前频道
while(1)
{
if (Data_frequency_map.Current_unmappedChannel < 8) //从第 0 个频道字节确定那个能用
{
if((Data_frequency_map.Channel_Map[0] >> Data_frequency_map.Current_unmappedChannel)& 0x01 ) //如果这个频道是可用的
{
Data_frequency_map.Current_Frequency_value = (Data_frequency_map.Current_unmappedChannel<<1)+4 ;
//得到真正的频率,可以直接赋值给 NRF_RADIO->FREQUENCY 寄存器
break; // 找到了可用的频道 并计算得到了实际寄存器的频率值后跳出循环
}
else //这个频道不可用需要重新映射
{
Data_frequency_map.Current_unmappedChannel=Data_frequency_map.Used_Channels[Data_frequency_map.Current_unmappedChannel \
% Data_frequency_map.Num_UsedChannels] ;
//这里得到的是接下来的频率通道号,能不能用?需要和 MAP 进行比较
}
}
else if(Data_frequency_map.Current_unmappedChannel < 16)//从第 1 个频道字节确定那个频道能用
{
if((Data_frequency_map.Channel_Map[1] >> (Data_frequency_map.Current_unmappedChannel- 8)) & 0x01 ) //如果这个频道是可用的
{
if(Data_frequency_map.Current_unmappedChannel < 11)
{
Data_frequency_map.Current_Frequency_value = (Data_frequency_map.Current_unmappedChannel<<1)+4 ;
//得到真正的频率,可以直接赋值给 NRF_RADIO->FREQUENCY 寄存器
}
else
{
Data_frequency_map.Current_Frequency_value = (Data_frequency_map.Current_unmappedChannel<<1)+6 ;
//得到真正的频率,可以直接赋值给 NRF_RADIO->FREQUENCY 寄存器
}
break; // 找到了可用的频道并计算得到了实际寄存器的频率值后跳出循环
}
else //这个频道不可用需要重新映射
{
Data_frequency_map.Current_unmappedChannel=Data_frequency_map.Used_Channels[Data_frequency_map.Current_unmappedChannel \
% Data_frequency_map.Num_UsedChannels] ;
//这里得到的是接下来的频率通道号,能不能用?需要和 MAP 进行比较
}
}
else if(Data_frequency_map.Current_unmappedChannel < 24) //从第 2 个频道字节确定那个频道能用
{
if((Data_frequency_map.Channel_Map[2] >> (Data_frequency_map.Current_unmappedChannel-16)) & 0x01 ) //如果这个频道是可用的
{
Data_frequency_map.Current_Frequency_value =(Data_frequency_map.Current_unmappedChannel<<1)+6 ;
//得到真正的频率,可以直接赋值给 NRF_RADIO->FREQUENCY 寄存器
break; // 找到了可用的频道并计算得到了实际寄存器的频率值后跳出循环
}
else //这个频道不可用需要重新映射
{
Data_frequency_map.Current_unmappedChannel=Data_frequency_map.Used_Channels[Data_frequency_map.Current_unmappedChannel \
% Data_frequency_map.Num_UsedChannels] ;
//这里得到的是接下来的频率通道号,能不能用?需要和 MAP 进行比较
}
}
else if(Data_frequency_map.Current_unmappedChannel < 32)//从第 3 个频道字节确定那个频道能用
{
if((Data_frequency_map.Channel_Map[3] >>(Data_frequency_map.Current_unmappedChannel- 24)) & 0x01 ) //如果这个频道是可用的
{
Data_frequency_map.Current_Frequency_value =(Data_frequency_map.Current_unmappedChannel<<1)+6 ;
//得到真正的频率,可以直接赋值给 NRF_RADIO->FREQUENCY 寄存器
break; // 找到了可用的频道并计算得到了实际寄存器的频率值后跳出循环
}
else //这个频道不可用需要重新映射
{
Data_frequency_map.Current_unmappedChannel=Data_frequency_map.Used_Channels[Data_frequency_map.Current_unmappedChannel \
% Data_frequency_map.Num_UsedChannels] ;
//这里得到的是接下来的频率通道号,能不能用?需要和 MAP 进行比较
}
}
else if(Data_frequency_map.Current_unmappedChannel < 40) //从第 4 个频道字节确定那个频道能用
{
if((Data_frequency_map.Channel_Map[4] >>(Data_frequency_map.Current_unmappedChannel- 32)) & 0x01 ) //如果这个频道是可用的
{
Data_frequency_map.Current_Frequency_value =(Data_frequency_map.Current_unmappedChannel<<1)+6 ;
//得到真正的频率,可以直接赋值给 NRF_RADIO->FREQUENCY 寄存器
break; // 找到了可用的频道并计算得到了实际寄存器的频率值后跳出循环
}
else //这个频道不可用需要重新映射
{
Data_frequency_map.Current_unmappedChannel=Data_frequency_map.Used_Channels[Data_frequency_map.Current_unmappedChannel \
% Data_frequency_map.Num_UsedChannels] ;
//这里得到的是接下来的频率通道号,能不能用?需要和 MAP 进行比较
}
}
}
NRF_RADIO->FREQUENCY = Data_frequency_map.Current_Frequency_value; //Actual frequency (MHz): 2400 + register value
NRF_RADIO->DATAWHITEIV = Data_frequency_map.Current_unmappedChannel; //白化数据寄存器初值为通道号
}