1 // --- CHUI EN TRAIN DE SUPPRIMER LES EXTERN RESOLX ET C_RESOLY ---
3 /* filter.c version 0.7
4 * contient les filtres applicable a un buffer
5 * creation : 01/10/2000
6 * -ajout de sinFilter()
7 * -ajout de zoomFilter()
8 * -copie de zoomFilter() en zoomFilterRGB(), gerant les 3 couleurs
9 * -optimisation de sinFilter (utilisant une table de sin)
11 * -optimisation de la procedure de generation du buffer de transformation
12 * la vitesse est maintenant comprise dans [0..128] au lieu de [0..100]
15 /* #define _DEBUG_PIXEL */
26 #ifdef HAVE_INTTYPES_H
30 #include "goom_filters.h"
31 #include "goom_graphic.h"
32 #include "goom_tools.h"
33 #include "goom_plugin_info.h"
37 /* TODO : MOVE THIS AWAY !!! */
38 /* jeko: j'ai essayer de le virer, mais si on veut les laisser inline c'est un peu lourdo... */
40 setPixelRGB (PluginInfo * goomInfo, Pixel * buffer, Uint x, Uint y, Color c)
47 *(buffer + (x + y * goomInfo->screen.width)) = i;
51 setPixelRGB_ (Pixel * buffer, Uint x, Color c)
53 buffer[x].channels.r = c.r;
54 buffer[x].channels.g = c.v;
55 buffer[x].channels.b = c.b;
59 getPixelRGB (PluginInfo * goomInfo, Pixel * buffer, Uint x, Uint y, Color * c)
61 Pixel i = *(buffer + (x + y * goomInfo->screen.width));
69 getPixelRGB_ (Pixel * buffer, Uint x, Color * c)
71 Pixel i = *(buffer + x);
82 // retourne x>>s , en testant le signe de x
83 //#define ShiftRight(_x,_s) (((_x)<0) ? -(-(_x)>>(_s)) : ((_x)>>(_s)))
84 //#define EFFECT_DISTORS 4
85 //#define EFFECT_DISTORS_SL 2
86 //#define INTERLACE_ADD 9
87 //#define INTERLACE_AND 0xf
90 #define BUFFPOINTNB 16
91 #define BUFFPOINTNBF 16.0f
92 #define BUFFPOINTMASK 0xffff
95 /* faire : a % sqrtperte <=> a & pertemask */
97 /* faire : a / sqrtperte <=> a >> PERTEDEC */
100 /* pure c version of the zoom filter */
101 static void c_zoom (Pixel * expix1, Pixel * expix2, unsigned int prevX,
102 unsigned int prevY, signed int *brutS, signed int *brutD, int buffratio,
103 int precalCoef[BUFFPOINTNB][BUFFPOINTNB]);
105 /* simple wrapper to give it the same proto than the others */
107 zoom_filter_c (int sizeX, int sizeY, Pixel * src, Pixel * dest, int *brutS,
108 int *brutD, int buffratio, int precalCoef[16][16])
110 c_zoom (src, dest, sizeX, sizeY, brutS, brutD, buffratio, precalCoef);
113 static void generatePrecalCoef (int precalCoef[BUFFPOINTNB][BUFFPOINTNB]);
116 typedef struct _ZOOM_FILTER_FX_WRAPPER_DATA
119 PluginParam enabled_bp;
120 PluginParameters params;
122 unsigned int *coeffs, *freecoeffs;
124 signed int *brutS, *freebrutS; /* source */
125 signed int *brutD, *freebrutD; /* dest */
126 signed int *brutT, *freebrutT; /* temp (en cours de generation) */
130 unsigned int prevX, prevY;
133 int reverse; /* reverse the speed */
140 int middleX, middleY;
145 /** modif by jeko : fixedpoint : buffration = (16:16) (donc 0<=buffration<=2^16) */
149 /** modif d'optim by Jeko : precalcul des 4 coefs resultant des 2 pos */
150 int precalCoef[BUFFPOINTNB][BUFFPOINTNB];
152 /** calculatePXandPY statics */
156 } ZoomFilterFXWrapperData;
162 zoomVector (ZoomFilterFXWrapperData * data, float X, float Y)
166 float sq_dist = X * X + Y * Y;
168 /* sx = (X < 0.0f) ? -1.0f : 1.0f;
169 sy = (Y < 0.0f) ? -1.0f : 1.0f;
171 float coefVitesse = (1.0f + data->general_speed) / 50.0f;
177 switch (data->theMode) {
178 case CRYSTAL_BALL_MODE:
179 coefVitesse -= (sq_dist - 0.3f) / 15.0f;
182 coefVitesse += sq_dist * 3.5f;
185 coefVitesse += sin (sq_dist * 20.0f) / 100.0f;
188 coefVitesse += sq_dist / 10.0f;
190 //case HYPERCOS1_MODE:
192 //case HYPERCOS2_MODE:
197 coefVitesse *= 4.0f * Y;
203 if (coefVitesse < -2.01f)
204 coefVitesse = -2.01f;
205 if (coefVitesse > 2.01f)
208 vx = coefVitesse * X;
209 vy = coefVitesse * Y;
212 // vx = X * tan(dist);
213 // vy = Y * tan(dist);
224 vx += (((float) rand ()) / ((float) RAND_MAX) - 0.5f) / 50.0f;
225 vy += (((float) rand ()) / ((float) RAND_MAX) - 0.5f) / 50.0f;
229 if (data->hypercosEffect) {
230 vx += sin (Y * 10.0f) / 120.0f;
231 vy += sin (X * 10.0f) / 120.0f;
235 if (data->hPlaneEffect)
236 vx += Y * 0.0025f * data->hPlaneEffect;
239 if (data->vPlaneEffect)
240 vy += X * 0.0025f * data->vPlaneEffect;
242 /* TODO : Water Mode */
243 // if (data->waveEffect)
253 * Makes a stripe of a transform buffer (brutT)
255 * The transform is (in order) :
256 * Translation (-data->middleX, -data->middleY)
257 * Homothetie (Center : 0,0 Coeff : 2/data->prevX)
260 makeZoomBufferStripe (ZoomFilterFXWrapperData * data, int INTERLACE_INCR)
262 // Position of the pixel to compute in pixmap coordinates
265 // Where (verticaly) to stop generating the buffer stripe
266 int maxEnd = (data->interlace_start + INTERLACE_INCR);
268 // Ratio from pixmap to normalized coordinates
269 float ratio = 2.0f / ((float) data->prevX);
271 // Ratio from normalized to virtual pixmap coordinates
272 float inv_ratio = BUFFPOINTNBF / ratio;
273 float min = ratio / BUFFPOINTNBF;
275 // Y position of the pixel to compute in normalized coordinates
276 float Y = ((float) (data->interlace_start - data->middleY)) * ratio;
278 maxEnd = data->prevY;
279 if (maxEnd > (data->interlace_start + INTERLACE_INCR))
280 maxEnd = (data->interlace_start + INTERLACE_INCR);
282 for (y = data->interlace_start;
283 (y < data->prevY) && ((signed int) y < maxEnd); y++) {
284 Uint premul_y_prevX = y * data->prevX * 2;
285 float X = -((float) data->middleX) * ratio;
287 for (x = 0; x < data->prevX; x++) {
288 v2g vector = zoomVector (data, X, Y);
290 /* Finish and avoid null displacement */
291 if (fabs (vector.x) < min)
292 vector.x = (vector.x < 0.0f) ? -min : min;
293 if (fabs (vector.y) < min)
294 vector.y = (vector.y < 0.0f) ? -min : min;
296 data->brutT[premul_y_prevX] =
297 ((int) ((X - vector.x) * inv_ratio) +
298 ((int) (data->middleX * BUFFPOINTNB)));
299 data->brutT[premul_y_prevX + 1] =
300 ((int) ((Y - vector.y) * inv_ratio) +
301 ((int) (data->middleY * BUFFPOINTNB)));
307 data->interlace_start += INTERLACE_INCR;
308 if (y >= data->prevY - 1)
309 data->interlace_start = -1;
314 * calculer px et py en fonction de x,y,middleX,middleY et theMode
315 * px et py indique la nouvelle position (en sqrtperte ieme de pixel)
318 inline void calculatePXandPY (PluginInfo *goomInfo, ZoomFilterFXWrapperData *data, int x, int y, int *px, int *py)
320 if (data->theMode == WATER_MODE) {
323 yy = y + goom_irand(goomInfo->gRandom, 4) - goom_irand(goomInfo->gRandom, 4) + data->wave / 10;
326 if (yy >= (signed int)goomInfo->screen.height)
327 yy = goomInfo->screen.height - 1;
329 *px = (x << 4) + data->firedec[yy] + (data->wave / 10);
330 *py = (y << 4) + 132 - ((data->vitesse < 131) ? data->vitesse : 130);
332 data->wavesp += goom_irand(goomInfo->gRandom, 3) - goom_irand(goomInfo->gRandom, 3);
333 if (data->wave < -10)
337 data->wave += (data->wavesp / 10) + goom_irand(goomInfo->gRandom, 3) - goom_irand(goomInfo->gRandom, 3);
338 if (data->wavesp > 100)
339 data->wavesp = (data->wavesp * 9) / 10;
342 int dist = 0, vx9, vy9;
345 int fvitesse = data->vitesse << 4;
348 x += goom_irand(goomInfo->gRandom, data->noisify) - goom_irand(goomInfo->gRandom, data->noisify);
349 y += goom_irand(goomInfo->gRandom, data->noisify) - goom_irand(goomInfo->gRandom, data->noisify);
351 vx = (x - data->middleX) << 9;
352 vy = (y - data->middleY) << 9;
354 if (data->hPlaneEffect)
355 vx += data->hPlaneEffect * (y - data->middleY);
357 if (data->vPlaneEffect)
358 vy += data->vPlaneEffect * (x - data->middleX);
360 if (data->waveEffect) {
363 ShiftRight (goomInfo->sintable
364 [(unsigned short) (dist * 0xffff + EFFECT_DISTORS)], 6);
368 if (data->hypercosEffect) {
369 vx += ShiftRight (goomInfo->sintable[(-vy + dist) & 0xffff], 1);
370 vy += ShiftRight (goomInfo->sintable[(vx + dist) & 0xffff], 1);
373 vx9 = ShiftRight (vx, 9);
374 vy9 = ShiftRight (vy, 9);
375 dist = vx9 * vx9 + vy9 * vy9;
377 switch (data->theMode) {
381 ShiftRight (goomInfo->sintable
382 [(unsigned short) (dist * 0xffff * EFFECT_DISTORS)], 6);
385 case CRYSTAL_BALL_MODE:
386 fvitesse += (dist >> (10-EFFECT_DISTORS_SL));
389 fvitesse -= (dist >> (4 - EFFECT_DISTORS_SL));
392 fvitesse -= (dist >> (10 - EFFECT_DISTORS_SL));
395 vx = vx + ShiftRight (goomInfo->sintable[(-vy + dist) & 0xffff], 1);
396 vy = vy + ShiftRight (goomInfo->sintable[(vx + dist) & 0xffff], 1);
400 vx + ShiftRight (goomInfo->sintable[(-ShiftRight (vy, 1) + dist) & 0xffff], 0);
402 vy + ShiftRight (goomInfo->sintable[(ShiftRight (vx, 1) + dist) & 0xffff], 0);
406 fvitesse *= 1024 + ShiftRight (goomInfo->sintable[vy & 0xffff], 6);
410 fvitesse -= (ShiftRight(vy,10-EFFECT_DISTORS_SL));
414 if (fvitesse < -3024)
417 if (vx < 0) // pb avec decalage sur nb negatif
418 ppx = -(-(vx * fvitesse) >> 16);
419 // 16 = 9 + 7 (7 = nb chiffre virgule de vitesse * (v = 128 => immobile)
420 // * * * * * 9 = nb chiffre virgule de vx)
422 ppx = ((vx * fvitesse) >> 16);
425 ppy = -(-(vy * fvitesse) >> 16);
427 ppy = ((vy * fvitesse) >> 16);
429 *px = (data->middleX << 4) + ppx;
430 *py = (data->middleY << 4) + ppy;
438 c_zoom (Pixel * expix1, Pixel * expix2, unsigned int prevX, unsigned int prevY,
439 signed int *brutS, signed int *brutD, int buffratio, int precalCoef[16][16])
444 unsigned int ax = (prevX - 1) << PERTEDEC, ay = (prevY - 1) << PERTEDEC;
446 int bufsize = prevX * prevY * 2;
447 int bufwidth = prevX;
449 expix1[0].val = expix1[prevX - 1].val = expix1[prevX * prevY - 1].val =
450 expix1[prevX * prevY - prevX].val = 0;
452 for (myPos = 0; myPos < bufsize; myPos += 2) {
453 Color col1, col2, col3, col4;
454 int c1, c2, c3, c4, px, py;
458 int brutSmypos = brutS[myPos];
462 px = brutSmypos + (((brutD[myPos] -
463 brutSmypos) * buffratio) >> BUFFPOINTNB);
464 brutSmypos = brutS[myPos2];
465 py = brutSmypos + (((brutD[myPos2] -
466 brutSmypos) * buffratio) >> BUFFPOINTNB);
468 if ((py >= ay) || (px >= ax)) {
471 pos = ((px >> PERTEDEC) + prevX * (py >> PERTEDEC));
472 /* coef en modulo 15 */
473 coeffs = precalCoef[px & PERTEMASK][py & PERTEMASK];
475 getPixelRGB_ (expix1, pos, &col1);
476 getPixelRGB_ (expix1, pos + 1, &col2);
477 getPixelRGB_ (expix1, pos + bufwidth, &col3);
478 getPixelRGB_ (expix1, pos + bufwidth + 1, &col4);
481 c2 = (c1 >> 8) & 0xFF;
482 c3 = (c1 >> 16) & 0xFF;
483 c4 = (c1 >> 24) & 0xFF;
486 couleur.r = col1.r * c1 + col2.r * c2 + col3.r * c3 + col4.r * c4;
491 couleur.v = col1.v * c1 + col2.v * c2 + col3.v * c3 + col4.v * c4;
496 couleur.b = col1.b * c1 + col2.b * c2 + col3.b * c3 + col4.b * c4;
501 setPixelRGB_ (expix2, myPos >> 1, couleur);
505 /** generate the water fx horizontal direction buffer */
507 generateTheWaterFXHorizontalDirectionBuffer (PluginInfo * goomInfo,
508 ZoomFilterFXWrapperData * data)
512 int decc = goom_irand (goomInfo->gRandom, 8) - 4;
513 int spdc = goom_irand (goomInfo->gRandom, 8) - 4;
514 int accel = goom_irand (goomInfo->gRandom, 8) - 4;
516 for (loopv = data->prevY; loopv != 0;) {
519 data->firedec[loopv] = decc;
522 goom_irand (goomInfo->gRandom, 3) - goom_irand (goomInfo->gRandom, 3);
530 spdc = spdc - goom_irand (goomInfo->gRandom, 3) + accel / 10;
532 spdc = spdc + goom_irand (goomInfo->gRandom, 3) + accel / 10;
534 if (decc > 8 && spdc > 1)
535 spdc -= goom_irand (goomInfo->gRandom, 3) - 2;
537 if (decc < -8 && spdc < -1)
538 spdc += goom_irand (goomInfo->gRandom, 3) + 2;
540 if (decc > 8 || decc < -8)
544 goom_irand (goomInfo->gRandom, 2) - goom_irand (goomInfo->gRandom, 2);
555 * Main work for the dynamic displacement map.
557 * Reads data from pix1, write to pix2.
559 * Useful datas for this FX are stored in ZoomFilterData.
561 * If you think that this is a strange function name, let me say that a long time ago,
562 * there has been a slow version and a gray-level only one. Then came these function,
563 * fast and workin in RGB colorspace ! nice but it only was applying a zoom to the image.
564 * So that is why you have this name, for the nostalgy of the first days of goom
565 * when it was just a tiny program writen in Turbo Pascal on my i486...
568 zoomFilterFastRGB (PluginInfo * goomInfo, Pixel * pix1, Pixel * pix2,
569 ZoomFilterData * zf, Uint resx, Uint resy, int switchIncr, float switchMult)
573 ZoomFilterFXWrapperData *data =
574 (ZoomFilterFXWrapperData *) goomInfo->zoomFilter_fx.fx_data;
576 if (!BVAL (data->enabled_bp))
579 /** changement de taille **/
580 if ((data->prevX != resx) || (data->prevY != resy)) {
585 free (data->freebrutS);
588 free (data->freebrutD);
591 free (data->freebrutT);
594 data->middleX = resx / 2;
595 data->middleY = resy / 2;
596 data->mustInitBuffers = 1;
598 free (data->firedec);
602 if (data->interlace_start != -2)
605 /** changement de config **/
607 data->reverse = zf->reverse;
608 data->general_speed = (float) (zf->vitesse - 128) / 128.0f;
610 data->general_speed = -data->general_speed;
611 data->middleX = zf->middleX;
612 data->middleY = zf->middleY;
613 data->theMode = zf->mode;
614 data->hPlaneEffect = zf->hPlaneEffect;
615 data->vPlaneEffect = zf->vPlaneEffect;
616 data->waveEffect = zf->waveEffect;
617 data->hypercosEffect = zf->hypercosEffect;
618 data->noisify = zf->noisify;
619 data->interlace_start = 0;
623 if (data->mustInitBuffers) {
625 data->mustInitBuffers = 0;
627 (signed int *) calloc (resx * resy * 2 + 128, sizeof (unsigned int));
629 (gint32 *) ((1 + ((uintptr_t) (data->freebrutS)) / 128) * 128);
632 (signed int *) calloc (resx * resy * 2 + 128, sizeof (unsigned int));
634 (gint32 *) ((1 + ((uintptr_t) (data->freebrutD)) / 128) * 128);
637 (signed int *) calloc (resx * resy * 2 + 128, sizeof (unsigned int));
639 (gint32 *) ((1 + ((uintptr_t) (data->freebrutT)) / 128) * 128);
643 data->firedec = (int *) malloc (data->prevY * sizeof (int));
644 generateTheWaterFXHorizontalDirectionBuffer (goomInfo, data);
646 data->interlace_start = 0;
647 makeZoomBufferStripe (data, resy);
649 /* Copy the data from temp to dest and source */
650 memcpy (data->brutS, data->brutT, resx * resy * 2 * sizeof (int));
651 memcpy (data->brutD, data->brutT, resx * resy * 2 * sizeof (int));
654 /* generation du buffer de trans */
655 if (data->interlace_start == -1) {
657 /* sauvegarde de l'etat actuel dans la nouvelle source
658 * TODO: write that in MMX (has been done in previous version, but did not follow some new fonctionnalities) */
659 y = data->prevX * data->prevY * 2;
660 for (x = 0; x < y; x += 2) {
661 int brutSmypos = data->brutS[x];
665 brutSmypos + (((data->brutD[x] -
666 brutSmypos) * data->buffratio) >> BUFFPOINTNB);
667 brutSmypos = data->brutS[x2];
669 brutSmypos + (((data->brutD[x2] -
670 brutSmypos) * data->buffratio) >> BUFFPOINTNB);
675 if (data->interlace_start == -1) {
679 data->brutD = data->brutT;
681 tmp = data->freebrutD;
682 data->freebrutD = data->freebrutT;
683 data->freebrutT = tmp;
684 data->interlace_start = -2;
687 if (data->interlace_start >= 0) {
688 /* creation de la nouvelle destination */
689 makeZoomBufferStripe (data, resy / 16);
692 if (switchIncr != 0) {
693 data->buffratio += switchIncr;
694 if (data->buffratio > BUFFPOINTMASK)
695 data->buffratio = BUFFPOINTMASK;
698 if (switchMult != 1.0f) {
699 data->buffratio = (int) ((float) BUFFPOINTMASK * (1.0f - switchMult) +
700 (float) data->buffratio * switchMult);
703 data->zoom_width = data->prevX;
705 goomInfo->methods.zoom_filter (data->prevX, data->prevY, pix1, pix2,
706 data->brutS, data->brutD, data->buffratio, data->precalCoef);
710 generatePrecalCoef (int precalCoef[16][16])
714 for (coefh = 0; coefh < 16; coefh++) {
715 for (coefv = 0; coefv < 16; coefv++) {
721 diffcoeffh = sqrtperte - coefh;
722 diffcoeffv = sqrtperte - coefv;
724 if (!(coefh || coefv)) {
729 i1 = diffcoeffh * diffcoeffv;
730 i2 = coefh * diffcoeffv;
731 i3 = diffcoeffh * coefv;
734 // TODO: faire mieux...
744 i = (i1) | (i2 << 8) | (i3 << 16) | (i4 << 24);
746 precalCoef[coefh][coefv] = i;
751 /* VisualFX Wrapper */
754 zoomFilterVisualFXWrapper_init (struct _VISUAL_FX *_this, PluginInfo * info)
756 ZoomFilterFXWrapperData *data =
757 (ZoomFilterFXWrapperData *) malloc (sizeof (ZoomFilterFXWrapperData));
760 data->freecoeffs = 0;
770 data->mustInitBuffers = 1;
771 data->interlace_start = -2;
773 data->general_speed = 0.0f;
775 data->theMode = AMULETTE_MODE;
776 data->waveEffect = 0;
777 data->hypercosEffect = 0;
778 data->vPlaneEffect = 0;
779 data->hPlaneEffect = 0;
782 /** modif by jeko : fixedpoint : buffration = (16:16) (donc 0<=buffration<=2^16) */
786 data->wave = data->wavesp = 0;
788 data->enabled_bp = secure_b_param ("Enabled", 1);
790 data->params = plugin_parameters ("Zoom Filter", 1);
791 data->params.params[0] = &data->enabled_bp;
793 _this->params = &data->params;
794 _this->fx_data = (void *) data;
796 /** modif d'optim by Jeko : precalcul des 4 coefs resultant des 2 pos */
797 generatePrecalCoef (data->precalCoef);
801 zoomFilterVisualFXWrapper_free (struct _VISUAL_FX *_this)
803 ZoomFilterFXWrapperData *data = (ZoomFilterFXWrapperData *) _this->fx_data;
806 free (data->freebrutT);
808 free (data->freebrutS);
810 free (data->freebrutD);
812 free (data->firedec);
814 goom_plugin_parameters_free (_this->params);
816 free (_this->fx_data);
820 zoomFilterVisualFXWrapper_apply (struct _VISUAL_FX *_this, Pixel * src,
821 Pixel * dest, PluginInfo * info)
826 zoomFilterVisualFXWrapper_create (void)
830 fx.init = zoomFilterVisualFXWrapper_init;
831 fx.free = zoomFilterVisualFXWrapper_free;
832 fx.apply = zoomFilterVisualFXWrapper_apply;
839 /* TODO : MOVE THIS AWAY */
842 pointFilter (PluginInfo * goomInfo, Pixel * pix1, Color c, float t1, float t2,
843 float t3, float t4, Uint cycle)
845 Uint x = (Uint) ((int) (goomInfo->screen.width / 2)
846 + (int) (t1 * cos ((float) cycle / t3)));
847 Uint y = (Uint) ((int) (goomInfo->screen.height / 2)
848 + (int) (t2 * sin ((float) cycle / t4)));
850 if ((x > 1) && (y > 1) && (x < goomInfo->screen.width - 2)
851 && (y < goomInfo->screen.height - 2)) {
852 setPixelRGB (goomInfo, pix1, x + 1, y, c);
853 setPixelRGB (goomInfo, pix1, x, y + 1, c);
854 setPixelRGB (goomInfo, pix1, x + 1, y + 1, WHITE);
855 setPixelRGB (goomInfo, pix1, x + 2, y + 1, c);
856 setPixelRGB (goomInfo, pix1, x + 1, y + 2, c);