summaryrefslogtreecommitdiffstats
path: root/libhb/eedi2.c
diff options
context:
space:
mode:
Diffstat (limited to 'libhb/eedi2.c')
-rw-r--r--libhb/eedi2.c1870
1 files changed, 1870 insertions, 0 deletions
diff --git a/libhb/eedi2.c b/libhb/eedi2.c
new file mode 100644
index 000000000..2aa906ef0
--- /dev/null
+++ b/libhb/eedi2.c
@@ -0,0 +1,1870 @@
+/* $Id: eedi2.c,v 1.0 2009/03/06 5:00:00 jbrjake Exp $
+
+ This file is part of the HandBrake source code.
+ Homepage: <http://handbrake.fr/>.
+ It may be used under the terms of the GNU General Public License.
+
+ The EEDI2 interpolator was created by tritical:
+ http://web.missouri.edu/~kes25c/
+*/
+
+#include "hb.h"
+#include "eedi2.h"
+
+/**
+ * EEDI2 directional limit lookup table
+ *
+ * These values are used to limit the range of edge direction searches and filtering.
+ */
+const int eedi2_limlut[33] __attribute__ ((aligned (16))) = {
+ 6, 6, 7, 7, 8, 8, 9, 9, 9, 10,
+ 10, 11, 11, 12, 12, 12, 12, 12, 12, 12,
+ 12, 12, 12, 12, 12, 12, 12, 12, 12, 12,
+ 12, -1, -1 };
+
+/**
+ * Analog of _aligned_malloc
+ * @param size Size of memory being pointed to
+ * @param align_size Size of memory chunks to align to (must be power of 2)
+ */
+void *eedi2_aligned_malloc( size_t size, size_t align_size )
+{
+ char * ptr, * ptr2, * aligned_ptr;
+ int align_mask = align_size - 1;
+
+ ptr = (char *)malloc( size + align_size + sizeof( int ) );
+ if( ptr==NULL ) return( NULL );
+
+ ptr2 = ptr + sizeof( int );
+ aligned_ptr = ptr2 + ( align_size - ( (size_t)ptr2 & align_mask ) );
+
+
+ ptr2 = aligned_ptr - sizeof( int );
+ *( (int *)ptr2 ) = (int)( aligned_ptr - ptr );
+
+ return( aligned_ptr );
+}
+
+/**
+ * Analog of _aligned_free
+ * @param ptr The aligned pointer, created with eedi2_aligned_malloc, to be freed
+ */
+void eedi2_aligned_free( void *ptr )
+{
+ int * ptr2 = (int *)ptr - 1;
+ ptr -= * ptr2;
+ free(ptr);
+}
+
+/**
+ * Sorts metrics for median filtering
+ * @param order Pointer to the table of values to sort
+ * @param length Length of the order array
+ */
+void eedi2_sort_metrics( int *order, const int length )
+{
+ int i;
+ for( i = 1; i < length; ++i )
+ {
+ int j = i;
+ const int temp = order[j];
+ while( j > 0 && order[j-1] > temp )
+ {
+ order[j] = order[j-1];
+ --j;
+ }
+ order[j] = temp;
+ }
+}
+
+/**
+ * Bitblits an image plane (overwrites one bitmap with another)
+ * @param dtsp Pointer to destination bitmap
+ * @param dst_pitch Stride of destination bitmap
+ * @param srcp Pointer to source bitmap
+ * @param src_pitch Stride of destination bitmap
+ * @param row_size Width of the bitmap being copied
+ * @param height Height of the source bitmap
+ *
+ * When row_size, dst_pitch, and src_pitch are equal, eedi2_bit_blit can work more quickly by copying the whole plane at once instead of individual lines.
+ */
+void eedi2_bit_blit( uint8_t * dstp, int dst_pitch,
+ const uint8_t * srcp, int src_pitch,
+ int row_size, int height )
+{
+ if( ( !height ) || ( !row_size ) )
+ return;
+
+ if( height == 1 || ( dst_pitch == src_pitch && src_pitch == row_size ) )
+ {
+ memcpy( dstp, srcp, row_size * height );
+ }
+ else
+ {
+ int y;
+ for( y = height; y > 0; --y )
+ {
+ memcpy( dstp, srcp, row_size );
+ dstp += dst_pitch;
+ srcp += src_pitch;
+ }
+ }
+}
+
+/**
+ * A specialized variant of bit_blit, just for setting up the initial, field-sized bitmap planes that EEDI2 interpolates from.
+ * @param src Pointer to source bitmap plane being copied from
+ * @param dst Pointer to the destination bitmap plane being copied to
+ * @param pitch Stride of both bitmaps
+ * @param height Height of the original, full-size src plane being copied from
+ */
+void eedi2_fill_half_height_buffer_plane( uint8_t * src, uint8_t * dst, int pitch, int height )
+{
+ /* When TFF, we want to copy alternating
+ lines starting at 0, the top field.
+ When BFF, we want to start at line 1. */
+ int y;
+ for( y = height; y > 0; y = y - 2 )
+ {
+ memcpy( dst, src, pitch );
+ dst += pitch;
+ src += pitch * 2;
+ }
+}
+
+/**
+ * A specialized variant of bit_blit, just for resizing the field-height maps EEDI2 generates to frame-height...a simple line doubler
+ * @param srcp Pointer to source bitmap plane being copied from
+ * @param dstp Pointer to the destination bitmap plane being copied to
+ * @param height Height of the input, half-size src plane being copied from
+ * @param pitch Stride of both bitmaps
+ */
+void eedi2_upscale_by_2( uint8_t * srcp, uint8_t * dstp, int height, int pitch )
+{
+ int y;
+ for( y = height; y > 0; y-- )
+ {
+ memcpy( dstp, srcp, pitch );
+ dstp += pitch;
+ memcpy( dstp, srcp, pitch );
+ srcp += pitch;
+ dstp += pitch;
+ }
+}
+
+/**
+ * Finds places where verticaly adjacent pixels abruptly change in intensity, i.e., sharp edges.
+ * @param dstp Pointer to the destination bitmap
+ * @param dst_pitch Stride of dstp
+ * @param srcp Pointer to the source bitmap
+ * @param src_pitch Stride of srcp
+ * @param mtresh Magnitude threshold, ensures it doesn't mark edges on pixels that are too similar (10 is a good default value)
+ * @param vthresh Variance threshold, ensures it doesn't look for edges in highly random pixel blocks (20 is a good default value)
+ * @param lthresh Laplacian threshold, ensures edges are still prominent in the 2nd spatial derivative of the srcp plane (20 is a good default value)
+ * @param height Height of half-height single-field frame
+ * @param width Width of srcp bitmap rows, as opposed to the padded stride in src_pitch
+ */
+void eedi2_build_edge_mask( uint8_t * dstp, int dst_pitch, uint8_t *srcp, int src_pitch,
+ int mthresh, int lthresh, int vthresh, int height, int width )
+{
+ int x, y;
+
+ mthresh = mthresh * 10;
+ vthresh = vthresh * 81;
+
+ memset( dstp, 0, ( height / 2 ) * dst_pitch );
+
+ srcp += src_pitch;
+ dstp += dst_pitch;
+ unsigned char *srcpp = srcp-src_pitch;
+ unsigned char *srcpn = srcp+src_pitch;
+ for( y = 1; y < height - 1; ++y )
+ {
+ for( x = 1; x < width-1; ++x )
+ {
+ if( ( abs( srcpp[x] - srcp[x] ) < 10 &&
+ abs( srcp[x] - srcpn[x] ) < 10 &&
+ abs( srcpp[x] - srcpn[x] ) < 10 )
+ ||
+ ( abs( srcpp[x-1] - srcp[x-1] ) < 10 &&
+ abs( srcp[x-1] - srcpn[x-1] ) < 10 &&
+ abs( srcpp[x-1] - srcpn[x-1] ) < 10 &&
+ abs( srcpp[x+1] - srcp[x+1] ) < 10 &&
+ abs( srcp[x+1] - srcpn[x+1] ) < 10 &&
+ abs( srcpp[x+1] - srcpn[x+1] ) < 10) )
+ continue;
+
+ const int sum = srcpp[x-1] + srcpp[x] + srcpp[x+1] +
+ srcp[x-1] + srcp[x]+ srcp[x+1] +
+ srcpn[x-1] + srcpn[x] + srcpn[x+1];
+
+ const int sumsq = srcpp[x-1] * srcpp[x-1] +
+ srcpp[x] * srcpp[x] +
+ srcpp[x+1] * srcpp[x+1] +
+ srcp[x-1] * srcp[x-1] +
+ srcp[x] * srcp[x] +
+ srcp[x+1] * srcp[x+1] +
+ srcpn[x-1] * srcpn[x-1] +
+ srcpn[x] * srcpn[x] +
+ srcpn[x+1] * srcpn[x+1];
+
+ if( 9 * sumsq-sum * sum < vthresh )
+ continue;
+
+ const int Ix = srcp[x+1] - srcp[x-1];
+ const int Iy = MAX( MAX( abs( srcpp[x] - srcpn[x] ),
+ abs( srcpp[x] - srcp[x] ) ),
+ abs( srcp[x] - srcpn[x] ) );
+ if( Ix * Ix + Iy * Iy >= mthresh )
+ {
+ dstp[x] = 255;
+ continue;
+ }
+
+ const int Ixx = srcp[x-1] - 2 * srcp[x] + srcp[x+1];
+ const int Iyy = srcpp[x] - 2 * srcp[x] + srcpn[x];
+ if( abs( Ixx ) + abs( Iyy ) >= lthresh )
+ dstp[x] = 255;
+ }
+ dstp += dst_pitch;
+ srcpp += src_pitch;
+ srcp += src_pitch;
+ srcpn += src_pitch;
+ }
+}
+
+/**
+ * Expands and smooths out the edge mask
+ * @param mskp Pointer to the source edge mask being read from
+ * @param msk_pitch Stride of mskp
+ * @param dstp Pointer to the destination to store the dilated edge mask
+ * @param dst_pitch Stride of dstp
+ * @param dstr Dilation threshold, ensures a pixel is only retained as an edge in dstp if this number of adjacent pixels or greater are also edges in mskp (4 is a good default value)
+ * @param height Height of half-height field-sized frame
+ * @param width Width of mskp bitmap rows, as opposed to the pdded stride in msk_pitch
+ */
+void eedi2_dilate_edge_mask( uint8_t *mskp, int msk_pitch, uint8_t *dstp, int dst_pitch,
+ int dstr, int height, int width )
+{
+ int x, y;
+
+ eedi2_bit_blit( dstp, dst_pitch, mskp, msk_pitch, width, height );
+
+ mskp += msk_pitch;
+ unsigned char *mskpp = mskp - msk_pitch;
+ unsigned char *mskpn = mskp + msk_pitch;
+ dstp += dst_pitch;
+ for( y = 1; y < height - 1; ++y )
+ {
+ for( x = 1; x < width - 1; ++x )
+ {
+ if( mskp[x] != 0 )
+ continue;
+
+ int count = 0;
+ if( mskpp[x-1] == 0xFF ) ++count;
+ if( mskpp[x] == 0xFF ) ++count;
+ if( mskpp[x+1] == 0xFF ) ++count;
+ if( mskp[x-1] == 0xFF ) ++count;
+ if( mskp[x+1] == 0xFF ) ++count;
+ if( mskpn[x-1] == 0xFF ) ++count;
+ if( mskpn[x] == 0xFF ) ++count;
+ if( mskpn[x+1] == 0xFF ) ++count;
+
+ if( count >= dstr )
+ dstp[x] = 0xFF;
+ }
+ mskpp += msk_pitch;
+ mskp += msk_pitch;
+ mskpn += msk_pitch;
+ dstp += dst_pitch;
+ }
+}
+
+/**
+ * Contracts the edge mask
+ * @param mskp Pointer to the source edge mask being read from
+ * @param msk_pitch Stride of mskp
+ * @param dstp Pointer to the destination to store the eroded edge mask
+ * @param dst_pitch Stride of dstp
+ * @param estr Erosion threshold, ensures a pixel isn't retained as an edge in dstp if fewer than this number of adjacent pixels are also edges in mskp (2 is a good default value)
+ * @param height Height of half-height field-sized frame
+ * @param width Width of mskp bitmap rows, as opposed to the pdded stride in msk_pitch
+ */
+void eedi2_erode_edge_mask( uint8_t *mskp, int msk_pitch, uint8_t *dstp, int dst_pitch,
+ int estr, int height, int width )
+{
+ int x, y;
+
+ eedi2_bit_blit( dstp, dst_pitch, mskp, msk_pitch, width, height );
+
+ mskp += msk_pitch;
+ unsigned char *mskpp = mskp - msk_pitch;
+ unsigned char *mskpn = mskp + msk_pitch;
+ dstp += dst_pitch;
+ for ( y = 1; y < height - 1; ++y )
+ {
+ for ( x = 1; x < width - 1; ++x )
+ {
+ if( mskp[x] != 0xFF ) continue;
+
+ int count = 0;
+ if ( mskpp[x-1] == 0xFF ) ++count;
+ if ( mskpp[x] == 0xFF ) ++count;
+ if ( mskpp[x+1] == 0xFF ) ++count;
+ if ( mskp[x-1] == 0xFF ) ++count;
+ if ( mskp[x+1] == 0xFF ) ++count;
+ if ( mskpn[x-1] == 0xFF ) ++count;
+ if ( mskpn[x] == 0xFF ) ++count;
+ if ( mskpn[x+1] == 0xFF ) ++count;
+
+ if ( count < estr) dstp[x] = 0;
+ }
+ mskpp += msk_pitch;
+ mskp += msk_pitch;
+ mskpn += msk_pitch;
+ dstp += dst_pitch;
+ }
+}
+
+/**
+ * Smooths out horizontally aligned holes in the mask
+ *
+ * If none of the 6 horizontally adjacent pixels are edges, mark the current pixel as not edged.
+ * If at least 1 of the 3 on either side are edges, mark the current pixel as an edge.
+ *
+ * @param mskp Pointer to the source edge mask being read from
+ * @param msk_pitch Stride of mskp
+ * @param dstp Pointer to the destination to store the smoothed edge mask
+ * @param dst_pitch Stride of dstp
+ * @param height Height of half-height field-sized frame
+ * @param width Width of mskp bitmap rows, as opposed to the pdded stride in msk_pitch
+ */
+void eedi2_remove_small_gaps( uint8_t * mskp, int msk_pitch, uint8_t * dstp, int dst_pitch,
+ int height, int width )
+{
+ int x, y;
+
+ eedi2_bit_blit( dstp, dst_pitch, mskp, msk_pitch, width, height );
+
+ mskp += msk_pitch;
+ dstp += dst_pitch;
+ for( y = 1; y < height - 1; ++y )
+ {
+ for( x = 3; x < width - 3; ++x )
+ {
+ if( mskp[x] )
+ {
+ if( mskp[x-3] ) continue;
+ if( mskp[x-2] ) continue;
+ if( mskp[x-1] ) continue;
+ if( mskp[x+1] ) continue;
+ if( mskp[x+2] ) continue;
+ if( mskp[x+3] ) continue;
+ dstp[x] = 0;
+ }
+ else
+ {
+ if ( ( mskp[x+1] && ( mskp[x-1] || mskp[x-2] || mskp[x-3] ) ) ||
+ ( mskp[x+2] && ( mskp[x-1] || mskp[x-2] ) ) ||
+ ( mskp[x+3] && mskp[x-1] ) )
+ dstp[x] = 0xFF;
+ }
+ }
+ mskp += msk_pitch;
+ dstp += dst_pitch;
+ }
+}
+
+/**
+ * Calculates spatial direction vectors for the edges. This is EEDI2's timesink, and can be thought of as YADIF_CHECK on steroids, as both try to discern which angle a given edge follows
+ * @param plane The plane of the image being processed, to know to reduce maxd for chroma planes (HandBrake only works with YUV420 video so it is assumed they are half-height)
+ * @param mskp Pointer to the source edge mask being read from
+ * @param msk_pitch Stride of mskp
+ * @param srcp Pointer to the source image being filtered
+ * @param src_pitch Stride of srcp
+ * @param dstp Pointer to the destination to store the dilated edge mask
+ * @param dst_pitch Stride of dstp
+ * @param maxd Maximum pixel distance to search (24 is a good default value)
+ * @param nt Noise threshold (50 is a good default value)
+ * @param height Height of half-height field-sized frame
+ * @param width Width of srcp bitmap rows, as opposed to the pdded stride in src_pitch
+ */
+void eedi2_calc_directions( const int plane, uint8_t * mskp, int msk_pitch, uint8_t * srcp, int src_pitch,
+ uint8_t * dstp, int dst_pitch, int maxd, int nt, int height, int width )
+{
+ int x, y, u, i;
+
+ memset( dstp, 255, dst_pitch * height );
+ mskp += msk_pitch;
+ dstp += dst_pitch;
+ srcp += src_pitch;
+ unsigned char *src2p = srcp - src_pitch * 2;
+ unsigned char *srcpp = srcp - src_pitch;
+ unsigned char *srcpn = srcp + src_pitch;
+ unsigned char *src2n = srcp + src_pitch * 2;
+ unsigned char *mskpp = mskp - msk_pitch;
+ unsigned char *mskpn = mskp + msk_pitch;
+ const int maxdt = plane == 0 ? maxd : ( maxd >> 1 );
+
+ for( y = 1; y < height - 1; ++y )
+ {
+ for( x = 1; x < width - 1; ++x )
+ {
+ if( mskp[x] != 0xFF || ( mskp[x-1] != 0xFF && mskp[x+1] != 0xFF ) )
+ continue;
+ const int startu = MAX( -x + 1, -maxdt );
+ const int stopu = MIN( width - 2 - x, maxdt );
+ int minb = MIN( 13 * nt,
+ ( abs( srcp[x] - srcpn[x] ) +
+ abs( srcp[x] - srcpp[x] ) ) * 6 );
+ int mina = MIN( 19 * nt,
+ ( abs( srcp[x] - srcpn[x] ) +
+ abs( srcp[x] - srcpp[x] ) ) * 9 );
+ int minc = mina;
+ int mind = minb;
+ int mine = minb;
+ int dira = -5000, dirb = -5000, dirc = -5000, dird = -5000, dire = -5000;
+ for( u = startu; u <= stopu; ++u )
+ {
+ if( y == 1 ||
+ mskpp[x-1+u] == 0xFF || mskpp[x+u] == 0xFF || mskpp[x+1+u] == 0xFF )
+ {
+ if( y == height - 2 ||
+ mskpn[x-1-u] == 0xFF || mskpn[x-u] == 0xFF || mskpn[x+1-u] == 0xFF )
+ {
+ const int diffsn = abs( srcp[x-1] - srcpn[x-1-u] ) +
+ abs( srcp[x] - srcpn[x-u] ) +
+ abs( srcp[x+1] - srcpn[x+1-u] );
+
+ const int diffsp = abs( srcp[x-1] - srcpp[x-1+u] ) +
+ abs( srcp[x] - srcpp[x+u] ) +
+ abs( srcp[x+1] - srcpp[x+1+u] );
+
+ const int diffps = abs( srcpp[x-1] - srcp[x-1-u] ) +
+ abs( srcpp[x] - srcp[x-u] ) +
+ abs( srcpp[x+1] - srcp[x+1-u] );
+
+ const int diffns = abs( srcpn[x-1] - srcp[x-1+u] ) +
+ abs( srcpn[x] - srcp[x+u] ) +
+ abs( srcpn[x+1] - srcp[x+1+u] );
+
+ const int diff = diffsn + diffsp + diffps + diffns;
+ int diffd = diffsp + diffns;
+ int diffe = diffsn + diffps;
+ if( diff < minb )
+ {
+ dirb = u;
+ minb = diff;
+ }
+ if( __builtin_expect( y > 1, 1) )
+ {
+ const int diff2pp = abs( src2p[x-1] - srcpp[x-1-u] ) +
+ abs( src2p[x] - srcpp[x-u] ) +
+ abs( src2p[x+1] - srcpp[x+1-u] );
+ const int diffp2p = abs( srcpp[x-1] - src2p[x-1+u] ) +
+ abs( srcpp[x] - src2p[x+u] ) +
+ abs( srcpp[x+1] - src2p[x+1+u] );
+ const int diffa = diff + diff2pp + diffp2p;
+ diffd += diffp2p;
+ diffe += diff2pp;
+ if( diffa < mina )
+ {
+ dira = u;
+ mina = diffa;
+ }
+ }
+ if( __builtin_expect( y < height-2, 1) )
+ {
+ const int diff2nn = abs( src2n[x-1] - srcpn[x-1+u] ) +
+ abs( src2n[x] - srcpn[x+u] ) +
+ abs( src2n[x+1] - srcpn[x+1+u] );
+ const int diffn2n = abs( srcpn[x-1] - src2n[x-1-u] ) +
+ abs( srcpn[x] - src2n[x-u] ) +
+ abs( srcpn[x+1] - src2n[x+1-u] );
+ const int diffc = diff + diff2nn + diffn2n;
+ diffd += diff2nn;
+ diffe += diffn2n;
+ if( diffc < minc )
+ {
+ dirc = u;
+ minc = diffc;
+ }
+ }
+ if( diffd < mind )
+ {
+ dird = u;
+ mind = diffd;
+ }
+ if( diffe < mine )
+ {
+ dire = u;
+ mine = diffe;
+ }
+ }
+ }
+ }
+ int order[5], k=0;
+ if( dira != -5000 ) order[k++] = dira;
+ if( dirb != -5000 ) order[k++] = dirb;
+ if( dirc != -5000 ) order[k++] = dirc;
+ if( dird != -5000 ) order[k++] = dird;
+ if( dire != -5000 ) order[k++] = dire;
+ if( k > 1 )
+ {
+ eedi2_sort_metrics( order, k );
+ const int mid = ( k & 1 ) ?
+ order[k>>1] :
+ ( order[(k-1)>>1] + order[k>>1] + 1 ) >> 1;
+ const int tlim = MAX( eedi2_limlut[abs(mid)] >> 2, 2 );
+ int sum = 0, count = 0;
+ for( i = 0; i < k; ++i )
+ {
+ if( abs( order[i] - mid ) <= tlim )
+ {
+ ++count;
+ sum += order[i];
+ }
+ }
+ if( count > 1 )
+ dstp[x] = 128 + ( (int)( (float)sum / (float)count ) * 4 );
+ else
+ dstp[x] = 128;
+ }
+ else dstp[x] = 128;
+ }
+ mskpp += msk_pitch;
+ mskp += msk_pitch;
+ mskpn += msk_pitch;
+ src2p += src_pitch;
+ srcpp += src_pitch;
+ srcp += src_pitch;
+ srcpn += src_pitch;
+ src2n += src_pitch;
+ dstp += dst_pitch;
+ }
+}
+
+/**
+ * Filters the edge mask
+ * @param mskp Pointer to the source edge mask being read from
+ * @param msk_pitch Stride of mskp
+ * @param dmskp Pointer to the edge direction mask
+ * @param dmsk_pitch Stride of dmskp
+ * @param dstp Pointer to the destination to store the filtered edge mask
+ * @param dst_pitch Stride of dstp
+ * @param height Height of half-height field-sized frame
+ * @param width Width of mskp bitmap rows, as opposed to the pdded stride in msk_pitch
+ */
+void eedi2_filter_map( uint8_t * mskp, int msk_pitch, uint8_t * dmskp, int dmsk_pitch,
+ uint8_t * dstp, int dst_pitch, int height, int width )
+{
+ int x, y, j;
+
+ eedi2_bit_blit( dstp, dst_pitch, dmskp, dmsk_pitch, width, height );
+
+ mskp += msk_pitch;
+ dmskp += dmsk_pitch;
+ dstp += dst_pitch;
+ unsigned char *dmskpp = dmskp - dmsk_pitch;
+ unsigned char *dmskpn = dmskp + dmsk_pitch;
+
+ for( y = 1; y < height - 1; ++y )
+ {
+ for( x = 1; x < width - 1; ++x )
+ {
+ if( dmskp[x] == 0xFF || mskp[x] != 0xFF )
+ continue;
+ const int dir = ( dmskp[x] - 128 ) >> 2;
+ const int lim = MAX( abs( dir ) * 2, 12 );
+ int ict = 0, icb = 0;
+ if( dir < 0 )
+ {
+ const int dirt = MAX( -x, dir );
+ for( j = dirt; j <= 0; ++j )
+ {
+ if( ( abs( dmskpp[x+j] - dmskp[x] ) > lim && dmskpp[x+j] != 0xFF ) ||
+ ( dmskp[x+j] == 0xFF && dmskpp[x+j] == 0xFF ) ||
+ ( abs( dmskp[x+j] - dmskp[x] ) > lim && dmskp[x+j] != 0xFF ) )
+ {
+ ict = 1;
+ break;
+ }
+ }
+ }
+ else
+ {
+ const int dirt = MIN( width - x - 1, dir );
+ for( j = 0; j <= dirt; ++j )
+ {
+ if( ( abs( dmskpp[x+j] - dmskp[x] ) > lim && dmskpp[x+j] != 0xFF ) ||
+ ( dmskp[x+j] == 0xFF && dmskpp[x+j] == 0xFF ) ||
+ ( abs( dmskp[x+j] - dmskp[x] ) > lim && dmskp[x+j] != 0xFF ) )
+ {
+ ict = 1;
+ break;
+ }
+ }
+ }
+ if( ict )
+ {
+ if( dir < 0 )
+ {
+ const int dirt = MIN( width - x - 1, abs( dir ) );
+ for( j = 0; j <= dirt; ++j )
+ {
+ if( ( abs( dmskpn[x+j] - dmskp[x] ) > lim && dmskpn[x+j] != 0xFF ) ||
+ ( dmskpn[x+j] == 0xFF && dmskp[x+j] == 0xFF ) ||
+ ( abs( dmskp[x+j] - dmskp[x] ) > lim && dmskp[x+j] != 0xFF ) )
+ {
+ icb = 1;
+ break;
+ }
+ }
+ }
+ else
+ {
+ const int dirt = MAX( -x, -dir );
+ for( j = dirt; j <= 0; ++j )
+ {
+ if( ( abs( dmskpn[x+j] - dmskp[x] ) > lim && dmskpn[x+j] != 0xFF ) ||
+ ( dmskpn[x+j] == 0xFF && dmskp[x+j] == 0xFF ) ||
+ ( abs( dmskp[x+j] - dmskp[x] ) > lim && dmskp[x+j] != 0xFF ) )
+ {
+ icb = 1;
+ break;
+ }
+ }
+ }
+ if( icb )
+ dstp[x] = 255;
+ }
+ }
+ mskp += msk_pitch;
+ dmskpp += dmsk_pitch;
+ dmskp += dmsk_pitch;
+ dmskpn += dmsk_pitch;
+ dstp += dst_pitch;
+ }
+}
+
+
+/**
+ * Filters the edge direction mask
+ * @param mskp Pointer to the edge mask
+ * @param msk_pitch Stride of mskp
+ * @param dmskp Pointer to the edge direction mask being read from
+ * @param dmsk_pitch Stride of dmskp
+ * @param dstp Pointer to the destination to store the filtered edge direction mask
+ * @param dst_pitch Stride of dstp
+ * @param height Height of half_height field-sized frame
+ * @param width Width of dmskp bitmap rows, as opposed to the pdded stride in dmsk_pitch
+ */
+void eedi2_filter_dir_map( uint8_t * mskp, int msk_pitch, uint8_t * dmskp, int dmsk_pitch,
+ uint8_t * dstp, int dst_pitch, int height, int width )
+{
+ int x, y, i;
+
+ eedi2_bit_blit( dstp, dst_pitch, dmskp, dmsk_pitch, width, height );
+
+ dmskp += dmsk_pitch;
+ unsigned char *dmskpp = dmskp - dmsk_pitch;
+ unsigned char *dmskpn = dmskp + dmsk_pitch;
+ dstp += dst_pitch;
+ mskp += msk_pitch;
+ for( y = 1; y < height - 1; ++y )
+ {
+ for( x = 1; x < width - 1; ++x )
+ {
+ if( mskp[x] != 0xFF ) continue;
+ int u = 0, order[9];
+ if( dmskpp[x-1] != 0xFF ) order[u++] = dmskpp[x-1];
+ if( dmskpp[x] != 0xFF ) order[u++] = dmskpp[x];
+ if( dmskpp[x+1] != 0xFF ) order[u++] = dmskpp[x+1];
+ if( dmskp[x-1] != 0xFF ) order[u++] = dmskp[x-1];
+ if( dmskp[x] != 0xFF ) order[u++] = dmskp[x];
+ if( dmskp[x+1] != 0xFF ) order[u++] = dmskp[x+1];
+ if( dmskpn[x-1] != 0xFF ) order[u++] = dmskpn[x-1];
+ if( dmskpn[x] != 0xFF ) order[u++] = dmskpn[x];
+ if( dmskpn[x+1] != 0xFF ) order[u++] = dmskpn[x+1];
+ if( u < 4 )
+ {
+ dstp[x] = 255;
+ continue;
+ }
+ eedi2_sort_metrics( order, u );
+ const int mid = ( u & 1 ) ?
+ order[u>>1] : ( order[(u-1)>>1] + order[u>>1] + 1 ) >> 1;
+ int sum = 0, count = 0;
+ const int lim = eedi2_limlut[abs(mid-128)>>2];
+ for( i = 0; i < u; ++i )
+ {
+ if( abs( order[i] - mid ) <= lim )
+ {
+ ++count;
+ sum += order[i];
+ }
+ }
+ if( count < 4 || ( count < 5 && dmskp[x] == 0xFF ) )
+ {
+ dstp[x] = 255;
+ continue;
+ }
+ dstp[x] = (int)( ( (float)( sum + mid ) / (float)( count + 1 ) ) + 0.5f );
+ }
+ dmskpp += dmsk_pitch;
+ dmskp += dmsk_pitch;
+ dmskpn += dmsk_pitch;
+ dstp += dst_pitch;
+ mskp += msk_pitch;
+ }
+}
+
+/**
+ * Smoothes out the edge direction map
+ * @param mskp Pointer to the edge mask
+ * @param msk_pitch Stride of mskp
+ * @param dmskp Pointer to the edge direction mask being read from
+ * @param dmsk_pitch Stride of dmskp
+ * @param dstp Pointer to the destination to store the expanded edge direction mask
+ * @param dst_pitch Stride of dstp
+ * @param height Height of half-height field-sized frame
+ * @param width Width of dmskp bitmap rows, as opposed to the pdded stride in dmsk_pitch
+ */
+void eedi2_expand_dir_map( uint8_t * mskp, int msk_pitch, uint8_t * dmskp, int dmsk_pitch,
+ uint8_t * dstp, int dst_pitch, int height, int width )
+{
+ int x, y, i;
+
+ eedi2_bit_blit( dstp, dst_pitch, dmskp, dmsk_pitch, width, height );
+
+ dmskp += dmsk_pitch;
+ unsigned char *dmskpp = dmskp - dmsk_pitch;
+ unsigned char *dmskpn = dmskp + dmsk_pitch;
+ dstp += dst_pitch;
+ mskp += msk_pitch;
+ for( y = 1; y < height - 1; ++y )
+ {
+ for( x = 1; x < width - 1; ++x )
+ {
+ if( dmskp[x] != 0xFF || mskp[x] != 0xFF ) continue;
+ int u = 0, order[9];
+ if( dmskpp[x-1] != 0xFF ) order[u++] = dmskpp[x-1];
+ if( dmskpp[x] != 0xFF ) order[u++] = dmskpp[x];
+ if( dmskpp[x+1] != 0xFF ) order[u++] = dmskpp[x+1];
+ if( dmskp[x-1] != 0xFF ) order[u++] = dmskp[x-1];
+ if( dmskp[x+1] != 0xFF ) order[u++] = dmskp[x+1];
+ if( dmskpn[x-1] != 0xFF ) order[u++] = dmskpn[x-1];
+ if( dmskpn[x] != 0xFF ) order[u++] = dmskpn[x];
+ if( dmskpn[x+1] != 0xFF ) order[u++] = dmskpn[x+1];
+ if( u < 5 ) continue;
+ eedi2_sort_metrics( order, u );
+ const int mid = ( u & 1 ) ?
+ order[u>>1] : ( order[(u-1)>>1] + order[u>>1] + 1 ) >> 1;
+ int sum = 0, count = 0;
+ const int lim = eedi2_limlut[abs(mid-128)>>2];
+ for( i = 0; i < u; ++i )
+ {
+ if( abs( order[i] - mid ) <= lim )
+ {
+ ++count;
+ sum += order[i];
+ }
+ }
+ if( count < 5 ) continue;
+ dstp[x] = (int)( ( (float)( sum + mid ) / (float)( count + 1 ) ) + 0.5f );
+ }
+ dmskpp += dmsk_pitch;
+ dmskp += dmsk_pitch;
+ dmskpn += dmsk_pitch;
+ dstp += dst_pitch;
+ mskp += msk_pitch;
+ }
+}
+
+/**
+ * Re-draws a clearer, less blocky frame-height edge direction mask
+ * @param mskp Pointer to the edge mask
+ * @param msk_pitch Stride of mskp
+ * @param dmskp Pointer to the edge direction mask being read from
+ * @param dmsk_pitch Stride of dmskp
+ * @param dstp Pointer to the destination to store the redrawn direction mask
+ * @param dst_pitch Stride of dstp
+ * @param tff Whether or not the frame parity is Top Field First
+ * @param height Height of the full-frame output
+ * @param width Width of dmskp bitmap rows, as opposed to the pdded stride in dmsk_pitch
+ */
+void eedi2_mark_directions_2x( uint8_t * mskp, int msk_pitch, uint8_t * dmskp, int dmsk_pitch,
+ uint8_t * dstp, int dst_pitch, int tff, int height, int width )
+{
+ int x, y, i;
+ memset( dstp, 255, dst_pitch * height );
+ dstp += dst_pitch * ( 2 - tff );
+ dmskp += dmsk_pitch * ( 1 - tff );
+ mskp += msk_pitch * ( 1 - tff );
+ unsigned char *dmskpn = dmskp + dmsk_pitch * 2;
+ unsigned char *mskpn = mskp + msk_pitch * 2;
+ for( y = 2 - tff; y < height - 1; y += 2 )
+ {
+ for( x = 1; x < width - 1; ++x )
+ {
+ if( mskp[x] != 0xFF && mskpn[x] != 0xFF ) continue;
+ int v = 0, order[6];
+ if( dmskp[x-1] != 0xFF ) order[v++] = dmskp[x-1];
+ if( dmskp[x] != 0xFF ) order[v++] = dmskp[x];
+ if( dmskp[x+1] != 0xFF ) order[v++] = dmskp[x+1];
+ if( dmskpn[x-1] != 0xFF ) order[v++] = dmskpn[x-1];
+ if( dmskpn[x] != 0xFF ) order[v++] = dmskpn[x];
+ if( dmskpn[x+1] != 0xFF ) order[v++] = dmskpn[x+1];
+ if( v < 3 ) continue;
+ else
+ {
+ eedi2_sort_metrics( order, v );
+ const int mid = ( v & 1 ) ? order[v>>1] : ( order[(v-1)>>1] + order[v>>1]+1) >> 1;
+ const int lim = eedi2_limlut[abs(mid-128)>>2];
+ int u = 0;
+ if( abs( dmskp[x-1] - dmskpn[x-1] ) <= lim ||
+ dmskp[x-1] == 0xFF || dmskpn[x-1] == 0xFF )
+ ++u;
+ if( abs( dmskp[x] - dmskpn[x] ) <= lim ||
+ dmskp[x] == 0xFF || dmskpn[x] == 0xFF )
+ ++u;
+ if( abs( dmskp[x+1] - dmskpn[x-1] ) <= lim ||
+ dmskp[x+1] == 0xFF || dmskpn[x+1] == 0xFF)
+ ++u;
+ if( u < 2 ) continue;
+ int count = 0, sum = 0;
+ for( i = 0; i < v; ++i )
+ {
+ if( abs( order[i] - mid ) <= lim )
+ {
+ ++count;
+ sum += order[i];
+ }
+ }
+ if( count < v - 2 || count < 2 ) continue;
+ dstp[x] = (int)( ( (float)( sum + mid ) / (float)( count + 1 ) ) + 0.5f );
+ }
+ }
+ mskp += msk_pitch * 2;
+ mskpn += msk_pitch * 2;
+ dstp += dst_pitch * 2;
+ dmskp += dmsk_pitch * 2;
+ dmskpn += dmsk_pitch * 2;
+ }
+}
+
+/**
+ * Filters the frane-height edge direction mask
+ * @param mskp Pointer to the edge mask
+ * @param msk_pitch Stride of mskp
+ * @param dmskp Pointer to the edge direction mask being read from
+ * @param dmsk_pitch Stride of dmskp
+ * @param dstp Pointer to the destination to store the filtered direction mask
+ * @param dst_pitch Stride of dstp
+ * @param field Field to filter
+ * @param height Height of the full-frame output
+ * @param width Width of dmskp bitmap rows, as opposed to the pdded stride in dmsk_pitch
+ */
+void eedi2_filter_dir_map_2x( uint8_t * mskp, int msk_pitch, uint8_t * dmskp, int dmsk_pitch,
+ uint8_t * dstp, int dst_pitch, int field, int height, int width )
+{
+ int x, y, i;
+ eedi2_bit_blit( dstp, dst_pitch, dmskp, dmsk_pitch, width, height );
+ dmskp += dmsk_pitch * ( 2 - field );
+ unsigned char *dmskpp = dmskp - dmsk_pitch * 2;
+ unsigned char *dmskpn = dmskp + dmsk_pitch * 2;
+ mskp += msk_pitch * ( 1 - field );
+ unsigned char *mskpn = mskp + msk_pitch * 2;
+ dstp += dst_pitch * ( 2 - field );
+ for( y = 2 - field; y < height - 1; y += 2 )
+ {
+ for( x = 1; x < width - 1; ++x )
+ {
+ if( mskp[x] != 0xFF && mskpn[x] != 0xFF ) continue;
+ int u = 0, order[9];
+ if( y > 1 )
+ {
+ if( dmskpp[x-1] != 0xFF ) order[u++] = dmskpp[x-1];
+ if( dmskpp[x] != 0xFF ) order[u++] = dmskpp[x];
+ if( dmskpp[x+1] != 0xFF ) order[u++] = dmskpp[x+1];
+ }
+ if( dmskp[x-1] != 0xFF ) order[u++] = dmskp[x-1];
+ if( dmskp[x] != 0xFF ) order[u++] = dmskp[x];
+ if( dmskp[x+1] != 0xFF ) order[u++] = dmskp[x+1];
+ if( y < height - 2 )
+ {
+ if( dmskpn[x-1] != 0xFF ) order[u++] = dmskpn[x-1];
+ if( dmskpn[x] != 0xFF ) order[u++] = dmskpn[x];
+ if( dmskpn[x+1] != 0xFF ) order[u++] = dmskpn[x+1];
+ }
+ if( u < 4 )
+ {
+ dstp[x] = 255;
+ continue;
+ }
+ eedi2_sort_metrics( order, u );
+ const int mid = ( u & 1 ) ? order[u>>1] : (order[(u-1)>>1] + order[u>>1] + 1 ) >> 1;
+ int sum = 0, count = 0;
+ const int lim = eedi2_limlut[abs(mid-128)>>2];
+ for( i = 0; i < u; ++i )
+ {
+ if( abs( order[i] - mid ) <= lim )
+ {
+ ++count;
+ sum += order[i];
+ }
+ }
+ if( count < 4 || ( count < 5 && dmskp[x] == 0xFF ) )
+ {
+ dstp[x] = 255;
+ continue;
+ }
+ dstp[x] = (int)( ( (float)( sum + mid ) / (float)( count + 1 ) ) + 0.5f );
+ }
+ mskp += msk_pitch * 2;
+ mskpn += msk_pitch * 2;
+ dmskpp += dmsk_pitch * 2;
+ dmskp += dmsk_pitch * 2;
+ dmskpn += dmsk_pitch * 2;
+ dstp += dst_pitch * 2;
+ }
+}
+
+/**
+ * Smoothes out the frame-height edge direction mask
+ * @param mskp Pointer to the edge mask
+ * @param msk_pitch Stride of mskp
+ * @param dmskp Pointer to the edge direction mask being read from
+ * @param dmsk_pitch Stride of dmskp
+ * @param dstp Pointer to the destination to store the expanded direction mask
+ * @param dst_pitch Stride of dstp
+ * @param field Field to filter
+ * @param height Height of the full-frame output
+ * @param width Width of dmskp bitmap rows, as opposed to the pdded stride in dmsk_pitch
+ */
+void eedi2_expand_dir_map_2x( uint8_t * mskp, int msk_pitch, uint8_t * dmskp, int dmsk_pitch,
+ uint8_t * dstp, int dst_pitch, int field, int height, int width )
+{
+ int x, y, i;
+
+ eedi2_bit_blit( dstp, dst_pitch, dmskp, dmsk_pitch, width, height );
+
+ dmskp += dmsk_pitch * ( 2 - field );
+ unsigned char *dmskpp = dmskp - dmsk_pitch * 2;
+ unsigned char *dmskpn = dmskp + dmsk_pitch * 2;
+ mskp += msk_pitch * ( 1 - field );
+ unsigned char *mskpn = mskp + msk_pitch * 2;
+ dstp += dst_pitch * ( 2 - field );
+ for( y = 2 - field; y < height - 1; y += 2)
+ {
+ for( x = 1; x < width - 1; ++x )
+ {
+ if( dmskp[x] != 0xFF || ( mskp[x] != 0xFF && mskpn[x] != 0xFF ) ) continue;
+ int u = 0, order[9];
+ if( y > 1 )
+ {
+ if( dmskpp[x-1] != 0xFF ) order[u++] = dmskpp[x-1];
+ if( dmskpp[x] != 0xFF ) order[u++] = dmskpp[x];
+ if( dmskpp[x+1] != 0xFF ) order[u++] = dmskpp[x+1];
+ }
+ if( dmskp[x-1] != 0xFF ) order[u++] = dmskp[x-1];
+ if( dmskp[x+1] != 0xFF ) order[u++] = dmskp[x+1];
+ if( y < height - 2 )
+ {
+ if( dmskpn[x-1] != 0xFF) order[u++] = dmskpn[x-1];
+ if( dmskpn[x] != 0xFF) order[u++] = dmskpn[x];
+ if( dmskpn[x+1] != 0xFF) order[u++] = dmskpn[x+1];
+ }
+ if( u < 5 ) continue;
+ eedi2_sort_metrics( order, u );
+ const int mid = ( u & 1 ) ? order[u>>1] : ( order[(u-1)>>1] + order[u>>1] + 1 ) >> 1;
+ int sum = 0, count = 0;
+ const int lim = eedi2_limlut[abs(mid-128)>>2];
+ for( i = 0; i < u; ++i )
+ {
+ if( abs( order[i] - mid ) <= lim )
+ {
+ ++count;
+ sum += order[i];
+ }
+ }
+ if( count < 5 ) continue;
+ dstp[x] = (int)( ( (float)( sum + mid ) / (float)( count + 1 ) ) + 0.5f );
+ }
+ mskp += msk_pitch * 2;
+ mskpn += msk_pitch * 2;
+ dmskpp += dmsk_pitch * 2;
+ dmskp += dmsk_pitch * 2;
+ dmskpn += dmsk_pitch * 2;
+ dstp += dst_pitch * 2;
+ }
+}
+
+/**
+ * Like the name suggests, this function fills in gaps in the frame-height edge direction mask
+ * @param mskp Pointer to the edge mask
+ * @param msk_pitch Stride of mskp
+ * @param dmskp Pointer to the edge direction mask being read from
+ * @param dmsk_pitch Stride of dmskp
+ * @param dstp Pointer to the destination to store the filled-in direction mask
+ * @param dst_pitch Stride of dstp
+ * @param field Field to filter
+ * @param height Height of the full-frame output
+ * @param width Width of dmskp bitmap rows, as opposed to the pdded stride in dmsk_pitch
+ */
+void eedi2_fill_gaps_2x( uint8_t *mskp, int msk_pitch, uint8_t * dmskp, int dmsk_pitch,
+ uint8_t * dstp, int dst_pitch, int field, int height, int width )
+{
+ int x, y, j;
+
+ eedi2_bit_blit( dstp, dst_pitch, dmskp, dmsk_pitch, width, height );
+
+ dmskp += dmsk_pitch * ( 2 - field );
+ unsigned char *dmskpp = dmskp - dmsk_pitch * 2;
+ unsigned char *dmskpn = dmskp + dmsk_pitch * 2;
+ mskp += msk_pitch * ( 1 - field );
+ unsigned char *mskpp = mskp - msk_pitch * 2;
+ unsigned char *mskpn = mskp + msk_pitch * 2;
+ unsigned char *mskpnn = mskpn + msk_pitch * 2;
+ dstp += dst_pitch * ( 2 - field );
+ for( y = 2 - field; y < height - 1; y += 2 )
+ {
+ for( x = 1; x < width - 1; ++x )
+ {
+ if( dmskp[x] != 0xFF ||
+ ( mskp[x] != 0xFF && mskpn[x] != 0xFF ) ) continue;
+ int u = x - 1, back = 500, forward = -500;
+ while( u )
+ {
+ if( dmskp[u] != 0xFF )
+ {
+ back = dmskp[u];
+ break;
+ }
+ if( mskp[u] != 0xFF && mskpn[u] != 0xFF ) break;
+ --u;
+ }
+ int v = x + 1;
+ while( v < width )
+ {
+ if( dmskp[v] != 0xFF )
+ {
+ forward = dmskp[v];
+ break;
+ }
+ if( mskp[v] != 0xFF && mskpn[v] != 0xFF ) break;
+ ++v;
+ }
+ int tc = 1, bc = 1;
+ int mint = 500, maxt = -20;
+ int minb = 500, maxb = -20;
+ for( j = u; j <= v; ++j )
+ {
+ if( tc )
+ {
+ if( y <= 2 || dmskpp[j] == 0xFF || ( mskpp[j] != 0xFF && mskp[j] != 0xFF ) )
+ {
+ tc = 0;
+ mint = maxt = 20;
+ }
+ else
+ {
+ if( dmskpp[j] < mint ) mint = dmskpp[j];
+ if( dmskpp[j] > maxt ) maxt = dmskpp[j];
+ }
+ }
+ if( bc )
+ {
+ if( y >= height - 3 || dmskpn[j] == 0xFF || ( mskpn[j] != 0xFF && mskpnn[j] != 0xFF ) )
+ {
+ bc = 0;
+ minb = maxb = 20;
+ }
+ else
+ {
+ if( dmskpn[j] < minb ) minb = dmskpn[j];
+ if( dmskpn[j] > maxb ) maxb = dmskpn[j];
+ }
+ }
+ }
+ if( maxt == -20 ) maxt = mint = 20;
+ if( maxb == -20 ) maxb = minb = 20;
+ int thresh = MAX(
+ MAX( MAX( abs( forward - 128 ), abs( back - 128 ) ) >> 2, 8 ),
+ MAX( abs( mint - maxt ), abs( minb - maxb ) ) );
+ const int flim = MIN(
+ MAX( abs( forward - 128 ), abs( back - 128 ) ) >> 2,
+ 6 );
+ if( abs( forward - back ) <= thresh && ( v - u - 1 <= flim || tc || bc ) )
+ {
+ double step = (double)( forward - back ) / (double)( v - u );
+ for( j = 0; j < v - u - 1; ++j )
+ dstp[u+j+1] = back + (int)( j * step + 0.5 );
+ }
+ }
+ mskpp += msk_pitch * 2;
+ mskp += msk_pitch * 2;
+ mskpn += msk_pitch * 2;
+ mskpnn += msk_pitch * 2;
+ dmskpp += dmsk_pitch * 2;
+ dmskp += dmsk_pitch * 2;
+ dmskpn += dmsk_pitch * 2;
+ dstp += dst_pitch * 2;
+ }
+}
+
+/**
+ * Actually renders the output frame, based on the edge and edge direction masks
+ * @param plane The plane of the image being processed, to know to reduce a search distance for chroma planes (HandBrake only works with YUV420 video so it is assumed they are half-height)
+ * @param dmskp Pointer to the edge direction mask being read from
+ * @param dmsk_pitch Stride of dmskp
+ * @param dstp Pointer to the line-doubled source field used being filtered in place
+ * @param dst_pitch Stride of dstp
+ * @param omskp Pointer to the destination to store the output edge mask used for post-processing
+ * @param osmk_pitch Stride of omskp
+ * @param field Field to filter
+ * @nt Noise threshold, (50 is a good default value)
+ * @param height Height of the full-frame output
+ * @param width Width of dstp bitmap rows, as opposed to the pdded stride in dst_pitch
+ */
+void eedi2_interpolate_lattice( const int plane, uint8_t * dmskp, int dmsk_pitch, uint8_t * dstp,
+ int dst_pitch, uint8_t * omskp, int omsk_pitch, int field, int nt,
+ int height, int width )
+{
+ int x, y, u;
+
+ if( field == 1 )
+ {
+ eedi2_bit_blit( dstp + ( height - 1 ) * dst_pitch,
+ dst_pitch,
+ dstp + ( height - 2 ) * dst_pitch,
+ dst_pitch,
+ width,
+ 1 );
+ }
+ else
+ {
+ eedi2_bit_blit( dstp,
+ dst_pitch,
+ dstp + dst_pitch,
+ dst_pitch,
+ width,
+ 1 );
+ }
+
+ dstp += dst_pitch * ( 1 - field );
+ omskp += omsk_pitch * ( 1 - field );
+ unsigned char *dstpn = dstp + dst_pitch;
+ unsigned char *dstpnn = dstp + dst_pitch * 2;
+ unsigned char *omskn = omskp + omsk_pitch * 2;
+ dmskp += dmsk_pitch * ( 2 - field );
+ for( y = 2 - field; y < height - 1; y += 2 )
+ {
+ for( x = 0; x < width; ++x )
+ {
+ int dir = dmskp[x];
+ const int lim = eedi2_limlut[abs(dir-128)>>2];
+ if( dir == 255 ||
+ ( abs( dmskp[x] - dmskp[x-1] ) > lim &&
+ abs( dmskp[x] - dmskp[x+1] ) > lim ) )
+ {
+ dstpn[x] = ( dstp[x] + dstpnn[x] + 1 ) >> 1;
+ if( dir != 255 ) dmskp[x] = 128;
+ continue;
+ }
+ if( lim < 9 )
+ {
+ const int sum = dstp[x-1] + dstp[x] + dstp[x+1] +
+ dstpnn[x-1] + dstpnn[x] + dstpnn[x+1];
+ const int sumsq = dstp[x-1] * dstp[x-1] +
+ dstp[x] * dstp[x] +
+ dstp[x+1] * dstp[x+1] +
+ dstpnn[x-1] * dstpnn[x-1] +
+ dstpnn[x] * dstpnn[x] +
+ dstpnn[x+1] * dstpnn[x+1];
+ if( 6 * sumsq - sum * sum < 576 )
+ {
+ dstpn[x] = ( dstp[x] + dstpnn[x] + 1 ) >> 1;
+ dmskp[x] = 255;
+ continue;
+ }
+ }
+ if( x > 1 && x < width - 2 &&
+ ( dstp[x] < MAX( dstp[x-2], dstp[x-1] ) - 3 &&
+ dstp[x] < MAX( dstp[x+2], dstp[x+1] ) - 3 &&
+ dstpnn[x] < MAX( dstpnn[x-2], dstpnn[x-1] ) - 3 &&
+ dstpnn[x] < MAX( dstpnn[x+2], dstpnn[x+1] ) - 3 )
+ ||
+ ( dstp[x] > MIN( dstp[x-2], dstp[x-1] ) + 3 &&
+ dstp[x] > MIN( dstp[x+2], dstp[x+1] ) + 3 &&
+ dstpnn[x] > MIN( dstpnn[x-2], dstpnn[x-1] ) + 3 &&
+ dstpnn[x] > MIN( dstpnn[x+2], dstpnn[x+1] ) + 3 ) )
+ {
+ dstpn[x] = ( dstp[x] + dstpnn[x] + 1 ) >> 1;
+ dmskp[x] = 128;
+ continue;
+ }
+ dir = ( dir - 128 + 2 ) >> 2;
+ int val = ( dstp[x] + dstpnn[x] + 1 ) >> 1;
+ const int startu = ( dir - 2 < 0 ) ?
+ MAX( -x + 1, MAX( dir - 2, -width + 2 + x ) )
+ :
+ MIN( x - 1, MIN( dir - 2, width - 2 - x ) );
+ const int stopu = ( dir + 2 < 0 ) ?
+ MAX( -x + 1, MAX( dir + 2, -width + 2 + x ) )
+ :
+ MIN( x - 1, MIN( dir + 2, width - 2 - x ) );
+ int min = 8 * nt;
+ for( u = startu; u <= stopu; ++u )
+ {
+ const int diff =
+ abs( dstp[x-1] - dstpnn[x-u-1] ) +
+ abs( dstp[x] - dstpnn[x-u] ) +
+ abs( dstp[x+1] - dstpnn[x-u+1] ) +
+ abs( dstpnn[x-1] - dstp[x+u-1] ) +
+ abs( dstpnn[x] - dstp[x+u] ) +
+ abs( dstpnn[x+1] - dstp[x+u+1] );
+ if( diff < min &&
+ ( ( omskp[x-1+u] != 0xFF && abs( omskp[x-1+u] - dmskp[x] ) <= lim ) ||
+ ( omskp[x+u] != 0xFF && abs( omskp[x+u] - dmskp[x]) <= lim ) ||
+ ( omskp[x+1+u] != 0xFF && abs( omskp[x+1+u] - dmskp[x]) <= lim ) ) &&
+ ( ( omskn[x-1-u] != 0xFF && abs( omskn[x-1-u] - dmskp[x]) <= lim ) ||
+ ( omskn[x-u] != 0xFF && abs( omskn[x-u] - dmskp[x]) <= lim ) ||
+ ( omskn[x+1-u] != 0xFF && abs( omskn[x+1-u] - dmskp[x]) <= lim ) ) )
+ {
+ const int diff2 =
+ abs( dstp[x+(u>>1)-1] - dstpnn[x-(u>>1)-1] ) +
+ abs( dstp[x+(u>>1)] - dstpnn[x-(u>>1)] ) +
+ abs( dstp[x+(u>>1)+1] - dstpnn[x-(u>>1)+1] );
+ if( diff2 < 4 * nt &&
+ ( ( ( abs( omskp[x+(u>>1)] - omskn[x-(u>>1)] ) <= lim ||
+ abs( omskp[x+(u>>1)] - omskn[x-((u+1)>>1)] ) <= lim ) &&
+ omskp[x+(u>>1)] != 0xFF )
+ ||
+ ( ( abs( omskp[x+((u+1)>>1)] - omskn[x-(u>>1)] ) <= lim ||
+ abs( omskp[x+((u+1)>>1)] - omskn[x-((u+1)>>1)] ) <= lim ) &&
+ omskp[x+((u+1)>>1)] != 0xFF ) ) )
+ {
+ if( ( abs( dmskp[x] - omskp[x+(u>>1)] ) <= lim ||
+ abs( dmskp[x] - omskp[x+((u+1)>>1)] ) <= lim ) &&
+ ( abs( dmskp[x] - omskn[x-(u>>1)] ) <= lim ||
+ abs( dmskp[x] - omskn[x-((u+1)>>1)] ) <= lim ) )
+ {
+ val = ( dstp[x+(u>>1)] + dstp[x+((u+1)>>1)] +
+ dstpnn[x-(u>>1)] + dstpnn[x-((u+1)>>1)] + 2 ) >> 2;
+ min = diff;
+ dir = u;
+ }
+ }
+ }
+ }
+ if( min != 8 * nt )
+ {
+ dstpn[x] = val;
+ dmskp[x] = 128 + dir * 4;
+ }
+ else
+ {
+ const int minm = MIN( dstp[x], dstpnn[x] );
+ const int maxm = MAX( dstp[x], dstpnn[x] );
+ const int d = plane == 0 ? 4 : 2;
+ const int startu = MAX( -x + 1, -d );
+ const int stopu = MIN( width - 2 - x, d );
+ min = 7 * nt;
+ for( u = startu; u <= stopu; ++u )
+ {
+ const int p1 = dstp[x+(u>>1)] + dstp[x+((u+1)>>1)];
+ const int p2 = dstpnn[x-(u>>1)] + dstpnn[x-((u+1)>>1)];
+ const int diff =
+ abs( dstp[x-1] - dstpnn[x-u-1] ) +
+ abs( dstp[x] - dstpnn[x-u] ) +
+ abs( dstp[x+1] - dstpnn[x-u+1] ) +
+ abs( dstpnn[x-1] - dstp[x+u-1] ) +
+ abs( dstpnn[x] - dstp[x+u] ) +
+ abs( dstpnn[x+1] - dstp[x+u+1] ) +
+ abs( p1 - p2 );
+ if( diff < min )
+ {
+ const int valt = ( p1 + p2 + 2 ) >> 2;
+ if( valt >= minm && valt <= maxm )
+ {
+ val = valt;
+ min = diff;
+ dir = u;
+ }
+ }
+ }
+ dstpn[x] = val;
+ if( min == 7*nt ) dmskp[x] = 128;
+ else dmskp[x] = 128 + dir * 4;
+ }
+ }
+ dstp += dst_pitch * 2;
+ dstpn += dst_pitch * 2;
+ dstpnn += dst_pitch * 2;
+ dmskp += dmsk_pitch * 2;
+ omskp += omsk_pitch * 2;
+ omskn += omsk_pitch * 2;
+ }
+}
+
+/**
+ * Applies some extra filtering to smooth the edge direction mask
+ * @param nmskp Pointer to the newly-filtered edge direction mask being read from
+ * @param nmsk_pitch Stride of nmskp
+ * @param omskp Pointer to the old unfiltered edge direction mask being read from
+ * @param omsk_pitch Stride of osmkp
+ * @param dstp Pointer to the output image being filtered in place
+ * @param src_pitch Stride of dstp ....not sure why it's named this
+ * @param field Field to filter
+ * @param height Height of the full-frame output
+ * @param width Width of dstp bitmap rows, as opposed to the pdded stride in src_pitch
+ */
+void eedi2_post_process( uint8_t * nmskp, int nmsk_pitch, uint8_t * omskp, int omsk_pitch,
+ uint8_t * dstp, int src_pitch, int field, int height, int width )
+{
+ int x, y;
+
+ nmskp += ( 2 - field ) * nmsk_pitch;
+ omskp += ( 2 - field ) * omsk_pitch;
+ dstp += ( 2 - field ) * src_pitch;
+ unsigned char *srcpp = dstp - src_pitch;
+ unsigned char *srcpn = dstp + src_pitch;
+ for( y = 2 - field; y < height - 1; y += 2 )
+ {
+ for( x = 0; x < width; ++x )
+ {
+ const int lim = eedi2_limlut[abs(nmskp[x]-128)>>2];
+ if( abs( nmskp[x] - omskp[x] ) > lim && omskp[x] != 255 && omskp[x] != 128 )
+ dstp[x] = ( srcpp[x] + srcpn[x] + 1 ) >> 1;
+ }
+ nmskp += nmsk_pitch * 2;
+ omskp += omsk_pitch * 2;
+ srcpp += src_pitch * 2;
+ dstp += src_pitch * 2;
+ srcpn += src_pitch * 2;
+ }
+}
+
+/**
+ * Blurs the source field plane
+ * @param src Pointer to the half-height source field plane
+ * @param src_pitch Stride of src
+ * @param tmp Pointer to a temporary buffer for juggling bitmaps
+ * @param tmp_pitch Stride of tmp
+ * @param dst Pointer to the destination to store the blurred field plane
+ * @param dst_pitch Stride of dst
+ * @param height Height of the hakf-height field-sized frame
+ * @param width Width of dstp bitmap rows, as opposed to the padded stride in dst_pitch
+ */
+void eedi2_gaussian_blur1( uint8_t * src, int src_pitch, uint8_t * tmp, int tmp_pitch, uint8_t * dst, int dst_pitch, int height, int width )
+{
+ uint8_t * srcp = src;
+ uint8_t * dstp = tmp;
+ int x, y;
+
+ for( y = 0; y < height; ++y )
+ {
+ dstp[0] = ( srcp[3] * 582 + srcp[2] * 7078 + srcp[1] * 31724 +
+ srcp[0] * 26152 + 32768 ) >> 16;
+ dstp[1] = ( srcp[4] * 582 + srcp[3] * 7078 +
+ ( srcp[0] + srcp[2] ) * 15862 +
+ srcp[1] * 26152 + 32768 ) >> 16;
+ dstp[2] = ( srcp[5] * 582 + ( srcp[0] + srcp[4] ) * 3539 +
+ ( srcp[1] + srcp[3] ) * 15862 +
+ srcp[2]*26152 + 32768 ) >> 16;
+ for( x = 3; x < width - 3; ++x )
+ {
+ dstp[x] = ( ( srcp[x-3] + srcp[x+3] ) * 291 +
+ ( srcp[x-2] + srcp[x+2] ) * 3539 +
+ ( srcp[x-1] + srcp[x+1] ) * 15862 +
+ srcp[x] * 26152 + 32768 ) >> 16;
+ }
+ dstp[x] = ( srcp[x-3] * 582 + ( srcp[x-2] + srcp[x+2] ) * 3539 +
+ ( srcp[x-1] + srcp[x+1] ) * 15862 +
+ srcp[x] * 26152 + 32768 ) >> 16;
+ ++x;
+ dstp[x] = ( srcp[x-3] * 582 + srcp[x-2] * 7078 +
+ ( srcp[x-1] + srcp[x+1] ) * 15862 +
+ srcp[x] * 26152 + 32768 ) >> 16;
+ ++x;
+ dstp[x] = ( srcp[x-3] * 582 + srcp[x-2] * 7078 +
+ srcp[x-1] * 31724 + srcp[x] * 26152 + 32768 ) >> 16;
+ srcp += src_pitch;
+ dstp += tmp_pitch;
+ }
+ srcp = tmp;
+ dstp = dst;
+ unsigned char *src3p = srcp - tmp_pitch * 3;
+ unsigned char *src2p = srcp - tmp_pitch * 2;
+ unsigned char *srcpp = srcp - tmp_pitch;
+ unsigned char *srcpn = srcp + tmp_pitch;
+ unsigned char *src2n = srcp + tmp_pitch * 2;
+ unsigned char *src3n = srcp + tmp_pitch * 3;
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src3n[x] * 582 + src2n[x] * 7078 + srcpn[x] * 31724 +
+ srcp[x] * 26152 + 32768 ) >> 16;
+ }
+ src3p += tmp_pitch;
+ src2p += tmp_pitch;
+ srcpp += tmp_pitch;
+ srcp += tmp_pitch;
+ srcpn += tmp_pitch;
+ src2n += tmp_pitch;
+ src3n += tmp_pitch;
+ dstp += dst_pitch;
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src3n[x] * 582 + src2n[x] * 7078 +
+ ( srcpp[x] + srcpn[x] ) * 15862 +
+ srcp[x] * 26152 + 32768 ) >> 16;
+ }
+ src3p += tmp_pitch;
+ src2p += tmp_pitch;
+ srcpp += tmp_pitch;
+ srcp += tmp_pitch;
+ srcpn += tmp_pitch;
+ src2n += tmp_pitch;
+ src3n += tmp_pitch;
+ dstp += dst_pitch;
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src3n[x] * 582 + ( src2p[x] + src2n[x] ) * 3539 +
+ ( srcpp[x] + srcpn[x] ) * 15862 +
+ srcp[x] * 26152 + 32768 ) >> 16;
+ }
+ src3p += src_pitch;
+ src2p += src_pitch;
+ srcpp += src_pitch;
+ srcp += src_pitch;
+ srcpn += src_pitch;
+ src2n += src_pitch;
+ src3n += src_pitch;
+ dstp += dst_pitch;
+ for( y = 3; y < height - 3; ++y )
+ {
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( ( src3p[x] + src3n[x] ) * 291 +
+ ( src2p[x] + src2n[x] ) * 3539 +
+ ( srcpp[x] + srcpn[x] ) * 15862 +
+ srcp[x] * 26152 + 32768 ) >> 16;
+ }
+ src3p += tmp_pitch;
+ src2p += tmp_pitch;
+ srcpp += tmp_pitch;
+ srcp += tmp_pitch;
+ srcpn += tmp_pitch;
+ src2n += tmp_pitch;
+ src3n += tmp_pitch;
+ dstp += dst_pitch;
+ }
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src3p[x] * 582 + ( src2p[x] + src2n[x] ) *3539 +
+ ( srcpp[x] + srcpn[x] ) * 15862 +
+ srcp[x] * 26152 + 32768 ) >> 16;
+ }
+ src3p += tmp_pitch;
+ src2p += tmp_pitch;
+ srcpp += tmp_pitch;
+ srcp += tmp_pitch;
+ srcpn += tmp_pitch;
+ src2n += tmp_pitch;
+ src3n += tmp_pitch;
+ dstp += dst_pitch;
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src3p[x] * 582 + src2p[x] * 7078 +
+ ( srcpp[x] + srcpn[x] ) * 15862 +
+ srcp[x] * 26152 + 32768 ) >> 16;
+ }
+ src3p += tmp_pitch;
+ src2p += tmp_pitch;
+ srcpp += tmp_pitch;
+ srcp += tmp_pitch;
+ srcpn += tmp_pitch;
+ src2n += tmp_pitch;
+ src3n += tmp_pitch;
+ dstp += dst_pitch;
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src3p[x] * 582 + src2p[x] * 7078 +
+ srcpp[x] * 31724 + srcp[x] * 26152 + 32768 ) >> 16;
+ }
+}
+
+
+/**
+ * Blurs the spatial derivatives of the source field plane
+ * @param src Pointer to the derivative array to filter
+ * @param tmp Pointer to a temporary storage for the derivative array while it's being filtered
+ * @param dst Pointer to the destination to store the filtered output derivative array
+ * @param pitch Stride of the bitmap from which the src array is derived
+ * @param height Height of the half-height field-sized frame from which the src array derivs were taken
+ * @param width Width of the bitmap from which the src array is derived, as opposed to the padded stride in pitch
+ */
+void eedi2_gaussian_blur_sqrt2( int *src, int *tmp, int *dst, const int pitch, int height, const int width )
+{
+ int * srcp = src;
+ int * dstp = tmp;
+ int x, y;
+
+ for( y = 0; y < height; ++y )
+ {
+ x = 0;
+ dstp[x] = ( srcp[x+4] * 678 + srcp[x+3] * 3902 + srcp[x+2] * 13618 +
+ srcp[x+1] * 28830 + srcp[x] * 18508 + 32768 ) >> 16;
+ ++x;
+ dstp[x] = ( srcp[x+4] * 678 + srcp[x+3] * 3902 + srcp[x+2] * 13618 +
+ ( srcp[x-1] + srcp[x+1] ) *14415 +
+ srcp[x] * 18508 + 32768 ) >> 16;
+ ++x;
+ dstp[x] = ( srcp[x+4] * 678 + srcp[x+3] * 3902 +
+ ( srcp[x-2] + srcp[x+2] ) * 6809 +
+ ( srcp[x-1] + srcp[x+1] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 16;
+ ++x;
+ dstp[x] = ( srcp[x+4] * 678 + ( srcp[x-3] + srcp[x+3] ) * 1951 +
+ ( srcp[x-2] + srcp[x+2] ) * 6809 +
+ ( srcp[x-1] + srcp[x+1] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 16;
+
+ for( x = 4; x < width - 4; ++x )
+ {
+ dstp[x] = ( ( srcp[x-4] + srcp[x+4] ) * 339 +
+ ( srcp[x-3] + srcp[x+3] ) * 1951 +
+ ( srcp[x-2] + srcp[x+2] ) * 6809 +
+ ( srcp[x-1] + srcp[x+1] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 16;
+ }
+
+ dstp[x] = ( srcp[x-4] * 678 + ( srcp[x-3] + srcp[x+3] ) * 1951 +
+ ( srcp[x-2] + srcp[x+2] ) * 6809 +
+ ( srcp[x-1] + srcp[x+1] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 16;
+ ++x;
+ dstp[x] = ( srcp[x-4] * 678 + srcp[x-3] * 3902 +
+ ( srcp[x-2] + srcp[x+2] ) * 6809 +
+ ( srcp[x-1] + srcp[x+1] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 16;
+ ++x;
+ dstp[x] = ( srcp[x-4] * 678 + srcp[x+3] * 3902 + srcp[x-2] * 13618 +
+ ( srcp[x-1] + srcp[x+1] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 16;
+ ++x;
+ dstp[x] = ( srcp[x-4] * 678 + srcp[x-3] * 3902 + srcp[x-2] * 13618 +
+ srcp[x-1] * 28830 +
+ srcp[x] * 18508 + 32768 ) >> 16;
+ srcp += pitch;
+ dstp += pitch;
+ }
+ dstp = dst;
+ srcp = tmp;
+ int * src4p = srcp - pitch * 4;
+ int * src3p = srcp - pitch * 3;
+ int * src2p = srcp - pitch * 2;
+ int * srcpp = srcp - pitch;
+ int * srcpn = srcp + pitch;
+ int * src2n = srcp + pitch * 2;
+ int * src3n = srcp + pitch * 3;
+ int * src4n = srcp + pitch * 4;
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src4n[x] * 678 + src3n[x] * 3902 +
+ src2n[x] * 13618 + srcpn[x] * 28830 +
+ srcp[x] * 18508 + 32768 ) >> 18;
+ }
+ src4p += pitch;
+ src3p += pitch;
+ src2p += pitch;
+ srcpp += pitch;
+ srcp += pitch;
+ srcpn += pitch;
+ src2n += pitch;
+ src3n += pitch;
+ src4n += pitch;
+ dstp += pitch;
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src4n[x] * 678 + src3n[x] * 3902 + src2n[x] * 13618 +
+ ( srcpp[x] + srcpn[x] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 18;
+ }
+ src4p += pitch;
+ src3p += pitch;
+ src2p += pitch;
+ srcpp += pitch;
+ srcp += pitch;
+ srcpn += pitch;
+ src2n += pitch;
+ src3n += pitch;
+ src4n += pitch;
+ dstp += pitch;
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src4n[x] * 678 + src3n[x] * 3902 +
+ ( src2p[x] + src2n[x] ) * 6809 +
+ ( srcpp[x] + srcpn[x] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 18;
+ }
+ src4p += pitch;
+ src3p += pitch;
+ src2p += pitch;
+ srcpp += pitch;
+ srcp += pitch;
+ srcpn += pitch;
+ src2n += pitch;
+ src3n += pitch;
+ src4n += pitch;
+ dstp += pitch;
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src4n[x] * 678 + ( src3p[x] + src3n[x] ) * 1951 +
+ ( src2p[x] + src2n[x] ) * 6809 +
+ ( srcpp[x] + srcpn[x] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 18;
+ }
+ src4p += pitch;
+ src3p += pitch;
+ src2p += pitch;
+ srcpp += pitch;
+ srcp += pitch;
+ srcpn += pitch;
+ src2n += pitch;
+ src3n += pitch;
+ src4n += pitch;
+ dstp += pitch;
+ for( y = 4; y < height - 4; ++y )
+ {
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( ( src4p[x] + src4n[x] ) * 339 +
+ ( src3p[x] + src3n[x] ) * 1951 +
+ ( src2p[x] + src2n[x] ) * 6809 +
+ ( srcpp[x] + srcpn[x] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 18;
+ }
+ src4p += pitch;
+ src3p += pitch;
+ src2p += pitch;
+ srcpp += pitch;
+ srcp += pitch;
+ srcpn += pitch;
+ src2n += pitch;
+ src3n += pitch;
+ src4n += pitch;
+ dstp += pitch;
+ }
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src4p[x] * 678 +
+ ( src3p[x] + src3n[x] ) * 1951 +
+ ( src2p[x] + src2n[x] ) * 6809 +
+ ( srcpp[x] + srcpn[x] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 18;
+ }
+ src4p += pitch;
+ src3p += pitch;
+ src2p += pitch;
+ srcpp += pitch;
+ srcp += pitch;
+ srcpn += pitch;
+ src2n += pitch;
+ src3n += pitch;
+ src4n += pitch;
+ dstp += pitch;
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src4p[x] * 678 + src3p[x] * 3902 +
+ ( src2p[x] + src2n[x] ) * 6809 +
+ ( srcpp[x] + srcpn[x] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 18;
+ }
+ src4p += pitch;
+ src3p += pitch;
+ src2p += pitch;
+ srcpp += pitch;
+ srcp += pitch;
+ srcpn += pitch;
+ src2n += pitch;
+ src3n += pitch;
+ src4n += pitch;
+ dstp += pitch;
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src4p[x] * 678 + src3p[x] * 3902 + src2p[x] * 13618 +
+ ( srcpp[x] + srcpn[x] ) * 14415 +
+ srcp[x] * 18508 + 32768 ) >> 18;
+ }
+ src4p += pitch;
+ src3p += pitch;
+ src2p += pitch;
+ srcpp += pitch;
+ srcp += pitch;
+ srcpn += pitch;
+ src2n += pitch;
+ src3n += pitch;
+ src4n += pitch;
+ dstp += pitch;
+ for( x = 0; x < width; ++x )
+ {
+ dstp[x] = ( src4p[x] * 678 + src3p[x] * 3902 +
+ src2p[x] * 13618 + srcpp[x] * 28830 +
+ srcp[x] * 18508 + 32768 ) >> 18;
+ }
+}
+
+/**
+ * Finds spatial derivatives for a a source field plane
+ * @param srcp Pointer to the plane to derive
+ * @param src_pitch Stride of srcp
+ * @param height Height of the half-height field-sized frame
+ * @param width Width of srcp bitmap rows, as opposed to the padded stride in src_pitch
+ * @param x2 Pointed to the array to store the x/x derivatives
+ * @param y2 Pointer to the array to store the y/y derivatives
+ * @param xy Pointer to the array to store the x/y derivatives
+ */
+void eedi2_calc_derivatives( uint8_t *srcp, int src_pitch, int height, int width, int *x2, int *y2, int *xy)
+{
+
+ unsigned char * srcpp = srcp - src_pitch;
+ unsigned char * srcpn = srcp + src_pitch;
+ int x, y;
+ {
+ const int Ix = srcp[1] - srcp[0];
+ const int Iy = srcp[0] - srcpn[0];
+ x2[0] = ( Ix * Ix ) >> 1;
+ y2[0] = ( Iy * Iy ) >> 1;
+ xy[0] = ( Ix * Iy ) >> 1;
+ }
+ for( x = 1; x < width - 1; ++x )
+ {
+ const int Ix = srcp[x+1] - srcp[x-1];
+ const int Iy = srcp[x] - srcpn[x];
+ x2[x] = ( Ix * Ix ) >> 1;
+ y2[x] = ( Iy * Iy ) >> 1;
+ xy[x] = ( Ix * Iy ) >> 1;
+ }
+ {
+ const int Ix = srcp[x] - srcp[x-1];
+ const int Iy = srcp[x] - srcpn[x];
+ x2[x] = ( Ix * Ix ) >> 1;
+ y2[x] = ( Iy * Iy ) >> 1;
+ xy[x] = ( Ix * Iy ) >> 1;
+ }
+ srcpp += src_pitch;
+ srcp += src_pitch;
+ srcpn += src_pitch;
+ x2 += src_pitch;
+ y2 += src_pitch;
+ xy += src_pitch;
+ for( y = 1; y < height - 1; ++y )
+ {
+ {
+ const int Ix = srcp[1] - srcp[0];
+ const int Iy = srcpp[0] - srcpn[0];
+ x2[0] = ( Ix * Ix ) >> 1;
+ y2[0] = ( Iy * Iy ) >> 1;
+ xy[0] = ( Ix * Iy ) >> 1;
+ }
+ for ( x = 1; x < width - 1; ++x )
+ {
+ const int Ix = srcp[x+1] - srcp[x-1];
+ const int Iy = srcpp[x] - srcpn[x];
+ x2[x] = ( Ix * Ix ) >> 1;
+ y2[x] = ( Iy * Iy ) >> 1;
+ xy[x] = ( Ix * Iy ) >> 1;
+ }
+ {
+ const int Ix = srcp[x] - srcp[x-1];
+ const int Iy = srcpp[x] - srcpn[x];
+ x2[x] = ( Ix *Ix ) >> 1;
+ y2[x] = ( Iy *Iy ) >> 1;
+ xy[x] = ( Ix *Iy ) >> 1;
+ }
+ srcpp += src_pitch;
+ srcp += src_pitch;
+ srcpn += src_pitch;
+ x2 += src_pitch;
+ y2 += src_pitch;
+ xy += src_pitch;
+ }
+ {
+ const int Ix = srcp[1] - srcp[0];
+ const int Iy = srcpp[0] - srcp[0];
+ x2[0] = ( Ix * Ix ) >> 1;
+ y2[0] = ( Iy * Iy ) >> 1;
+ xy[0] = ( Ix * Iy ) >> 1;
+ }
+ for( x = 1; x < width - 1; ++x )
+ {
+ const int Ix = srcp[x+1] - srcp[x-1];
+ const int Iy = srcpp[x] - srcp[x];
+ x2[x] = ( Ix * Ix ) >> 1;
+ y2[x] = ( Iy * Iy ) >> 1;
+ xy[x] = ( Ix * Iy ) >> 1;
+ }
+ {
+ const int Ix = srcp[x] - srcp[x-1];
+ const int Iy = srcpp[x] - srcp[x];
+ x2[x] = ( Ix * Ix ) >> 1;
+ y2[x] = ( Iy * Iy ) >> 1;
+ xy[x] = ( Ix * Iy ) >> 1;
+ }
+}
+
+/**
+ * Filters junctions and corners for the output image
+ * @param x2 Pointer to the x/x derivatives
+ * @param y2 Pointer to the y/y derivatives
+ * @param xy Pointer to the x/y derivatives
+ * @param pitch Stride of the source field plane from which the derivatives were calculated
+ * @param mskp Pointer to the edge direction mask
+ * @param msk_pitch Stride of mskp
+ * @param dstp Pointer to the output image being filtered in place
+ * @param dst_pitch Stride of dstp
+ * @param height Height of the full-frame output plane
+ * @param width Width of dstp bitmap rows, as opposed to the padded stride in dst_pitch
+ * @param field Field to filter
+ */
+void eedi2_post_process_corner( int *x2, int *y2, int *xy, const int pitch, uint8_t * mskp, int msk_pitch, uint8_t * dstp, int dst_pitch, int height, int width, int field )
+{
+ mskp += ( 8 - field ) * msk_pitch;
+ dstp += ( 8 - field ) * dst_pitch;
+ unsigned char * dstpp = dstp - dst_pitch;
+ unsigned char * dstpn = dstp + dst_pitch;
+ x2 += pitch * 3;
+ y2 += pitch * 3;
+ xy += pitch * 3;
+ int *x2n = x2 + pitch;
+ int *y2n = y2 + pitch;
+ int *xyn = xy + pitch;
+ int x, y;
+
+ for( y = 8 - field; y < height - 7; y += 2 )
+ {
+ for( x = 4; x < width - 4; ++x )
+ {
+ if( mskp[x] == 255 || mskp[x] == 128 ) continue;
+ const int c1 = (int)( x2[x] * y2[x] - xy[x] * xy[x] - 0.09 *
+ ( x2[x] + y2[x] ) * ( x2[x] + y2[x] ) );
+ const int c2 = (int)( x2n[x] * y2n[x] - xyn[x]* xyn[x] - 0.09 *
+ ( x2n[x] + y2n[x] ) * ( x2n[x] + y2n[x] ) );
+ if (c1 > 775 || c2 > 775)
+ dstp[x] = ( dstpp[x] + dstpn[x] + 1 ) >> 1;
+ }
+ mskp += msk_pitch * 2;
+ dstpp += dst_pitch * 2;
+ dstp += dst_pitch * 2;
+ dstpn += dst_pitch * 2;
+ x2 += pitch;
+ x2n += pitch;
+ y2 += pitch;
+ y2n += pitch;
+ xy += pitch;
+ xyn += pitch;
+ }
+}