Subversion Repositories openmsp430

#include "gfx_controller.h"
#include "timerA.h"
 
//----------------------------------------------------------
// Initialize Graphic controller
//----------------------------------------------------------
void init_gfx_ctrl (uint16_t gfx_mode, uint16_t refresh_rate) {
 
  // Local variable definition
  uint16_t kb_idx, b_idx;
 
  // Initialize frame buffer
#ifndef VERILOG_SIMULATION
  VID_RAM0_ADDR  = PIX_ADDR(0, 0);
  for( kb_idx = 0; kb_idx < FRAME_MEMORY_KB_SIZE/2; kb_idx = kb_idx + 1 ) {
    for( b_idx = 0; b_idx < 1024; b_idx = b_idx + 1 ) {
      VID_RAM0_DATA = 0x0000;
    }
  }
#endif
  VID_RAM0_ADDR     = PIX_ADDR(0, 0);
 
  // Configure Video mode
  GFX_CTRL          = gfx_mode | GFX_REFR_START_IRQ_DIS | GFX_REFR_DONE_IRQ_DIS | GFX_GPU_EN;
 
  // Configure Refresh Rate
  LT24_REFRESH_SYNC = LT24_REFR_SYNC | 0x0000;
  LT24_REFRESH      = refresh_rate;
 
  // Global configuration registers
  DISPLAY_WIDTH     = SCREEN_WIDTH;
  DISPLAY_HEIGHT    = SCREEN_HEIGHT;
  DISPLAY_SIZE      = (uint32_t)SCREEN_WIDTH * (uint32_t)SCREEN_HEIGHT;
 
#ifdef LT24_ROTATE
  DISPLAY_CFG       = DISPLAY_NO_X_SWAP | DISPLAY_NO_Y_SWAP | DISPLAY_NO_CL_SWAP;
#else
  DISPLAY_CFG       = DISPLAY_NO_X_SWAP | DISPLAY_NO_Y_SWAP | DISPLAY_CL_SWAP;
#endif
 
  // Initialize LT24 module
  init_lt24 (LT24_CLK_DIV2);
 
}
 
//----------------------------------------------------------
// Start Graphic controller
//----------------------------------------------------------
void start_gfx_ctrl (void) {
 
  start_lt24();
 
  LT24_REFRESH  = LT24_REFRESH | LT24_REFR_START;
 
}
 
//----------------------------------------------------------
// Initialize LT24 controller
//----------------------------------------------------------
void init_lt24 (uint16_t lt24_clk_div) {
 
  // Enable LCD, generate a reset and set LCD clock
  LT24_CFG       = 0x0000;
  ta_wait_no_lpm(WT_1MS);
  LT24_CFG       = LT24_ON | lt24_clk_div | LT24_RESET;
  ta_wait_no_lpm(WT_1MS);
  LT24_CFG       = LT24_ON | lt24_clk_div;
  ta_wait_no_lpm(WT_500MS+WT_20MS);
 
  // Set color mode to 16bits/pixel
  LT24_CMD       = 0x003A | LT24_CMD_HAS_PARAM;
  LT24_CMD_PARAM = 0x0055;
  while((LT24_STATUS & LT24_STATUS_WAIT_PARAM)==0);
  LT24_CMD       = 0x0000;
 
  // Define image rotation on the display
  // (MADCTL command: see pages 127 and 209 of the ILI9341 spec)
#ifdef LT24_ROTATE
  LT24_CMD       = 0x0036 | LT24_CMD_HAS_PARAM;
  LT24_CMD_PARAM = 0x0028;
  while((LT24_STATUS & LT24_STATUS_WAIT_PARAM)==0);
  LT24_CMD       = 0x0000;
#else
  LT24_CMD       = 0x0036 | LT24_CMD_HAS_PARAM;
  LT24_CMD_PARAM = 0x0008;
  while((LT24_STATUS & LT24_STATUS_WAIT_PARAM)==0);
  LT24_CMD       = 0x0000;
#endif
 
  // Send CASET
  LT24_CMD       = 0x002A | LT24_CMD_HAS_PARAM;
  LT24_CMD_PARAM = ( 0              & 0xFF00)>>8;   // CASET_SC[15:8]
  while((LT24_STATUS & LT24_STATUS_WAIT_PARAM)==0);
  LT24_CMD_PARAM = ( 0              & 0x00FF);      // CASET_SC[7:0]
  while((LT24_STATUS & LT24_STATUS_WAIT_PARAM)==0);
#ifdef LT24_ROTATE
  LT24_CMD_PARAM = ( SCREEN_WIDTH   & 0xFF00)>>8;   // CASET_EC[15:8]
#else
  LT24_CMD_PARAM = ( SCREEN_HEIGHT  & 0xFF00)>>8;   // CASET_EC[15:8]
#endif
  while((LT24_STATUS & LT24_STATUS_WAIT_PARAM)==0);
#ifdef LT24_ROTATE
  LT24_CMD_PARAM = ( SCREEN_WIDTH  & 0x00FF);      // CASET_EC[7:0]
#else
  LT24_CMD_PARAM = ( SCREEN_HEIGHT   & 0x00FF);      // CASET_EC[7:0]
#endif
  while((LT24_STATUS & LT24_STATUS_WAIT_PARAM)==0);
  LT24_CMD       = 0x0000;
 
  // Send PASET
  LT24_CMD       = 0x002B | LT24_CMD_HAS_PARAM;
  LT24_CMD_PARAM = ( 0              & 0xFF00)>>8;  // PASET_SC[15:8]
  while((LT24_STATUS & LT24_STATUS_WAIT_PARAM)==0);
  LT24_CMD_PARAM = ( 0              & 0x00FF);     // PASET_SC[7:0]
  while((LT24_STATUS & LT24_STATUS_WAIT_PARAM)==0);
#ifdef LT24_ROTATE
  LT24_CMD_PARAM = ( SCREEN_HEIGHT  & 0xFF00)>>8;  // PASET_EC[15:8]
#else
  LT24_CMD_PARAM = ( SCREEN_WIDTH  & 0xFF00)>>8;  // PASET_EC[15:8]
#endif
  while((LT24_STATUS & LT24_STATUS_WAIT_PARAM)==0);
#ifdef LT24_ROTATE
  LT24_CMD_PARAM = ( SCREEN_HEIGHT  & 0x00FF);     // PASET_EC[7:0]
#else
  LT24_CMD_PARAM = ( SCREEN_WIDTH   & 0x00FF);     // PASET_EC[7:0]
#endif
  while((LT24_STATUS & LT24_STATUS_WAIT_PARAM)==0);
  LT24_CMD       = 0x0000;
 
  // Initialize the LT24 display memory
#ifndef VERILOG_SIMULATION
  LT24_CMD_DFILL = 0x0000;
  while((LT24_STATUS & LT24_STATUS_DFILL_BUSY)!=0);
#endif
 
  // Display on
  LT24_CMD       = 0x0035 | LT24_CMD_NO_PARAM;
  LT24_CMD_PARAM = 0x0000;
 
  return;
}
 
//----------------------------------------------------------
// Start LT24 controller
//----------------------------------------------------------
void start_lt24(void) {
 
  // Display on
  LT24_CMD       = 0x0029 | LT24_CMD_NO_PARAM;
  LT24_CMD_PARAM = 0x0000;
  ta_wait_no_lpm(WT_10MS);
 
  // Go out of SLEEP
  LT24_CMD       = 0x0011 | LT24_CMD_NO_PARAM;
  LT24_CMD_PARAM = 0x0000;
  ta_wait_no_lpm(WT_100MS);
 
  return;
}
 
//----------------------------------------------------------
// Wait for the refresh to be done
//----------------------------------------------------------
void sync_screen_refresh_done(void) {
 
  // Clear IRQ flag
  GFX_IRQ |= GFX_IRQ_REFRESH_DONE;
 
  // Wait for flag to be set
  while((GFX_IRQ & GFX_IRQ_REFRESH_DONE)==0);
 
  return;
}
 
//----------------------------------------------------------
// Wait for the refresh to start
//----------------------------------------------------------
void sync_screen_refresh_start(void) {
 
  // Clear IRQ flag
  GFX_IRQ |= GFX_IRQ_REFRESH_START;
 
  // Wait for flag to be set
  while((GFX_IRQ & GFX_IRQ_REFRESH_START)==0);
 
  return;
}
 
//==========================================================
// GPU FUNCTIONS
//==========================================================
 
void gpu_fill (uint32_t addr, uint16_t width, uint16_t length, uint16_t color, uint16_t configuration) {
 
  while((GPU_STAT & GPU_STAT_FIFO_CNT_EMPTY)<7);
  GPU_CMD   = GPU_REC_WIDTH  | width;
  GPU_CMD   = GPU_REC_HEIGHT | length;
  GPU_CMD   = GPU_DST_PX_ADDR; GPU_CMD32 = addr;
  GPU_CMD   = GPU_EXEC_FILL  | configuration ;
  GPU_CMD   = color;
}
 
 
void gpu_copy (uint32_t src_addr, uint32_t dst_addr, uint16_t width, uint16_t length, uint16_t configuration) {
 
  while((GPU_STAT & GPU_STAT_FIFO_CNT_EMPTY)<9);
  GPU_CMD  = GPU_REC_WIDTH  | width;
  GPU_CMD  = GPU_REC_HEIGHT | length;
  GPU_CMD  = GPU_DST_PX_ADDR; GPU_CMD32 = dst_addr;
  GPU_CMD  = GPU_SRC_PX_ADDR; GPU_CMD32 = src_addr;
  GPU_CMD  = GPU_EXEC_COPY  | configuration ;
}
 
 
void gpu_copy_transparent (uint32_t src_addr, uint32_t dst_addr, uint16_t width, uint16_t length, uint16_t trans_color, uint16_t configuration) {
 
  while((GPU_STAT & GPU_STAT_FIFO_CNT_EMPTY)<9);
  GPU_CMD  = GPU_REC_WIDTH  | width;
  GPU_CMD  = GPU_REC_HEIGHT | length;
  GPU_CMD  = GPU_SET_TRANS;   GPU_CMD   = trans_color;
  GPU_CMD  = GPU_DST_PX_ADDR; GPU_CMD32 = dst_addr;
  GPU_CMD  = GPU_SRC_PX_ADDR; GPU_CMD32 = src_addr;
  GPU_CMD  = GPU_EXEC_COPY_TRANS  | configuration ;
}
 
inline void gpu_wait_done (void) {
    while((GPU_STAT & GPU_STAT_BUSY)!=0);
}