#include "os_config.h"

#include "c_def.h"
#include "debug.h"
#include "oem.h"


#ifdef HDMI_CEC_BY_OPTEK

#include "regmap.h"

#include "app_gpio.h"
#include "interrupt.h"
#include "fifo.h"
#include "optek_cec_cmd.h"

#include "optek_cec.h"

#include "app_main.h"


extern FIFO hdmi_cec_rx_fifo; 
extern U8 HdmiCEC_physical_addr[2];
extern U8 hdmi_cec_tx_buf[16];
extern U8 hdmi_tx_buf_len, hdmi_tx_buf_index;
extern U8 hdmi_tx_request;
extern U8 hdmi_tx_err_cnt;


#define MAX_MESSAGE_SIZE	16			/*16*10*/

extern const u8 HdmiCEC_logical_addr;
extern const u8 HdmiCEC_logical_bc_addr;

U8 app_cmd_get_hdmi_audio_status(void)
{
	u8 tmp;
	//vol bit0-bit6; max is 100
	tmp = (app_main_data.volume * 100)/VOLUME_MAX;
	if(app_main_data.Mute)
		tmp |= 0x80;
	//mute is bit 7; 0->mute off, 1 mute on
	return tmp;
}

u8 hdmi_direct_addr;

U8 HDMI_cec_waiting_cmd_fini (void)
{
	int i;

	for (i=0; i<10; i++)
	{
		if (hdmi_tx_request == 0)
		{
			return TRUE;
		}

		delayms(10);
	}

	DBG_Printf ("HDMI cmd timeout\n\r");
	return FALSE;
}

void HDMI_cec_report_status (void)
{
	//while (hdmi_tx_request == 1);		//waiting curreutn command finish

	if (HDMI_cec_waiting_cmd_fini() == FALSE)
	{
		return;
	}

	hdmi_cec_tx_buf[0] = (HdmiCEC_logical_addr << 4) | ((hdmi_direct_addr & 0xF0) >> 4);
	hdmi_cec_tx_buf[1] = CEC_OPCODE_REPORT_AUDIO_STATUS;
				
				
	hdmi_cec_tx_buf[2] = app_cmd_get_hdmi_audio_status();			
				
	hdmi_tx_buf_len = 3; 	
	hdmi_tx_err_cnt = 0;
	hdmi_tx_request = 1;		
}


void opetk_cec_key_down (u8 key)
{
	key_hold_counter = false;

	if (key == CEC_REMOTE_BUTTON_POWER)
	{
		app_nav_standby();
	}
	else if (key == CEC_REMOTE_BUTTON_VOLUME_UP)
	{
		//update vol		
		app_nav_mp3_plus();
		
		//report vol
		//HDMI_cec_report_status();
	}
	else if (key == CEC_REMOTE_BUTTON_VOLUME_DOWN)
	{
		//update vol
		app_nav_mp3_minus();
		
		//report vol
		//HDMI_cec_report_status();
	}
	else if (key == CEC_REMOTE_BUTTON_MUTE)
	{	
		app_nav_rmt_mute();
	}
}

void opetk_cec_key_up (u8 key)
{
	if (key == CEC_REMOTE_BUTTON_VOLUME_UP || key == CEC_REMOTE_BUTTON_VOLUME_DOWN)\
	{
		//update vol
		//report vol
		//HDMI_cec_report_status();
	}
}


void HdmiCec_cmd_rx_err (U32 len)
{
	U32 i;
	U8 tmp;
	
	//DBG_Assert (FALSE);
	for (i=0;i<len;i++)
	{
		fifo_get_data(&hdmi_cec_rx_fifo,&tmp,1);
	}
	
	DBG_Printf ("Hdmi rcv error\n\r");
}

void HdmiCec_cmd_tx_err (U32 opcode)
{	
	DBG_Printf ("Hdmi tx error 0x%x\n\r", opcode);
}

void HdmiCEC_report_physica_address (void)
{
	if (!(HdmiCEC_physical_addr[0] == 0xFF && HdmiCEC_physical_addr[1] == 0xFF) )
	{
		if (HDMI_cec_waiting_cmd_fini() == FALSE)
		{
			return;
		}
	
		hdmi_cec_tx_buf[0] = (HdmiCEC_logical_addr << 4) | HdmiCEC_logical_bc_addr;
		hdmi_cec_tx_buf[1] = CEC_OPCODE_REPORT_PHYSICAL_ADDRESS;
		hdmi_cec_tx_buf[2] = HdmiCEC_physical_addr[0];
		hdmi_cec_tx_buf[3] = HdmiCEC_physical_addr[1];
		hdmi_cec_tx_buf[4] = HdmiCEC_logical_addr;
		
		hdmi_tx_buf_len = 5; 	
		hdmi_tx_err_cnt = 0;
		hdmi_tx_request = 1;
	}
}

u8 Hdmi_Abort_feature (u8 *pBuf,u8 header, u8 opcode, u8 reason)
{
	//About feature
	pBuf[0] = (HdmiCEC_logical_addr << 4) | ((header & 0xF0) >> 4);
	pBuf[1] = CEC_OPCODE_FEATURE_ABORT;
	pBuf[2] = opcode;
	pBuf[3] = reason;
	
	return 4;
}


u8 Hdmi_Set_System_Audio_mode (u8 *pBuf,u8 header, u8 on)
{
	//About feature
	pBuf[0] = (HdmiCEC_logical_addr << 4) | ((header & 0xF0) >> 4);
	pBuf[1] = CEC_OPCODE_SET_SYSTEM_AUDIO_MODE;
	pBuf[2] = on;
	
	return 3;
}

void Hdmi_Set_System_Audio_set(U8 onoff)
{
	if (HDMI_cec_waiting_cmd_fini() == FALSE)
	{
		return;
	}

	hdmi_tx_buf_len = Hdmi_Set_System_Audio_mode(hdmi_cec_tx_buf,(HdmiCEC_logical_bc_addr<<4),onoff);					
	hdmi_tx_err_cnt = 0;
	hdmi_tx_request = 1;
}

void HdmiCec_cmd_handle (U32 len)
{
	U32 i;
	u8 cec_header;
	u8 opcode;
	u8 data_block[16-2];
	U8 tmp;

	if (len > MAX_MESSAGE_SIZE)
	{
		//from spec
		DBG_Assert (FALSE);

		//discard command
		for (i=0;i<len;i++) 
		{
			fifo_get_data(&hdmi_cec_rx_fifo,&tmp,1);
			DBG_Printf ("0x%x ",tmp);
		}

		//abort feature

		return;
	}

#if 0
	DBG_Printf ("HDMI rcv:");

	for (i=0;i<len;i++) 
	{
		fifo_get_data(&hdmi_cec_rx_fifo,&tmp,1);
		DBG_Printf ("0x%x ",tmp);
	}

	DBG_Printf ("\n\r");
#else

	fifo_get_data(&hdmi_cec_rx_fifo,&cec_header,1);
	
	if (len > 1)
	{
		fifo_get_data(&hdmi_cec_rx_fifo,&opcode,1);
		fifo_get_data(&hdmi_cec_rx_fifo,&data_block,len-2);

		if ( (cec_header & 0xF) == 0xF)
		{
			//braodcast, no need action
			if (opcode == CEC_OPCODE_VENDOR_COMMAND_WITH_ID  ||
				opcode == CEC_OPCODE_ACTIVE_SOURCE ||
				opcode == CEC_OPCODE_REPORT_PHYSICAL_ADDRESS)
			{
				asm ("NOP");
			}
			else if(opcode == CEC_OPCODE_STANDBY)
			{
				DBG_Printf ("TV/STB standby\n\r");
				if(app_main_data.media == MEDIA_ARC)
				{
				 	app_nav_standby();
				 }
			}
			else
			{
				DBG_Assert (FALSE);
				DBG_Printf ("HDMI BC opcode %d\n\r",opcode);
			}
			return;
		}

		//while (hdmi_tx_request == 1);		//????

		if (HDMI_cec_waiting_cmd_fini() == FALSE)
			return;

		//parse command
		switch (opcode)
		{
		case CEC_OPCODE_STANDBY:
			DBG_Printf ("TV/STB standby1\n\r");
			if(app_main_data.media == MEDIA_ARC)
			{
				app_nav_standby();
			}
			break;
			
		case CEC_OPCODE_FEATURE_ABORT:
			DBG_Printf ("HDMI Abort Feature\n\r");
			break;
		case CEC_OPCODE_ROUTING_CHANGE:
			DBG_Printf ("HDMI Routing Channel\n\r");
			break;

		case CEC_OPCODE_GIVE_PHYSICAL_ADDRESS:
			DBG_Printf ("HDMI Give Physical Addr\n\r");
			hdmi_cec_tx_buf[0] = (HdmiCEC_logical_addr << 4) | HdmiCEC_logical_bc_addr;
			hdmi_cec_tx_buf[1] = CEC_OPCODE_REPORT_PHYSICAL_ADDRESS;
			hdmi_cec_tx_buf[2] = HdmiCEC_physical_addr[0];
			hdmi_cec_tx_buf[3] = HdmiCEC_physical_addr[1];
			hdmi_cec_tx_buf[4] = HdmiCEC_logical_addr;

			hdmi_tx_buf_len = 5; 	
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;
			//DBG_Assert (FALSE);
			break;

		case CEC_OPCODE_GIVE_SYSTEM_AUDIO_MODE_STATUS:
			DBG_Printf ("HDMI Give System Audio Mode Status\n\r");

			hdmi_direct_addr = cec_header;

			hdmi_cec_tx_buf[0] = (HdmiCEC_logical_addr << 4) | ((cec_header & 0xF0) >> 4);
			hdmi_cec_tx_buf[1] = CEC_OPCODE_SYSTEM_AUDIO_MODE_STATUS;
			//hdmi_cec_tx_buf[2] = CEC_POWER_STATUS_ON; 
			hdmi_cec_tx_buf[2] = app_cmd_get_hdmi_audio_status(); // Samsung TV	

			hdmi_tx_buf_len = 3; 	
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;
			//DBG_Assert (FALSE);
			if ((app_main_data.media != MEDIA_OPTICAL)&&(!app_main_data.standby_status))
			{
				app_nav_rmt_convert_ARC();
			}
			else if (app_main_data.standby_status)
			{
				app_main_data.media = MEDIA_ARC;
				key_hold_counter = FALSE;
				DBG_Printf ("HDMI app_nav_standby_release\n\r");
				app_nav_standby_release();
			}
			break;

		case CEC_OPCODE_REQUEST_ARC_INITIATION:
			DBG_Printf ("HDMI Request ARC Init\n\r");

			hdmi_cec_tx_buf[0] = (HdmiCEC_logical_addr << 4) | ((cec_header & 0xF0) >> 4);
			hdmi_cec_tx_buf[1] = CEC_OPCODE_INITIATE_ARC;
			
			hdmi_tx_buf_len = 2; 	
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;
			//DBG_Assert (FALSE)		
			break;

		case CEC_OPCODE_GIVE_OSD_NAME:
			DBG_Printf ("HDMI Give OSD Name\n\r");

#if 1
			//???, osd name
			hdmi_tx_buf_len = Hdmi_Abort_feature(hdmi_cec_tx_buf,cec_header,opcode,CEC_ABORT_N0T_IN_CORRECT_MOD);
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;
#endif
			break;

		case CEC_OPCODE_GIVE_DEVICE_VENDOR_ID:
			DBG_Printf ("HDMI Give Device ID\n\r");

			hdmi_cec_tx_buf[0] = (HdmiCEC_logical_addr << 4) | ((cec_header & 0xF0) >> 4);
			hdmi_cec_tx_buf[1] = CEC_OPCODE_DEVICE_VENDOR_ID;
			hdmi_cec_tx_buf[2] = 0x8;							//Sharp
			hdmi_cec_tx_buf[3] = 0x0;
			hdmi_cec_tx_buf[4] = 0xF;
			
			hdmi_tx_buf_len = 5; 	
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;			
			break;
		
		case CEC_OPCODE_GIVE_DEVICE_POWER_STATUS:
			DBG_Assert (FALSE);
			hdmi_cec_tx_buf[0] = (HdmiCEC_logical_addr << 4) | ((cec_header & 0xF0) >> 4);
			hdmi_cec_tx_buf[1] = CEC_OPCODE_REPORT_POWER_STATUS;

			hdmi_cec_tx_buf[2] = CEC_POWER_STATUS_ON;		

			hdmi_tx_buf_len = 3; 	
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;		
			break;

		case CEC_OPCODE_REPORT_ARC_TERMINATED:
			DBG_Printf ("Terminate ARC\n\r");
			break;

		case CEC_OPCODE_SET_AUDIO_RATE:
			//???, not support
			DBG_Printf ("Set Audio Rate\n\r");
			DBG_Assert (FALSE);
			break;

		case CEC_OPCODE_REQUEST_ARC_TERMINATION:
			DBG_Printf ("HDMI Request ARC Termination\n\r");
			//DBG_Assert (FALSE);
			hdmi_cec_tx_buf[0] = (HdmiCEC_logical_addr << 4) | ((cec_header & 0xF0) >> 4);
			hdmi_cec_tx_buf[1] = CEC_OPCODE_TERMINATE_ARC;
			
			hdmi_tx_buf_len = 2; 	
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;
			break;

		case CEC_OPCODE_SET_SYSTEM_AUDIO_MODE:
			//should set to TV
			DBG_Printf ("Set System Audio Mode\n\r");
			DBG_Assert (FALSE);
			break;


		case CEC_OPCODE_GIVE_AUDIO_STATUS:
			DBG_Printf ("HDMI Give Audio Status\n\r");

			hdmi_cec_tx_buf[0] = (HdmiCEC_logical_addr << 4) | ((cec_header & 0xF0) >> 4);
			hdmi_cec_tx_buf[1] = CEC_OPCODE_REPORT_AUDIO_STATUS;

			hdmi_cec_tx_buf[2] = app_cmd_get_hdmi_audio_status();			
			
			hdmi_tx_buf_len = 3; 	
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;		
			break;	

		case CEC_OPCODE_REQUEST_SHORT_AUDIO_DESC:
			DBG_Printf ("HDMI Report Short Audio Desc\n\r");

			DBG_Printf (FALSE);

			hdmi_tx_buf_len = Hdmi_Abort_feature(hdmi_cec_tx_buf,cec_header,opcode,CEC_ABORT_INVALID_OPRAND);
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;			
			break;			
			
		case CEC_OPCODE_REPORT_ARC_INITIATED:
			DBG_Printf ("HDMI Report ARC Inieiated\n\r");
			
			if ( (app_main_data.media != MEDIA_ARC) && (!app_main_data.standby_status) )
			{
				app_nav_rmt_convert_ARC();
			}
			else if (app_main_data.standby_status)
			{
				app_main_data.media = MEDIA_ARC;
				key_hold_counter = FALSE;
				DBG_Printf ("HDMI app_nav_standby_release\n\r");
				app_nav_standby_release();
			}
#if 1
			hdmi_cec_tx_buf[0] = (HdmiCEC_logical_addr << 4) | ((cec_header & 0xF0) >> 4);
			hdmi_cec_tx_buf[1] = CEC_OPCODE_REPORT_AUDIO_STATUS;

			hdmi_cec_tx_buf[2] = app_cmd_get_hdmi_audio_status();			

			hdmi_tx_buf_len = 3;
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;
#endif

			//while (hdmi_tx_request == 1);
			if (HDMI_cec_waiting_cmd_fini() == FALSE)
				return;

			//mute TV speaker
			hdmi_tx_buf_len = Hdmi_Set_System_Audio_mode(hdmi_cec_tx_buf,(HdmiCEC_logical_bc_addr<<4),1);					
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;
			break;

		case CEC_OPCODE_USER_CONTROL_PRESSED:
			DBG_Printf ("HDMI User Control Pressed 0x%x\n\r",data_block[0]);
			opetk_cec_key_down (data_block[0]);
			break;
		case CEC_OPCODE_USER_CONTROL_RELEASED:
			//DBG_Assert (FALSE);
			DBG_Printf ("HDMI User Control Released\n\r");
			opetk_cec_key_up (data_block[0]);
			break;

		case CEC_OPCODE_SYSTEM_AUDIO_MODE_REQUEST:
			//changing to ARC source
			//DBG_Assert (FALSE);

			if (len > 2) {
				DBG_Printf ("HDMI System Audio Request On\n\r");
				//if ( (data_block[0] == HdmiCEC_physical_addr[0]) && (data_block[1] == HdmiCEC_physical_addr[1]) )
				if (1) 
				{
					if (1)//(app_main_data.media == MEDIA_OPTICAL)
					{
						if ( (app_main_data.media != MEDIA_ARC) && (!app_main_data.standby_status) )
						{
							app_nav_rmt_convert_ARC();
						}
						else if (app_main_data.standby_status)
						{
							app_main_data.media = MEDIA_ARC;
							key_hold_counter = FALSE;
							app_nav_standby_release();
						}
						hdmi_tx_buf_len = Hdmi_Set_System_Audio_mode(hdmi_cec_tx_buf,(HdmiCEC_logical_bc_addr<<4),1);					
						hdmi_tx_err_cnt = 0;
						hdmi_tx_request = 1;
					}

				}
				else {
					hdmi_tx_buf_len = Hdmi_Abort_feature(hdmi_cec_tx_buf,cec_header,opcode,CEC_ABORT_N0T_IN_CORRECT_MOD);
					hdmi_tx_err_cnt = 0;
					hdmi_tx_request = 1;	
				}		
			}
			else {
				//system audio off
				DBG_Printf ("HDMI System Audio Request Off\n\r");
				hdmi_tx_buf_len = Hdmi_Set_System_Audio_mode(hdmi_cec_tx_buf,(HdmiCEC_logical_bc_addr<<4),0);					
				hdmi_tx_err_cnt = 0;
				hdmi_tx_request = 1;
			}
			break;

#if 0
		case CEC_OPCODE_VENDOR_COMMAND_WITH_ID:
			hdmi_tx_buf_len = Hdmi_Abort_feature(hdmi_cec_tx_buf,cec_header,opcode,CEC_ABORT_N0T_IN_CORRECT_MOD);
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;			
			break;
#endif

		default:
			DBG_Printf ("HDMI abort opcode %d\n\r",opcode);

			DBG_Assert (FALSE);

			hdmi_tx_buf_len = Hdmi_Abort_feature(hdmi_cec_tx_buf,cec_header,opcode,CEC_ABORT_N0T_IN_CORRECT_MOD);
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;			

#if 0
			//About feature
			hdmi_cec_tx_buf[0] = (HdmiCEC_logical_addr << 4) | ((cec_header & 0xF0) >> 4);
			hdmi_cec_tx_buf[1] = CEC_OPCODE_FEATURE_ABORT;
			hdmi_cec_tx_buf[2] = opcode;
			hdmi_cec_tx_buf[3] = CEC_ABORT_REFUSED;
			
			hdmi_tx_buf_len = 4; 	
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;
#endif

#if 0
			//Abort Message
			hdmi_cec_tx_buf[0] = (HdmiCEC_logical_addr << 4) | ((cec_header & 0xF0) >> 4);
			hdmi_cec_tx_buf[1] = CEC_OPCODE_ABORT_MESSAGE;			
			hdmi_tx_buf_len = 2; 	
			hdmi_tx_err_cnt = 0;
			hdmi_tx_request = 1;
#endif
			//DBG_Assert (FALSE);
			break;
		}
	}
#endif
}
#endif