237 lines
		
	
	
		
			6.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			237 lines
		
	
	
		
			6.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * 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
 |