BLE蓝牙协议 — 自适应调频算法简单实现

写在前面：（转载文章，若有不妥，通知后我会立即删除）

最近看了大神刘权写的《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; //白化数据寄存器初值为通道号
}