grafX2/libraw2crtc.c

/* vim:expandtab:ts=2 sw=2:
*/
/* GFX2CRTC - libraw2crtc.c
 * CloudStrife - 20080921
 * Diffusé sous licence libre CeCILL v2
 * Voire LICENCE
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>

#include "global.h"

unsigned short addrCalc(unsigned char vcc, unsigned char rcc, unsigned char hcc, unsigned char cclk, unsigned char r1, unsigned char r12, unsigned char r13)
{
  unsigned short MA;
  unsigned short addr;

  //MA = vcc*r1 + hcc + (0x0C)*256;
  MA = vcc*r1 + hcc + r12*256 + r13;
  addr = cclk | ((MA & 0x03FF) << 1);
  addr = addr | ((rcc & 0x07) << 11);
  addr = addr | ((MA & 0x3000) << 2);

  return addr;
}

unsigned char mode0interlace(unsigned char x, unsigned char y)
{
  unsigned char mode0pixel[] = {0, 64, 4, 68, 16, 80, 20, 84, 1, 65, 5, 69, 17, 81, 21, 85};
  return mode0pixel[Read_pixel_function(x,y)] << 1 | mode0pixel[Read_pixel_function(x+1,y)];
}

unsigned char mode1interlace(unsigned char x, unsigned char y)
{
  unsigned char mode1pixel[] = {0, 16, 1, 17};
  return mode1pixel[Read_pixel_function(x,y)] << 3 | mode1pixel[Read_pixel_function(x+1,y)] << 2 | mode1pixel[Read_pixel_function(x+2,y)] << 1 | mode1pixel[Read_pixel_function(x+3,y)];
}

unsigned char mode2interlace(unsigned char x, unsigned char y)
{
  unsigned char out = 0;
  int i;
  for(i = 0; i < 8; i++) out += ((Read_pixel_function(x+7-i,y)&1) << i);
  return out;
}

unsigned char mode3interlace(unsigned char x, unsigned char y)
{
  unsigned char mode3pixel[] = {0, 16, 1, 17};
  return mode3pixel[Read_pixel_function(x,y)] << 3 | mode3pixel[Read_pixel_function(x+1,y)] << 2;
}

unsigned char (*ptrMode)(unsigned char x, unsigned char y);

unsigned char *raw2crtc(unsigned short width, unsigned short height, unsigned char mode, unsigned char r9, unsigned long *outSize, unsigned char *r1, unsigned char r12, unsigned char r13)
{
  unsigned char *outBuffer;
  unsigned char *tmpBuffer;
  unsigned char *allocationBuffer;
  unsigned short minAddr = 0;
  unsigned char minAddrIsDefined = 0;
  unsigned short maxAddr = 0;

  unsigned char nbPixPerByte;
  int y,x;
  unsigned char r6;
  unsigned short i;
  unsigned char *ptrTmp;
  unsigned char *ptrOut;
  unsigned char vcc;
  unsigned char rcc;
  unsigned char hcc;
  unsigned char cclk;
  
  switch(mode)
  {
    case 0:
    {
      *r1 = (width+3)/4;
      nbPixPerByte = 2;
      ptrMode = mode0interlace;
      break;
    }
    case 1:
    {
      *r1 = (width+7)/8;
      nbPixPerByte = 4;
      ptrMode = mode1interlace;
      break;
    }
    case 2:
    {
      *r1 = (width+15)/16;
      nbPixPerByte = 8;
      ptrMode = mode2interlace;
      break;
    }
    case 3:
    {
      *r1 = (width+3)/4;
      nbPixPerByte = 2;
      ptrMode = mode3interlace;
      break;
    }
    default:
    {
      exit(4);
    }
  }

  tmpBuffer = (unsigned char*)malloc(0xFFFF);
  if (tmpBuffer == NULL)
  {
    printf("Allocation tmpBuffer raté\n");
    exit(4);
  }

  allocationBuffer = (unsigned char*)malloc(0xFFFF);
  if(allocationBuffer == NULL)
  {
    printf("Allocation allocationBuffer raté\n");
    exit(4);
  }
  memset(allocationBuffer, 0, 0xFFFF);

  r6 = height/(r9+1);

  for(vcc = 0; vcc < r6; vcc++)
  {
    for(rcc = 0; rcc < (r9+1); rcc++)
    {
      for(hcc = 0; hcc < *r1; hcc++)
      {
	for(cclk = 0; cclk < 2; cclk++)
	{
	  x = (hcc << 1 | cclk);
	  y = vcc*(r9+1) + rcc;
	  *(tmpBuffer + addrCalc(vcc, rcc, hcc, cclk, *r1, r12, r13)) = (*ptrMode)(x,y);
	  *(allocationBuffer + addrCalc(vcc, rcc, hcc, cclk, *r1, r12, r13)) += 1;
	}
      }
    }
  }

  for(i = 0; i < 0xFFFF; i++)
  {
    if(*(allocationBuffer + i) > 1)
    {
      printf("Attention : Ecriture multiple a l'adresse mémoire %d\n",i);
    }
    if(*(allocationBuffer + i) > 0)
    {
      maxAddr = i;
    }
    if((*(allocationBuffer + i) == 1) && (minAddrIsDefined == 0))
    {
      minAddr = i;
      minAddrIsDefined = 1;
    }
  }

  *outSize = (maxAddr + 1) - minAddr;

  outBuffer = (unsigned char*)malloc((*outSize));
  if (outBuffer == NULL)
  {
    printf("Allocation outBuffer raté\n");
    exit(4);
  }

  ptrTmp = tmpBuffer + minAddr;
  ptrOut = outBuffer;

  for(i = minAddr; i <= maxAddr; i++)
  {
    *(ptrOut++) = *(ptrTmp++);
  }

  free(tmpBuffer);
  tmpBuffer = NULL;
  free(allocationBuffer);
  allocationBuffer = NULL;
  
  return outBuffer;
}