#include "setup_VA.h"
extern UINT16	vfd_set_open_state(UINT16 index);
extern UINT16	vfd_set_close_state(UINT16 index);
/*
history:
2004-7-19 14:43
         wanghaoying move the following functions for nec16312 here
2004-7-7 14:25  
        lijd
        Process 16312sw use for:
        1. extern pannel key
        2. volume button 
        note: need define NEC16312SW in cust_def.h
*/

/*
** FUNCTION
** reset_vfd
**
** DESCRIPTION
** setup VFD.  Should only called at power-up or emergency.
*/


void reset_vfd(void)
{
    
	UINT16 nIndex = 0;
     

	vfd_set_idle_state(nIndex);
	WaitIopFunRdy(IOP_RDY_WAIT);
}

//
//    LED: 
//
//    MSB   LSB
//    ---- 0000  turn on all led
//    ---- 1111  turn off all led
//
void write_vfd_led(UINT8 led_id)
{
	regs0->iop_data[VFD_CMD] = 0x41;
	regs0->iop_data[VFD_DAT0] = 0xff00 | led_id;
	regs0->iop_data[0] = (regs0->iop_data[0] & VFD_DATLEN_MASK) | (FUN_VFD_WRITE | VFD_DAT_LEN1);
	WaitIopFunRdy(IOP_RDY_WAIT);
}


/*
** FUNCTION
** polling_vfdr
**
** DESCRIPTION
** check if polling-ready
*/

void polling_vfdr(void)  //nec16321 type vfd
{
#ifdef SUPPORT_VFD

	
	
	UINT8 count ;
	UINT8 *VfdReadData;
#ifdef ORITRON_DVD_HT220_RECEIVER   
	//static UINT8   prologic_cmdflag=0;
	static UINT8   downmix_cmdflag=0;
	static  UINT8	flag_init_cnt=5;		
    
#endif//ORITRON_DVD_HT220_RECEIVER	
	if(regs0->iop_data[0] & 0xf000)
		return;
		
	 if(play_state == VCD_STATE_OPEN)
	  vfd_set_open_state(1); 
     else if(play_state == VCD_STATE_CLOSE)
	  vfd_set_close_state(1);
    
	 update_vfd_data();
					
   // VfdReadData2 = ((UINT8 *) (SDRAM_BASE_UNCACHED + regs0->iopya * 1024 + 0x01ff));      
	VfdReadData = ((UINT8 *) (SDRAM_BASE_UNCACHED + regs0->iopya * 1024 + 0x05E0));		

#ifdef ORITRON_DVD_HT220_RECEIVER
	for(count=4;count<VFD_DISPLAY_SIZE-2;count++)
	{   
	    *VfdReadData=count; 
	     VfdReadData++;        
	   
	    if(count==0x10)
	    {
            *VfdReadData=vfd_mem[count]&0xFE;
        }
	    else
	    {   
	        *VfdReadData=vfd_mem[count];
        }        
        VfdReadData++;  
    }	
    	
	
				
	if(flag_init_cnt==0) 
    {  
        if(setup_VA[SET_VA_DEFAULT]==1)
        {     
            regs0->iop_data[2]= 0x1540;
            regs0->iop_data[0] = regs0->iop_data[0]|0x9000 ;
            setup_VA[SET_VA_DEFAULT]=0;
            printf("\r\n========================\r\n78E58 CMD OK:1540 \r\n============\r\n");
        }      
        else if (setup_VA[SETUP_VA_DOWNMIX]!=downmix_cmdflag)
        {   
            downmix_cmdflag=setup_VA[SETUP_VA_DOWNMIX];
            if(downmix_cmdflag!=4)
    	        regs0->iop_data[2]= 0x1520;
    	    else 
    	        regs0->iop_data[2]= 0x1580;
    	   
    	    regs0->iop_data[0] = regs0->iop_data[0]|0x9000 ;
           
        }      
        else  
            regs0->iop_data[0] = regs0->iop_data[0]|0x2000;
    
    }
	else //k==1
	{  
        //printf("-------------flag_init_cnt=1-----------------\n");
       setup_VA[SET_VA_DEFAULT]=0;
	   downmix_cmdflag=setup_VA[SETUP_VA_DOWNMIX];
	   if(downmix_cmdflag!=4)
	    {
	        //regs0->iop_data[2] = 0x0;
	        delay_srv_10ms(5);
	        printf(" send iop_data[2] 0x1520\n");
	        regs0->iop_data[2]= 0x1524;
	    }
	   else 
	    {   
	        //regs0->iop_data[2] = 0x0;
	        delay_srv_10ms(5);
	        printf(" send iop_data[2] 0x1580\n");
	        regs0->iop_data[2]= 0x1584; 
	    }
	   
	   regs0->iop_data[0] = regs0->iop_data[0]|0x9000 ;

        flag_init_cnt--; 
        printf("-------------flag_init_cnt=0-----------------\n");
    }
#endif//ORITRON_DVD_HT220_RECEIVER


#endif//SUPPORT_VFD

}