source: thomson/tools/gfx2mo5/libraw2mo5.c@ 99bc67a

/* GFX2mo5 - libraw2mo5.c
 * CloudStrife - 20080921
 * PulkoMandy - 20101221
 * Diffusé sous licence libre CeCILL v2
 * Voire LICENCE
 */

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

unsigned char *raw2mo5(unsigned char *input)
{
  unsigned char *tmpBuffer;
  int x,y;

  tmpBuffer = (unsigned char*)calloc(0x4000,1);
  if (tmpBuffer == NULL)
  {
    printf("Allocation tmpBuffer raté\n");
    exit(4);
  }
        #define width 320

  for (y = 0; y < 200; y++)
        for (x = 0; x < 320; x+=8) {
                int fore = 255;
                int back = 255;
                int pix;
                for(pix = 0; pix < 8; pix++) {
                        int nc = input[y*width+x+pix];
                        if (nc > 15) printf("Color over limit!\n");
                        if (back == nc) {
                                // Pixel is in backcolor, set FORME to 0
                        } else if (fore == nc) {
                                // Pixel is in forecolor, set FORME to 1
                                tmpBuffer[(y*320+x)/8] |= 0x80>>pix;
                        } else if (back==255) {
                                // Pixel is in unknown color, back is free : allocate backcolor
                                back = nc;
                        } else if (fore == 255) {
                                // Pixel is unknown color, back is allocated : allocate front and set FORME
                                fore = nc;
                                tmpBuffer[(y*320+x)/8] |= 0x80>>pix;
                        } else {
                                printf("Color clash at %d %d : %d %d %d\n",x+pix,y,fore, back,
                                        input[y*width+x+pix]);
                        }
                }
                if (fore == 255) fore = 0;
                if (back == 255) back = 0;

                tmpBuffer[0x2000+(y*320+x)/8] = (fore << 4) | back;
  }

  return tmpBuffer;
}