/* ----------------------------------------------------------------------------
 *         SAM Software Package License 
 * ----------------------------------------------------------------------------
 * Copyright (c) 2013, Atmel Corporation
 *
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *
 * - Redistributions of source code must retain the above copyright notice,
 * this list of conditions and the disclaimer below.
 *
 * Atmel's name may not be used to endorse or promote products derived from
 * this software without specific prior written permission.
 *
 * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
 * DISCLAIMED. IN NO EVENT SHALL ATMEL 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 uint32_tERRUPTION) 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.
 * ----------------------------------------------------------------------------
 */


/*----------------------------------------------------------------------------
 *        Headers
 *----------------------------------------------------------------------------*/

#include "chip.h"

//-----------------------------------------------------------------------------
/// Conversion YCrCb to RGB:<BR>
/// R = 1.164(Yi ?16) + 1.596(Cr ?128)<BR>
/// G = 1.164(Yi ?16) ?0.813(Cr ?128) ?0.391(Cb ?128)<BR>
/// B = 1.164(Yi ?16) + 2.018(Cb ?128)<BR>
///
/// Pixel i+1:<BR>
/// YCrCb to RGB:<BR>
/// R = 1.164(Yi+1 ?16) + 1.596(Cr ?128)<BR>
/// G = 1.164(Yi+1 ?16) ?0.813(Cr ?128) ?0.391(Cb ?128)<BR>
/// B = 1.164(Yi+1 ?16) + 2.018(Cb ?128)
/// \param ycc Source buffer (YCC)
/// \param rgb Destination buffer (RGB)
/// \param len Length of buffer
//-----------------------------------------------------------------------------
void VIDEO_Ycc2Rgb(uint8_t *ycc, uint16_t *rgb, uint32_t len)
{
    int32_t r_calc_i;
    int32_t g_calc_i;
    int32_t b_calc_i;
    int32_t r_calc_i_incr;
    int32_t g_calc_i_incr;
    int32_t b_calc_i_incr;
    int32_t cr_i;
    int32_t y_i;
    int32_t cb_i;
    int32_t y_i_incr;
    int32_t val;
    int32_t val1;
    int32_t val2;
    int32_t val3;
    int32_t val4;
    int32_t val5;
    uint32_t i;

    for(i = 0; i < len; i++)
    {
#if 1
        cb_i = (int32_t)ycc[4*i];
        y_i  = (int32_t )ycc[4*i+1];
        cr_i = (int32_t )ycc[4*i+2];
        y_i_incr =(int32_t )ycc[4*i+3];
#endif
        val  = 1164*(y_i-16);
        val1 = 1164*(y_i_incr-16);
        val2 = 1596*(cr_i- 128);
        val3 =  813*(cb_i-128);
        val4 =  392*(cr_i-128);
        val5 = 2017*(cb_i-128);

        r_calc_i = (val + val2)/1000;
        g_calc_i = (val - val3 - val4)/1000;
        b_calc_i = (val + val5)/1000;
        r_calc_i_incr = (val1 + val2)/1000;
        g_calc_i_incr = (val1 - val3 - val4)/1000;
        b_calc_i_incr = (val1 + val5)/1000;

        if (r_calc_i < 0)
            r_calc_i = 0;
        else if (r_calc_i > 255)
            r_calc_i = 255;

        if (g_calc_i < 0)
            g_calc_i = 0;
        else if (g_calc_i > 255)
            g_calc_i = 255;

        if (b_calc_i < 0)
            b_calc_i = 0;
        else if (b_calc_i > 255)
            b_calc_i = 255;

        if (r_calc_i_incr < 0)
            r_calc_i_incr = 0;
        else if (r_calc_i_incr > 255)
            r_calc_i_incr = 255;

        if (g_calc_i_incr < 0)
            g_calc_i_incr = 0;
        else if (g_calc_i_incr > 255)
            g_calc_i_incr = 255;

        if (b_calc_i_incr < 0)
            b_calc_i_incr = 0;
        else if (b_calc_i_incr > 255)
            b_calc_i_incr = 255;
        //R1[4:0] G1[5:0] B1[4:0] R0[4:0] G0[5:0] B0[4:0]
        *rgb++ = (((uint16_t )b_calc_i & 0xF8) >> 3)
               | ((((uint16_t)g_calc_i & 0xFC) >> 2) << 5)
               | ((((uint16_t)r_calc_i & 0xF8) >> 3) << 11);

        *rgb++ = (((uint16_t )b_calc_i_incr & 0xF8) >> 3)
               | ((((uint16_t)g_calc_i_incr & 0xFC) >> 2) << 5)
               | ((((uint16_t)r_calc_i_incr & 0xF8) >> 3) << 11);
    }
}