/* Used by refresh task to extract bytes from the
framebuffer */

#define __STANDARD_H__ /* Avoid to define UBYTE, SYS_UWORD16 and UINT32. */

#include "r2d/lcds/i_sample/r2d_task_init_i.h"
#include "r2d/lcds/i_sample/r2d_tfd_lcd.h"
#include "r2d/r2d_i.h"
#include "r2d/r2d_independance_layer.h"
#include "r2d/r2d_env.h"
#include "r2d/lcds/i_sample/r2d_lcd_dma.h"
#include "dma/dma_api.h"
#include "dma/dma_message.h"

const unsigned char INIT_DISCTL[DISCTL_PARAM_NBR] = { 0xDE,0x01,0x64,0x00,0x1B,0xF4,0x00,0xDC,0x00,0x02,0x00};
const unsigned char INIT_GCP64[GCP64_PARAM_NBR] =  {
	0x3B, 0x0, 0x42, 0x0, 0x4A, 0x0, 0x51, 
	0x0, 0x58, 0x0, 0x5F, 0x0, 0x66, 0x0, 0x6E, 
	0x0, 0x75, 0x0, 0x7C, 0x0, 0x83, 0x0, 0x8A, 
	0x0, 0x92, 0x0, 0x99, 0x0, 0xA0, 0x0, 0xA7, 
	0x0, 0xAE, 0x0, 0xB6, 0x0, 0xBD, 0x0, 0xC4, 
	0x0, 0xCB, 0x0, 0xD2, 0x0, 0xDA, 0x0, 0xE1, 
	0x0, 0xE8, 0x0, 0xEF, 0x0, 0xF6, 0x0, 0xFE, 
	0x0, 0x5, 0x1, 0xC, 0x1, 0x13, 0x1, 0x1A, 
	0x1, 0x22, 0x1, 0x29, 0x1, 0x30, 0x1, 0x37, 
	0x1, 0x3E, 0x1, 0x46, 0x1, 0x4D, 0x1, 0x54, 
	0x1, 0x5B, 0x1, 0x62, 0x1, 0x6A, 0x1, 0x71, 
	0x1, 0x78, 0x1, 0x7F, 0x1, 0x86, 0x1, 0x8E, 
	0x1, 0x95, 0x1, 0x9C, 0x1, 0xA3, 0x1, 0xAA, 
	0x1, 0xB2, 0x1, 0xB9, 0x1, 0xC0, 0x1, 0xC7, 
	0x1, 0xCE, 0x1, 0xD6, 0x1, 0xDD, 0x1, 0xE4, 
	0x1, 0xEB, 0x1, 0xF2, 0x1, 0xFA, 0x1 };

const unsigned char INIT_GCP16[GCP16_PARAM_NBR] = {
	0x1A,0x31,0x48,0x54,0x5F,0x67,0x70,0x76,0x7C,0x80,0x83,0x84,0x85,0x87,0x96 };

const unsigned char INIT_MD_PSET[MD_PSET_PARAM_NBR] = { 0x00, 0x01, 0x00, 0x01 };
const unsigned char INIT_MD_CSET[MD_CSET_PARAM_NBR] = { 0x00, 0x02, 0x00, 0x02 };

const unsigned char INIT_SD_PSET[SD_PSET_PARAM_NBR] = { 0, 0, 219, 0 };
const unsigned char INIT_SD_CSET[SD_CSET_PARAM_NBR] = { 2, 0, 177, 0 };

const unsigned char INIT_ASCSET[ASCSET_PARAM_NBR] = { 0x00, 0x00, 0xDB, 0x00, 0xDC, 0x00, 0x01 };
const unsigned char INIT_SCSTART[SCSTART_PARAM_NBR] = { 0x00, 0x00 };


extern T_RVF_MB_ID r2d_mb_id;


#ifdef R2D_USE_LCD_DMA

extern volatile UINT8 r2d_lcd_dma_ok;
extern T_DMA_CHANNEL r2d_lcd_dma_channel;
extern T_DMA_CHANNEL_PARAMETERS r2d_lcd_dma_channel_info;
extern UINT32 r2d_lcd_dma_bytes_to_transfer;

extern volatile T_R2D_LCD_DMA_STATE r2d_lcd_dma_state;

extern void r2d_dma_callback(void *response);
	
#endif


static void r2d_nop_delay(SYS_UWORD32 ms)
{
    unsigned short a;
    while (ms-- > 0) for (a=0;a<1000;a++) asm(" nop");
}




 void r2d_refresh_task_init(void)
{

#ifndef _WINDOWS

  SYS_UWORD32  i,j,k;
  SYS_UWORD16 command;
  SYS_UWORD16 data;
  SYS_UWORD16 tab_tmp[264];
  SYS_UWORD16 *ptr;

#ifdef R2D_USE_LCD_DMA
  T_RV_RETURN r2d_dma_return_path;
#endif
  
  command = LCD_DISNOR; /* LCD_activate */
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);


  command = LCD_DISOFF; // this command turns ON the full-screen display 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);


  command = LCD_SLPIN; // this command causes the LCD module to enter the sleep mode 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
  

  command = LCD_DISNOR; // this command turns the display mode to NORMAL 
                        // without rewriting the content of the display data RAM 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
 
  r2d_nop_delay(10);

  command = LCD_DATCTL;  // data mode of the MPU interface 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
  r2d_nop_delay(10);
  data =  0x08;
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);

  r2d_nop_delay(10);

  command = LCD_GSSET; // this command and the subsequent parameter make the grey scale mode 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
  r2d_nop_delay(10);
  data = INIT_GSSET; // 64 gradients 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);


  r2d_nop_delay(100);


  command = LCD_DISCTL; // this command and the subsequent parameter make various display timing settings 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);

  ptr = (SYS_UWORD16 *)&INIT_DISCTL[0];

  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 6, C_LCD_IF_DISPLAY);

  r2d_nop_delay(100);


  command = LCD_GCP64;  // Init palette for 64 gradient palette 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);

  ptr = (SYS_UWORD16 *)&INIT_GCP64[0];
  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 63, C_LCD_IF_DISPLAY);

  r2d_nop_delay(100);

  command = LCD_GCP16;  // Init palette for 16 gradient palette 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);

  ptr = (SYS_UWORD16 *)&INIT_GCP16[0];
  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 8, C_LCD_IF_DISPLAY);


  command = LCD_MD_CSET;  // set area devoted to DSP interface 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);

  ptr =  (SYS_UWORD16 *)&INIT_MD_CSET[0];
  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 2 , C_LCD_IF_DISPLAY);


  command = LCD_MD_PSET;  // set area devoted to DSP interface 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);

  ptr =  (SYS_UWORD16 *)&INIT_MD_PSET[0];
  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 2, C_LCD_IF_DISPLAY);


  command = LCD_SD_CSET;  // set area devoted to MPU interface 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);

  ptr =  (SYS_UWORD16 *)&INIT_SD_CSET[0];

  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 2, C_LCD_IF_DISPLAY);


  command = LCD_SD_PSET;  // set area devoted to MPU interface
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);

  ptr =  (SYS_UWORD16 *)&INIT_SD_PSET[0];

  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 2, C_LCD_IF_DISPLAY);



  command = LCD_OSCISEL;  // internal OSG 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
  data = INIT_OSCISEL; // 0x05 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);


  command = LCD_14MSET; 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
  data = INIT_14MSET; // 0x4B 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);


  command = LCD_14MEND;  
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);


  command = LCD_3500KSET; 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
  data = INIT_3500KSET; // 0x45 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);


  command = LCD_3500KEND;
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);


  r2d_nop_delay(30);


  command = LCD_SLPOUT; // this command cancels the sleep mode 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);


  r2d_nop_delay(20);


  command = LCD_VOLCTL;  // sets Ton timing of power IC 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
  data = INIT_VOLCTL_Ton; // 152 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);


  r2d_nop_delay(20);


  command = LCD_VOLCTL;  // sets the electronic volume 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
  data = INIT_VOLCTL;
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);


  r2d_nop_delay(20);

  
  command = LCD_DISON; 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);

  command = LCD_DISNOR; // this command turns the display mode to NORMAL 
                        // without rewriting the content of the display data RAM 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);

  command = LCD_RAMWR; 
  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);


  for (i=0; i<264; i++)
  {
    // Try filling with white color 
    tab_tmp[i] = 0xFFFF;
  }
  
  
  for(j=0; j<220; j++)
  {
			f_lcd_if_poll_write(C_LCD_IF_CS0, &(tab_tmp[0]), 264, C_LCD_IF_DISPLAY);
  }

#ifdef R2D_USE_LCD_DMA

  
  r2d_dma_return_path.callback_func = r2d_dma_callback;

  dma_reserve_channel (DMA_CHAN_ANY,0,DMA_QUEUE_DISABLE,
	                    0,r2d_dma_return_path);
 
  
  r2d_lcd_dma_channel_info.data_width = DMA_DATA_S16;
  r2d_lcd_dma_channel_info.sync = DMA_SYNC_DEVICE_HW_LCD;
  r2d_lcd_dma_channel_info.hw_priority = DMA_HW_PRIORITY_HIGH;
  r2d_lcd_dma_channel_info.flush = DMA_FLUSH_DISABLED;
  r2d_lcd_dma_channel_info.nmb_frames = 1;
  r2d_lcd_dma_channel_info.nmb_elements = 128;
  r2d_lcd_dma_channel_info.dma_end_notification = DMA_NOTIFICATION;
  r2d_lcd_dma_channel_info.secure = DMA_NOT_SECURED;
  r2d_lcd_dma_channel_info.dma_mode = DMA_MODE_SINGLE;
  r2d_lcd_dma_channel_info.transfer = DMA_MODE_TRANSFER_ENABLE;

  r2d_lcd_dma_channel_info.source_address = 0;
  r2d_lcd_dma_channel_info.source_address_mode = DMA_ADDR_MODE_POST_INC;
  r2d_lcd_dma_channel_info.source_packet = DMA_NOT_PACKED;
  r2d_lcd_dma_channel_info.source_burst = DMA_NO_BURST;

  r2d_lcd_dma_channel_info.destination_address = (UINT32)C_LCD_IF_WR_FIFO;
  r2d_lcd_dma_channel_info.destination_address_mode = DMA_ADDR_MODE_CONSTANT;
  r2d_lcd_dma_channel_info.destination_packet = DMA_NOT_PACKED;
  r2d_lcd_dma_channel_info.destination_burst = DMA_NO_BURST;

#endif /* USE_LCD_DMA */


#endif
}

void r2d_refresh_task_kill(void)
{
}


void r2d_dithering_init(void)
{
   R2D_MALLOC(r2d_mb_id,UINT32,sizeof(UINT32)*4,r2d_g_dithering_matrix);
   if (r2d_g_dithering_matrix!=NULL)
   {
     r2d_g_dithering_matrix[0]=0;
     r2d_g_dithering_matrix[1]=2;
     r2d_g_dithering_matrix[2]=3;
     r2d_g_dithering_matrix[3]=1;
   }
}