Initial import for public releaseHEADmain

1 files changed, 186 insertions, 0 deletions

diff --git a/tools/gfx2crtc/libraw2crtc.c b/tools/gfx2crtc/libraw2crtc.c
new file mode 100644
index 0000000..b7d2f97
--- /dev/null
+++ b/tools/gfx2crtc/libraw2crtc.c
@@ -0,0 +1,186 @@
+/* GFX2CRTC - libraw2crtc.c
+ * CloudStrife - 20080921
+ * Diffusé sous licence libre CeCILL v2
+ * Voire LICENCE
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.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 mode0pixel[] = {0, 64, 4, 68, 16, 80, 20, 84, 1, 65, 5, 69, 17, 81, 21, 85};
+  return mode0pixel[x[0]] << 1 | mode0pixel[x[1]];
+}
+
+unsigned char mode1interlace(unsigned char *x)
+{
+  unsigned char mode1pixel[] = {0, 16, 1, 17};
+  return mode1pixel[x[0]] << 3 | mode1pixel[x[1]] << 2 | mode1pixel[x[2]] << 1 | mode1pixel[x[3]];
+}
+
+unsigned char mode2interlace(unsigned char *x)
+{
+  unsigned char out = 0;
+  int i;
+  for(i = 0; i < 8; i++) out += ((x[7-i]&1) << i);
+  return out;
+}
+
+unsigned char mode3interlace(unsigned char *x)
+{
+  unsigned char mode3pixel[] = {0, 16, 1, 17};
+  return mode3pixel[x[0]] << 3 | mode3pixel[x[1]] << 2;
+}
+
+unsigned char (*ptrMode)(unsigned char *x);
+
+unsigned char *raw2crtc(unsigned char *input, 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* reg6)
+{
+  unsigned char *outBuffer;
+  unsigned char *tmpBuffer;
+  unsigned char *allocationBuffer;
+  unsigned short minAddr = 0;
+  unsigned char minAddrIsDefined = 0;
+  unsigned short maxAddr;
+
+  unsigned char nbPixPerByte;
+  int y,x;
+
+  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*)calloc(0xFFFF, 1);
+  if(allocationBuffer == NULL)
+  {
+    printf("Allocation allocationBuffer raté\n");
+    exit(4);
+  }
+
+  {
+	unsigned char r6;
+	unsigned char vcc,rcc,hcc,cclk;
+	r6 = (height+r9)/(r9+1);
+	*reg6 = r6;
+	
+	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)(input + y*width + x*nbPixPerByte);
+			  *(allocationBuffer + addrCalc(vcc, rcc, hcc, cclk, *r1, r12, r13)) += 1;
+			}
+	      }
+	    }
+	}
+  }
+
+	{
+	  unsigned short i;
+	  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);
+  }
+
+	{
+	  unsigned char *ptrTmp;
+	  unsigned char *ptrOut;
+	  unsigned short i;
+	  ptrTmp = tmpBuffer + minAddr;
+	  ptrOut = outBuffer;
+	
+	  for(i = minAddr; i <= maxAddr; i++)
+	  {
+	    *(ptrOut++) = *(ptrTmp++);
+	  }
+	}
+  free(tmpBuffer);
+  tmpBuffer = NULL;
+  free(allocationBuffer);
+  allocationBuffer = NULL;
+  
+  return outBuffer;
+}