/* 
 * Linux VeeJay
 *
 * Copyright(C)2006 Niels Elburg <nwelburg@gmail.com>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License , or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307 , USA.
 */
#include <config.h>
#include <stdint.h>
#include <stdio.h>
#include <libvjmem/vjmem.h>
#include "threshold.h"
#include "common.h"
#include "softblur.h"

typedef int (*morph_func)(uint8_t *kernel, uint8_t mt[9] );

vj_effect *threshold_init(int w, int h)
{
    vj_effect *ve = (vj_effect *) vj_calloc(sizeof(vj_effect));
    ve->num_params = 2;

    ve->defaults = (int *) vj_calloc(sizeof(int) * ve->num_params);	/* default values */
    ve->limits[0] = (int *) vj_calloc(sizeof(int) * ve->num_params);	/* min */
    ve->limits[1] = (int *) vj_calloc(sizeof(int) * ve->num_params);	/* max */
    ve->limits[0][0] = 0;  // threshold
    ve->limits[1][0] = 255;
    ve->limits[0][1] = 0;  // reverse
    ve->limits[1][1] = 1;

    ve->defaults[0] = 40;
    ve->defaults[1] = 0;
    ve->description = "Map B from threshold mask";
    ve->sub_format = 1;
    ve->extra_frame = 1;
    ve->has_user = 0;
	ve->param_description = vje_build_param_list( ve->num_params, "Threshold", "Reverse" );
    return ve;
}


static uint8_t *binary_img;

int		threshold_malloc(int w, int h )
{
	binary_img = (uint8_t*) vj_malloc(sizeof(uint8_t) * RUP8(w * h) );
	if(!binary_img) return 0;
	return 1;
}

void		threshold_free(void)
{
	if(binary_img)
		free(binary_img);
	binary_img = NULL;
}

#ifndef MIN
#define MIN(a,b) ( (a)>(b) ? (b) : (a) )
#endif
#ifndef MAX
#define MAX(a,b) ( (a)>(b) ? (a) : (b) )
#endif

static int _dilate_kernel3x3( uint8_t *kernel, uint8_t img[9])
{
	register int x;
	/* consider all background pixels (0) in input image */	
	for(x = 0; x < 9; x ++ )
		if((kernel[x] * img[x]) > 0 )
			return 1;
	return 0;
}
#ifdef HAVE_ASM_MMX
static	inline	void	load_binary_map( uint8_t *mask )
{
	__asm __volatile(
		"movq	(%0),	%%mm0\n\t"
		:: "r" (mask) 
	);
}

static		inline	void	map_luma( uint8_t *dst, uint8_t *B )
//static	inline	void	map_luma( uint8_t *dst, uint8_t *B, uint8_t *mask )
{
	__asm __volatile(
	//	"movq	(%0),	%%mm0\n\t"
		"movq	(%0),	%%mm1\n\t"
		"pand	%%mm0,  %%mm1\n\t"
		"movq	%%mm1,  (%1)\n\t"
	//	:: "r" (mask), "r" (B), "r" (dst) 
		:: "r" (B) , "r" (dst)
	);
}

static	inline	void	load_chroma( uint8_t val )
{
	uint8_t mask[8] = { val,val,val,val, val,val,val,val };
	uint8_t *m = &mask[0];

	__asm __volatile(
		"movq	(%0),	%%mm3\n\t # mm3: 128,128,128,128, ..."  
		:: "r" (m)
	);
}

static	inline	void	map_chroma( uint8_t *dst, uint8_t *B )
{
	__asm	__volatile(
		"movq	(%0),	%%mm1\n\t"
		"pand	%%mm0,   %%mm1\n\t"
		"pxor	%%mm5,  %%mm5\n\t"
		"pcmpeqb %%mm1,%%mm5\n\t"
		"pand	%%mm3,%%mm5\n\t"
		"paddb	%%mm5,%%mm1\n\t"
		"movq	%%mm1,  (%1) \n\t"
		:: "r" (B), "r" (dst)
	);

}
#endif

void threshold_apply( VJFrame *frame, VJFrame *frame2,int width, int height, int threshold, int reverse )
{
	unsigned int y;
    	uint8_t *Y = frame->data[0];
	uint8_t *Cb = frame->data[1];
	uint8_t *Cr = frame->data[2];
	uint8_t *Y2 = frame2->data[0];
	uint8_t *Cb2=frame2->data[1];
	uint8_t *Cr2=frame2->data[2];

	uint8_t *bmap = binary_img;

	softblur_apply( frame, width,height,0 );

	binarify_1src( binary_img,Y,threshold,reverse, width,height);

#ifdef HAVE_ASM_MMX
	int work = (width*height)>>3;
	load_chroma( 128 );
	for( y = 0 ; y < work; y ++ )
	{
		load_binary_map( bmap );
		map_luma(Y , Y2 );
		map_chroma( Cb, Cb2 );
		map_chroma( Cr, Cr2 );
		//@ we could mmx-ify dilation
		Y  += 8;
		Y2 += 8;	
		Cb += 8;
		Cb2 += 8;
		Cr += 8;
		Cr2 +=8;
		bmap += 8; 
	}

	do_emms;
#else

//	veejay_memset( Y, 0, width );
//	veejay_memset( Cb, 128, width );
//	veejay_memset( Cr, 128, width );

//	veejay_memset(Y+(len-width),0, width );
//	veejay_memset(Cb+(len-width),128,width);
//	veejay_memset(Cr+(len-width),128,width);

//	len -= width;

	if(!reverse)
	{
		for(y = 0; y < len; y += width  )
		{	
			for(x = 0; x < width; x ++)
			{	
				if(binary_img[x+y]) //@ found white pixel
				{
					Y[x+y] = Y2[x+y];
					Cb[x+y] = Cb2[x+y];
					Cr[x+y] = Cr2[x+y];

				}
				else //@ black
				{
					Y[x + y] = 0;
					Cb[x + y] = 128;
					Cr[x + y] = 128;
				}
			}
		}
	}
	else
	{
		for(y = 0; y < len; y += width  )
		{	
			for(x = 0; x < width; x ++)
			{	
				if(binary_img[x+y] == 0x0) //@ found black pixel
				{
					Y[x+y] = Y2[x+y];
					Cb[x+y]= Cb2[x+y];
					Cr[x+y]= Cr2[x+y];
				}
				else
				{ 
					Y[x+y] = 0x0;
					Cb[x+y] = 128; 
					Cr[x+y] = 128;
				}
			}
		}
	}
#endif
}