4030613dd21d38320833bb97e415c2ba27b6bcd9
[platform/upstream/gstreamer.git] / gst / effectv / gstwarp.c
1 /* GStreamer
2  * Copyright (C) <1999> Erik Walthinsen <omega@cse.ogi.edu>
3  * Copyright (C) <2003> David Schleef <ds@schleef.org>
4  *
5  * EffecTV - Realtime Digital Video Effector
6  * Copyright (C) 2001 FUKUCHI Kentarou
7  *
8  * This library is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU Library General Public
10  * License as published by the Free Software Foundation; either
11  * version 2 of the License, or (at your option) any later version.
12  *
13  * This library is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
16  * Library General Public License for more details.
17  *
18  * You should have received a copy of the GNU Library General Public
19  * License along with this library; if not, write to the
20  * Free Software Foundation, Inc., 59 Temple Place - Suite 330,
21  * Boston, MA 02111-1307, USA.
22  */
23
24 /*
25  * This file was (probably) generated from gstvideotemplate.c,
26  * gstvideotemplate.c,v 1.11 2004/01/07 08:56:45 ds Exp 
27  */
28
29 /* From main.c of warp-1.1:
30  *
31  *      Simple DirectMedia Layer demo
32  *      Realtime picture 'gooing'
33  *      by sam lantinga slouken@devolution.com
34  */
35
36 #ifdef HAVE_CONFIG_H
37 #include "config.h"
38 #endif
39
40 #include <gst/gst.h>
41 #include <gstvideofilter.h>
42 #include <string.h>
43 #include <math.h>
44 #include "gsteffectv.h"
45
46 #ifndef M_PI
47 #define M_PI    3.14159265358979323846
48 #endif
49
50
51 #define GST_TYPE_WARPTV \
52   (gst_warptv_get_type())
53 #define GST_WARPTV(obj) \
54   (G_TYPE_CHECK_INSTANCE_CAST((obj),GST_TYPE_WARPTV,GstWarpTV))
55 #define GST_WARPTV_CLASS(klass) \
56   (G_TYPE_CHECK_CLASS_CAST((klass),GST_TYPE_WARPTV,GstWarpTVClass))
57 #define GST_IS_WARPTV(obj) \
58   (G_TYPE_CHECK_INSTANCE_TYPE((obj),GST_TYPE_WARPTV))
59 #define GST_IS_WARPTV_CLASS(obj) \
60   (G_TYPE_CHECK_CLASS_TYPE((klass),GST_TYPE_WARPTV))
61
62 typedef struct _GstWarpTV GstWarpTV;
63 typedef struct _GstWarpTVClass GstWarpTVClass;
64
65 struct _GstWarpTV
66 {
67   GstVideofilter videofilter;
68
69   gint width, height;
70   gint *offstable;
71   gint32 *disttable;
72   gint32 ctable[1024];
73   gint32 sintable[1024 + 256];
74   gint tval;
75 };
76
77 struct _GstWarpTVClass
78 {
79   GstVideofilterClass parent_class;
80 };
81
82
83 /* GstWarpTV signals and args */
84 enum
85 {
86   /* FILL ME */
87   LAST_SIGNAL
88 };
89
90 enum
91 {
92   ARG_0
93       /* FILL ME */
94 };
95
96 static void gst_warptv_base_init (gpointer g_class);
97 static void gst_warptv_class_init (gpointer g_class, gpointer class_data);
98 static void gst_warptv_init (GTypeInstance * instance, gpointer g_class);
99
100 static void gst_warptv_set_property (GObject * object, guint prop_id,
101     const GValue * value, GParamSpec * pspec);
102 static void gst_warptv_get_property (GObject * object, guint prop_id,
103     GValue * value, GParamSpec * pspec);
104
105 static void gst_warptv_setup (GstVideofilter * videofilter);
106 static void initSinTable (GstWarpTV * filter);
107 static void initOffsTable (GstWarpTV * filter);
108 static void initDistTable (GstWarpTV * filter);
109 static void gst_warptv_rgb32 (GstVideofilter * videofilter, void *d, void *s);
110
111 GType
112 gst_warptv_get_type (void)
113 {
114   static GType warptv_type = 0;
115
116   if (!warptv_type) {
117     static const GTypeInfo warptv_info = {
118       sizeof (GstWarpTVClass),
119       gst_warptv_base_init,
120       NULL,
121       gst_warptv_class_init,
122       NULL,
123       NULL,
124       sizeof (GstWarpTV),
125       0,
126       gst_warptv_init,
127     };
128
129     warptv_type = g_type_register_static (GST_TYPE_VIDEOFILTER,
130         "GstWarpTV", &warptv_info, 0);
131   }
132   return warptv_type;
133 }
134
135 static GstVideofilterFormat gst_warptv_formats[] = {
136   {"RGB ", 32, gst_warptv_rgb32, 24, G_BIG_ENDIAN, 0x00ff0000, 0x0000ff00,
137       0x000000ff},
138   {"RGB ", 32, gst_warptv_rgb32, 24, G_BIG_ENDIAN, 0xff000000, 0x00ff0000,
139       0x0000ff00},
140   {"RGB ", 32, gst_warptv_rgb32, 24, G_BIG_ENDIAN, 0x000000ff, 0x0000ff00,
141       0x00ff0000},
142   {"RGB ", 32, gst_warptv_rgb32, 24, G_BIG_ENDIAN, 0x0000ff00, 0x00ff0000,
143       0xff000000},
144 };
145
146 static void
147 gst_warptv_base_init (gpointer g_class)
148 {
149   static GstElementDetails warptv_details = GST_ELEMENT_DETAILS ("WarpTV",
150       "Filter/Effect/Video",
151       "WarpTV does realtime goo'ing of the video input",
152       "Sam Lantinga <slouken@devolution.com>");
153   GstElementClass *element_class = GST_ELEMENT_CLASS (g_class);
154   GstVideofilterClass *videofilter_class = GST_VIDEOFILTER_CLASS (g_class);
155   int i;
156
157   gst_element_class_set_details (element_class, &warptv_details);
158
159   for (i = 0; i < G_N_ELEMENTS (gst_warptv_formats); i++) {
160     gst_videofilter_class_add_format (videofilter_class,
161         gst_warptv_formats + i);
162   }
163
164   gst_videofilter_class_add_pad_templates (GST_VIDEOFILTER_CLASS (g_class));
165 }
166
167 static void
168 gst_warptv_class_init (gpointer g_class, gpointer class_data)
169 {
170   GObjectClass *gobject_class;
171   GstVideofilterClass *videofilter_class;
172
173   gobject_class = G_OBJECT_CLASS (g_class);
174   videofilter_class = GST_VIDEOFILTER_CLASS (g_class);
175
176   gobject_class->set_property = gst_warptv_set_property;
177   gobject_class->get_property = gst_warptv_get_property;
178
179 #if 0
180   g_object_class_install_property (gobject_class, ARG_METHOD,
181       g_param_spec_enum ("method", "method", "method",
182           GST_TYPE_WARPTV_METHOD, GST_WARPTV_METHOD_1, G_PARAM_READWRITE));
183 #endif
184
185   videofilter_class->setup = gst_warptv_setup;
186 }
187
188 static void
189 gst_warptv_init (GTypeInstance * instance, gpointer g_class)
190 {
191   GstWarpTV *warptv = GST_WARPTV (instance);
192   GstVideofilter *videofilter;
193
194   GST_DEBUG ("gst_warptv_init");
195
196   videofilter = GST_VIDEOFILTER (warptv);
197
198   /* do stuff */
199 }
200
201 static void
202 gst_warptv_set_property (GObject * object, guint prop_id, const GValue * value,
203     GParamSpec * pspec)
204 {
205   GstWarpTV *src;
206
207   g_return_if_fail (GST_IS_WARPTV (object));
208   src = GST_WARPTV (object);
209
210   GST_DEBUG ("gst_warptv_set_property");
211   switch (prop_id) {
212 #if 0
213     case ARG_METHOD:
214       src->method = g_value_get_enum (value);
215       break;
216 #endif
217     default:
218       break;
219   }
220 }
221
222 static void
223 gst_warptv_get_property (GObject * object, guint prop_id, GValue * value,
224     GParamSpec * pspec)
225 {
226   GstWarpTV *src;
227
228   g_return_if_fail (GST_IS_WARPTV (object));
229   src = GST_WARPTV (object);
230
231   switch (prop_id) {
232 #if 0
233     case ARG_METHOD:
234       g_value_set_enum (value, src->method);
235       break;
236 #endif
237     default:
238       G_OBJECT_WARN_INVALID_PROPERTY_ID (object, prop_id, pspec);
239       break;
240   }
241 }
242
243
244 static void
245 gst_warptv_setup (GstVideofilter * videofilter)
246 {
247   GstWarpTV *warptv;
248   int width = gst_videofilter_get_input_width (videofilter);
249   int height = gst_videofilter_get_input_height (videofilter);
250
251   g_return_if_fail (GST_IS_WARPTV (videofilter));
252   warptv = GST_WARPTV (videofilter);
253
254   /* if any setup needs to be done, do it here */
255
256   warptv->width = width;
257   warptv->height = height;
258 #if 0
259   /* FIXME this should be reset in PAUSE->READY, not here */
260   warptv->tval = 0;
261 #endif
262
263   g_free (warptv->disttable);
264   g_free (warptv->offstable);
265
266   warptv->offstable = g_malloc (height * sizeof (guint32));
267   warptv->disttable = g_malloc (width * height * sizeof (guint32));
268
269   initSinTable (warptv);
270   initOffsTable (warptv);
271   initDistTable (warptv);
272 }
273
274 static void
275 initSinTable (GstWarpTV * filter)
276 {
277   gint32 *tptr, *tsinptr;
278   double i;
279
280   tsinptr = tptr = filter->sintable;
281
282   for (i = 0; i < 1024; i++)
283     *tptr++ = (int) (sin (i * M_PI / 512) * 32767);
284
285   for (i = 0; i < 256; i++)
286     *tptr++ = *tsinptr++;
287 }
288
289 static void
290 initOffsTable (GstWarpTV * filter)
291 {
292   int y;
293
294   for (y = 0; y < filter->height; y++) {
295     filter->offstable[y] = y * filter->width;
296   }
297 }
298
299 static void
300 initDistTable (GstWarpTV * filter)
301 {
302   gint32 halfw, halfh, *distptr;
303
304 #ifdef PS2
305   float x, y, m;
306 #else
307   double x, y, m;
308 #endif
309
310   halfw = filter->width >> 1;
311   halfh = filter->height >> 1;
312
313   distptr = filter->disttable;
314
315   m = sqrt ((double) (halfw * halfw + halfh * halfh));
316
317   for (y = -halfh; y < halfh; y++)
318     for (x = -halfw; x < halfw; x++)
319 #ifdef PS2
320       *distptr++ = ((int) ((sqrtf (x * x + y * y) * 511.9999) / m)) << 1;
321 #else
322       *distptr++ = ((int) ((sqrt (x * x + y * y) * 511.9999) / m)) << 1;
323 #endif
324 }
325
326 static void
327 gst_warptv_rgb32 (GstVideofilter * videofilter, void *d, void *s)
328 {
329   GstWarpTV *warptv;
330   int width = gst_videofilter_get_input_width (videofilter);
331   int height = gst_videofilter_get_input_height (videofilter);
332   guint32 *src = s;
333   guint32 *dest = d;
334   gint xw, yw, cw;
335   gint32 c, i, x, y, dx, dy, maxx, maxy;
336   gint32 skip, *ctptr, *distptr;
337   gint32 *sintable, *ctable;
338
339   g_return_if_fail (GST_IS_WARPTV (videofilter));
340   warptv = GST_WARPTV (videofilter);
341
342   xw = (gint) (sin ((warptv->tval + 100) * M_PI / 128) * 30);
343   yw = (gint) (sin ((warptv->tval) * M_PI / 256) * -35);
344   cw = (gint) (sin ((warptv->tval - 70) * M_PI / 64) * 50);
345   xw += (gint) (sin ((warptv->tval - 10) * M_PI / 512) * 40);
346   yw += (gint) (sin ((warptv->tval + 30) * M_PI / 512) * 40);
347
348   ctptr = warptv->ctable;
349   distptr = warptv->disttable;
350   sintable = warptv->sintable;
351   ctable = warptv->ctable;
352
353   skip = 0;                     /* video_width*sizeof(RGB32)/4 - video_width;; */
354   c = 0;
355
356   for (x = 0; x < 512; x++) {
357     i = (c >> 3) & 0x3FE;
358     *ctptr++ = ((sintable[i] * yw) >> 15);
359     *ctptr++ = ((sintable[i + 256] * xw) >> 15);
360     c += cw;
361   }
362   maxx = width - 2;
363   maxy = height - 2;
364
365   for (y = 0; y < height - 1; y++) {
366     for (x = 0; x < width; x++) {
367       i = *distptr++;
368       dx = ctable[i + 1] + x;
369       dy = ctable[i] + y;
370
371       if (dx < 0)
372         dx = 0;
373       else if (dx > maxx)
374         dx = maxx;
375
376       if (dy < 0)
377         dy = 0;
378       else if (dy > maxy)
379         dy = maxy;
380       *dest++ = src[warptv->offstable[dy] + dx];
381     }
382     dest += skip;
383   }
384
385   warptv->tval = (warptv->tval + 1) & 511;
386 }