libmpcodecs/vf_denoise3d.c

   1 /*
   2  * Copyright (C) 2003 Daniel Moreno <comac@comac.darktech.org>
   3  *
   4  * This file is part of MPlayer.
   5  *
   6  * MPlayer is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * MPlayer is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License along
  17  * with MPlayer; if not, write to the Free Software Foundation, Inc.,
  18  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  19  */
  20
  21 #include <stdio.h>
  22 #include <stdlib.h>
  23 #include <string.h>
  24 #include <inttypes.h>
  25 #include <math.h>
  26
  27 #include "config.h"
  28 #include "mp_msg.h"
  29
  30 #ifdef HAVE_MALLOC_H
  31 #include <malloc.h>
  32 #endif
  33
  34 #include "img_format.h"
  35 #include "mp_image.h"
  36 #include "vf.h"
  37
  38 #define PARAM1_DEFAULT 4.0
  39 #define PARAM2_DEFAULT 3.0
  40 #define PARAM3_DEFAULT 6.0
  41
  42 //===========================================================================//
  43
  44 struct vf_priv_s {
  45         int Coefs[4][512];
  46         unsigned char *Line;
  47         mp_image_t *pmpi;
  48 };
  49
  50
  51 /***************************************************************************/
  52
  53
  54 static int config(struct vf_instance_s* vf,
  55         int width, int height, int d_width, int d_height,
  56         unsigned int flags, unsigned int outfmt){
  57
  58         if(vf->priv->Line) free(vf->priv->Line);
  59         vf->priv->Line = malloc(width);
  60         vf->priv->pmpi=NULL;
  61 //        vf->default_caps &= !VFCAP_ACCEPT_STRIDE;
  62
  63         return vf_next_config(vf,width,height,d_width,d_height,flags,outfmt);
  64 }
  65
  66
  67 static void uninit(struct vf_instance_s* vf)
  68 {
  69     free(vf->priv->Line);
  70 }
  71
  72 #define LowPass(Prev, Curr, Coef) (Curr + Coef[Prev - Curr])
  73
  74 static void deNoise(unsigned char *Frame,        // mpi->planes[x]
  75                     unsigned char *FramePrev,    // pmpi->planes[x]
  76                     unsigned char *FrameDest,    // dmpi->planes[x]
  77                     unsigned char *LineAnt,      // vf->priv->Line (width bytes)
  78                     int W, int H, int sStride, int pStride, int dStride,
  79                     int *Horizontal, int *Vertical, int *Temporal)
  80 {
  81     int X, Y;
  82     int sLineOffs = 0, pLineOffs = 0, dLineOffs = 0;
  83     unsigned char PixelAnt;
  84
  85     /* First pixel has no left nor top neighbor. Only previous frame */
  86     LineAnt[0] = PixelAnt = Frame[0];
  87     FrameDest[0] = LowPass(FramePrev[0], LineAnt[0], Temporal);
  88
  89     /* Fist line has no top neighbor. Only left one for each pixel and
  90      * last frame */
  91     for (X = 1; X < W; X++)
  92     {
  93         PixelAnt = LowPass(PixelAnt, Frame[X], Horizontal);
  94         LineAnt[X] = PixelAnt;
  95         FrameDest[X] = LowPass(FramePrev[X], LineAnt[X], Temporal);
  96     }
  97
  98     for (Y = 1; Y < H; Y++)
  99     {
 100         sLineOffs += sStride, pLineOffs += pStride, dLineOffs += dStride;
 101         /* First pixel on each line doesn't have previous pixel */
 102         PixelAnt = Frame[sLineOffs];
 103         LineAnt[0] = LowPass(LineAnt[0], PixelAnt, Vertical);
 104         FrameDest[dLineOffs] = LowPass(FramePrev[pLineOffs], LineAnt[0], Temporal);
 105
 106         for (X = 1; X < W; X++)
 107         {
 108             /* The rest are normal */
 109             PixelAnt = LowPass(PixelAnt, Frame[sLineOffs+X], Horizontal);
 110             LineAnt[X] = LowPass(LineAnt[X], PixelAnt, Vertical);
 111             FrameDest[dLineOffs+X] = LowPass(FramePrev[pLineOffs+X], LineAnt[X], Temporal);
 112         }
 113     }
 114 }
 115
 116
 117
 118 static int put_image(struct vf_instance_s* vf, mp_image_t *mpi, double pts){
 119         int cw= mpi->w >> mpi->chroma_x_shift;
 120         int ch= mpi->h >> mpi->chroma_y_shift;
 121         int W = mpi->w, H = mpi->h;
 122
 123         mp_image_t *dmpi=vf_get_image(vf->next,mpi->imgfmt,
 124                 MP_IMGTYPE_IP, MP_IMGFLAG_ACCEPT_STRIDE |
 125                 MP_IMGFLAG_PRESERVE | MP_IMGFLAG_READABLE,
 126                 mpi->w,mpi->h);
 127
 128         if(!dmpi) return 0;
 129         if (!vf->priv->pmpi) vf->priv->pmpi=mpi;
 130
 131         deNoise(mpi->planes[0], vf->priv->pmpi->planes[0], dmpi->planes[0],
 132                 vf->priv->Line, W, H,
 133                 mpi->stride[0], vf->priv->pmpi->stride[0], dmpi->stride[0],
 134                 vf->priv->Coefs[0] + 256,
 135                 vf->priv->Coefs[0] + 256,
 136                 vf->priv->Coefs[1] + 256);
 137         deNoise(mpi->planes[1], vf->priv->pmpi->planes[1], dmpi->planes[1],
 138                 vf->priv->Line, cw, ch,
 139                 mpi->stride[1], vf->priv->pmpi->stride[1], dmpi->stride[1],
 140                 vf->priv->Coefs[2] + 256,
 141                 vf->priv->Coefs[2] + 256,
 142                 vf->priv->Coefs[3] + 256);
 143         deNoise(mpi->planes[2], vf->priv->pmpi->planes[2], dmpi->planes[2],
 144                 vf->priv->Line, cw, ch,
 145                 mpi->stride[2], vf->priv->pmpi->stride[2], dmpi->stride[2],
 146                 vf->priv->Coefs[2] + 256,
 147                 vf->priv->Coefs[2] + 256,
 148                 vf->priv->Coefs[3] + 256);
 149
 150         vf->priv->pmpi=dmpi; // save reference image
 151         return vf_next_put_image(vf,dmpi, pts);
 152 }
 153
 154 //===========================================================================//
 155
 156 static int query_format(struct vf_instance_s* vf, unsigned int fmt){
 157         switch(fmt)
 158         {
 159         case IMGFMT_YV12:
 160         case IMGFMT_I420:
 161         case IMGFMT_IYUV:
 162         case IMGFMT_YVU9:
 163         case IMGFMT_444P:
 164         case IMGFMT_422P:
 165         case IMGFMT_411P:
 166                 return vf_next_query_format(vf, fmt);
 167         }
 168         return 0;
 169 }
 170
 171
 172 #define ABS(A) ( (A) > 0 ? (A) : -(A) )
 173
 174 static void PrecalcCoefs(int *Ct, double Dist25)
 175 {
 176     int i;
 177     double Gamma, Simil, C;
 178
 179     Gamma = log(0.25) / log(1.0 - Dist25/255.0);
 180
 181     for (i = -256; i <= 255; i++)
 182     {
 183         Simil = 1.0 - ABS(i) / 255.0;
 184 //        Ct[256+i] = lround(pow(Simil, Gamma) * (double)i);
 185         C = pow(Simil, Gamma) * (double)i;
 186         Ct[256+i] = (C<0) ? (C-0.5) : (C+0.5);
 187     }
 188 }
 189
 190
 191 static int open(vf_instance_t *vf, char* args){
 192         double LumSpac, LumTmp, ChromSpac, ChromTmp;
 193         double Param1, Param2, Param3;
 194
 195         vf->config=config;
 196         vf->put_image=put_image;
 197         vf->query_format=query_format;
 198         vf->uninit=uninit;
 199         vf->priv=malloc(sizeof(struct vf_priv_s));
 200         memset(vf->priv, 0, sizeof(struct vf_priv_s));
 201
 202         if (args)
 203         {
 204             switch(sscanf(args, "%lf:%lf:%lf",
 205                           &Param1, &Param2, &Param3
 206                          ))
 207             {
 208             case 0:
 209                 LumSpac = PARAM1_DEFAULT;
 210                 LumTmp = PARAM3_DEFAULT;
 211
 212                 ChromSpac = PARAM2_DEFAULT;
 213                 ChromTmp = LumTmp * ChromSpac / LumSpac;
 214                 break;
 215
 216             case 1:
 217                 LumSpac = Param1;
 218                 LumTmp = PARAM3_DEFAULT * Param1 / PARAM1_DEFAULT;
 219
 220                 ChromSpac = PARAM2_DEFAULT * Param1 / PARAM1_DEFAULT;
 221                 ChromTmp = LumTmp * ChromSpac / LumSpac;
 222                 break;
 223
 224             case 2:
 225                 LumSpac = Param1;
 226                 LumTmp = PARAM3_DEFAULT * Param1 / PARAM1_DEFAULT;
 227
 228                 ChromSpac = Param2;
 229                 ChromTmp = LumTmp * ChromSpac / LumSpac;
 230                 break;
 231
 232             case 3:
 233                 LumSpac = Param1;
 234                 LumTmp = Param3;
 235
 236                 ChromSpac = Param2;
 237                 ChromTmp = LumTmp * ChromSpac / LumSpac;
 238                 break;
 239
 240             default:
 241                 LumSpac = PARAM1_DEFAULT;
 242                 LumTmp = PARAM3_DEFAULT;
 243
 244                 ChromSpac = PARAM2_DEFAULT;
 245                 ChromTmp = LumTmp * ChromSpac / LumSpac;
 246             }
 247         }
 248         else
 249         {
 250             LumSpac = PARAM1_DEFAULT;
 251             LumTmp = PARAM3_DEFAULT;
 252
 253             ChromSpac = PARAM2_DEFAULT;
 254             ChromTmp = LumTmp * ChromSpac / LumSpac;
 255         }
 256
 257         PrecalcCoefs(vf->priv->Coefs[0], LumSpac);
 258         PrecalcCoefs(vf->priv->Coefs[1], LumTmp);
 259         PrecalcCoefs(vf->priv->Coefs[2], ChromSpac);
 260         PrecalcCoefs(vf->priv->Coefs[3], ChromTmp);
 261
 262         return 1;
 263 }
 264
 265 const vf_info_t vf_info_denoise3d = {
 266     "3D Denoiser (variable lowpass filter)",
 267     "denoise3d",
 268     "Daniel Moreno",
 269     "",
 270     open,
 271     NULL
 272 };
 273
 274 //===========================================================================//