/*
 ******************************************************************************
 *
 * @file     VOX_Module.c
 * @brief    VOL/R module
 *                 
 *
 * @version  1.0
 * @date     2022/07/18   09:59:40
 * @author   Alex Xu
 *
 * Copyright (c) 2013-2099,Tkplusemi Technology Co.,Ltd.
 * All Rights Reserved
 *
 * History:
 * Revision          Date           Author            Desc
 * 1.0.0            2022/07/18      Alex          build this file
 ******************************************************************************
 */
#include "vox_module.h"
#include "led.h"
#include "system.h"
#include "discharge_module.h"
#include "sleep.h"
#include "bat.h"
#include "hall.h"
#include "key.h"
#include "sys_tim.h"
#include "sys_tim.h"

bit Vox_Vout_Enable = OFF;			//Vox功率输出标志位

#if VOX_ENABLE

/******************************************************************************\
                          Macro definitions
\******************************************************************************/
#define VOX_TX_CNT	30			//VOX发送指令时间
#define EARPHONR_WKUP_CNT	2
#define BES_RST_PULS_CNT	20	
#define Vox_TX_Interval		2  //Vox定时发送指令时间间隔
#define BOOST_VOUT_HIGH_CNT			100			//关盖，发完指令后，Boost Vout输出5.15V时间。

/******************************************************************************\
                             Variables definitions
\******************************************************************************/

uint8_t Vox_TX_Timer = 0;		//VOX发送指令持续时间计数,在Hall_Handler检测中清0.

//uint8_t BES_Rst_Puls_Timer = 0;		//关盖15s后发送BES Reset 脉冲
bit BES_Rst_Puls_Flag = 0;
//uint8_t	WkUp_EarPhone_Debounce = 0;

bit Cover_Close_Flag = 0;
bit Cover_Open_Flag = 0;
bit EarPhone_ShutDown_Flag	= 0;		//耳机关机标志位

bit Boost_Open_Flag = 0;     //用于开启Boost后延时开启Vox 5V。

uint8_t Vox_Output_Short_Debounce = 0;
uint16_t Boost_Open_Atleast_Tim_Cnt = 0;

uint8_t Box_To_Bes_Comm_Debounce = 0;
bit Boost_Vout_Change_Flag = 0;

#ifdef VOX_RX

uint8_t	Vox_Pairing_State[2] = 0;		//耳机配对状态，VOL:低4bit；VOR:高4bit。0是无效，1是正在配对，2是配对成功，3不处理，保持当前状态。
idata uint8_t	Vox_Get_BES_Addr_Flag[2] = 0;		
idata uint8_t	BES_Addr[2][6] = 0;			//蓝牙耳机地址，Vox_Bes_Addr[0][6]：VOL；Vox_Bes_Addr[1][6]：VOR

#endif
/******************************************************************************\
                             Functions definitions
\******************************************************************************/

/*
  *******************************************************************************
  * 			void VOX_EN_Type(VOR_Enable_Type_e VOR_Enable_Type)
  *
  * Description : VOL Open(EN_VO)

  * Arguments	:
 
  * Returns 	:
 
  * Notes		:
  *
  *******************************************************************************
  */
 void VOX_EN_Type(VOX_Enable_Mode_e VOX_Enable_Mode)
 { 
 	COM_CTRL = ON;
	switch(VOX_Enable_Mode)
	{	
		case VOX_VOUT_Mode:    
	   
			 VOX_CTL0 &= ~0x30; 	 //VOX Disable 5V And Disable VOX ADT
			 
			 VOX_CTL0 |= 0x30;		 //VOX Enable 5V		 
					 
		break;
		case VOX_ADT_Mode:
		   
			 VOX_CTL0 &= ~0x30;    //VOX 5v Off 	
			 
			 VOX_CTL0 |= 0x03;		//VOX load detect On   
			   
		break;

		default:
		break;
	}  
}

/*
*******************************************************************************
*			 void Vox_Det_Machine(void)
*
* Description : Vox Detect:耳机识别。 (100ms调用周期)
*
* Arguments	 : NONE

* Returns	 : NONE

* Notes		 : NONE
*
*******************************************************************************
*/
/*
1、关盖开启Boost denounce一段时间（ms级延时）后开启Vox 5v；显示灯效。
2、开盖开启Boost denounce一段时间（ms级延时）后开启Vox 5v至少500ms用于唤醒耳机；后发送开盖指令，持续10s，间隔250-300ms。
3、发送开盖指令间隔（250-300ms）期间，Vox转入ADT模式，检测都Loadon状态需要有灯效。
4、两只耳机电池都充满或仓低电，则发送关机指令。
*/
void Vox_Det_Machine(void)
{
	/*Vox 过流保护，两只耳机都每隔200ms打嗝一次(28Bytes)*/
	if( IRQ_FLAG0 & 0x0C )
	{		
		Vox_Output_Short_Debounce++;
		if( Vox_Output_Short_Debounce >= 2 )		//Vox短路保护200ms后，重新开启Vox 5V。
		{
			Vox_Output_Short_Debounce = 0;
			IRQ_FLAG0 = 0x0C;
			VOX_EN_Type(VOX_VOUT_Mode);	
			return;
		}
	}	

	if( CoverEvent_Flg )		//Hall事件。
	{	
	#if 0
		if(gBoost_Prepared_Flag && ( CHIP_STA1 & 0xA0 ) )		//1、Boost开启条件不满足，则Vox一直处于ADT模式。2、存在loadon，有耳机在仓，开启Vox 5V输出
	#else
		if( gBoost_Prepared_Flag )
	#endif
		{	
			if( !Boost_Open_Flag )
			{		
				BST_EN = 1; 		//Boost Enable；异常时由硬件主动关闭。开启Boost，开启Vox 5v会在开启Boost之后（100ms延时）。	
				Boost_Open_Flag = 1;				
				return;
			}
			
			BES_Rst_Puls_Flag = 0;
			EarPhone_ShutDown_Flag = 0;
			Boost_Open_Atleast_Tim_Cnt = 0; 
			
		//	SFRADDR = MFP_CTL0;
		//	SFRDATA |= 0x04;    //P01 as UART's TX
			
			if( CoverStatus == CLOSE )    //1、关盖关闭COM_CTRL；显示灯效。（无需查询Loadon、IOFF状态，无论耳机是否在仓，关盖发送指令间隔300ms持续10s，间隔之间关闭COM_CTRL。）
			{
				Cover_Close_Flag = 1;
				Cover_Open_Flag = 0;
				CoverEvent_Flg = 0;		
				Vox_Vout_Enable = ON;
				Boost_Open_Flag = 0;
			}
			else						//2、开盖处理，Vox 5V输出500ms用于唤醒耳机；500ms后vox设置为ADT模式，关Boost。
			{
				Cover_Close_Flag = 0;
				
				/*开启VOUT 500ms用于唤醒耳机。*/
				if( Vox_TX_Timer < EARPHONR_WKUP_CNT )		//debounce 500ms
				{  
					if( (VOX_CTL0 & 0x30) != 0x30 )			//1、当前已经开启了VOUT，则无需重复开启；原因：在使能VOUT前需要先关闭VOUT使能，如果连续开，会出现一段时间断开的情况。
					{
						VOX_EN_Type(VOX_VOUT_Mode);
					}
					Vox_TX_Timer++;
				}
				else
				{
					BST_EN = 0;	  //Boost Disable
					Cover_Open_Flag = 1;
					CoverEvent_Flg = 0;
					Boost_Open_Flag = 0;
					Vox_TX_Timer = 0;
					VOX_EN_Type(VOX_ADT_Mode);				
				}
			}
		} 
		else
		{
			VOX_EN_Type(VOX_ADT_Mode);
		}
	}
	
	/* 发送开盖指令*/
	if( Cover_Open_Flag )				/*开盖后，每隔200-300ms发送一次开盖指令，并且接收耳机配对状态信息。*/
	{
		if( (Vox_TX_Timer % Vox_TX_Interval) == 0 ) 	//200ms发送一次
		{
#ifdef VOX_TX
			HandleTxCommand(CMD_BOX_OPEN,VOL_CHAN); 		//左耳发开盖指令，区分耳机通道。
#endif
		}
		else
		if( (Vox_TX_Timer % (Vox_TX_Interval + 1)) == 0 ) 	//300ms发送一次
		{
#ifdef VOX_TX
			HandleTxCommand(CMD_BOX_OPEN,VOR_CHAN); 		//右耳发开盖指令，区分耳机通道。
#endif
		}
	
		Vox_TX_Timer++;
	}
	
	/* 发送开、关盖指令*/
	if( Cover_Close_Flag || EarPhone_ShutDown_Flag )
	{	
		/*间隔300ms发送指令，持续3s，关盖间隔之间开启VOUT;开盖间隔之间开启ADT。*/
		if( Vox_TX_Timer < VOX_TX_CNT )
		{		
			if( (Vox_TX_Timer % Vox_TX_Interval) == 0 )		//200ms发送一次
			{
				if( EarPhone_ShutDown_Flag )
				{
#ifdef VOX_TX
					HandleTxCommand(CMD_SHUT_DOWN,VOX_BOTH);			/*耳机电池充满或仓处于低电，发关机指令*/			
#endif
				}
				else
				if( CoverStatus == CLOSE )
				{
#ifdef VOX_TX
					HandleTxCommand(CMD_BOX_CLOSE,VOX_BOTH);		 //发送关盖指令	，不区分耳机通道。
#endif
				}
			}					
			
			Vox_TX_Timer++;
		}
		else			//5s后清标志位。
		{		
			if( EarPhone_ShutDown_Flag )
			{
				EarPhone_ShutDown_Flag = 0;
				Cover_Close_Flag = 0;	
				Vox_Vout_Enable = OFF;
				BST_EN = 0;	  									//Boost Disable
				VOX_EN_Type(VOX_ADT_Mode);
			}
			else
			if( Cover_Close_Flag )											//关盖发送完相应的指令后，VOX 5V充电，等待耳机电池充满。充满
			{
				if( ((CHIP_STA1 & 0xAC) == 0xAC) || F_batlevel_low )			//一、loadon和ioff状态同时存在，说明1、耳机电池充满；2、耳机锂保；3、盒中没耳机；二、盒电池低电。两种情况都发SHUT_DOWN。等待开盖重新插拔耳机。
				{
					if( Boost_Open_Atleast_Tim_Cnt >= TIM_SHUTDOWN_DEBOUNCE )   //Boost必须工作满10分钟软件才允许关机，原因，给耳机电池处于锂保状态进行充电。
					{					
						EarPhone_ShutDown_Flag = 1;
						Vox_TX_Timer = 0;										//为了后面发送SHUT_DOWN指令。
					}		
				}
				
				if( !BES_Rst_Puls_Flag )    
				{		
					Vox_TX_Timer++;
					if( Vox_TX_Timer > (BES_RST_PULS_CNT + VOX_TX_CNT) )   			//关盖后3+2s后发送BES 复位 pattern
					{
						BES_Rst_Puls_Flag = 1;							//发完复位Pattern后，开始蓝牙地址置换。
						COM_CTRL = ON;	
						//SFRADDR = MFP_CTL0;												//Set P01 Pinmux As GPIO Function,目的：保证BES Reset Pattern低电平能拉到0V
						//SFRDATA &= ~0x0C;
#ifdef VOX_TX					
						HandleTxCommand(BES_RESET,VOX_BOTH);	 					//发送BES Reset脉冲，只发一次。		23*5=115ms，
#endif	
						return;					/*return的原因：Vox_Det_Machine() 100ms调用周期，BES_RESET在Timer1中5ms调用。整个复位Pattern需要115ms，
												在此处return可以保证在200ms内只有BES 复位pattern在操作COM_CTRL。*/
					}
				}									
			}
		}
	}
}

#ifdef VOX_TX
/*
 *******************************************************************************
 *             void HandleTxCommand(VOX_BES_COMMAND_E  RxCommand, e_Vox_Chan nVox_Chn_Select)
 *
 * Description : 发送数据包的封装，并打开相应的双向通信通道 
 * Command payload
 *	Header	 checksum   side	 cmd 	  len		Data	    
 *	1bytes	  1byte    1byte	 1byte	  1byte		Len bytes

 *
 * Arguments   : VOX_BES_COMMAND_E  TxCommand: , e_Vox_Chan nVox_Chn_Select
				 
 * Returns     :
 *
 * Notes       :
 *
 *******************************************************************************
*/

void HandleTxCommand(VOX_BES_COMMAND_E TxCommand, e_Vox_Chan nVox_Chn_Select)
{
	uint8_t tx_pData[10] = 0;
	uint8_t i = 0;
	
	/*数据包头*/
	tx_pData[0] = BOXHEADER;
	/*耳机通道*/
	tx_pData[2] = nVox_Chn_Select;		
	/*指令编号*/
	tx_pData[3] = TxCommand;	

	switch(TxCommand)
	{
		case CMD_BOX_OPEN:

		case CMD_BOX_CLOSE:
	#if 0
			/*Data Length*/
			tx_pData[4] = 0x02;				
			tx_pData[5] = bat_level;	
			tx_pData[6] = FW_VER;

		break;
	#endif
		case CMD_SHUT_DOWN:			
			/*Data Length*/
			tx_pData[4] = 0x02;				
		//	tx_pData[5] = bat_level;
			tx_pData[5] = CHIP_STA1;
			tx_pData[6] = FW_VER;
		
		break;

		case CMD_BES_PAIRING:
			/*Data Length*/
			tx_pData[4] = 0x06;	
			
			for(i=0;i<6;i++)		
			{
				tx_pData[5+i] = BES_Addr[nVox_Chn_Select][i];				//获取耳机蓝牙地址。
			}
		
		break;
				
		case BES_RESET:			//BES 复位patten	
		
			BES_Puls_Start = 1;
			
		return;
		
		default:
		break;
	}
	
	for(i=2;i<(tx_pData[4] + 5);i++)		  //datalen + side + cmd 
	{
		tx_pData[1] += tx_pData[i];				//求校验和
	}

	COM_CTRL = OFF;				//VOX切换到通讯TX功能模式（1.8V）。
	
	SFRADDR = MFP_CTL0;
	SFRDATA |= 0x04;    //P01 as UART's TX
	
#if UART0_ENABLE	
	Uart0SendPacket(tx_pData[4] + 5, tx_pData);
#endif	

	SFRADDR = MFP_CTL0; 											//Set P01 Pinmux As GPIO Function,原因：TX和RX连在一起，要保证RX能正常接收到数据，TX需设置为GPIO模式，并浮空或输入模式。
	SFRDATA &= ~0x0C;
}

#endif

#ifdef VOX_RX
 /*
 *******************************************************************************
 *             void HandleRxCommand(ACK_TYPE_E  RxCommand)
 *
 * Description : 耳机端发送的数据包的解析及处理 
 *	Ack payload:
 *	Header	 checksum   side	 cmd 	  len		Data	    
 *	1bytes	  1byte    1byte	 1byte	  1byte		Len bytes	        		 
 *
 * Arguments   : ACK_TYPE_E  RxCommand: 
				 
 * Returns     :
 *
 * Notes       :
 *
 *******************************************************************************
*/
void HandleRxMsg(VOX_BES_COMMAND_E  RxCommand)
{
	uint8_t i = 0;

	switch(RxCommand)
	{
		case CMD_BOX_OPEN:
					
		case CMD_BOX_CLOSE:			
			
			if( RX0_Buffer[2] == VOL_CHAN )    //根据耳机Side参数
			{
				Vox_Pairing_State[VOL_CHAN] = RX0_Buffer[5];		//获取左耳机配对状态
			}
			else
			{
				Vox_Pairing_State[VOR_CHAN] = RX0_Buffer[5];		//获取右耳机配对状态
			}

		break;

		case CMD_SHUT_DOWN:

		break;

		case CMD_BES_PAIRING:
			
			if( RX0_Buffer[2] == VOL_CHAN )    //根据耳机Side参数
			{				
				for(i=0;i<6;i++)		
				{
					BES_Addr[VOL_CHAN][i+5] = RX0_Buffer[i];				//获取左耳机蓝牙地址。
					BES_Addr[VOR_CHAN][i+5] = RX0_Buffer[i];
				}	
				
				Vox_Get_BES_Addr_Flag[VOL_CHAN] = 1;			//获取左耳机配对状态
			}
			else
			{
				for(i=0;i<6;i++)		
				{
					BES_Addr[VOR_CHAN][i+5] = RX0_Buffer[i];				//获取左耳机蓝牙地址。
					BES_Addr[VOL_CHAN][i+5] = RX0_Buffer[i];
				}	
				
				Vox_Get_BES_Addr_Flag[VOR_CHAN] = 1;			//获取右耳机配对状态
			}

		break;
			
		default:
		break;
	}
}

/*
*******************************************************************************
*			  void HandleVoxCommMsg(void)
*
* Description : Vox 通讯功能处理函数，100ms定时调用。由于和耳机通信前需要打开耳机端的TRX功能，并且每次通信只能一只耳机。通过切换VOL/VOR通信开关进行通信
*
* Arguments  : NONE

* Returns	 : NONE

* Notes 	 : NONE
*
*******************************************************************************
*/

void HandleVoxCommMsg(void)
{
	uint8_t CrcCheckSum = 0;
	uint8_t i = 0;
	
	/*RX数据处理*/
	if( Uart0_RX_Finish_Flag )
	{
		Uart0_RX_Finish_Flag = 0;
			
		for(i=2 ;i<(RX0_Buffer[4] + 3);i++)		//计算校验和	
		{
			CrcCheckSum += RX0_Buffer[i];				//求校验和
		}
		
		if( CrcCheckSum == RX0_Buffer[1] )
		{
			HandleRxMsg((VOX_BES_COMMAND_E)RX0_Buffer[3]);		
		}	
		else
		{
			return;
		}
	}
		
	/*蓝牙地址交互*/
	if( BES_Rst_Puls_Flag && ( CHIP_STA1 & 0xA0 ) == 0xA0 )   /*1、关盖；2、有双耳机在盒。关盖5s后，发完关盖指令。*/
	{
		if( Box_To_Bes_Comm_Debounce < 1 )    
		{
		//	SFRADDR = MFP_CTL0;
		//	SFRDATA |= 0x04;    //P01 as UART's TX
			
#ifdef VOX_TX
			HandleTxCommand(CMD_BES_PAIRING,VOL_CHAN);			/*关盖5s后，左耳发送配对指令，获取左耳蓝牙地址。*/			
#endif
			Vox_Get_BES_Addr_Flag[VOL_CHAN] = 0x00;
			Vox_Get_BES_Addr_Flag[VOR_CHAN] = 0x00;
			Box_To_Bes_Comm_Debounce += 1;
		}
		else
		{
			if( Vox_Get_BES_Addr_Flag[VOL_CHAN] != 0x00 )     /*收到左耳回复的蓝牙地址*/
			{
				if( Vox_Get_BES_Addr_Flag[VOR_CHAN] != 0x00 )
				{
					Box_To_Bes_Comm_Debounce = 0;
					BES_Rst_Puls_Flag = 0;
					Boost_Vout_Change_Flag = 1;

					VOX_EN_Type(VOX_VOUT_Mode);			
				}
				else
				{		
#ifdef VOX_TX					
					HandleTxCommand(CMD_BES_PAIRING,VOR_CHAN);			/*发右耳配对指令，获取右耳蓝牙地址。*/	
#endif
					Vox_Get_BES_Addr_Flag[VOL_CHAN] = 0x00;				
				}
			}
			else
			if( Vox_Get_BES_Addr_Flag[VOR_CHAN] != 0x00 )		/*收到右耳回复的蓝牙地址，再将右蓝牙地址发给左耳。*/
			{
#ifdef VOX_TX			
				HandleTxCommand(CMD_BES_PAIRING,VOL_CHAN);	
#endif
			}
		}
	}	

	/* 关盖，发完指令后，Boost Vout输出5.15V时间1s。*/
	if( Boost_Vout_Change_Flag )
	{
		if( Box_To_Bes_Comm_Debounce < BOOST_VOUT_HIGH_CNT )
		{
			SFRADDR = BST_CTL0;			//设置输出5.15V
			SFRDATA |= 0x03;	
			Box_To_Bes_Comm_Debounce++;
		}
		else
		{
			Boost_Vout_Change_Flag = 0;
			Box_To_Bes_Comm_Debounce = 0;
			SFRADDR = BST_CTL0;			//设置输出5.05V
			SFRDATA &= ~0x03;
			SFRDATA |= 0x01;
		}
	}
}

#endif

#endif