Subversion Repositories openrisc_me

/* fb.c -- Simple frame buffer
 
   Copyright (C) 2001 Marko Mlinar, markom@opencores.org
   Copyright (C) 2008 Embecosm Limited
 
   Contributor Jeremy Bennett <jeremy.bennett@embecosm.com>
 
   This file is part of Or1ksim, the OpenRISC 1000 Architectural Simulator.
 
   This program is free software; you can redistribute it and/or modify it
   under the terms of the GNU General Public License as published by the Free
   Software Foundation; either version 3 of the License, or (at your option)
   any later version.
 
   This program is distributed in the hope that it will be useful, but WITHOUT
   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
   FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
   more details.
 
   You should have received a copy of the GNU General Public License along
   with this program.  If not, see <http://www.gnu.org/licenses/>.  */
 
/* This program is commented throughout in a fashion suitable for processing
   with Doxygen. */
 
 
/* Autoconf and/or portability configuration */
#include "config.h"
#include "port.h"
 
/* System includes */
#include <stdlib.h>
#include <stdio.h>
 
/* Package includes */
#include "arch.h"
#include "sim-config.h"
#include "abstract.h"
#include "sched.h"
#include "toplevel-support.h"
 
 
#define FB_SIZEX           640
#define FB_SIZEY           480
 
#define CAM_SIZEX	   352
#define CAM_SIZEY	   288
 
/*! Relative amount of time spent in refresh */
#define REFRESH_DIVIDER	    20
 
#define FB_CTRL            0x0000
#define FB_BUFADDR         0x0004
#define FB_CAMBUFADDR      0x0008
#define FB_CAMPOSADDR      0x000c
#define FB_PAL             0x0400
 
#define FB_WRAP (512*1024)
 
struct fb_state
{
  int enabled;
  unsigned long pal[256];
  int ctrl;
  int pic;
  int in_refresh;
  int refresh_count;
  oraddr_t addr;
  oraddr_t cam_addr;
  int camerax;
  int cameray;
  int camera_pos;
  oraddr_t baseaddr;
  int refresh;
  int refresh_rate;
  char *filename;
};
 
static void
change_buf_addr (struct fb_state *fb, oraddr_t addr)
{
  fb->addr = addr;
}
 
/* Write a register */
static void
fb_write32 (oraddr_t addr, uint32_t value, void *dat)
{
  struct fb_state *fb = dat;
 
  switch (addr)
    {
    case FB_CTRL:
      fb->ctrl = value;
      break;
    case FB_BUFADDR:
      change_buf_addr (fb, value);
      break;
    case FB_CAMBUFADDR:
      fb->cam_addr = value;
      break;
    case FB_CAMPOSADDR:
      fb->camera_pos = value;
      fb->camerax = value % FB_SIZEX;
      fb->cameray = value / FB_SIZEX;
      break;
    default:
      addr -= FB_PAL;
      addr /= 4;
      if (addr < 0 || addr >= 256)
	{
	  fprintf (stderr, "Write out of palette buffer (0x%" PRIxADDR ")!\n",
		   addr);
	}
      else
	fb->pal[addr] = value;
      break;
    }
}
 
/* Read a register */
static oraddr_t
fb_read32 (oraddr_t addr, void *dat)
{
  struct fb_state *fb = dat;
 
  switch (addr)
    {
    case FB_CTRL:
      return (fb->ctrl & ~0xff000000) | (fb->
					 in_refresh ? 0x80000000 : 0) |
	((unsigned long) (fb->refresh_count & 0x7f) << 24);
      break;
    case FB_BUFADDR:
      return fb->addr;
      break;
    case FB_CAMBUFADDR:
      return fb->cam_addr;
      break;
    case FB_CAMPOSADDR:
      return fb->camera_pos;
      break;
    default:
      addr -= FB_PAL;
      addr /= 4;
      if (addr < 0 || addr >= 256)
	{
	  fprintf (stderr, "Read out of palette buffer (0x%" PRIxADDR ")!\n",
		   addr);
	  return 0;
	}
      else
	return fb->pal[addr];
    }
}
 
/* define these also for big endian */
#if __BIG_ENDIAN__
#define CNV32(x) (\
     ((((x) >> 24) & 0xff) << 0)\
   | ((((x) >> 16) & 0xff) << 8)\
   | ((((x) >> 8) & 0xff) << 16)\
   | ((((x) >> 0) & 0xff) << 24))
#define CNV16(x) (\
     ((((x) >> 8) & 0xff) << 0)\
   | ((((x) >> 0) & 0xff) << 8))
#else
#define CNV16(x) (x)
#define CNV32(x) (x)
#endif
 
/* Dumps a bmp file, based on current image */
static int
fb_dump_image8 (struct fb_state *fb, char *filename)
{
  int sx = FB_SIZEX;
  int sy = FB_SIZEY;
  int i, x = 0, y = 0;
  FILE *fo;
 
  unsigned short int u16;
  unsigned long int u32;
 
  if (config.sim.verbose)
    PRINTF ("Creating %s...", filename);
  fo = fopen (filename, "wb+");
  u16 = CNV16 (19778);		/* BM */
  if (!fwrite (&u16, 2, 1, fo))
    return 1;
  u32 = CNV32 (14 + 40 + sx * sy + 1024);	/* size */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (0);		/* reserved */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = 14 + 40 + 1024;		/* offset */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
 
  u32 = CNV32 (40);		/* header size */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (sx);		/* width */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (sy);		/* height */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u16 = CNV16 (1);		/* planes */
  if (!fwrite (&u16, 2, 1, fo))
    return 1;
  u16 = CNV16 (8);		/* bits */
  if (!fwrite (&u16, 2, 1, fo))
    return 1;
  u32 = CNV32 (0);		/* compression */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (x * y);		/* image size */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (2835);		/* x resolution */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (2835);		/* y resolution */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (0);		/* ncolours = 0; should be generated */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (0);		/* important colours; all are important */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
 
  for (i = 0; i < 256; i++)
    {
      unsigned long val, d;
      d = fb->pal[i];
#if 1
      val = ((d >> 0) & 0x1f) << 3;	/* Blue */
      val |= ((d >> 5) & 0x3f) << 10;	/* Green */
      val |= ((d >> 11) & 0x1f) << 19;	/* Red */
#else
      val = CNV32 (pal[i]);
#endif
      if (!fwrite (&val, 4, 1, fo))
	return 1;
    }
 
  if (config.sim.verbose)
    PRINTF ("(%i,%i)", sx, sy);
  /* Data is stored upside down */
  for (y = sy - 1; y >= 0; y--)
    {
      int align = (4 - sx) % 4;
      int zero = CNV32 (0);
      int add;
      while (align < 0)
	align += 4;
      for (x = 0; x < sx; x++)
	{
	  add =
	    (fb->
	     addr & ~(FB_WRAP - 1)) | ((fb->addr + y * sx + x) & (FB_WRAP -
								  1));
	  fputc (eval_direct8 (add, 0, 0), fo);
	}
      if (align && !fwrite (&zero, align, 1, fo))
	return 1;
    }
 
  if (config.sim.verbose)
    PRINTF ("DONE\n");
  fclose (fo);
  return 0;
}
 
/* Dumps a bmp file, based on current image */
static int
fb_dump_image24 (struct fb_state *fb, char *filename)
{
  int sx = FB_SIZEX;
  int sy = FB_SIZEY;
  int x = 0, y = 0;
  FILE *fo;
 
  unsigned short int u16;
  unsigned long int u32;
 
  if (config.sim.verbose)
    PRINTF ("Creating %s...", filename);
  fo = fopen (filename, "wb+");
  u16 = CNV16 (19778);		/* BM */
  if (!fwrite (&u16, 2, 1, fo))
    return 1;
  u32 = CNV32 (14 + 40 + sx * sy * 3);	/* size */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (0);		/* reserved */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = 14 + 40;		/* offset */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
 
  u32 = CNV32 (40);		/* header size */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (sx);		/* width */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (sy);		/* height */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u16 = CNV16 (1);		/* planes */
  if (!fwrite (&u16, 2, 1, fo))
    return 1;
  u16 = CNV16 (24);		/* bits */
  if (!fwrite (&u16, 2, 1, fo))
    return 1;
  u32 = CNV32 (0);		/* compression */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (x * y * 3);	/* image size */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (2835);		/* x resolution */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (2835);		/* y resolution */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (0);		/* ncolours = 0; should be generated */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
  u32 = CNV32 (0);		/* important colours; all are important */
  if (!fwrite (&u32, 4, 1, fo))
    return 1;
 
  if (config.sim.verbose)
    PRINTF ("(%i,%i)", sx, sy);
  /* Data is stored upside down */
  for (y = sy - 1; y >= 0; y--)
    {
      unsigned char line[FB_SIZEX][3];
      for (x = 0; x < sx; x++)
	if (y >= fb->cameray && x >= fb->camerax
	    && y < fb->cameray + CAM_SIZEY && x < fb->camerax + CAM_SIZEX)
	  {
	    int add =
	      (fb->cam_addr +
	       (x - fb->camerax + (y - fb->cameray) * CAM_SIZEX) * 2) ^ 2;
	    unsigned short d = eval_direct16 (add, 0, 0);
	    line[x][0] = ((d >> 0) & 0x1f) << 3;	/* Blue */
	    line[x][1] = ((d >> 5) & 0x3f) << 2;	/* Green */
	    line[x][2] = ((d >> 11) & 0x1f) << 3;	/* Red */
	  }
	else
	  {
	    int add =
	      (fb->
	       addr & ~(FB_WRAP - 1)) | ((fb->addr + y * sx + x) & (FB_WRAP -
								    1));
	    unsigned short d = fb->pal[eval_direct8 (add, 0, 0)];
	    line[x][0] = ((d >> 0) & 0x1f) << 3;	/* Blue */
	    line[x][1] = ((d >> 5) & 0x3f) << 2;	/* Green */
	    line[x][2] = ((d >> 11) & 0x1f) << 3;	/* Red */
	  }
      if (!fwrite (line, sizeof (line), 1, fo))
	return 1;
    }
 
  if (config.sim.verbose)
    PRINTF ("DONE\n");
  fclose (fo);
  return 0;
}
 
static void
fb_job (void *dat)
{
  struct fb_state *fb = dat;
 
  if (fb->refresh)
    {
      /* dump the image? */
      if (fb->ctrl & 1)
	{
	  char temp[STR_SIZE];
	  sprintf (temp, "%s%04i.bmp", fb->filename, fb->pic);
	  if (fb->ctrl & 2)
	    fb_dump_image24 (fb, temp);
	  else
	    fb_dump_image8 (fb, temp);
	  fb->pic++;
	}
      SCHED_ADD (fb_job, dat, fb->refresh_rate / REFRESH_DIVIDER);
      fb->in_refresh = 0;
      fb->refresh = 0;
    }
  else
    {
      fb->refresh_count++;
      fb->refresh = 1;
      SCHED_ADD (fb_job, dat, fb->refresh_rate / REFRESH_DIVIDER);
    }
}
 
/* Reset all FBs */
static void
fb_reset (void *dat)
{
  struct fb_state *fb = dat;
  int i;
 
  fb->pic = 0;
  fb->addr = 0;
  fb->ctrl = 0;
 
  for (i = 0; i < 256; i++)
    fb->pal[i] = (i << 16) | (i << 8) | (i << 0);
 
  SCHED_ADD (fb_job, dat, fb->refresh_rate);
  fb->refresh = 0;
}
 
/*-----------------------------------------------------[ FB configuration ]---*/
static void
fb_enabled (union param_val val, void *dat)
{
  struct fb_state *fb = dat;
  fb->enabled = val.int_val;
}
 
 
static void
fb_baseaddr (union param_val val, void *dat)
{
  struct fb_state *fb = dat;
  fb->baseaddr = val.addr_val;
}
 
 
static void
fb_refresh_rate (union param_val val, void *dat)
{
  struct fb_state *fb = dat;
  fb->refresh_rate = val.int_val;
}
 
 
/*---------------------------------------------------------------------------*/
/*!Set the frame buffer output file
 
   Free any previously allocated value.
 
   @param[in] val  The value to use
   @param[in] dat  The config data structure                                 */
/*---------------------------------------------------------------------------*/
static void
fb_filename (union param_val  val,
	     void            *dat)
{
  struct fb_state *fb = dat;
 
  if (NULL != fb->filename)
    {
      free (fb->filename);
      fb->filename = NULL;
    }
 
  if (!(fb->filename = strdup (val.str_val)))
    {
      fprintf (stderr, "Peripheral FB: Run out of memory\n");
      exit (-1);
    }
}	/* fb_filename() */
 
 
/*---------------------------------------------------------------------------*/
/*!Initialize a new frame buffer configuration
 
   ALL parameters are set explicitly to default values.                      */
/*---------------------------------------------------------------------------*/
static void *
fb_sec_start ()
{
  struct fb_state *new = malloc (sizeof (struct fb_state));
 
  if (!new)
    {
      fprintf (stderr, "Peripheral FB: Run out of memory\n");
      exit (-1);
    }
 
  new->enabled       = 1;
  new->baseaddr      = 0;
  new->refresh_rate  = 1000000000000ULL / 50ULL / config.sim.clkcycle_ps;
  new->filename      = strdup ("fb_out");
 
  new->ctrl          = 0;
  new->pic           = 0;
  new->in_refresh    = 1;
  new->refresh_count = 0;
  new->addr          = 0;
  new->cam_addr      = 0;
  new->camerax       = 0;
  new->cameray       = 0;
  new->camera_pos    = 0;
 
  return new;
 
}	/* fb_sec_start() */
 
 
static void
fb_sec_end (void *dat)
{
  struct fb_state *fb = dat;
  struct mem_ops ops;
 
  if (!fb->enabled)
    {
      free (fb->filename);
      free (fb);
      return;
    }
 
  memset (&ops, 0, sizeof (struct mem_ops));
 
  ops.readfunc32 = fb_read32;
  ops.writefunc32 = fb_write32;
  ops.write_dat32 = dat;
  ops.read_dat32 = dat;
 
  /* FIXME: Correct delay? */
  ops.delayr = 2;
  ops.delayw = 2;
 
  reg_mem_area (fb->baseaddr, FB_PAL + 256 * 4, 0, &ops);
 
  reg_sim_reset (fb_reset, dat);
}
 
void
reg_fb_sec ()
{
  struct config_section *sec =
    reg_config_sec ("fb", fb_sec_start, fb_sec_end);
 
  reg_config_param (sec, "baseaddr", paramt_addr, fb_baseaddr);
  reg_config_param (sec, "enabled", paramt_int, fb_enabled);
  reg_config_param (sec, "refresh_rate", paramt_int, fb_refresh_rate);
  reg_config_param (sec, "txfile", paramt_str, fb_filename);
  reg_config_param (sec, "filename", paramt_str, fb_filename);
}