- int i_red = ( i_color & 0xFF0000 ) >> 16;
- int i_green = ( i_color & 0xFF00 ) >> 8;
- int i_blue = i_color & 0xFF;
- int i_u = (int8_t)(( -38 * i_red - 74 * i_green +
- 112 * i_blue + 128) >> 8) + 128;
- int i_v = (int8_t)(( 112 * i_red - 94 * i_green -
- 18 * i_blue + 128) >> 8) + 128;
- int refu = i_u - 0x80; /*bright red*/
- int refv = i_v - 0x80;
- int reflength = sqrt(refu*refu+refv*refv);
-
- while( p_in_u < p_in_end_u ) {
- /* Length of color vector */
- int inu = (*p_in_u) - 0x80;
- int inv = (*p_in_v) - 0x80;
- int length = sqrt(inu*inu+inv*inv);
-
- int diffu = refu * length - inu *reflength;
- int diffv = refv * length - inv *reflength;
- long long int difflen2=diffu*diffu;
- difflen2 +=diffv*diffv;
- long long int thres = length*reflength;
- thres *= thres;
- if( length > i_satthres && (difflen2*i_simthres< thres ) ) {
- *p_out_u = *p_in_u;
- *p_out_v = *p_in_v;
-// fprintf(stderr,"keeping color %d %d\n", length, difflen2);
+ int refu, refv, reflength;
+ GetReference( &refu, &refv, &reflength, i_color );
+
+ for( int y = 0; y < p_pic->p[U_PLANE].i_visible_lines; y++ )
+ {
+ uint8_t *p_src_u = &p_pic->p[U_PLANE].p_pixels[y * p_pic->p[U_PLANE].i_pitch];
+ uint8_t *p_src_v = &p_pic->p[V_PLANE].p_pixels[y * p_pic->p[V_PLANE].i_pitch];
+ uint8_t *p_dst_u = &p_outpic->p[U_PLANE].p_pixels[y * p_outpic->p[U_PLANE].i_pitch];
+ uint8_t *p_dst_v = &p_outpic->p[V_PLANE].p_pixels[y * p_outpic->p[V_PLANE].i_pitch];
+
+ for( int x = 0; x < p_pic->p[U_PLANE].i_visible_pitch; x++ )
+ {
+ if( IsSimilar( *p_src_u - 0x80, *p_src_v - 0x80,
+ refu, refv, reflength,
+ i_satthres, i_simthres ) )
+
+ {
+ *p_dst_u++ = *p_src_u;
+ *p_dst_v++ = *p_src_v;
+ }
+ else
+ {
+ *p_dst_u++ = 0x80;
+ *p_dst_v++ = 0x80;
+ }
+ p_src_u++;
+ p_src_v++;
+ }
+ }
+
+ return CopyInfoAndRelease( p_outpic, p_pic );
+}
+
+static picture_t *FilterPacked( filter_t *p_filter, picture_t *p_pic )
+{
+ picture_t *p_outpic;
+ filter_sys_t *p_sys = p_filter->p_sys;
+ int i_simthres = atomic_load( &p_sys->i_simthres );
+ int i_satthres = atomic_load( &p_sys->i_satthres );
+ int i_color = atomic_load( &p_sys->i_color );
+
+ if( !p_pic ) return NULL;
+
+ p_outpic = filter_NewPicture( p_filter );
+ if( !p_outpic )
+ {
+ picture_Release( p_pic );
+ return NULL;
+ }
+
+ int i_y_offset, i_u_offset, i_v_offset;
+ int i_ret = GetPackedYuvOffsets( p_filter->fmt_in.video.i_chroma,
+ &i_y_offset, &i_u_offset, &i_v_offset );
+ if( i_ret == VLC_EGENERIC )
+ {
+ picture_Release( p_pic );
+ return NULL;
+ }
+
+ /*
+ * Copy Y and do the U and V planes
+ */
+ int refu, refv, reflength;
+ GetReference( &refu, &refv, &reflength, i_color );
+
+ for( int y = 0; y < p_pic->p->i_visible_lines; y++ )
+ {
+ uint8_t *p_src = &p_pic->p->p_pixels[y * p_pic->p->i_pitch];
+ uint8_t *p_dst = &p_outpic->p->p_pixels[y * p_outpic->p->i_pitch];
+
+ for( int x = 0; x < p_pic->p->i_visible_pitch / 4; x++ )
+ {
+ p_dst[i_y_offset + 0] = p_src[i_y_offset + 0];
+ p_dst[i_y_offset + 2] = p_src[i_y_offset + 2];
+
+ if( IsSimilar( p_src[i_u_offset] - 0x80, p_src[i_v_offset] - 0x80,
+ refu, refv, reflength,
+ i_satthres, i_simthres ) )
+ {
+ p_dst[i_u_offset] = p_src[i_u_offset];
+ p_dst[i_v_offset] = p_src[i_v_offset];
+ }
+ else
+ {
+ p_dst[i_u_offset] = 0x80;
+ p_dst[i_v_offset] = 0x80;
+ }
+
+ p_dst += 4;
+ p_src += 4;