/*

 * LIBOIL - Library of Optimized Inner Loops

 * Copyright (c) 2003,2004 David A. Schleef <ds@schleef.org>

 * All rights reserved.

 *

 * Redistribution and use in source and binary forms, with or without

 * modification, are permitted provided that the following conditions

 * are met:

 * 1. Redistributions of source code must retain the above copyright

 *    notice, this list of conditions and the following disclaimer.

 * 2. Redistributions in binary form must reproduce the above copyright

 *    notice, this list of conditions and the following disclaimer in the

 *    documentation and/or other materials provided with the distribution.

 * 

 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR

 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED

 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE

 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,

 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES

 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR

 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)

 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,

 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING

 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE

 * POSSIBILITY OF SUCH DAMAGE.

 */

//Portions Copyright (c)  2008-2009 Nokia Corporation and/or its subsidiary(-ies). All rights reserved. 

#ifdef HAVE_CONFIG_H

#include "config.h"

#endif

#include "liboil/liboil.h"

#include "liboilfunction.h"

#include "liboil/liboilcolorspace.h"

#include "liboil/liboiltest.h"

#include <string.h>

/**

 * oil_ayuv2argb_u8:

 * @d_4xn:

 * @s_4xn:

 * @n:

 *

 * Converts AYUV pixels to ARGB pixels.  AYUV pixels are in the

 * JPEG colorspace.  Note that this function doesn't follow normal

 * liboil pixel conventions.

 *

 * (This function should be replaced by one that handles other

 * conversion factors.)

 */

OIL_DEFINE_CLASS (ayuv2argb_u8, "uint8_t *d_4xn, uint8_t *s_4xn, int n");

#define clamp(x,a,b) clamp_lower(clamp_upper(x,b),a)

#define clamp_lower(x,a) ((x<a)?(a):(x))

#define clamp_upper(x,b) ((x>b)?(b):(x))

/* from the JFIF spec */

#define YUV_TO_R(y,u,v) clamp((y) + 1.402*((v)-128.0),0,255)

#define YUV_TO_G(y,u,v) clamp((y) - 0.34414*((u)-128.0) - 0.71414*((v)-128.0),0,255)

#define YUV_TO_B(y,u,v) clamp((y) + 1.772*((u)-128.0),0,255)

#define muldiv256(x,y) (((x)*(y) + 128)>>8)

#define YUV_TO_R_INT8(y,u,v) clamp((y) + muldiv256(359,(v)-128),0,255)

#define YUV_TO_G_INT8(y,u,v) clamp((y) + muldiv256(-88,(u)-128) + muldiv256(-183,(v)-128),0,255)

#define YUV_TO_B_INT8(y,u,v) clamp((y) + muldiv256(454,(u)-128),0,255)

#define muldiv65536(x,y) (((x)*(y) + 32768)>>16)

#define YUV_TO_R_INT16(y,u,v) clamp((y) + muldiv65536(91881,(v)-128),0,255)

#define YUV_TO_G_INT16(y,u,v) clamp((y) - muldiv65536(22554,(u)-128) - muldiv65536(46802,(v)-128),0,255)

#define YUV_TO_B_INT16(y,u,v) clamp((y) + muldiv65536(116130,(u)-128),0,255)

#define SHIFT 6

#define MULT (1<<6)

#define X(x) ((int)((x)*(1<<(SHIFT+8)) + 0.5))

static int16_t jfif_matrix[][4] = {

  { 0,      0,      -8192,   -8192  },

  { 16384,  0,      0,       0      },

  { 0,      16384,  16384,   16384  },

  { 0,      0,      -5638,   29032  },

  { 0,      22970,  -11700,  0      },

  { 0, 0, 0, 0 }

};

static void

colorspace_argb_test (OilTest *test)

{

  int16_t *data = oil_test_get_source_data (test, OIL_ARG_SRC2);

  memcpy (data, jfif_matrix, 4*2*6);

}

OIL_DEFINE_CLASS_FULL (colorspace_argb, "uint32_t *d, uint32_t *s, int16_t *s2_24, int n", colorspace_argb_test);

static void

colorspace_argb_ref (uint32_t *dest, const uint32_t *src, const int16_t *matrix, int n)

{

  int i;

  for(i=0;i<n;i++){

    int sa = (oil_argb_A(src[i])<<SHIFT) + matrix[0*4+0];

    int sr = (oil_argb_R(src[i])<<SHIFT) + matrix[0*4+1];

    int sg = (oil_argb_G(src[i])<<SHIFT) + matrix[0*4+2];

    int sb = (oil_argb_B(src[i])<<SHIFT) + matrix[0*4+3];

    int da, dr, dg, db;

#define MUL(a,b) (((a)*(b))>>16)

    da = (MUL(sa,matrix[1*4+0]) + MUL(sr,matrix[2*4+0]) + MUL(sg,matrix[3*4+0]) +

        MUL(sb,matrix[4*4+0]) + matrix[5*4+0] + 8)>>(2*SHIFT - 8);

    dr = (MUL(sa,matrix[1*4+1]) + MUL(sr,matrix[2*4+1]) + MUL(sg,matrix[3*4+1]) +

        MUL(sb,matrix[4*4+1]) + matrix[5*4+1] + 8)>>(2*SHIFT - 8);

    dg = (MUL(sa,matrix[1*4+2]) + MUL(sr,matrix[2*4+2]) + MUL(sg,matrix[3*4+2]) +

        MUL(sb,matrix[4*4+2]) + matrix[5*4+2] + 8)>>(2*SHIFT - 8);

    db = (MUL(sa,matrix[1*4+3]) + MUL(sr,matrix[2*4+3]) + MUL(sg,matrix[3*4+3]) +

        MUL(sb,matrix[4*4+3]) + matrix[5*4+3] + 8)>>(2*SHIFT - 8);

    dest[i] = oil_argb(da, dr, dg, db);

  }

}

OIL_DEFINE_IMPL_REF (colorspace_argb_ref, colorspace_argb);

static void

ayuv2argb_u8_ref (uint8_t *argb, const uint8_t *ayuv, int n)

{

  int i;

  for(i=0;i<n;i++){

    argb[0] = ayuv[0];

    argb[1] = YUV_TO_R_INT8(ayuv[1], ayuv[2], ayuv[3]);

    argb[2] = YUV_TO_G_INT8(ayuv[1], ayuv[2], ayuv[3]);

    argb[3] = YUV_TO_B_INT8(ayuv[1], ayuv[2], ayuv[3]);

    argb+=4;

    ayuv+=4;

  }

}

OIL_DEFINE_IMPL_REF (ayuv2argb_u8_ref, ayuv2argb_u8);

#ifdef	__SYMBIAN32__

OilFunctionClass* __oil_function_class_ayuv2argb_u8() {

		return &_oil_function_class_ayuv2argb_u8;

}

#endif

#ifdef	__SYMBIAN32__

OilFunctionClass* __oil_function_class_colorspace_argb() {

		return &_oil_function_class_colorspace_argb;

}

#endif

#ifdef	__SYMBIAN32__

OilFunctionImpl* __oil_function_impl_colorspace_argb_ref() {

		return &_oil_function_impl_colorspace_argb_ref;

}

#endif

#ifdef	__SYMBIAN32__

OilFunctionImpl* __oil_function_impl_ayuv2argb_u8_ref() {

		return &_oil_function_impl_ayuv2argb_u8_ref;

}

#endif

#ifdef	__SYMBIAN32__

EXPORT_C void** _oil_function_class_ptr_ayuv2argb_u8 ()	{

	oil_function_class_ptr_ayuv2argb_u8 = __oil_function_class_ayuv2argb_u8();

	return &oil_function_class_ptr_ayuv2argb_u8->func;

	}

#endif

#ifdef	__SYMBIAN32__

EXPORT_C void** _oil_function_class_ptr_colorspace_argb ()	{

	oil_function_class_ptr_colorspace_argb = __oil_function_class_colorspace_argb();

	return &oil_function_class_ptr_colorspace_argb->func;

	}

#endif