Subversion Repositories or1k

/* fb.c -- Simple frame buffer

   Copyright (C) 2001 Marko Mlinar, markom@opencores.org

This file is part of 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 2 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, write to the Free Software

Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */

#include <stdio.h>

#include "sim-config.h"

#include "abstract.h"

#include "fb.h"

#include "sched.h"

#define FB_WRAP (512*1024)

static unsigned long pal[256];

static int fb_ctrl = 0;

static int fb_pic = 0;

static unsigned long fb_addr = 0;

static void change_buf_addr (unsigned long addr)

{

  fb_addr = addr;

}

/* Write a register */

void fb_write32 (unsigned long addr, unsigned long value)

{

  int a = (addr - config.fb.baseaddr);

  switch (a) {

    case FB_CTRL:    fb_ctrl = value; break;

    case FB_BUFADDR: change_buf_addr (value); break;

    default:

      a -= FB_PAL;

      a /= 4;

      if (a < 0 || a >= 256) {

        fprintf (stderr, "Write out of palette buffer (0x%08x)!\n", addr);

        cont_run = 0;

      } else pal[a] = value;

      break;

  }

}

/* Read a register */

unsigned long fb_read32 (unsigned long addr)

{

  int a = (addr - config.fb.baseaddr);

  switch (a) {

    case FB_CTRL:    return fb_ctrl; break;

    case FB_BUFADDR: return fb_addr; break;

    default:

      a -= FB_PAL;

      a /= 4;

      if (a < 0 || a >= 256) {

        fprintf (stderr, "Read out of palette buffer (0x%08x)!\n", addr);

        cont_run = 0;

        return 0;

      } else return pal[a];

  }

}

/* define these also for big endian */

#define CNV16(x) (x)

#define CNV32(x) (x)

/* Dumps a bmp file, based on current image */

static int fb_dump_image (char *filename)

{

  int sx = FB_SIZEX;

  int sy = FB_SIZEY;

  int i, x, y;

  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(0);  /* x resolution */

  if (!fwrite (&u32, 4, 1, fo)) return 1;

  u32 = CNV32(0);  /* 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 = 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 (evalsim_mem8 (add), fo);

    }

    if (align && !fwrite (&zero, align, 1, fo)) return 1;

  }

  if (config.sim.verbose) printf ("DONE\n");

  fclose (fo);

  return 0;

}

void fb_job (int param)

{

  /* dump the image? */

  if (fb_ctrl) {

    char temp[STR_SIZE];

    sprintf (temp, "%s%04i.bmp", &config.fb.filename[0], fb_pic);

    fb_dump_image (temp);

    fb_pic++;

  }

  SCHED_ADD(fb_job, 0, cycles + config.fb.refresh_rate);

}

/* Reset all VGAs */

void fb_reset ()

{

  int i;

  if (config.fb.enabled) {

    fb_pic = 0;

    fb_addr = 0;

    fb_ctrl = 0;

    for (i = 0; i < 256; i++)

      pal[i] = (i << 16) | (i << 8) | (i << 0);

    if (config.fb.baseaddr)

      register_memoryarea(config.fb.baseaddr, FB_PAL + 256*4, 4, fb_read32, fb_write32);

    SCHED_ADD(fb_job, 0, cycles + config.fb.refresh_rate);

  }

}