gst/median/gstmedian.c

   1 /* GStreamer
   2  * Copyright (C) <1999> Erik Walthinsen <omega@cse.ogi.edu>
   3  *
   4  * This library is free software; you can redistribute it and/or
   5  * modify it under the terms of the GNU Library General Public
   6  * License as published by the Free Software Foundation; either
   7  * version 2 of the License, or (at your option) any later version.
   8  *
   9  * This library is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12  * Library General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU Library General Public
  15  * License along with this library; if not, write to the
  16  * Free Software Foundation, Inc., 59 Temple Place - Suite 330,
  17  * Boston, MA 02111-1307, USA.
  18  */
  19
  20 #ifdef HAVE_CONFIG_H
  21 #include "config.h"
  22 #endif
  23 #include <string.h>
  24 #include "gstmedian.h"
  25 #include <gst/video/video.h>
  26
  27 /* elementfactory information */
  28 static GstElementDetails median_details = {
  29   "Median effect",
  30   "Filter/Effect/Video",
  31   "Apply a median filter to an image",
  32   "Wim Taymans <wim.taymans@chello.be>"
  33 };
  34
  35 static GstStaticPadTemplate median_src_factory = GST_STATIC_PAD_TEMPLATE ("src",
  36     GST_PAD_SRC,
  37     GST_PAD_ALWAYS,
  38     GST_STATIC_CAPS (GST_VIDEO_CAPS_YUV ("I420"))
  39     );
  40
  41 static GstStaticPadTemplate median_sink_factory =
  42 GST_STATIC_PAD_TEMPLATE ("sink",
  43     GST_PAD_SINK,
  44     GST_PAD_ALWAYS,
  45     GST_STATIC_CAPS (GST_VIDEO_CAPS_YUV ("I420"))
  46     );
  47
  48
  49 /* Median signals and args */
  50 enum
  51 {
  52   /* FILL ME */
  53   LAST_SIGNAL
  54 };
  55
  56 enum
  57 {
  58   ARG_0,
  59   ARG_ACTIVE,
  60   ARG_FILTERSIZE,
  61   ARG_LUM_ONLY
  62 };
  63
  64 static GType gst_median_get_type (void);
  65 static void gst_median_class_init (GstMedianClass * klass);
  66 static void gst_median_base_init (GstMedianClass * klass);
  67 static void gst_median_init (GstMedian * median);
  68
  69 static void median_5 (unsigned char *src, unsigned char *dest, int height,
  70     int width);
  71 static void median_9 (unsigned char *src, unsigned char *dest, int height,
  72     int width);
  73 static void gst_median_chain (GstPad * pad, GstData * _data);
  74
  75 static void gst_median_set_property (GObject * object, guint prop_id,
  76     const GValue * value, GParamSpec * pspec);
  77 static void gst_median_get_property (GObject * object, guint prop_id,
  78     GValue * value, GParamSpec * pspec);
  79
  80 static GstElementClass *parent_class = NULL;
  81
  82 /*static guint gst_median_signals[LAST_SIGNAL] = { 0 }; */
  83
  84 GType
  85 gst_median_get_type (void)
  86 {
  87   static GType median_type = 0;
  88
  89   if (!median_type) {
  90     static const GTypeInfo median_info = {
  91       sizeof (GstMedianClass),
  92       (GBaseInitFunc) gst_median_base_init,
  93       NULL,
  94       (GClassInitFunc) gst_median_class_init,
  95       NULL,
  96       NULL,
  97       sizeof (GstMedian),
  98       0,
  99       (GInstanceInitFunc) gst_median_init,
 100     };
 101
 102     median_type =
 103         g_type_register_static (GST_TYPE_ELEMENT, "GstMedian", &median_info, 0);
 104   }
 105   return median_type;
 106 }
 107
 108 static void
 109 gst_median_base_init (GstMedianClass * klass)
 110 {
 111   GstElementClass *element_class = GST_ELEMENT_CLASS (klass);
 112
 113   gst_element_class_add_pad_template (element_class,
 114       gst_static_pad_template_get (&median_sink_factory));
 115   gst_element_class_add_pad_template (element_class,
 116       gst_static_pad_template_get (&median_src_factory));
 117   gst_element_class_set_details (element_class, &median_details);
 118 }
 119
 120 static void
 121 gst_median_class_init (GstMedianClass * klass)
 122 {
 123   GObjectClass *gobject_class;
 124   GstElementClass *gstelement_class;
 125
 126   gobject_class = (GObjectClass *) klass;
 127   gstelement_class = (GstElementClass *) klass;
 128
 129   parent_class = g_type_class_ref (GST_TYPE_ELEMENT);
 130
 131   g_object_class_install_property (G_OBJECT_CLASS (klass), ARG_ACTIVE, g_param_spec_boolean ("active", "active", "active", TRUE, G_PARAM_READWRITE));   /* CHECKME */
 132   g_object_class_install_property (G_OBJECT_CLASS (klass), ARG_FILTERSIZE, g_param_spec_int ("filtersize", "filtersize", "filtersize", G_MININT, G_MAXINT, 0, G_PARAM_READWRITE));      /* CHECKME */
 133   g_object_class_install_property (G_OBJECT_CLASS (klass), ARG_LUM_ONLY, g_param_spec_boolean ("lum_only", "lum_only", "lum_only", TRUE, G_PARAM_READWRITE));   /* CHECKME */
 134
 135   gobject_class->set_property = gst_median_set_property;
 136   gobject_class->get_property = gst_median_get_property;
 137 }
 138
 139 static gboolean
 140 gst_median_link (GstPad * pad, const GstCaps * caps)
 141 {
 142   GstMedian *filter = GST_MEDIAN (gst_pad_get_parent (pad));
 143   GstPad *otherpad = (pad == filter->srcpad) ? filter->sinkpad : filter->srcpad;
 144   GstStructure *structure = gst_caps_get_structure (caps, 0);
 145   gint w, h;
 146   GstPadLinkReturn ret;
 147
 148   gst_structure_get_int (structure, "width", &w);
 149   gst_structure_get_int (structure, "height", &h);
 150
 151   ret = gst_pad_try_set_caps (otherpad, caps);
 152   if (GST_PAD_LINK_SUCCESSFUL (ret)) {
 153     filter->width = w;
 154     filter->height = h;
 155   }
 156
 157   return ret;
 158 }
 159
 160 void
 161 gst_median_init (GstMedian * median)
 162 {
 163   median->sinkpad =
 164       gst_pad_new_from_template (gst_static_pad_template_get
 165       (&median_sink_factory), "sink");
 166   gst_pad_set_getcaps_function (median->sinkpad, gst_pad_proxy_getcaps);
 167   gst_pad_set_link_function (median->sinkpad, gst_median_link);
 168   gst_pad_set_chain_function (median->sinkpad, gst_median_chain);
 169   gst_element_add_pad (GST_ELEMENT (median), median->sinkpad);
 170
 171   median->srcpad =
 172       gst_pad_new_from_template (gst_static_pad_template_get
 173       (&median_src_factory), "src");
 174   gst_pad_set_getcaps_function (median->srcpad, gst_pad_proxy_getcaps);
 175   gst_pad_set_link_function (median->sinkpad, gst_median_link);
 176   gst_element_add_pad (GST_ELEMENT (median), median->srcpad);
 177
 178   median->filtersize = 5;
 179   median->lum_only = TRUE;
 180   median->active = TRUE;
 181 }
 182
 183 #define PIX_SORT(a,b) { if ((a)>(b)) PIX_SWAP((a),(b)); }
 184 #define PIX_SWAP(a,b) { unsigned char temp=(a);(a)=(b);(b)=temp; }
 185
 186 static void
 187 median_5 (unsigned char *src, unsigned char *dest, int width, int height)
 188 {
 189   int nLastRow;
 190   int nLastCol;
 191   unsigned char p[9];
 192   int i, j, k;
 193
 194   nLastCol = width - 1;
 195   nLastRow = height - 1;
 196
 197   /*copy the top and bottom rows into the result array */
 198   for (i = 0; i < width; i++) {
 199     dest[i] = src[i];
 200     dest[nLastRow * width + i] = src[nLastRow * width + i];
 201   }
 202   dest[i] = src[i];
 203
 204   nLastCol--;
 205   nLastRow--;
 206
 207   /* process the interior pixels */
 208   i = width + 1;
 209   for (k = 0; k < nLastRow; k++) {
 210     for (j = 0; j < nLastCol; j++, i++) {
 211       p[0] = src[i - width];
 212       p[1] = src[i - 1];
 213       p[2] = src[i];
 214       p[3] = src[i + 1];
 215       p[4] = src[i + width];
 216       PIX_SORT (p[0], p[1]);
 217       PIX_SORT (p[3], p[4]);
 218       PIX_SORT (p[0], p[3]);
 219       PIX_SORT (p[1], p[4]);
 220       PIX_SORT (p[1], p[2]);
 221       PIX_SORT (p[2], p[3]);
 222       PIX_SORT (p[1], p[2]);
 223       dest[i] = p[2];
 224     }
 225     dest[i] = src[i];
 226     i++;
 227     dest[i] = src[i];
 228     i++;
 229   }
 230   dest[i] = src[i];
 231   i++;
 232 }
 233
 234 static void
 235 median_9 (unsigned char *src, unsigned char *dest, int width, int height)
 236 {
 237   int nLastRow;
 238   int nLastCol;
 239   unsigned char p[9];
 240   int i, j, k;
 241
 242   nLastCol = width - 1;
 243   nLastRow = height - 1;
 244
 245   /*copy the top and bottom rows into the result array */
 246   for (i = 0; i < width; i++) {
 247     dest[i] = src[i];
 248     dest[nLastRow * width + i] = src[nLastRow * width + i];
 249   }
 250   dest[i] = src[i];
 251
 252   nLastCol--;
 253   nLastRow--;
 254
 255   /* process the interior pixels */
 256   i = width + 1;
 257   for (k = 0; k < nLastRow; k++) {
 258     for (j = 0; j < nLastCol; j++, i++) {
 259       p[0] = src[i - width - 1];
 260       p[1] = src[i - width];
 261       p[2] = src[i - width + 1];
 262       p[3] = src[i - 1];
 263       p[4] = src[i];
 264       p[5] = src[i + 1];
 265       p[6] = src[i + width - 1];
 266       p[7] = src[i + width];
 267       p[8] = src[i + width + 1];
 268       PIX_SORT (p[1], p[2]);
 269       PIX_SORT (p[4], p[5]);
 270       PIX_SORT (p[7], p[8]);
 271       PIX_SORT (p[0], p[1]);
 272       PIX_SORT (p[3], p[4]);
 273       PIX_SORT (p[6], p[7]);
 274       PIX_SORT (p[1], p[2]);
 275       PIX_SORT (p[4], p[5]);
 276       PIX_SORT (p[7], p[8]);
 277       PIX_SORT (p[0], p[3]);
 278       PIX_SORT (p[5], p[8]);
 279       PIX_SORT (p[4], p[7]);
 280       PIX_SORT (p[3], p[6]);
 281       PIX_SORT (p[1], p[4]);
 282       PIX_SORT (p[2], p[5]);
 283       PIX_SORT (p[4], p[7]);
 284       PIX_SORT (p[4], p[2]);
 285       PIX_SORT (p[6], p[4]);
 286       PIX_SORT (p[4], p[2]);
 287       dest[i] = p[4];
 288     }
 289     dest[i] = src[i];
 290     i++;
 291     dest[i] = src[i];
 292     i++;
 293   }
 294   dest[i] = src[i];
 295   i++;
 296 }
 297
 298 static void
 299 gst_median_chain (GstPad * pad, GstData * _data)
 300 {
 301   GstBuffer *buf = GST_BUFFER (_data);
 302   GstMedian *median;
 303   guchar *data;
 304   gulong size;
 305   GstBuffer *outbuf;
 306
 307 /*  GstMeta *meta; */
 308   int lumsize, chromsize;
 309
 310   g_return_if_fail (pad != NULL);
 311   g_return_if_fail (GST_IS_PAD (pad));
 312   g_return_if_fail (buf != NULL);
 313
 314   median = GST_MEDIAN (GST_OBJECT_PARENT (pad));
 315
 316   if (!median->active) {
 317     gst_pad_push (median->srcpad, GST_DATA (buf));
 318     return;
 319   }
 320
 321   data = GST_BUFFER_DATA (buf);
 322   size = GST_BUFFER_SIZE (buf);
 323
 324   GST_DEBUG ("median: have buffer of %d", GST_BUFFER_SIZE (buf));
 325
 326   outbuf = gst_buffer_new ();
 327   GST_BUFFER_DATA (outbuf) = g_malloc (GST_BUFFER_SIZE (buf));
 328   GST_BUFFER_SIZE (outbuf) = GST_BUFFER_SIZE (buf);
 329
 330   lumsize = median->width * median->height;
 331   chromsize = lumsize / 4;
 332
 333   if (median->filtersize == 5) {
 334     median_5 (data, GST_BUFFER_DATA (outbuf), median->width, median->height);
 335     if (!median->lum_only) {
 336       median_5 (data + lumsize, GST_BUFFER_DATA (outbuf) + lumsize,
 337           median->width / 2, median->height / 2);
 338       median_5 (data + lumsize + chromsize,
 339           GST_BUFFER_DATA (outbuf) + lumsize + chromsize, median->width / 2,
 340           median->height / 2);
 341     } else {
 342       memcpy (GST_BUFFER_DATA (outbuf) + lumsize, data + lumsize,
 343           chromsize * 2);
 344     }
 345   } else {
 346     median_9 (data, GST_BUFFER_DATA (outbuf), median->width, median->height);
 347     if (!median->lum_only) {
 348       median_9 (data + lumsize, GST_BUFFER_DATA (outbuf) + lumsize,
 349           median->width / 2, median->height / 2);
 350       median_9 (data + lumsize + chromsize,
 351           GST_BUFFER_DATA (outbuf) + lumsize + chromsize, median->width / 2,
 352           median->height / 2);
 353     } else {
 354       memcpy (GST_BUFFER_DATA (outbuf) + lumsize, data + lumsize,
 355           chromsize * 2);
 356     }
 357   }
 358   GST_BUFFER_TIMESTAMP (outbuf) = GST_BUFFER_TIMESTAMP (buf);
 359
 360   gst_buffer_unref (buf);
 361
 362   gst_pad_push (median->srcpad, GST_DATA (outbuf));
 363 }
 364
 365 static void
 366 gst_median_set_property (GObject * object, guint prop_id, const GValue * value,
 367     GParamSpec * pspec)
 368 {
 369   GstMedian *median;
 370   gint argvalue;
 371
 372   g_return_if_fail (GST_IS_MEDIAN (object));
 373   median = GST_MEDIAN (object);
 374
 375   switch (prop_id) {
 376     case ARG_FILTERSIZE:
 377       argvalue = g_value_get_int (value);
 378       if (argvalue != 5 && argvalue != 9) {
 379         g_warning ("median: invalid filtersize (%d), must be 5 or 9\n",
 380             argvalue);
 381       } else {
 382         median->filtersize = argvalue;
 383       }
 384       break;
 385     case ARG_ACTIVE:
 386       median->active = g_value_get_boolean (value);
 387       break;
 388     case ARG_LUM_ONLY:
 389       median->lum_only = g_value_get_boolean (value);
 390       break;
 391     default:
 392       break;
 393   }
 394 }
 395
 396 static void
 397 gst_median_get_property (GObject * object, guint prop_id, GValue * value,
 398     GParamSpec * pspec)
 399 {
 400   GstMedian *median;
 401
 402   g_return_if_fail (GST_IS_MEDIAN (object));
 403   median = GST_MEDIAN (object);
 404
 405   switch (prop_id) {
 406     case ARG_FILTERSIZE:
 407       g_value_set_int (value, median->filtersize);
 408       break;
 409     case ARG_ACTIVE:
 410       g_value_set_boolean (value, median->active);
 411       break;
 412     case ARG_LUM_ONLY:
 413       g_value_set_boolean (value, median->lum_only);
 414       break;
 415     default:
 416       G_OBJECT_WARN_INVALID_PROPERTY_ID (object, prop_id, pspec);
 417       break;
 418   }
 419 }
 420
 421
 422 static gboolean
 423 plugin_init (GstPlugin * plugin)
 424 {
 425   return gst_element_register (plugin, "median",
 426       GST_RANK_NONE, GST_TYPE_MEDIAN);
 427 }
 428
 429 GST_PLUGIN_DEFINE (GST_VERSION_MAJOR,
 430     GST_VERSION_MINOR,
 431     "median",
 432     "Video median filter",
 433     plugin_init, VERSION, GST_LICENSE, GST_PACKAGE, GST_ORIGIN)