/*
 * mlt_frame.c -- interface for all frame classes
 * Copyright (C) 2003-2004 Ushodaya Enterprises Limited
 * Author: Charles Yates <charles.yates@pandora.be>
 *
 * 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 "mlt_frame.h"
#include <stdio.h>
#include <stdlib.h>
#include <string.h>

typedef struct
{
	mlt_image_format vfmt;
	int width;
	int height;
	uint8_t *image;
	uint8_t *alpha;
	mlt_audio_format afmt;
	int16_t *audio;
}
frame_test;

static frame_test test_card = { mlt_image_none, 0, 0, NULL, NULL, mlt_audio_none, NULL };

/** Constructor for a frame.
*/

mlt_frame mlt_frame_init( )
{
	// Allocate a frame
	mlt_frame this = calloc( sizeof( struct mlt_frame_s ), 1 );

	if ( this != NULL )
	{
		// Initialise the properties
		mlt_properties properties = &this->parent;
		mlt_properties_init( properties, this );

		// Set default properties on the frame
		mlt_properties_set_timecode( properties, "timecode", 0.0 );
		mlt_properties_set_data( properties, "image", NULL, 0, NULL, NULL );
		mlt_properties_set_int( properties, "width", 720 );
		mlt_properties_set_int( properties, "height", 576 );
		mlt_properties_set_double( properties, "aspect_ratio", 4.0 / 3.0 );
		mlt_properties_set_data( properties, "audio", NULL, 0, NULL, NULL );
		mlt_properties_set_data( properties, "alpha", NULL, 0, NULL, NULL );
	}
	return this;
}

/** Fetch the frames properties.
*/

mlt_properties mlt_frame_properties( mlt_frame this )
{
	return &this->parent;
}

/** Check if we have a way to derive something other than a test card.
*/

int mlt_frame_is_test_card( mlt_frame this )
{
	return this->stack_get_image_size == 0;
}

/** Get the aspect ratio of the frame.
*/

double mlt_frame_get_aspect_ratio( mlt_frame this )
{
	mlt_properties properties = mlt_frame_properties( this );
	return mlt_properties_get_double( properties, "aspect_ratio" );
}

/** Set the aspect ratio of the frame.
*/

int mlt_frame_set_aspect_ratio( mlt_frame this, double value )
{
	mlt_properties properties = mlt_frame_properties( this );
	return mlt_properties_set_double( properties, "aspect_ratio", value );
}

/** Get the timecode of this frame.
*/

mlt_timecode mlt_frame_get_timecode( mlt_frame this )
{
	mlt_properties properties = mlt_frame_properties( this );
	return mlt_properties_get_timecode( properties, "timecode" );
}

/** Set the timecode of this frame.
*/

int mlt_frame_set_timecode( mlt_frame this, mlt_timecode value )
{
	mlt_properties properties = mlt_frame_properties( this );
	return mlt_properties_set_timecode( properties, "timecode", value );
}

/** Stack a get_image callback.
*/

int mlt_frame_push_get_image( mlt_frame this, mlt_get_image get_image )
{
	int ret = this->stack_get_image_size >= 10;
	if ( ret == 0 )
		this->stack_get_image[ this->stack_get_image_size ++ ] = get_image;
	return ret;
}

/** Pop a get_image callback.
*/

mlt_get_image mlt_frame_pop_get_image( mlt_frame this )
{
	mlt_get_image result = NULL;
	if ( this->stack_get_image_size > 0 )
		result = this->stack_get_image[ -- this->stack_get_image_size ];
	return result;
}

/** Push a frame.
*/

int mlt_frame_push_frame( mlt_frame this, mlt_frame that )
{
	int ret = this->stack_frame_size >= 10;
	if ( ret == 0 )
		this->stack_frame[ this->stack_frame_size ++ ] = that;
	return ret;
}

/** Pop a frame.
*/

mlt_frame mlt_frame_pop_frame( mlt_frame this )
{
	mlt_frame result = NULL;
	if ( this->stack_frame_size > 0 )
		result = this->stack_frame[ -- this->stack_frame_size ];
	return result;
}

int mlt_frame_get_image( mlt_frame this, uint8_t **buffer, mlt_image_format *format, int *width, int *height, int writable )
{
	mlt_properties properties = mlt_frame_properties( this );
	mlt_get_image get_image = mlt_frame_pop_get_image( this );
	
	if ( get_image != NULL )
	{
		return get_image( this, buffer, format, width, height, writable );
	}
	else if ( mlt_properties_get_data( properties, "image", NULL ) != NULL )
	{
		*format = mlt_image_yuv422;
		*buffer = mlt_properties_get_data( properties, "image", NULL );
		*width = mlt_properties_get_int( properties, "width" );
		*height = mlt_properties_get_int( properties, "height" );
	}
	else
	{
		if ( test_card.vfmt != *format )
		{
			uint8_t *p;
			uint8_t *q;
			
			test_card.vfmt = *format;
			test_card.width = *width == 0 ? 720 : *width;
			test_card.height = *height == 0 ? 576 : *height;

			switch( *format )
			{
				case mlt_image_none:
					break;
				case mlt_image_rgb24:
					test_card.image = realloc( test_card.image, test_card.width * test_card.height * 3 );
					memset( test_card.image, 255, test_card.width * test_card.height * 3 );
					break;
				case mlt_image_rgb24a:
					test_card.image = realloc( test_card.image, test_card.width * test_card.height * 4 );
					memset( test_card.image, 255, test_card.width * test_card.height * 4 );
					break;
				case mlt_image_yuv422:
					test_card.image = realloc( test_card.image, test_card.width * test_card.height * 2 );
					p = test_card.image;
					q = test_card.image + test_card.width * test_card.height * 2;
					while ( p != q )
					{
						*p ++ = 255;
						*p ++ = 128;
					}
					break;
				case mlt_image_yuv420p:
					test_card.image = realloc( test_card.image, test_card.width * test_card.height * 3 / 2 );
					memset( test_card.image, 255, test_card.width * test_card.height * 3 / 2 );
					break;
			}
		}

		*width = test_card.width;
		*height = test_card.height;
		*buffer = test_card.image;
	}

	return 0;
}

uint8_t *mlt_frame_get_alpha_mask( mlt_frame this )
{
	if ( this->get_alpha_mask != NULL )
		return this->get_alpha_mask( this );
	return test_card.alpha;
}

int mlt_frame_get_audio( mlt_frame this, int16_t **buffer, mlt_audio_format *format, int *frequency, int *channels, int *samples )
{
	if ( this->get_audio != NULL )
	{
		return this->get_audio( this, buffer, format, frequency, channels, samples );
	}
	else
	{
		if ( test_card.afmt != *format )
		{
			test_card.afmt = *format;
			test_card.audio = realloc( test_card.audio, 1920 * 2 * sizeof( int16_t ) );
			memset( test_card.audio, 0, 1920 * 2 * sizeof( int16_t ) );
		}
		
		*buffer = test_card.audio;
		*frequency = 48000;
		*channels = 2;
		*samples = 1920;
	}
	return 0;
}

void mlt_frame_close( mlt_frame this )
{
	mlt_frame frame = mlt_frame_pop_frame( this );
	
	while ( frame != NULL )
	{
		mlt_frame_close( frame);
		frame = mlt_frame_pop_frame( this );
	}
	
	mlt_properties_close( &this->parent );

	free( this );
}

/***** convenience functions *****/
#define RGB2YUV(r, g, b, y, u, v)\
  y = (306*r + 601*g + 117*b)  >> 10;\
  u = ((-172*r - 340*g + 512*b) >> 10)  + 128;\
  v = ((512*r - 429*g - 83*b) >> 10) + 128;\
  y = y < 0 ? 0 : y;\
  u = u < 0 ? 0 : u;\
  v = v < 0 ? 0 : v;\
  y = y > 255 ? 255 : y;\
  u = u > 255 ? 255 : u;\
  v = v > 255 ? 255 : v

int mlt_convert_rgb24a_to_yuv422( uint8_t *rgba, int width, int height, int stride, uint8_t *yuv, uint8_t *alpha )
{
	int ret = 0;
	register int y0, y1, u0, u1, v0, v1;
	register int r, g, b;
	register uint8_t *d = yuv;
	register int i, j;

	for ( i = 0; i < height; i++ )
	{
		register uint8_t *s = rgba + ( stride * i );
		for ( j = 0; j < ( width / 2 ); j++ )
		{
			r = *s++;
			g = *s++;
			b = *s++;
			*alpha++ = *s++;
			RGB2YUV (r, g, b, y0, u0 , v0);
			r = *s++;
			g = *s++;
			b = *s++;
			*alpha++ = *s++;
			RGB2YUV (r, g, b, y1, u1 , v1);
			*d++ = y0;
			*d++ = (u0+u1) >> 1;
			*d++ = y1;
			*d++ = (v0+v1) >> 1;
		}
		if ( width % 2 )
		{
			r = *s++;
			g = *s++;
			b = *s++;
			*alpha++ = *s++;
			RGB2YUV (r, g, b, y0, u0 , v0);
			*d++ = y0;
			*d++ = u0;
		}
	}
	return ret;
}

int mlt_convert_rgb24_to_yuv422( uint8_t *rgb, int width, int height, int stride, uint8_t *yuv )
{
	int ret = 0;
	register int y0, y1, u0, u1, v0, v1;
	register int r, g, b;
	register uint8_t *d = yuv;
	register int i, j;

	for ( i = 0; i < height; i++ )
	{
		register uint8_t *s = rgb + ( stride * i );
		for ( j = 0; j < ( width / 2 ); j++ )
		{
			r = *s++;
			g = *s++;
			b = *s++;
			RGB2YUV (r, g, b, y0, u0 , v0);
			r = *s++;
			g = *s++;
			b = *s++;
			RGB2YUV (r, g, b, y1, u1 , v1);
			*d++ = y0;
			*d++ = (u0+u1) >> 1;
			*d++ = y1;
			*d++ = (v0+v1) >> 1;
		}
		if ( width % 2 )
		{
			r = *s++;
			g = *s++;
			b = *s++;
			RGB2YUV (r, g, b, y0, u0 , v0);
			*d++ = y0;
			*d++ = u0;
		}
	}
	return ret;
}

int mlt_convert_yuv420p_to_yuv422( uint8_t *yuv420p, int width, int height, int stride, uint8_t *yuv )
{
	int ret = 0;
	register int i, j;

	int half = width >> 1;

	uint8_t *Y = yuv420p;
	uint8_t *U = Y + width * height;
	uint8_t *V = U + width * height / 4;

	register uint8_t *d = yuv;

	for ( i = 0; i < height; i++ )
	{
		register uint8_t *u = U + ( i / 2 ) * ( half );
		register uint8_t *v = V + ( i / 2 ) * ( half );

		for ( j = 0; j < half; j++ )
		{
			*d ++ = *Y ++;
			*d ++ = *u ++;
			*d ++ = *Y ++;
			*d ++ = *v ++;
		}
	}
	return ret;
}

int mlt_frame_composite_yuv( mlt_frame this, mlt_frame that, int x, int y, float weight )
{
	int ret = 0;
	int width_src, height_src;
	int width_dest, height_dest;
	mlt_image_format format_src, format_dest;
	uint8_t *p_src, *p_dest;
	int i, j;
	int stride_src;
	int stride_dest;
	int x_src = 0, y_src = 0;

	// optimization point - no work to do
	if ( ( x < 0 && -x >= width_src ) || ( y < 0 && -y >= height_src ) )
		return ret;

	format_src = mlt_image_yuv422;
	format_dest = mlt_image_yuv422;
	
	mlt_frame_get_image( this, &p_dest, &format_dest, &width_dest, &height_dest, 1 /* writable */ );
	mlt_frame_get_image( that, &p_src, &format_src, &width_src, &height_src, 0 /* writable */ );
	
	stride_src = width_src * 2;
	stride_dest = width_dest * 2;
	
	// crop overlay off the left edge of frame
	if ( x < 0 )
	{
		x_src = -x;
		width_src -= x_src;
		x = 0;
	}
	
	// crop overlay beyond right edge of frame
	else if ( x + width_src > width_dest )
		width_src = width_dest - x;

	// crop overlay off the top edge of the frame
	if ( y < 0 )
	{
		y_src = -y;
		height_src -= y_src;
	}
	// crop overlay below bottom edge of frame
	else if ( y + height_src > height_dest )
		height_src = height_dest - y;

	// offset pointer into overlay buffer based on cropping
	p_src += x_src * 2 + y_src * stride_src;

	// offset pointer into frame buffer based upon positive, even coordinates only!
//	if ( interlaced && y % 2 )
//		++y;
	p_dest += ( x < 0 ? 0 : x ) * 2 + ( y < 0 ? 0 : y ) * stride_dest;

	// Get the alpha channel of the overlay
	uint8_t *p_alpha = mlt_frame_get_alpha_mask( that );

	// offset pointer into alpha channel based upon cropping
	if ( p_alpha )
		p_alpha += x_src + y_src * stride_src / 2;

	// now do the compositing only to cropped extents
	for ( i = 0; i < height_src; i++ )
	{
		uint8_t *p = p_src;
		uint8_t *q = p_dest;
		uint8_t *o = p_dest;
		uint8_t *z = p_alpha;

		for ( j = 0; j < width_src; j ++ )
		{
				uint8_t y = *p ++;
				uint8_t uv = *p ++;
				uint8_t a = ( z == NULL ) ? 255 : *z ++;
				float value = ( weight * ( float ) a / 255.0 );
				*o ++ = (uint8_t)( y * value + *q++ * ( 1 - value ) );
				*o ++ = (uint8_t)( uv * value + *q++ * ( 1 - value ) );
		}

		p_src += stride_src;
		p_dest += stride_dest;
		if ( p_alpha )
			p_alpha += stride_src / 2;
	}

	return ret;
}

void *memfill( void *dst, void *src, int l, int elements )
{
	int i = 0;
	for ( i = 0; i < elements; i ++ )
		dst = memcpy( dst, src, l ) + l;
	return dst;
}

void mlt_resize_yuv422( uint8_t *output, int owidth, int oheight, uint8_t *input, int iwidth, int iheight )
{
	// Calculate strides
	int istride = iwidth * 2;
	int ostride = owidth * 2;

	iwidth = iwidth - ( iwidth % 4 );
	owidth = owidth - ( owidth % 4 );
	iheight = iheight - ( iheight % 2 );
	oheight = oheight - ( oheight % 2 );

   	// Coordinates (0,0 is middle of output)
   	int y;

   	// Calculate ranges
   	int out_x_range = owidth / 2;
   	int out_y_range = oheight / 2;
   	int in_x_range = iwidth / 2 < out_x_range ? iwidth / 2 : out_x_range;
   	int in_y_range = iheight / 2 < out_y_range ? iheight / 2 : out_y_range;

   	// Output pointers
   	uint8_t *out_line = output;
   	uint8_t *out_ptr = out_line;

   	// Calculate a middle and possibly invalid pointer in the input
   	uint8_t *in_middle = input + istride * ( iheight / 2 ) + ( iwidth / 2 ) * 2;
   	int in_line = - in_y_range * istride - in_x_range * 2;

	uint8_t black[ 2 ] = { 16, 128 };

   	// Loop for the entirety of our output height.
   	for ( y = - out_y_range; y < out_y_range ; y ++ )
   	{
       	// Start at the beginning of the line
       	out_ptr = out_line;

		if ( abs( y ) < iheight / 2 )
		{
			// Fill the outer part with black
			out_ptr = memfill( out_ptr, black, 2, out_x_range - in_x_range );

       		// We're in the input range for this row.
			memcpy( out_ptr, in_middle + in_line, 2 * iwidth );
			out_ptr += 2 * iwidth;

			// Fill the outer part with black
			out_ptr = memfill( out_ptr, black, 2, out_x_range - in_x_range );

       		// Move to next input line
       		in_line += istride;
		}
		else
		{
			// Fill whole line with black
			out_ptr = memfill( out_ptr, black, 2, owidth );
		}

       	// Move to next output line
       	out_line += ostride;
   	}
}

/** A resizing function for yuv422 frames - this does not rescale, but simply
	resizes. It assumes yuv422 images available on the frame so use with care.
*/

uint8_t *mlt_frame_resize_yuv422( mlt_frame this, int owidth, int oheight )
{
	// Get properties
	mlt_properties properties = mlt_frame_properties( this );

	// Get the input image, width and height
	uint8_t *input = mlt_properties_get_data( properties, "image", NULL );
	int iwidth = mlt_properties_get_int( properties, "width" );
	int iheight = mlt_properties_get_int( properties, "height" );

	// If width and height are correct, don't do anything
	if ( iwidth != owidth || iheight != oheight )
	{
		// Create the output image
		uint8_t *output = malloc( owidth * oheight * 2 );

		// Call the generic resize
		mlt_resize_yuv422( output, owidth, oheight, input, iwidth, iheight );

		// Now update the frame
		mlt_properties_set_data( properties, "image", output, owidth * oheight * 2, free, NULL );
		mlt_properties_set_int( properties, "width", owidth );
		mlt_properties_set_int( properties, "height", oheight );

		// Return the output
		return output;
	}

	// No change, return input
	return input;
}

/** A rescaling function for yuv422 frames - low quality, and provided for testing
 	only. It assumes yuv422 images available on the frame so use with care.
*/

uint8_t *mlt_frame_rescale_yuv422( mlt_frame this, int owidth, int oheight )
{
	// Get properties
	mlt_properties properties = mlt_frame_properties( this );

	// Get the input image, width and height
	uint8_t *input = mlt_properties_get_data( properties, "image", NULL );
	int iwidth = mlt_properties_get_int( properties, "width" );
	int iheight = mlt_properties_get_int( properties, "height" );

	// If width and height are correct, don't do anything
	if ( iwidth != owidth || iheight != oheight )
	{
		// Create the output image
		uint8_t *output = malloc( owidth * oheight * 2 );

		// Calculate strides
		int istride = iwidth * 2;
		int ostride = owidth * 2;

		iwidth = iwidth - ( iwidth % 4 );

    	// Coordinates (0,0 is middle of output)
    	int y, x;

		// Derived coordinates
		int dy, dx;

    	// Calculate ranges
    	int out_x_range = owidth / 2;
    	int out_y_range = oheight / 2;
    	int in_x_range = iwidth / 2;
    	int in_y_range = iheight / 2;

    	// Output pointers
    	uint8_t *out_line = output;
    	uint8_t *out_ptr;

    	// Calculate a middle pointer
    	uint8_t *in_middle = input + istride * in_y_range + in_x_range * 2;
    	uint8_t *in_line;
		uint8_t *in_ptr;

		// Generate the affine transform scaling values
		float scale_width = ( float )iwidth / ( float )owidth;
		float scale_height = ( float )iheight / ( float )oheight;

    	// Loop for the entirety of our output height.
    	for ( y = - out_y_range; y < out_y_range ; y ++ )
    	{
			// Calculate the derived y value
			dy = scale_height * y;

        	// Start at the beginning of the line
        	out_ptr = out_line;
	
        	// Pointer to the middle of the input line
        	in_line = in_middle + dy * istride;
	
        	// Loop for the entirety of our output row.
        	for ( x = - out_x_range; x < out_x_range; x += 1 )
        	{
				// Calculated the derived x
				dx = scale_width * x;

            	// Check if x and y are in the valid input range.
            	if ( abs( dx ) < in_x_range && abs( dy ) < in_y_range  )
            	{
                	// We're in the input range for this row.
					in_ptr = in_line + ( dx >> 1 ) * 4 + 2 * ( x & 1 );
                	*out_ptr ++ = *in_ptr ++;
                	*out_ptr ++ = *in_ptr ++;
            	}
            	else
            	{
                	// We're not in the input range for this row.
                	*out_ptr ++ = 16;
                	*out_ptr ++ = 128;
            	}
        	}

        	// Move to next output line
        	out_line += ostride;
    	}

		// Now update the frame
		mlt_properties_set_data( properties, "image", output, owidth * oheight * 2, free, NULL );
		mlt_properties_set_int( properties, "width", owidth );
		mlt_properties_set_int( properties, "height", oheight );

		// Return the output
		return output;
	}

	// No change, return input
	return input;
}

int mlt_frame_mix_audio( mlt_frame this, mlt_frame that, float weight, int16_t **buffer, mlt_audio_format *format, int *frequency, int *channels, int *samples )
{
	int ret = 0;
	int16_t *p_src, *p_dest;
	int frequency_src, frequency_dest;
	int channels_src, channels_dest;
	int samples_src, samples_dest;
	int i, j;

	mlt_frame_get_audio( this, &p_dest, format, &frequency_dest, &channels_dest, &samples_dest );
	mlt_frame_get_audio( that, &p_src, format, &frequency_src, &channels_src, &samples_src );

	*samples = samples_src < samples_dest ? samples_src : samples_dest;
	*channels = channels_src < channels_dest ? channels_src : channels_dest;
	*buffer = p_dest;

	for ( i = 0; i < *samples; i++ )
	{
		for ( j = 0; j < *channels; j++ )
		{
			double dest = (double) p_dest[ i * channels_dest + j ];
			double src = (double) p_src[ i * channels_src + j ];
			p_dest[ i * channels_dest + j ] = src * weight + dest * ( 1.0 - weight );
		}
	}
	
	return ret;
}

int mlt_sample_calculator( float fps, int frequency, int64_t position )
{
	int samples = 0;

	if ( fps > 29 && fps <= 30 )
	{
		samples = frequency / 30;

		switch ( frequency )
		{
			case 48000:
				if ( position % 5 != 0 )
					samples += 2;
				break;
			case 44100:
				if ( position % 300 == 0 )
					samples = 1471;
				else if ( position % 30 == 0 )
					samples = 1470;
				else if ( position % 2 == 0 )
					samples = 1472;
				else
					samples = 1471;
				break;
			case 32000:
				if ( position % 30 == 0 )
					samples = 1068;
				else if ( position % 29 == 0 )
					samples = 1067;
				else if ( position % 4 == 2 )
					samples = 1067;
				else
					samples = 1068;
				break;
			default:
				samples = 0;
		}
	}
	else if ( fps != 0 )
	{
		samples = frequency / fps;
	}

	return samples;
}