gstreamer/gst/goom/filters.c

/* filter.c version 0.7
 * contient les filtres applicable a un buffer
 * creation : 01/10/2000
 *  -ajout de sinFilter()
 *  -ajout de zoomFilter()
 *  -copie de zoomFilter() en zoomFilterRGB(), g<EFBFBD>rant les 3 couleurs
 *  -optimisation de sinFilter (utilisant une table de sin)
 *      -asm
 *      -optimisation de la procedure de g<EFBFBD>n<EFBFBD>ration du buffer de transformation
 *              la vitesse est maintenant comprise dans [0..128] au lieu de [0..100]
*/

/*#define _DEBUG_PIXEL; */

#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

#include "filters.h"
#include "graphic.h"
#include "goom_tools.h"
#include <stdlib.h>
#include <math.h>
#include <stdio.h>

#ifdef MMX
#define USE_ASM
#endif
#ifdef POWERPC
#define USE_ASM
#endif

#ifdef USE_ASM
#define EFFECT_DISTORS 4
#else
#define EFFECT_DISTORS 10
#endif


extern volatile guint32 resolx;
extern volatile guint32 resoly;

#ifdef USE_ASM

#ifdef MMX
int mmx_zoom ();
guint32 mmx_zoom_size;
#endif /* MMX */

#ifdef POWERPC
extern unsigned int useAltivec;
extern void ppc_zoom (void);
extern void ppc_zoom_altivec (void);
unsigned int ppcsize4;
#endif /* PowerPC */

unsigned int *coeffs = 0, *freecoeffs = 0;
guint32 *expix1 = 0;            /* pointeur exporte vers p1 */
guint32 *expix2 = 0;            /* pointeur exporte vers p2 */
guint32 zoom_width;

#endif /* ASM */


static int sintable[0xffff];
static int vitesse = 127;
static char theMode = AMULETTE_MODE;
static int vPlaneEffect = 0;
static int hPlaneEffect = 0;
static char noisify = 2;
static int middleX, middleY;
static unsigned char sqrtperte = 16;

static int *firedec = 0;


/* retourne x>>s , en testant le signe de x */
static inline int
ShiftRight (int x, const unsigned char s)
{
  if (x < 0)
    return -(-x >> s);
  else
    return x >> s;
}

/*
  calculer px et py en fonction de x,y,middleX,middleY et theMode
  px et py indique la nouvelle position (en sqrtperte ieme de pixel)
  (valeur * 16)
*/
void
calculatePXandPY (int x, int y, int *px, int *py)
{
  if (theMode == WATER_MODE) {
    static int wave = 0;
    static int wavesp = 0;
    int yy;

    yy = y + RAND () % 4 + wave / 10;
    yy -= RAND () % 4;
    if (yy < 0)
      yy = 0;
    if (yy >= resoly)
      yy = resoly - 1;

    *px = (x << 4) + firedec[yy] + (wave / 10);
    *py = (y << 4) + 132 - ((vitesse < 132) ? vitesse : 131);

    wavesp += RAND () % 3;
    wavesp -= RAND () % 3;
    if (wave < -10)
      wavesp += 2;
    if (wave > 10)
      wavesp -= 2;
    wave += (wavesp / 10) + RAND () % 3;
    wave -= RAND () % 3;
    if (wavesp > 100)
      wavesp = (wavesp * 9) / 10;
  } else {
    int dist;
    register int vx, vy;
    int fvitesse = vitesse << 4;

    if (noisify) {
      x += RAND () % noisify;
      x -= RAND () % noisify;
      y += RAND () % noisify;
      y -= RAND () % noisify;
    }

    if (hPlaneEffect)
      vx = ((x - middleX) << 9) + hPlaneEffect * (y - middleY);
    else
      vx = (x - middleX) << 9;

    if (vPlaneEffect)
      vy = ((y - middleY) << 9) + vPlaneEffect * (x - middleX);
    else
      vy = (y - middleY) << 9;

    switch (theMode) {
      case WAVE_MODE:
        dist =
            ShiftRight (vx, 9) * ShiftRight (vx, 9) + ShiftRight (vy,
            9) * ShiftRight (vy, 9);
        fvitesse *=
            1024 +
            ShiftRight (sintable[(unsigned short) (0xffff * dist *
                    EFFECT_DISTORS)], 6);
        fvitesse /= 1024;
        break;
      case CRYSTAL_BALL_MODE:
        dist =
            ShiftRight (vx, 9) * ShiftRight (vx, 9) + ShiftRight (vy,
            9) * ShiftRight (vy, 9);
        fvitesse += (dist * EFFECT_DISTORS >> 10);
        break;
      case AMULETTE_MODE:
        dist =
            ShiftRight (vx, 9) * ShiftRight (vx, 9) + ShiftRight (vy,
            9) * ShiftRight (vy, 9);
        fvitesse -= (dist * EFFECT_DISTORS >> 4);
        break;
      case SCRUNCH_MODE:
        dist =
            ShiftRight (vx, 9) * ShiftRight (vx, 9) + ShiftRight (vy,
            9) * ShiftRight (vy, 9);
        fvitesse -= (dist * EFFECT_DISTORS >> 9);
        break;
    }
    if (vx < 0)
      *px = (middleX << 4) - (-(vx * fvitesse) >> 16);
    else
      *px = (middleX << 4) + ((vx * fvitesse) >> 16);
    if (vy < 0)
      *py = (middleY << 4) - (-(vy * fvitesse) >> 16);
    else
      *py = (middleY << 4) + ((vy * fvitesse) >> 16);
  }
}

/*#define _DEBUG */

static inline void
setPixelRGB (Uint * buffer, Uint x, Uint y, Color c)
{
/*              buffer[ y*WIDTH + x ] = (c.r<<16)|(c.v<<8)|c.b */
#ifdef _DEBUG_PIXEL
  if (x + y * resolx >= resolx * resoly) {
    fprintf (stderr, "setPixel ERROR : hors du tableau... %i, %i\n", x, y);
    /*exit (1) ; */
  }
#endif

#ifdef USE_DGA
  buffer[y * resolx + x] = (c.b << 16) | (c.v << 8) | c.r;
#else
  buffer[y * resolx + x] = (c.r << 16) | (c.v << 8) | c.b;
#endif
}


static inline void
setPixelRGB_ (Uint * buffer, Uint x, Color c)
{
#ifdef _DEBUG
  if (x >= resolx * resoly) {
    printf ("setPixel ERROR : hors du tableau... %i, %i\n", x, y);
    exit (1);
  }
#endif

#ifdef USE_DGA
  buffer[x] = (c.b << 16) | (c.v << 8) | c.r;
#else
  buffer[x] = (c.r << 16) | (c.v << 8) | c.b;
#endif
}



static inline void
getPixelRGB (Uint * buffer, Uint x, Uint y, Color * c)
{
  register unsigned char *tmp8;

#ifdef _DEBUG
  if (x + y * resolx >= resolx * resoly) {
    printf ("getPixel ERROR : hors du tableau... %i, %i\n", x, y);
    exit (1);
  }
#endif

#ifdef __BIG_ENDIAN__
  c->b = *(unsigned char *) (tmp8 =
      (unsigned char *) (buffer + (x + y * resolx)));
  c->r = *(unsigned char *) (++tmp8);
  c->v = *(unsigned char *) (++tmp8);
  c->b = *(unsigned char *) (++tmp8);

#else
  /* ATTENTION AU PETIT INDIEN  */
  c->b = *(unsigned char *) (tmp8 =
      (unsigned char *) (buffer + (x + y * resolx)));
  c->v = *(unsigned char *) (++tmp8);
  c->r = *(unsigned char *) (++tmp8);
/*      *c = (Color) buffer[x+y*WIDTH] ; */
#endif
}


static inline void
getPixelRGB_ (Uint * buffer, Uint x, Color * c)
{
  register unsigned char *tmp8;

#ifdef _DEBUG
  if (x >= resolx * resoly) {
    printf ("getPixel ERROR : hors du tableau... %i\n", x);
    exit (1);
  }
#endif

#ifdef __BIG_ENDIAN__
  c->b = *(unsigned char *) (tmp8 = (unsigned char *) (buffer + x));
  c->r = *(unsigned char *) (++tmp8);
  c->v = *(unsigned char *) (++tmp8);
  c->b = *(unsigned char *) (++tmp8);

#else
  /* ATTENTION AU PETIT INDIEN  */
  c->b = *(unsigned char *) (tmp8 = (unsigned char *) (buffer + x));
  c->v = *(unsigned char *) (++tmp8);
  c->r = *(unsigned char *) (++tmp8);
/*      *c = (Color) buffer[x+y*WIDTH] ; */
#endif
}


/*===============================================================*/
void
zoomFilterFastRGB (Uint * pix1,
    Uint * pix2, ZoomFilterData * zf, Uint resx, Uint resy)
{
  static guint32 prevX = 0, prevY = 0;

  static char reverse = 0;      /*vitesse invers<72>..(zoom out) */

  /*    static int perte = 100; // 100 = normal */
  static unsigned char pertedec = 8;
  static char firstTime = 1;

  Uint x, y;

/*  static unsigned int prevX = 0, prevY = 0; */

#ifdef USE_ASM
  expix1 = pix1;
  expix2 = pix2;
#else
  Color couleur;
  Color col1, col2, col3, col4;
  Uint position;

  static unsigned int *pos10 = 0;
  static unsigned int *c1 = 0, *c2 = 0, *c3 = 0, *c4 = 0;
#endif

  if ((prevX != resx) || (prevY != resy)) {
    prevX = resx;
    prevY = resy;
#ifndef USE_ASM
    if (c1)
      free (c1);
    if (c2)
      free (c2);
    if (c3)
      free (c3);
    if (c4)
      free (c4);
    if (pos10)
      free (pos10);
    c1 = c2 = c3 = c4 = pos10 = 0;
#else
    if (coeffs)
      free (freecoeffs);
    coeffs = 0;
#endif
    middleX = resx / 2;
    middleY = resy - 1;
    firstTime = 1;
    if (firedec)
      free (firedec);
    firedec = 0;
  }

  if (zf) {
    reverse = zf->reverse;
    vitesse = zf->vitesse;
    if (reverse)
      vitesse = 256 - vitesse;
#ifndef USE_ASM
    sqrtperte = zf->sqrtperte;
#endif
    pertedec = zf->pertedec;
    middleX = zf->middleX;
    middleY = zf->middleY;
    theMode = zf->mode;
    hPlaneEffect = zf->hPlaneEffect;
    vPlaneEffect = zf->vPlaneEffect;
    noisify = zf->noisify;
  }

  if (firstTime || zf) {

    /* generation d'une table de sinus */
    if (firstTime) {
      unsigned short us;

      firstTime = 0;
#ifdef USE_ASM
      freecoeffs = (unsigned int *)
          malloc (resx * resy * 2 * sizeof (unsigned int) + 128);
      coeffs = (guint32 *) ((1 + ((unsigned int) (freecoeffs)) / 128) * 128);

#else
      pos10 = (unsigned int *) malloc (resx * resy * sizeof (unsigned int));
      c1 = (unsigned int *) malloc (resx * resy * sizeof (unsigned int));
      c2 = (unsigned int *) malloc (resx * resy * sizeof (unsigned int));
      c3 = (unsigned int *) malloc (resx * resy * sizeof (unsigned int));
      c4 = (unsigned int *) malloc (resx * resy * sizeof (unsigned int));
#endif
      for (us = 0; us < 0xffff; us++) {
        sintable[us] = (int) (1024.0f * sin (us * 2 * 3.31415f / 0xffff));
      }

      {
        int loopv;
        firedec = (int *) malloc (prevY * sizeof (int));
        for (loopv = prevY; loopv != 0;) {
          static int decc = 0;
          static int spdc = 0;
          static int accel = 0;

          loopv--;
          firedec[loopv] = decc;
          decc += spdc / 10;
          spdc += RAND () % 3;
          spdc -= RAND () % 3;

          if (decc > 4)
            spdc -= 1;
          if (decc < -4)
            spdc += 1;

          if (spdc > 30)
            spdc = spdc - RAND () % 3 + accel / 10;
          if (spdc < -30)
            spdc = spdc + RAND () % 3 + accel / 10;

          if (decc > 8 && spdc > 1)
            spdc -= RAND () % 3 - 2;

          if (decc < -8 && spdc < -1)
            spdc += RAND () % 3 + 2;

          if (decc > 8 || decc < -8)
            decc = decc * 8 / 9;

          accel += RAND () % 2;
          accel -= RAND () % 2;
          if (accel > 20)
            accel -= 2;
          if (accel < -20)
            accel += 2;
        }
      }
    }


    /* generation du buffer */
    for (y = 0; y < prevY; y++)
      for (x = 0; x < prevX; x++) {
        int px, py;
        unsigned char coefv, coefh;

        /* calculer px et py en fonction de */
        /*   x,y,middleX,middleY et theMode */
        calculatePXandPY (x, y, &px, &py);
        if ((px == x << 4) && (py == y << 4))
          py += 8;

        if ((py < 0) || (px < 0) ||
            (py >= (prevY - 1) * sqrtperte) ||
            (px >= (prevX - 1) * sqrtperte)) {
#ifdef USE_ASM
          coeffs[(y * prevX + x) * 2] = 0;
          coeffs[(y * prevX + x) * 2 + 1] = 0;
#else
          pos10[y * prevX + x] = 0;
          c1[y * prevX + x] = 0;
          c2[y * prevX + x] = 0;
          c3[y * prevX + x] = 0;
          c4[y * prevX + x] = 0;
#endif
        } else {
          int npx10;
          int npy10;
          int pos;

          npx10 = (px / sqrtperte);
          npy10 = (py / sqrtperte);

/*                        if (npx10 >= prevX) fprintf(stderr,"error npx:%d",npx10);
                          if (npy10 >= prevY) fprintf(stderr,"error npy:%d",npy10);
*/
          coefh = px % sqrtperte;
          coefv = py % sqrtperte;
#ifdef USE_ASM
          pos = (y * prevX + x) * 2;
          coeffs[pos] = (npx10 + prevX * npy10) * 4;

          if (!(coefh || coefv))
            coeffs[pos + 1] = (sqrtperte * sqrtperte - 1);
          else
            coeffs[pos + 1] = ((sqrtperte - coefh) * (sqrtperte - coefv));

          coeffs[pos + 1] |= (coefh * (sqrtperte - coefv)) << 8;
          coeffs[pos + 1] |= ((sqrtperte - coefh) * coefv) << 16;
          coeffs[pos + 1] |= (coefh * coefv) << 24;
#else
          pos = y * prevX + x;
          pos10[pos] = npx10 + prevX * npy10;

          if (!(coefh || coefv))
            c1[pos] = sqrtperte * sqrtperte - 1;
          else
            c1[pos] = (sqrtperte - coefh) * (sqrtperte - coefv);

          c2[pos] = coefh * (sqrtperte - coefv);
          c3[pos] = (sqrtperte - coefh) * coefv;
          c4[pos] = coefh * coefv;
#endif
        }
      }
  }
#ifdef USE_ASM

#ifdef MMX
  zoom_width = prevX;
  mmx_zoom_size = prevX * prevY;
  mmx_zoom ();
#endif

#ifdef POWERPC
  zoom_width = prevX;
  if (useAltivec) {
    ppcsize4 = ((unsigned int) (prevX * prevY)) / 4;
    ppc_zoom_altivec ();
  } else {
    ppcsize4 = ((unsigned int) (prevX * prevY));
    ppc_zoom ();
  }
#endif
#else
  for (position = 0; position < prevX * prevY; position++) {
    getPixelRGB_ (pix1, pos10[position], &col1);
    getPixelRGB_ (pix1, pos10[position] + 1, &col2);
    getPixelRGB_ (pix1, pos10[position] + prevX, &col3);
    getPixelRGB_ (pix1, pos10[position] + prevX + 1, &col4);

    couleur.r = col1.r * c1[position]
        + col2.r * c2[position]
        + col3.r * c3[position]
        + col4.r * c4[position];
    couleur.r >>= pertedec;

    couleur.v = col1.v * c1[position]
        + col2.v * c2[position]
        + col3.v * c3[position]
        + col4.v * c4[position];
    couleur.v >>= pertedec;

    couleur.b = col1.b * c1[position]
        + col2.b * c2[position]
        + col3.b * c3[position]
        + col4.b * c4[position];
    couleur.b >>= pertedec;

    setPixelRGB_ (pix2, position, couleur);
  }
#endif
}


void
pointFilter (Uint * pix1, Color c,
    float t1, float t2, float t3, float t4, Uint cycle)
{
  Uint x = (Uint) ((int) middleX + (int) (t1 * cos ((float) cycle / t3)));
  Uint y = (Uint) ((int) middleY + (int) (t2 * sin ((float) cycle / t4)));

  if ((x > 1) && (y > 1) && (x < resolx - 2) && (y < resoly - 2)) {
    setPixelRGB (pix1, x + 1, y, c);
    setPixelRGB (pix1, x, y + 1, c);
    setPixelRGB (pix1, x + 1, y + 1, WHITE);
    setPixelRGB (pix1, x + 2, y + 1, c);
    setPixelRGB (pix1, x + 1, y + 2, c);
  }
}