/*
  * Bayer-to-RGB/YV12 template
  * Copyright (c) 2011-2014 Peter Ross <pross@xvid.org>
  *
  * This file is part of FFmpeg.
  *
  * FFmpeg is free software; you can redistribute it and/or
  * modify it under the terms of the GNU Lesser General Public
  * License as published by the Free Software Foundation; either
  * version 2.1 of the License, or (at your option) any later version.
  *
  * FFmpeg 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
  * Lesser General Public License for more details.
  *
  * You should have received a copy of the GNU Lesser General Public
  * License along with FFmpeg; if not, write to the Free Software
  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  */
 
 #if defined(BAYER_BGGR) || defined(BAYER_GBRG)
 #define BAYER_R       0
 #define BAYER_G       1
 #define BAYER_B       2
 #endif
 #if defined(BAYER_RGGB) || defined(BAYER_GRBG)
 #define BAYER_R       2
 #define BAYER_G       1
 #define BAYER_B       0
 #endif
 
 #if defined(BAYER_8)
 #define BAYER_READ(x) (x)
 #define BAYER_SIZEOF  1
 #define BAYER_SHIFT   0
 #endif
 #if defined(BAYER_16LE)

 #define BAYER_READ(x) AV_RL16(&(x))

 #define BAYER_SIZEOF  2
 #define BAYER_SHIFT   8
 #endif
 #if defined(BAYER_16BE)

 #define BAYER_READ(x) AV_RB16(&(x))

 #define BAYER_SIZEOF  2
 #define BAYER_SHIFT   8
 #endif
 
 #define S(y, x) BAYER_READ(src[(y)*src_stride + BAYER_SIZEOF*(x)])
 #define T(y, x) (unsigned int)S(y, x)
 #define R(y, x) dst[(y)*dst_stride + (x)*3 + BAYER_R]
 #define G(y, x) dst[(y)*dst_stride + (x)*3 + BAYER_G]
 #define B(y, x) dst[(y)*dst_stride + (x)*3 + BAYER_B]
 
 #if defined(BAYER_BGGR) || defined(BAYER_RGGB)
 #define BAYER_TO_RGB24_COPY \
     R(0, 0) = \
     R(0, 1) = \
     R(1, 1) = \
     R(1, 0) = S(1, 1) >> BAYER_SHIFT; \
     \
     G(0, 1) = S(0, 1) >> BAYER_SHIFT; \
     G(0, 0) = \
     G(1, 1) = (T(0, 1) + T(1, 0)) >> (1 + BAYER_SHIFT); \
     G(1, 0) = S(1, 0) >> BAYER_SHIFT; \
     \
     B(1, 1) = \
     B(0, 0) = \
     B(0, 1) = \
     B(1, 0) = S(0, 0) >> BAYER_SHIFT;
 #define BAYER_TO_RGB24_INTERPOLATE \
     R(0, 0) = (T(-1, -1) + T(-1,  1) + T(1, -1) + T(1, 1)) >> (2 + BAYER_SHIFT); \
     G(0, 0) = (T(-1,  0) + T( 0, -1) + T(0,  1) + T(1, 0)) >> (2 + BAYER_SHIFT); \
     B(0, 0) =  S(0, 0) >> BAYER_SHIFT; \
     \
     R(0, 1) = (T(-1, 1) + T(1, 1)) >> (1 + BAYER_SHIFT); \
     G(0, 1) =  S(0,  1) >> BAYER_SHIFT; \
     B(0, 1) = (T(0,  0) + T(0, 2)) >> (1 + BAYER_SHIFT); \
     \
     R(1, 0) = (T(1, -1) + T(1, 1)) >> (1 + BAYER_SHIFT); \
     G(1, 0) =  S(1,  0) >> BAYER_SHIFT; \
     B(1, 0) = (T(0,  0) + T(2, 0)) >> (1 + BAYER_SHIFT); \
     \
     R(1, 1) =  S(1, 1) >> BAYER_SHIFT; \
     G(1, 1) = (T(0, 1) + T(1, 0) + T(1, 2) + T(2, 1)) >> (2 + BAYER_SHIFT); \
     B(1, 1) = (T(0, 0) + T(0, 2) + T(2, 0) + T(2, 2)) >> (2 + BAYER_SHIFT);
 #else
 #define BAYER_TO_RGB24_COPY \
     R(0, 0) = \
     R(0, 1) = \
     R(1, 1) = \
     R(1, 0) = S(1, 0) >> BAYER_SHIFT; \
     \
     G(0, 0) = S(0, 0) >> BAYER_SHIFT; \
     G(1, 1) = S(1, 1) >> BAYER_SHIFT; \
     G(0, 1) = \
     G(1, 0) = (T(0, 0) + T(1, 1)) >> (1 + BAYER_SHIFT); \
     \
     B(1, 1) = \
     B(0, 0) = \
     B(0, 1) = \
     B(1, 0) = S(0, 1) >> BAYER_SHIFT;
 #define BAYER_TO_RGB24_INTERPOLATE \
     R(0, 0) = (T(-1, 0) + T(1, 0)) >> (1 + BAYER_SHIFT); \
     G(0, 0) =  S(0, 0) >> BAYER_SHIFT; \
     B(0, 0) = (T(0, -1) + T(0, 1)) >> (1 + BAYER_SHIFT); \
     \
     R(0, 1) = (T(-1, 0) + T(-1, 2) + T(1, 0) + T(1, 2)) >> (2 + BAYER_SHIFT); \
     G(0, 1) = (T(-1, 1) + T(0,  0) + T(0, 2) + T(1, 1)) >> (2 + BAYER_SHIFT); \
     B(0, 1) =  S(0, 1) >> BAYER_SHIFT; \
     \
     R(1, 0) =  S(1, 0) >> BAYER_SHIFT; \
     G(1, 0) = (T(0, 0)  + T(1, -1) + T(1,  1) + T(2, 0)) >> (2 + BAYER_SHIFT); \
     B(1, 0) = (T(0, -1) + T(0,  1) + T(2, -1) + T(2, 1)) >> (2 + BAYER_SHIFT); \
     \
     R(1, 1) = (T(1, 0) + T(1, 2)) >> (1 + BAYER_SHIFT); \
     G(1, 1) =  S(1, 1) >> BAYER_SHIFT; \
     B(1, 1) = (T(0, 1) + T(2, 1)) >> (1 + BAYER_SHIFT);
 #endif
 
 /**
  * invoke ff_rgb24toyv12 for 2x2 pixels
  */
 #define rgb24toyv12_2x2(src, dstY, dstU, dstV, luma_stride, src_stride, rgb2yuv) \
     ff_rgb24toyv12(src, dstY, dstV, dstU, 2, 2, luma_stride, 0, src_stride, rgb2yuv)
 
 static void BAYER_RENAME(rgb24_copy)(const uint8_t *src, int src_stride, uint8_t *dst, int dst_stride, int width)
 {
     int i;
     for (i = 0 ; i < width; i+= 2) {
         BAYER_TO_RGB24_COPY
         src += 2 * BAYER_SIZEOF;
         dst += 6;
     }
 }
 
 static void BAYER_RENAME(rgb24_interpolate)(const uint8_t *src, int src_stride, uint8_t *dst, int dst_stride, int width)
 {
     int i;
 
     BAYER_TO_RGB24_COPY
     src += 2 * BAYER_SIZEOF;
     dst += 6;
 
     for (i = 2 ; i < width - 2; i+= 2) {
         BAYER_TO_RGB24_INTERPOLATE
         src += 2 * BAYER_SIZEOF;
         dst += 6;
     }
 
     if (width > 2) {
         BAYER_TO_RGB24_COPY
     }
 }
 
 static void BAYER_RENAME(yv12_copy)(const uint8_t *src, int src_stride, uint8_t *dstY, uint8_t *dstU, uint8_t *dstV, int luma_stride, int width, int32_t *rgb2yuv)
 {
     uint8_t dst[12];
     const int dst_stride = 6;
     int i;
     for (i = 0 ; i < width; i+= 2) {
         BAYER_TO_RGB24_COPY
         rgb24toyv12_2x2(dst, dstY, dstU, dstV, luma_stride, dst_stride, rgb2yuv);
         src  += 2 * BAYER_SIZEOF;
         dstY += 2;
         dstU++;
         dstV++;
     }
 }
 
 static void BAYER_RENAME(yv12_interpolate)(const uint8_t *src, int src_stride, uint8_t *dstY, uint8_t *dstU, uint8_t *dstV, int luma_stride, int width, int32_t *rgb2yuv)
 {
     uint8_t dst[12];
     const int dst_stride = 6;
     int i;
 
     BAYER_TO_RGB24_COPY
     rgb24toyv12_2x2(dst, dstY, dstU, dstV, luma_stride, dst_stride, rgb2yuv);
     src  += 2 * BAYER_SIZEOF;
     dstY += 2;
     dstU++;
     dstV++;
 
     for (i = 2 ; i < width - 2; i+= 2) {
         BAYER_TO_RGB24_INTERPOLATE
         rgb24toyv12_2x2(dst, dstY, dstU, dstV, luma_stride, dst_stride, rgb2yuv);
         src  += 2 * BAYER_SIZEOF;
         dstY += 2;
         dstU++;
         dstV++;
     }
 
     if (width > 2) {
         BAYER_TO_RGB24_COPY
         rgb24toyv12_2x2(dst, dstY, dstU, dstV, luma_stride, dst_stride, rgb2yuv);
     }
 }
 
 #undef S
 #undef T
 #undef R
 #undef G
 #undef B
 #undef BAYER_TO_RGB24_COPY
 #undef BAYER_TO_RGB24_INTERPOLATE
 
 #undef BAYER_RENAME
 
 #undef BAYER_R
 #undef BAYER_G
 #undef BAYER_B
 #undef BAYER_READ
 #undef BAYER_SIZEOF
 #undef BAYER_SHIFT
 
 #if defined(BAYER_BGGR)
 #undef BAYER_BGGR
 #endif
 #if defined(BAYER_RGGB)
 #undef BAYER_RGGB
 #endif
 #if defined(BAYER_GBRG)
 #undef BAYER_GBRG
 #endif
 #if defined(BAYER_GRBG)
 #undef BAYER_GRBG
 #endif
 #if defined(BAYER_8)
 #undef BAYER_8
 #endif
 #if defined(BAYER_16LE)
 #undef BAYER_16LE
 #endif
 #if defined(BAYER_16BE)
 #undef BAYER_16BE
 #endif