 #include "HS6220.H"
#include "key.H"
#include "extern.H"
extern word point;
byte rf_data_buf[32];



//byte tx_id[2];
byte rf_buf,rf_write_data_cnt;
byte rf_reg,rf_data;
byte DelayCnt;

/*******************************************************************************
* 名称: Delayus
* 功能: 延迟
* 形参:       
* 返回: 无
* 说明: 
*******************************************************************************/
void Delay100US(void)
{
	byte cnt;
	do
	{
		cnt = 70;
		do
		{
//		wdreset;
		}while(--cnt$0);
	}while(--DelayCnt$0);
}

//===============================================
//write into bk2421 abyte
//===============================================
void spi_Writeabyte(void)
{
//--------四线 SPI----------------------
/*
   byte k=8;
 //  PBC.2=1;
   .delay 10
   while(k)
   {     
	   spi_sck=0;               // _|~
	   if(rf_buf.7)
	     spi_mosi=1;
 	   else 
	     spi_mosi=0;
	  nop;
	   spi_sck=1;               // ~|_
 	   rf_buf<<=1;  	   
	   k--;
   }
   spi_sck=0;
   spi_mosi=0;
*/
//--------三线 SPI----------------------

   byte k=8;
   spi_mosi_c=1;

   .delay 10
   while(k)
   {     
	   spi_sck=0;               // _|~
	   if(rf_buf.7)
	     spi_mosi=1;
 	   else 
	     spi_mosi=0;
	   spi_sck=1;    
	   nop;
 	   rf_buf<<=1;  	   
	   k--;
   }
   spi_sck=0;
   spi_mosi=0;
   .delay 10
} 
//===============================================
//read from bk2421 abyte
//===============================================
void  spi_Readabyte(void)
{
//--------四线 SPI----------------------
/*
  byte k=8;
  // PAC.0=0;
 // paph.0 =1;
   .delay 10

  while(k)
  {
  	 rf_buf<<=1;
     spi_sck=1; 
     if(spi_miso)
	    rf_buf.0=1; //   rf_buf |=0x01;
     else
	    rf_buf.0=0; // rf_buf &=0xfe;
     spi_sck=0;
	 k--;
  }
*/
//--------三线 SPI----------------------
  byte k=8;
   spi_mosi_c=0;
   spi_mosi_h=1;
   .delay 10

  while(k)
  {
  	 rf_buf<<=1;
     spi_sck=1;
	 if(spi_mosi)
	    rf_buf.0=1; //   rf_buf |=0x01;
     else
	    rf_buf.0=0; // rf_buf &=0xfe;
     spi_sck=0;
	 k--;
  }

}
//===============================================
//write reg
//===============================================
void rf_write_onebyte(void)
{
	spi_csn=0;
	rf_buf=rf_reg;
	spi_Writeabyte();
	rf_buf=rf_data;
	spi_Writeabyte();
    spi_csn=1;
}
//===============================================
//write reg
//===============================================
void rf_read_onebyte(void)
{
	spi_csn=0;
	rf_buf=rf_reg;
	spi_Writeabyte();
	rf_buf=rf_data;
	spi_Readabyte();
    spi_csn=1;
		.delay 20	
}

//===============================================
//flush fifo
//===============================================
void flush_tx_fifo(void)
{
	spi_csn=0;
	rf_buf=HS6220_FLUSH_TX;
	spi_Writeabyte();
//	rf_buf=0;
//	spi_Writeabyte();
    spi_csn=1;
}
//===============================================
//flush fifo
//===============================================
void flush_rx_fifo(void)
{
	spi_csn=0;
	rf_buf=HS6220_FLUSH_RX;
	spi_Writeabyte();
//	rf_buf=0;
//	spi_Writeabyte();
    spi_csn=1;
}
//===============================================
//clear rf status flag
//===============================================
void clear_rf_status(void)
{
    spi_csn=0;
	rf_buf=0x27;  //HS6220_BANK0_STATUS
	spi_Writeabyte();
	rf_buf=0x70;
	spi_Writeabyte();
    spi_csn=1;

}
//===============================================
//get rf status flag
//===============================================
void get_rf_status_flag(void)
{
    spi_csn=0;
    rf_buf=0x07;
    spi_Writeabyte();
    spi_Readabyte();       //read rf status
    spi_csn=1;
}

//===============================================
//set_tx
//===============================================
void rf_tx_set(void)
{
    spi_csn=0;
	rf_buf=0x20;
	spi_Writeabyte();
	rf_buf=0xfa;
	spi_Writeabyte();
    spi_csn=1;
}
//===============================================
//set_rx
//===============================================
void rf_rx_set(void)
{
    spi_csn=0;
	rf_buf=0x20;
	spi_Writeabyte();
	rf_buf=0xfb;
	spi_Writeabyte();
    spi_csn=1;
}
//===============================================
//rf power up
//===============================================
void rf_power_up(void)
{
	rf_reg = HS6220_BANK0_CONFIG | HS6220_W_REGISTER;   rf_data =0Xfa;rf_write_onebyte();
	DelayCnt = 10;Delay100US();// 这个1ms的时间是必须的，等待晶体起振和RF芯片的一系列动作

	rf_reg = HS6220_BANK0_PMU_CTL | HS6220_R_REGISTER;   rf_data =0;rf_read_onebyte();
	rf_buf&=0xfc;
	rf_reg = HS6220_BANK0_PMU_CTL | HS6220_W_REGISTER;   rf_data =0xa8;rf_write_onebyte();

}
//===============================================
//rf power down
//===============================================
void rf_power_down(void)
{
	rf_reg = HS6220_BANK0_PMU_CTL | HS6220_R_REGISTER;   rf_data =0;rf_read_onebyte();
	rf_buf&=0xfc;
	rf_buf|=0x01;
	rf_reg = HS6220_BANK0_PMU_CTL | HS6220_W_REGISTER;   rf_data =rf_buf;rf_write_onebyte();
	DelayCnt = 10;Delay100US();// 这个1ms时间是必须要的，要等待RF完成一系列动作

	rf_reg = HS6220_BANK0_CONFIG | HS6220_W_REGISTER;   rf_data =0Xf8;rf_write_onebyte();
}

//===============================================
//ce low
//===============================================
void rf_ce_low(void)
{

    spi_csn=0;
	rf_buf=HS6220_CMD_CE_LOW;
	spi_Writeabyte();
    spi_csn=1;
}
//===============================================
//ce high
//===============================================
void rf_ce_high(void)
{
    spi_csn=0;
	rf_buf=HS6220_CMD_CE_HIGH;
	spi_Writeabyte();
    spi_csn=1;
}
//==============================================
//write rf_buf
//==============================================
void write_rf_data_buf(void)
{
     byte temp01_buf;

	 point=rf_data_buf;
	 temp01_buf=0;
	 while(temp01_buf<rf_write_data_cnt)
	 {
	     rf_buf=*point;  
         spi_Writeabyte();
	     point++;
	     temp01_buf++;
	 }
}
//==============================================
//write rf_buf
//==============================================
void read_rf_data_buf(void)
{
     byte temp01_buf;

	 point=rf_data_buf;
	 temp01_buf=0;
	 while(temp01_buf<rf_write_data_cnt)
	 {
	   //  rf_buf=;  
         spi_Readabyte();
		 *point=rf_buf;
	     point++;
	     temp01_buf++;
	 }
}

//==============================================
//write tx0_address
//==============================================
void write_tx0_address(void)
{
	 spi_csn=0;
	 rf_buf=0x30;       //write TX0 address
     spi_Writeabyte();
	 rf_write_data_cnt=5;
	 write_rf_data_buf();
     spi_csn=1;
}
//==============================================
//write rx0_address
//==============================================
void write_rx0_address(void)
{
	 spi_csn=0;
	 rf_buf=0x2a;     //write  rx address
     spi_Writeabyte();
	 rf_write_data_cnt=5;
	 write_rf_data_buf();
     spi_csn=1;
}

/*******************************************************************************
* 名称: HS6200_Bank_Select
* 功能: 
* 形参:       
* 返回: 无
* 说明: 
*******************************************************************************/
void rf_bank_Switch(void)
{
	byte bank = rf_buf;//保存选择blank

	get_rf_status_flag();
	
	if(bank == Rf_Bank1)//选择bank1
	{
		if(!(rf_buf.7)){
			rf_reg=HS6220_ACTIVATE; rf_data=HS6220_ACTIVATE_DATA; rf_write_onebyte();
		}
	}
	else
	{
		if(rf_buf.7){
			rf_reg=HS6220_ACTIVATE; rf_data=HS6220_ACTIVATE_DATA; rf_write_onebyte();
		}
	}
}

void hs6200_get_chip_ID(void)
{
	 rf_buf=Rf_Bank1; rf_bank_Switch();//切换到bank1
	while(1)
	{
	 spi_csn=0;
	 rf_buf=0x20;       //write TX0 address
     spi_Writeabyte();
	 rf_buf=0;
 	 spi_Readabyte();
	 rf_buf=0;
 	 spi_Readabyte();
     spi_csn=1;
	 if(rf_buf==1)
		 break;
	 .delay 100
	}

}


//===============================================
//初始化RF
//===============================================
extern byte mode_cnt;
void init_rf(void)
{   
	byte temp00,tmp_data;

	rf_reg=HS6220_BANK0_FEATURE+HS6220_W_REGISTER; rf_data=SOFT_RST;rf_write_onebyte();// soft_reset

	rf_reg=HS6220_BANK0_DYNPD+HS6220_W_REGISTER; rf_data=0x00;rf_write_onebyte();//三线通信
//	rf_reg=HS6220_BANK0_DYNPD+HS6220_W_REGISTER; rf_data=0x08;rf_write_onebyte();//四线通信

	rf_ce_low();
	rf_reg=HS6220_BANK0_CONFIG+HS6220_W_REGISTER; rf_data=0x8b;rf_write_onebyte();// power up
	DelayCnt = 30;Delay100US();// wait 3 ms
	rf_reg=HS6220_BANK0_PMU_CTL+HS6220_W_REGISTER; rf_data=0xac;rf_write_onebyte();// HS6220_PWRDWN = 00
	DelayCnt = 20;Delay100US();// wait 2 ms
	rf_reg=HS6220_BANK0_FEATURE+HS6220_W_REGISTER; rf_data=0x10;rf_write_onebyte();// VCO_AMP_TX_MUX = b'0, A2 don't need config this bit

	rf_buf=Rf_Bank1; rf_bank_Switch();//切换到bank1

	rf_reg=HS6220_BANK1_TEST_PKDET+HS6220_W_REGISTER; rf_data=0x20;rf_write_onebyte();// pll_vdiv2_sel = 01, A2 don't need config this bit

	spi_csn=0;
	rf_buf=HS6220_BANK1_FAGC_CTRL_1+HS6220_W_REGISTER;
	spi_Writeabyte();
//	rf_data_buf[2]=0x05;
//	rf_data_buf[1]=0xa0;
	rf_data_buf[0]=0x01;
	rf_write_data_cnt=1;
	write_rf_data_buf();
    spi_csn=1;
/*  
//************电机动作的时候 HS6220_BANK1_FAGC_CTRL_1按以下配置**********要先拉低CE，切换到Bank1去操作*****	
//*********** 6220为了提高抗干扰能力, 提高了 VCO的增益, 而这样做, 也增强了 本振泄露, 过认证又不好过了. 
//**********一个可行的解决办法:  接收小车在 马达转动的时候才提高VCO, 不转的时候恢复原来的值 	
	spi_csn=0;
	rf_buf=HS6220_BANK1_FAGC_CTRL_1+HS6220_W_REGISTER;
	spi_Writeabyte();
	rf_data_buf[1]=0xa1;
	rf_data_buf[0]=0xc1;
	rf_write_data_cnt=2;
	write_rf_data_buf();
    spi_csn=1;	
*/
    spi_csn=0;
	rf_buf=HS6220_BANK1_AGC_CTRL+HS6220_W_REGISTER;
	spi_Writeabyte();
	rf_data_buf[1]=0xb2;
	rf_data_buf[0]=0xcf;
	rf_write_data_cnt=2;
	write_rf_data_buf();
    spi_csn=1;

	rf_buf=Rf_Bank0; rf_bank_Switch();//切换到bank0
	rf_ce_high();
	DelayCnt = 2;Delay100US();// wait 100us
	rf_ce_low();// 一定要注意，校准的时候CE是低的

	while(1)
	{
		rf_reg=HS6220_BANK0_RF_SETUP+HS6220_R_REGISTER; rf_data=0x40;rf_read_onebyte();
		if(rf_buf.5)  break;
	}
	rf_reg=HS6220_BANK0_RF_SETUP+HS6220_W_REGISTER; rf_data=0x40;rf_write_onebyte();

	rf_buf=Rf_Bank1; rf_bank_Switch();//切换到bank1
    spi_csn=0;
	rf_buf=HS6220_BANK1_CAL_CTL+HS6220_W_REGISTER;
	spi_Writeabyte();
	rf_data_buf[2]=0x75;
	rf_data_buf[1]=0x98;
	rf_data_buf[0]=0x20;
	rf_write_data_cnt=3;
	write_rf_data_buf();
    spi_csn=1;
	/* increase fitler agc threshold start (A2 don't need config this bit)*/
/*
	spi_csn=0;
	rf_buf=HS6220_BANK1_FAGC_CTRL_1+HS6220_W_REGISTER;
	spi_Writeabyte();
	rf_data_buf[2]=0x05;
	rf_data_buf[1]=0xa0;
	rf_data_buf[0]=0x03;
	rf_write_data_cnt=3;
	write_rf_data_buf();
    spi_csn=1;

    spi_csn=0;
	rf_buf=HS6220_BANK1_AGC_CTRL+HS6220_W_REGISTER;
	spi_Writeabyte();
	rf_data_buf[1]=0xb2;
	rf_data_buf[0]=0xcf;
	rf_write_data_cnt=2;
	write_rf_data_buf();
    spi_csn=1;
*/	
	/* increase fitler agc threshold end (A2 don't need config this bit)*/

/*    spi_csn=0;
	rf_buf=HS6220_BANK1_RF_IVGEN+HS6220_W_REGISTER;
	spi_Writeabyte();
	rf_data_buf[2]=0x11;
	rf_data_buf[1]=0x04;
	rf_data_buf[0]=0x1f;
	rf_write_data_cnt=3;
	write_rf_data_buf();
    spi_csn=1;
*/
	rf_buf=Rf_Bank0; rf_bank_Switch();//切换到bank0

    spi_csn=0;
	rf_buf=HS6220_BANK0_RX_ADDR_P0+HS6220_W_REGISTER;
	spi_Writeabyte();
	rf_data_buf[0]=0x46;
	rf_data_buf[1]=0x0b;
	rf_data_buf[2]=0xaf;
	rf_data_buf[3]=0x43;
	rf_data_buf[4]=0x98;
	rf_write_data_cnt=5;
	write_rf_data_buf();
    spi_csn=1;

    spi_csn=0;
	rf_buf=HS6220_BANK0_TX_ADDR+HS6220_W_REGISTER;
	spi_Writeabyte();
	rf_data_buf[0]=0x46;
	rf_data_buf[1]=0x0b;
	rf_data_buf[2]=0xaf;
	rf_data_buf[3]=0x43;
	rf_data_buf[4]=0x98;
	rf_write_data_cnt=5;
	write_rf_data_buf();
    spi_csn=1;

	rf_reg=HS6220_BANK0_FEATURE+HS6220_W_REGISTER; rf_data=0x10;rf_write_onebyte();
	rf_reg=HS6220_BANK0_EN_AA+HS6220_W_REGISTER; rf_data=0x00;rf_write_onebyte();
	rf_reg=HS6220_BANK0_CONFIG+HS6220_W_REGISTER; rf_data=0xfa;rf_write_onebyte();
	rf_reg=HS6220_BANK0_RX_PW_P0+HS6220_W_REGISTER; rf_data=rx_lenth;rf_write_onebyte();
	rf_reg=HS6220_BANK0_RF_CH+HS6220_W_REGISTER; rf_data=45;rf_write_onebyte();
	rf_reg=HS6220_BANK0_EN_RXADDR+HS6220_W_REGISTER; rf_data=0x03;rf_write_onebyte();//scramble_en = 0
	rf_reg=HS6220_BANK0_RF_SETUP+HS6220_W_REGISTER; rf_data=0x47;rf_write_onebyte();
	rf_reg=HS6220_BANK0_DYNPD+HS6220_W_REGISTER; rf_data=0x07;rf_write_onebyte();

	clear_rf_status();
	flush_rx_fifo();
	if(mode_cnt==rx_mode)
	{
	rf_rx_set();
	}
	else
	{
	rf_tx_set();
	}
	rf_ce_high();
}

//===============================================
//tx_rf_data
//===============================================
void rf_tx_data(void)
{
	byte repeat_send_cnt=10;

	rf_ce_low();
	flush_tx_fifo();
	clear_rf_status();
	 spi_csn=0;
	 rf_buf=HS6220_W_TX_PAYLOAD_NOACK;
     spi_Writeabyte();
     rf_write_data_cnt=rx_lenth;
	 write_rf_data_buf();
	 spi_csn=1;
	 rf_ce_high();
	DelayCnt = 10;Delay100US();//
	rf_ce_low();

	clear_rf_status();
	flush_tx_fifo();
	rf_ce_high();

}

//===============================================
//rf_RecivePack
//===============================================
extern word rf_reset_cnt;
void rf_RecivePack(void)
{
//	rf_ce_low();
//	rf_reg=HS6220_BANK0_RF_CH+HS6220_R_REGISTER; rf_data=0x00;rf_read_onebyte();
	get_rf_status_flag();
	if(rf_buf.6) //rx_dr
	{
		rf_reset_cnt=rf_reset_time;
		rf_sleep_cnt=10;
	 rf_reg = HS6220_R_RX_PL_WID | HS6220_R_REGISTER;   rf_data =0;rf_read_onebyte();
	 if(rf_buf==rx_lenth)  //16
	 {
		 rf_write_data_cnt=rf_buf;
		 spi_csn=0;
		 rf_buf=HS6220_R_RX_PAYLOAD;
		 spi_Writeabyte();
		 rf_write_data_cnt=rx_lenth;
		 read_rf_data_buf();
		 spi_csn=1;
	 }
	// 接收到数据并读取FIFO之后，这个操作必须的
	rf_ce_low();
	flush_rx_fifo();
	clear_rf_status();
	rf_ce_high(); // CE拉高等待下次数据到来

	}

	if(!rf_reset_cnt) // 如果300ms都没有收到1包数据，则复位RF重新初始化
	{

		init_rf();
		rf_reset_cnt=rf_reset_time;

	}
	if(!rf_sleep_cnt)// 如果20ms都没有收到1包数据，则让RF睡眠唤醒一次
	{
		
		rf_ce_low();
		flush_rx_fifo();
		clear_rf_status();
		rf_reg = HS6220_BANK0_PMU_CTL | HS6220_W_REGISTER;   rf_data =0xae;rf_write_onebyte();
		DelayCnt = 10;Delay100US();// 这里的1ms延时不可缺少，也不能小 
		rf_reg = HS6220_BANK0_PMU_CTL | HS6220_W_REGISTER;   rf_data =0xac;rf_write_onebyte();
		DelayCnt = 10;Delay100US();// 这里的1ms延时不可缺少，也不能小
		rf_ce_high(); 
		rf_sleep_cnt=10;
	}


}
		/* 注意：最高位为载波使能位，设置了载波模式之后，CE要拉高，载波才会出来；
		   如果不要切换频点，功率等，就不要去在操作RF，否则会看不到载波信号的*/
extern byte int_2ms;
extern byte test_mode_fg;
extern byte key_code;

void test_mode(void)
{
	byte key_temp;
	byte key_cnt=0;
	byte rc_ch;
		rf_ce_low();
		rf_tx_set();

		 spi_csn=0;
		 rf_buf=0x26;
	     spi_Writeabyte();
		 rf_buf=0xc7;
	     spi_Writeabyte();  
		 spi_csn=1;
		rf_ce_high();	
		test_mode_fg=1;
/*	rf_ce_low();

	if(test_mode_fg==1)//载波模式
	{
		 spi_csn=0;
		 rf_buf=0x26;
	     spi_Writeabyte();
		 rf_buf=0xc7;
	     spi_Writeabyte();  
		 spi_csn=1;
	}
	else
	if(test_mode_fg==2)//数据模式
	{
		 spi_csn=0;
		 rf_buf=0x26;
	     spi_Writeabyte();
		 rf_buf=0x47;
	     spi_Writeabyte();  
		 spi_csn=1;
	}
	else//接收模式
	{
		 rf_rx_set();
	}
	rf_ce_high();

	io_led=1;
*/
	while(1)
	{

		io_led=1;

		if((key_temp!=key_code))//&&(key_code.0))
		{
			key_temp=key_code;
			if(key_code)
			{
			key_cnt++;
			if(key_cnt>9) key_cnt=1;
			}

			if(key_cnt==1)
			{
				init_rf();
				rf_ce_low();
				rf_tx_set();

				 spi_csn=0;
				 rf_buf=0x26;
			     spi_Writeabyte();
				 rf_buf=0xc7;
			     spi_Writeabyte();  
				 spi_csn=1;
				rf_ce_high();	
				test_mode_fg=1;

				rc_ch=0x05;
			}
			else
			if(key_cnt==2)
			{
				rc_ch=34;
			}
			else
			if(key_cnt==3)
			{
				rc_ch=75;
			}
			else
			if(key_cnt==4)
			{
				init_rf();
				rf_ce_low();
				rf_tx_set();

				 spi_csn=0;
				 rf_buf=0x26;
			     spi_Writeabyte();
				 rf_buf=0x47;
			     spi_Writeabyte();  
				 spi_csn=1;
				rf_ce_high();	
				test_mode_fg=2;

				rc_ch=0x05;
			}
			else
			if(key_cnt==5)
			{
				rc_ch=34;
			}
			else
			if(key_cnt==6)
			{
				rc_ch=75;
			}
			else
			if(key_cnt==7)
			{
				init_rf();
				rf_ce_low();
				rf_rx_set();
				rf_ce_high();	
				test_mode_fg=3;

				rc_ch=0x05;
			}
			else
			if(key_cnt==8)
			{
				rc_ch=34;
			}
			else
			if(key_cnt==9)
			{
				rc_ch=75;
			}


			 rf_ce_low();
			 spi_csn=0;
			 rf_buf=0x25;
		     spi_Writeabyte();
			 rf_buf=rc_ch;
		     spi_Writeabyte();  
			 spi_csn=1;
			 rf_ce_high();
		}

		if(!int_2ms )
		{
			int_2ms=2;
			key_deal();
			if(test_mode_fg==2)
			{
		 	 
			 rf_tx_data();

			}
		}
	}
}

void hs6200_carrier_mode(void)
{
	rf_ce_low();
/*	flush_tx_fifo();
	clear_rf_status();
	 spi_csn=0;
	 rf_buf=0x20;
     spi_Writeabyte();
	 rf_buf=0x0e;
     spi_Writeabyte();  
	 spi_csn=1;*/
//	 rf_ce_high();

	 spi_csn=0;
	 rf_buf=0x26;
     spi_Writeabyte();
	 rf_buf=0xc7;
     spi_Writeabyte();  
	 spi_csn=1;
	 spi_csn=0;
	 rf_buf=0x25;
     spi_Writeabyte();
	 rf_buf=45;
     spi_Writeabyte();  
	 spi_csn=1;
	 rf_ce_high();
	 while(1){

		 .delay 200
	 };


} 

