?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
sync with en/mplayer.1 r28576
[mplayer/glamo.git] / libmpcodecs / vf_kerndeint.c
blobac51acfb3b83b47d5ce0803e79032e0eb5ed1769
1 /*
2 * Original AVISynth Filter Copyright (C) 2003 Donald A. Graft
3 * Adapted to MPlayer by Tobias Diedrich
4 *
5 * This file is part of MPlayer.
6 *
7 * MPlayer is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * MPlayer is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License along
18 * with MPlayer; if not, write to the Free Software Foundation, Inc.,
19 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
20 */
21
22 #include <stdio.h>
23 #include <stdlib.h>
24 #include <string.h>
25 #include <inttypes.h>
26 #include <math.h>
27
28 #include "config.h"
29 #include "mp_msg.h"
30
31 #if HAVE_MALLOC_H
32 #include <malloc.h>
33 #endif
34
35 #include "img_format.h"
36 #include "mp_image.h"
37 #include "vf.h"
38 #include "libvo/fastmemcpy.h"
39
40 //===========================================================================//
41
42 struct vf_priv_s {
43 int frame;
44 int map;
45 int order;
46 int thresh;
47 int sharp;
48 int twoway;
49 int do_deinterlace;
50 };
51
52
53 /***************************************************************************/
54
55
56 static int config(struct vf_instance_s* vf,
57 int width, int height, int d_width, int d_height,
58 unsigned int flags, unsigned int outfmt){
59
60 return vf_next_config(vf,width,height,d_width,d_height,flags,outfmt);
61 }
62
63
64 static void uninit(struct vf_instance_s* vf)
65 {
66 free(vf->priv);
67 }
68
69 static inline int IsRGB(mp_image_t *mpi)
70 {
71 return mpi->imgfmt == IMGFMT_RGB;
72 }
73
74 static inline int IsYUY2(mp_image_t *mpi)
75 {
76 return mpi->imgfmt == IMGFMT_YUY2;
77 }
78
79 #define PLANAR_Y 0
80 #define PLANAR_U 1
81 #define PLANAR_V 2
82
83 static int put_image(struct vf_instance_s* vf, mp_image_t *mpi, double pts){
84 int cw= mpi->w >> mpi->chroma_x_shift;
85 int ch= mpi->h >> mpi->chroma_y_shift;
86 int W = mpi->w, H = mpi->h;
87 const unsigned char *prvp, *prvpp, *prvpn, *prvpnn, *prvppp, *prvp4p, *prvp4n;
88 const unsigned char *srcp_saved;
89 const unsigned char *srcp, *srcpp, *srcpn, *srcpnn, *srcppp, *srcp3p, *srcp3n, *srcp4p, *srcp4n;
90 unsigned char *dstp, *dstp_saved;
91 int src_pitch;
92 int psrc_pitch;
93 int dst_pitch;
94 int x, y, z;
95 int n = vf->priv->frame++;
96 int val, hi, lo, w, h;
97 double valf;
98 int plane;
99 int threshold = vf->priv->thresh;
100 int order = vf->priv->order;
101 int map = vf->priv->map;
102 int sharp = vf->priv->sharp;
103 int twoway = vf->priv->twoway;
104 mp_image_t *dmpi, *pmpi;
105
106 if(!vf->priv->do_deinterlace)
107 return vf_next_put_image(vf, mpi, pts);
108
109 dmpi=vf_get_image(vf->next,mpi->imgfmt,
110 MP_IMGTYPE_IP, MP_IMGFLAG_ACCEPT_STRIDE,
111 mpi->w,mpi->h);
112 pmpi=vf_get_image(vf->next,mpi->imgfmt,
113 MP_IMGTYPE_TEMP, MP_IMGFLAG_ACCEPT_STRIDE,
114 mpi->w,mpi->h);
115 if(!dmpi) return 0;
116
117 for (z=0; z<mpi->num_planes; z++) {
118 if (z == 0) plane = PLANAR_Y;
119 else if (z == 1) plane = PLANAR_U;
120 else plane = PLANAR_V;
121
122 h = plane == PLANAR_Y ? H : ch;
123 w = plane == PLANAR_Y ? W : cw;
124
125 srcp = srcp_saved = mpi->planes[z];
126 src_pitch = mpi->stride[z];
127 psrc_pitch = pmpi->stride[z];
128 dstp = dstp_saved = dmpi->planes[z];
129 dst_pitch = dmpi->stride[z];
130 srcp = srcp_saved + (1-order) * src_pitch;
131 dstp = dstp_saved + (1-order) * dst_pitch;
132
133 for (y=0; y<h; y+=2) {
134 fast_memcpy(dstp, srcp, w);
135 srcp += 2*src_pitch;
136 dstp += 2*dst_pitch;
137 }
138
139 // Copy through the lines that will be missed below.
140 fast_memcpy(dstp_saved + order*dst_pitch, srcp_saved + (1-order)*src_pitch, w);
141 fast_memcpy(dstp_saved + (2+order)*dst_pitch, srcp_saved + (3-order)*src_pitch, w);
142 fast_memcpy(dstp_saved + (h-2+order)*dst_pitch, srcp_saved + (h-1-order)*src_pitch, w);
143 fast_memcpy(dstp_saved + (h-4+order)*dst_pitch, srcp_saved + (h-3-order)*src_pitch, w);
144 /* For the other field choose adaptively between using the previous field
145 or the interpolant from the current field. */
146
147 prvp = pmpi->planes[z] + 5*psrc_pitch - (1-order)*psrc_pitch;
148 prvpp = prvp - psrc_pitch;
149 prvppp = prvp - 2*psrc_pitch;
150 prvp4p = prvp - 4*psrc_pitch;
151 prvpn = prvp + psrc_pitch;
152 prvpnn = prvp + 2*psrc_pitch;
153 prvp4n = prvp + 4*psrc_pitch;
154 srcp = srcp_saved + 5*src_pitch - (1-order)*src_pitch;
155 srcpp = srcp - src_pitch;
156 srcppp = srcp - 2*src_pitch;
157 srcp3p = srcp - 3*src_pitch;
158 srcp4p = srcp - 4*src_pitch;
159 srcpn = srcp + src_pitch;
160 srcpnn = srcp + 2*src_pitch;
161 srcp3n = srcp + 3*src_pitch;
162 srcp4n = srcp + 4*src_pitch;
163 dstp = dstp_saved + 5*dst_pitch - (1-order)*dst_pitch;
164 for (y = 5 - (1-order); y <= h - 5 - (1-order); y+=2)
165 {
166 for (x = 0; x < w; x++)
167 {
168 if ((threshold == 0) || (n == 0) ||
169 (abs((int)prvp[x] - (int)srcp[x]) > threshold) ||
170 (abs((int)prvpp[x] - (int)srcpp[x]) > threshold) ||
171 (abs((int)prvpn[x] - (int)srcpn[x]) > threshold))
172 {
173 if (map == 1)
174 {
175 int g = x & ~3;
176 if (IsRGB(mpi) == 1)
177 {
178 dstp[g++] = 255;
179 dstp[g++] = 255;
180 dstp[g++] = 255;
181 dstp[g] = 255;
182 x = g;
183 }
184 else if (IsYUY2(mpi) == 1)
185 {
186 dstp[g++] = 235;
187 dstp[g++] = 128;
188 dstp[g++] = 235;
189 dstp[g] = 128;
190 x = g;
191 }
192 else
193 {
194 if (plane == PLANAR_Y) dstp[x] = 235;
195 else dstp[x] = 128;
196 }
197 }
198 else
199 {
200 if (IsRGB(mpi))
201 {
202 hi = 255;
203 lo = 0;
204 }
205 else if (IsYUY2(mpi))
206 {
207 hi = (x & 1) ? 240 : 235;
208 lo = 16;
209 }
210 else
211 {
212 hi = (plane == PLANAR_Y) ? 235 : 240;
213 lo = 16;
214 }
215
216 if (sharp == 1)
217 {
218 if (twoway == 1)
219 valf = + 0.526*((int)srcpp[x] + (int)srcpn[x])
220 + 0.170*((int)srcp[x] + (int)prvp[x])
221 - 0.116*((int)srcppp[x] + (int)srcpnn[x] + (int)prvppp[x] + (int)prvpnn[x])
222 - 0.026*((int)srcp3p[x] + (int)srcp3n[x])
223 + 0.031*((int)srcp4p[x] + (int)srcp4n[x] + (int)prvp4p[x] + (int)prvp4n[x]);
224 else
225 valf = + 0.526*((int)srcpp[x] + (int)srcpn[x])
226 + 0.170*((int)prvp[x])
227 - 0.116*((int)prvppp[x] + (int)prvpnn[x])
228 - 0.026*((int)srcp3p[x] + (int)srcp3n[x])
229 + 0.031*((int)prvp4p[x] + (int)prvp4p[x]);
230 if (valf > hi) valf = hi;
231 else if (valf < lo) valf = lo;
232 dstp[x] = (int) valf;
233 }
234 else
235 {
236 if (twoway == 1)
237 val = (8*((int)srcpp[x] + (int)srcpn[x]) + 2*((int)srcp[x] + (int)prvp[x]) -
238 (int)(srcppp[x]) - (int)(srcpnn[x]) -
239 (int)(prvppp[x]) - (int)(prvpnn[x])) >> 4;
240 else
241 val = (8*((int)srcpp[x] + (int)srcpn[x]) + 2*((int)prvp[x]) -
242 (int)(prvppp[x]) - (int)(prvpnn[x])) >> 4;
243 if (val > hi) val = hi;
244 else if (val < lo) val = lo;
245 dstp[x] = (int) val;
246 }
247 }
248 }
249 else
250 {
251 dstp[x] = srcp[x];
252 }
253 }
254 prvp += 2*psrc_pitch;
255 prvpp += 2*psrc_pitch;
256 prvppp += 2*psrc_pitch;
257 prvpn += 2*psrc_pitch;
258 prvpnn += 2*psrc_pitch;
259 prvp4p += 2*psrc_pitch;
260 prvp4n += 2*psrc_pitch;
261 srcp += 2*src_pitch;
262 srcpp += 2*src_pitch;
263 srcppp += 2*src_pitch;
264 srcp3p += 2*src_pitch;
265 srcp4p += 2*src_pitch;
266 srcpn += 2*src_pitch;
267 srcpnn += 2*src_pitch;
268 srcp3n += 2*src_pitch;
269 srcp4n += 2*src_pitch;
270 dstp += 2*dst_pitch;
271 }
272
273 srcp = mpi->planes[z];
274 dstp = pmpi->planes[z];
275 for (y=0; y<h; y++) {
276 fast_memcpy(dstp, srcp, w);
277 srcp += src_pitch;
278 dstp += psrc_pitch;
279 }
280 }
281
282 return vf_next_put_image(vf,dmpi, pts);
283 }
284
285 //===========================================================================//
286
287 static int query_format(struct vf_instance_s* vf, unsigned int fmt){
288 switch(fmt)
289 {
290 case IMGFMT_YV12:
291 case IMGFMT_RGB:
292 case IMGFMT_YUY2:
293 return vf_next_query_format(vf, fmt);
294 }
295 return 0;
296 }
297
298 static int control(struct vf_instance_s* vf, int request, void* data){
299 switch (request)
300 {
301 case VFCTRL_GET_DEINTERLACE:
302 *(int*)data = vf->priv->do_deinterlace;
303 return CONTROL_OK;
304 case VFCTRL_SET_DEINTERLACE:
305 vf->priv->do_deinterlace = *(int*)data;
306 return CONTROL_OK;
307 }
308 return vf_next_control (vf, request, data);
309 }
310
311 static int open(vf_instance_t *vf, char* args){
312
313 vf->control=control;
314 vf->config=config;
315 vf->put_image=put_image;
316 vf->query_format=query_format;
317 vf->uninit=uninit;
318 vf->priv=malloc(sizeof(struct vf_priv_s));
319 memset(vf->priv, 0, sizeof(struct vf_priv_s));
320
321 vf->priv->frame = 0;
322
323 vf->priv->map = 0;
324 vf->priv->order = 0;
325 vf->priv->thresh = 10;
326 vf->priv->sharp = 0;
327 vf->priv->twoway = 0;
328 vf->priv->do_deinterlace=1;
329
330 if (args)
331 {
332 sscanf(args, "%d:%d:%d:%d:%d",
333 &vf->priv->thresh, &vf->priv->map,
334 &vf->priv->order, &vf->priv->sharp,
335 &vf->priv->twoway);
336 }
337 if (vf->priv->order > 1) vf->priv->order = 1;
338
339 return 1;
340 }
341
342 const vf_info_t vf_info_kerndeint = {
343 "Kernel Deinterlacer",
344 "kerndeint",
345 "Donald Graft",
346 "",
347 open,
348 NULL
349 };
350
351 //===========================================================================//
mplayer with SMedia Glamo drivers