Subversion Repositories scarm

// scLCDCtrl.cpp: implementation of the scLCDCtrl class.
//
//////////////////////////////////////////////////////////////////////
 
#include "scLCDCtrl.h"
 
//////////////////////////////////////////////////////////////////////
// Construction/Destruction
//////////////////////////////////////////////////////////////////////
 
sscLCDCtrl::scLCDCtrl()
{
  //printf(MODULE_NAME": In Constructor\n");
  if((fScreen = fopen(LCDCTRL_SCREENFILE,"w")) == NULL)
  {
    fprintf(stderr,MODULE_NAME": Error opening %d\n",LCDCTRL_SCREENFILE);
    exit(1);
  }
  Reset();
}
///////////////////////////////////////////////////////////////////////////////
// ~CLCDCtrl - 
//
scLCDCtrl::~scLCDCtrl()
{
  //printf(MODULE_NAME": In Destructor\n");
  fclose(fScreen);
}
 
 
///////////////////////////////////////////////////////////////////////////////
// Reset -
//
void scLCDCtrl::Reset()
{
  int r, g, b, colorinc;
  double dcolorinc;
 
  memset(m_regs, 0, sizeof(uint32_t) * LCDCTRL_NUMREGS);
  m_regs[R_LCDVER] = 0x00001000; // v0.1
 
  r = g = b = 0;
  dcolorinc = (double)0xff/LCDCTRL_NUMPALS;
  colorinc = (int) dcolorinc+1;
  for(int i = 0; i < LCDCTRL_NUMPALS; i++)
  {
    r = g = b = i*colorinc;      
    m_pals[i] = ( (r << 16) | (g << 8) | b );
  }
}
 
 
///////////////////////////////////////////////////////////////////////////////
// UpdateScreen - 
//
void scLCDCtrl::UpdateScreen()
{
  //printf(MODULE_NAME": Updating Screen\n");
  fseek(fScreen,0,SEEK_SET);
  for(int i = 0; i < LCDCTRL_NUMPALS; i++)
    fprintf(fScreen, "Pal[%x] = %x\n", i, m_pals[i]);
  fflush(fScreen);
}
 
///////////////////////////////////////////////////////////////////////////////
// Cycle - 
//
void scLCDCtrl::Cycle(LCDCTRLBUS* bus)
{
  static int CycleCount = 0;
 
 
  if( (CycleCount++ % LCDCTRL_UPDATEINTERVAL) == 0)
          UpdateScreen();
  // See what the pesky real world wants
  if (bus->w != 0)
  {
    uint32_t addr = bus->addr;
 
    // R_LCDVER        0x0
    if (addr == 0x00000004) // R_LCDRESOLUTION 0x1
      m_regs[R_LCDRESOLUTION] = bus->data;
    else if (addr == 0x00000008) // R_LCDCOLORDEPTH 0x2
      m_regs[R_LCDCOLORDEPTH] = bus->data;
    else if (addr == 0x0000000C) // R_LCDSTARTADDR  0x3
      m_regs[R_LCDSTARTADDR] = bus->data;
    // R_LCDRESERVED1  0x4
    // R_LCDPALINDEX   0x5
    // R_LCDPALDATA    0x6
    // R_LCDSTATUS     0x7
  }
 
 
  // Did the nosy busy body want any info?
  if (bus->r != 0)
  {
    uint32_t addr = bus->addr;
 
    if (addr == 0x00000000)
	    bus->data = m_regs[R_LCDVER];
    else if (addr == 0x00000004)
	    bus->data = m_regs[R_LCDRESOLUTION];
    else if (addr == 0x00000008)
	    bus->data = m_regs[R_LCDCOLORDEPTH];
    else if (addr == 0x0000000C)
	    bus->data = m_regs[R_LCDSTARTADDR];
    else
	    bus->data = 0;
  }
}