util.c

#include <stdlib.h>
#include "util.h"

inline void clear_screen(const char *with)
{
  SMS_setNextTileatLoc(0);
  for (int i = 0; i < 896; i++)
    SMS_print(with);
}

const unsigned char color_reduction[]={RGB(0,0,0), RGB(0,0,1), RGB(0,1,1), RGB(1,1,1),
                                      RGB(1,1,2), RGB(1,2,2), RGB(2,2,2),
                                      RGB(2,2,3), RGB(2,3,3), RGB(3,3,3)};

#define COLOR_SUBTRACT(c,r) (((((r)&0x3)>=((c)&0x3))?0:(((c)&0x3)-((r)&0x3)))|((((r)&0xC)>=((c)&0xC))?0:(((c)&0xC)-((r)&0xC)))|((((r)&0x30)>=((c)&0x30))?0:(((c)&0x30)-((r)&0x30))))

__sfr __at 0x7E VDPVCounterPort;

void _SMS_loadBGPaletteafterColorSubtraction (const void *palette, const unsigned char subtraction_color) {
  unsigned char i;
  unsigned char j = 0;
  SMS_setNextBGColoratIndex(0);
  // precalculate the first four colors so that we tie up the CPU long enough to miss the bottom border
  unsigned char new_colors[16];
  for (i=0;i<16;j=i++) {
    new_colors[i] = COLOR_SUBTRACT(((unsigned char *)(palette))[i],subtraction_color);
    if (VDPVCounterPort >= 219)
      break;
  }
  for (i=0;i<=j;i++)
    SMS_setColor(new_colors[i]);

  for (;i<16;i++)
    SMS_setColor(COLOR_SUBTRACT(((unsigned char *)(palette))[i],subtraction_color));
}

void _SMS_loadSpritePaletteafterColorSubtraction (const void *palette, const unsigned char subtraction_color) {
  unsigned char i;
  unsigned char j = 0;
  SMS_setNextSpriteColoratIndex(0);
  // precalculate the first four colors so that we tie up the CPU long enough to miss the bottom border
  unsigned char new_colors[16];
  for (i=0;i<16;j=i++) {
    new_colors[i] = COLOR_SUBTRACT(((unsigned char *)(palette))[i],subtraction_color);
    if (VDPVCounterPort >= 219)
      break;
  }
  for (i=0;i<=j;i++)
    SMS_setColor(new_colors[i]);

  for (;i<16;i++)
    SMS_setColor(COLOR_SUBTRACT(((unsigned char *)(palette))[i],subtraction_color));
}

void fade_in(const void *bg_palette, const void *sprite_palette, unsigned int sprite_palette_bank)
{
  SMS_displayOff();
  for (int i = sizeof(color_reduction) - 1; i >= 0; i--)
  {
    SMS_waitForVBlank();

    if (bg_palette != NULL)
      _SMS_loadBGPaletteafterColorSubtraction(bg_palette, color_reduction[i]);

    SMS_waitForVBlank();
    if (sprite_palette != NULL)
    {
      SMS_saveROMBank();
      SMS_mapROMBank(sprite_palette_bank);
      _SMS_loadSpritePaletteafterColorSubtraction(sprite_palette, color_reduction[i]);
      SMS_restoreROMBank();
    }
    if (i == sizeof(color_reduction) - 1)
      SMS_displayOn();
  }
}

void fade_out(const void *bg_palette, const void *sprite_palette, unsigned int sprite_palette_bank)
{
  for (int i = 0; i < sizeof(color_reduction); i++)
  {
    SMS_waitForVBlank();

    if (bg_palette != NULL)
      _SMS_loadBGPaletteafterColorSubtraction(bg_palette, color_reduction[i]);

    SMS_waitForVBlank();
    if (sprite_palette != NULL)
    {
      SMS_saveROMBank();
      SMS_mapROMBank(sprite_palette_bank);
      _SMS_loadSpritePaletteafterColorSubtraction(sprite_palette, color_reduction[i]);
      SMS_restoreROMBank();
    }
  }
  SMS_displayOff();
}