bgr24转yuv420提取自ffmpeg代码,不依赖ffmpeg

#include "color_bgr_yuv420.h" #define RY_IDX 0 #define GY_IDX 1 #define BY_IDX 2 #define RU_IDX 3 #define GU_IDX 4 #define BU_IDX 5 #define RV_IDX 6 #define GV_IDX 7 #define BV_IDX 8 #define RGB2YUV_SHIFT 15 #if 0 //以下内容为table数据计算方法,为了运行效率，先利用此方法生成table即可 #define ROUNDED_DIV(a,b) (((a)>0 ? (a) + ((b)>>1) : (a) - ((b)>>1))/(b)) static int ff_yuv2rgb_coeffs[8][4] = { { 117504, 138453, 13954, 34903 }, /* no sequence_display_extension */ { 117504, 138453, 13954, 34903 }, /* ITU-R Rec. 709 (1990) */ { 104597, 132201, 25675, 53279 }, /* unspecified */ { 104597, 132201, 25675, 53279 }, /* reserved */ { 104448, 132798, 24759, 53109 }, /* FCC */ { 104597, 132201, 25675, 53279 }, /* ITU-R Rec. 624-4 System B, G */ { 104597, 132201, 25675, 53279 }, /* SMPTE 170M */ { 117579, 136230, 16907, 35559 } /* SMPTE 240M (1987) */ }; #define SWS_CS_DEFAULT 5 #define AV_WL16(p, darg) do { \ unsigned d = (darg); \ ((unsigned char*)(p))[0] = (d); \ ((unsigned char*)(p))[1] = (d)>>8; \ } while(0) /** *利用此函数生成的table数组 **/ static void fill_rgb2yuv_table(int *input_rgb2yuv_table) { int W, V, Z, Cy, Cu, Cv; int *table = ff_yuv2rgb_coeffs[SWS_CS_DEFAULT]; int vr = table[0]; int ub = table[1]; int ug = -table[2]; int vg = -table[3]; int ONE = 65536; int cy = ONE; unsigned char *p = (unsigned char*)input_rgb2yuv_table; int i; static const char map[] = { BY_IDX, GY_IDX, -1 , BY_IDX, BY_IDX, GY_IDX, -1 , BY_IDX, RY_IDX, -1 , GY_IDX, RY_IDX, RY_IDX, -1 , GY_IDX, RY_IDX, RY_IDX, GY_IDX, -1 , RY_IDX, RY_IDX, GY_IDX, -1 , RY_IDX, BY_IDX, -1 , GY_IDX, BY_IDX, BY_IDX, -1 , GY_IDX, BY_IDX, BU_IDX, GU_IDX, -1 , BU_IDX, BU_IDX, GU_IDX, -1 , BU_IDX, RU_IDX, -1 , GU_IDX, RU_IDX, RU_IDX, -1 , GU_IDX, RU_IDX, RU_IDX, GU_IDX, -1 , RU_IDX, RU_IDX, GU_IDX, -1 , RU_IDX, BU_IDX, -1 , GU_IDX, BU_IDX, BU_IDX, -1 , GU_IDX, BU_IDX, BV_IDX, GV_IDX, -1 , BV_IDX, BV_IDX, GV_IDX, -1 , BV_IDX, RV_IDX, -1 , GV_IDX, RV_IDX, RV_IDX, -1 , GV_IDX, RV_IDX, RV_IDX, GV_IDX, -1 , RV_IDX, RV_IDX, GV_IDX, -1 , RV_IDX, BV_IDX, -1 , GV_IDX, BV_IDX, BV_IDX, -1 , GV_IDX, BV_IDX, RY_IDX, BY_IDX, RY_IDX, BY_IDX, RY_IDX, BY_IDX, RY_IDX, BY_IDX, BY_IDX, RY_IDX, BY_IDX, RY_IDX, BY_IDX, RY_IDX, BY_IDX, RY_IDX, GY_IDX, -1 , GY_IDX, -1 , GY_IDX, -1 , GY_IDX, -1 , -1 , GY_IDX, -1 , GY_IDX, -1 , GY_IDX, -1 , GY_IDX, RU_IDX, BU_IDX, RU_IDX, BU_IDX, RU_IDX, BU_IDX, RU_IDX, BU_IDX, BU_IDX, RU_IDX, BU_IDX, RU_IDX, BU_IDX, RU_IDX, BU_IDX, RU_IDX, GU_IDX, -1 , GU_IDX, -1 , GU_IDX, -1 , GU_IDX, -1 , -1 , GU_IDX, -1 , GU_IDX, -1 , GU_IDX, -1 , GU_IDX, RV_IDX, BV_IDX, RV_IDX, BV_IDX, RV_IDX, BV_IDX, RV_IDX, BV_IDX, BV_IDX, RV_IDX, BV_IDX, RV_IDX, BV_IDX, RV_IDX, BV_IDX, RV_IDX, GV_IDX, -1 , GV_IDX, -1 , GV_IDX, -1 , GV_IDX, -1 , -1 , GV_IDX, -1 , GV_IDX, -1 , GV_IDX, -1 , GV_IDX, //23 -1 , -1 , -1 , -1 , -1 , -1 , -1 , -1 , //24 -1 , -1 , -1 , -1 , -1 , -1 , -1 , -1 , //25 -1 , -1 , -1 , -1 , -1 , -1 , -1 , -1 , //26 -1 , -1 , -1 , -1 , -1 , -1 , -1 , -1 , //27 -1 , -1 , -1 , -1 , -1 , -1 , -1 , -1 , //28 -1 , -1 , -1 , -1 , -1 , -1 , -1 , -1 , //29 -1 , -1 , -1 , -1 , -1 , -1 , -1 , -1 , //30 -1 , -1 , -1 , -1 , -1 , -1 , -1 , -1 , //31 BY_IDX, GY_IDX, RY_IDX, -1 , -1 , -1 , -1 , -1 , //32 BU_IDX, GU_IDX, RU_IDX, -1 , -1 , -1 , -1 , -1 , //33 BV_IDX, GV_IDX, RV_IDX, -1 , -1 , -1 , -1 , -1 , //34 }; int mapsize = sizeof(map)/sizeof(map[0]); cy = cy * 255 / 219; W = ROUNDED_DIV(ONE*ONE*ug, ub); V = ROUNDED_DIV(ONE*ONE*vg, vr); Z = ONE*ONE-W-V; Cy = ROUNDED_DIV(cy*Z, ONE); Cu = ROUNDED_DIV(ub*Z, ONE); Cv = ROUNDED_DIV(vr*Z, ONE); input_rgb2yuv_table[RY_IDX] = -ROUNDED_DIV((1 << RGB2YUV_SHIFT)*V , Cy); input_rgb2yuv_table[GY_IDX] = ROUNDED_DIV((1 << RGB2YUV_SHIFT)*ONE*ONE , Cy); input_rgb2yuv_table[BY_IDX] = -ROUNDED_DIV((1 << RGB2YUV_SHIFT)*W , Cy); input_rgb2yuv_table[RU_IDX] = ROUNDED_DIV((1 << RGB2YUV_SHIFT)*V , Cu); input_rgb2yuv_table[GU_IDX] = -ROUNDED_DIV((1 << RGB2YUV_SHIFT)*ONE*ONE , Cu); input_rgb2yuv_table[BU_IDX] = ROUNDED_DIV((1 << RGB2YUV_SHIFT)*(Z+W) , Cu); input_rgb2yuv_table[RV_IDX] = ROUNDED_DIV((1 << RGB2YUV_SHIFT)*(V+Z) , Cv); input_rgb2yuv_table[GV_IDX] = -ROUNDED_DIV((1 << RGB2YUV_SHIFT)*ONE*ONE , Cv); input_rgb2yuv_table[BV_IDX] = ROUNDED_DIV((1 << RGB2YUV_SHIFT)*W , Cv); { input_rgb2yuv_table[BY_IDX] = ((int)(0.114 * 219 / 255 * (1 << RGB2YUV_SHIFT) + 0.5)); input_rgb2yuv_table[BV_IDX] = (-(int)(0.081 * 224 / 255 * (1 << RGB2YUV_SHIFT) + 0.5)); input_rgb2yuv_table[BU_IDX] = ((int)(0.500 * 224 / 255 * (1 << RGB2YUV_SHIFT) + 0.5)); input_rgb2yuv_table[GY_IDX] = ((int)(0.587 * 219 / 255 * (1 << RGB2YUV_SHIFT) + 0.5)); input_rgb2yuv_table[GV_IDX] = (-(int)(0.419 * 224 / 255 * (1 << RGB2YUV_SHIFT) + 0.5)); input_rgb2yuv_table[GU_IDX] = (-(int)(0.331 * 224 / 255 * (1 << RGB2YUV_SHIFT) + 0.5)); input_rgb2yuv_table[RY_IDX] = ((int)(0.299 * 219 / 255 * (1 << RGB2YUV_SHIFT) + 0.5)); input_rgb2yuv_table[RV_IDX] = ((int)(0.500 * 224 / 255 * (1 << RGB2YUV_SHIFT) + 0.5)); input_rgb2yuv_table[RU_IDX] = (-(int)(0.169 * 224 / 255 * (1 << RGB2YUV_SHIFT) + 0.5)); } for(i=0; i<mapsize; i++){ AV_WL16(p + 16*4 + 2*i, map[i] >= 0 ? input_rgb2yuv_table[map[i]] : 0); } return; } #endif static void ff_rgb24toyv12_c( unsigned char *src, unsigned char *ydst, unsigned char *udst, unsigned char *vdst, int width, int height, int lumStride, int chromStride, int srcStride, const int rgb2yuv[]) { int ry = rgb2yuv[RY_IDX], gy = rgb2yuv[GY_IDX], by = rgb2yuv[BY_IDX]; int ru = rgb2yuv[RU_IDX], gu = rgb2yuv[GU_IDX], bu = rgb2yuv[BU_IDX]; int rv = rgb2yuv[RV_IDX], gv = rgb2yuv[GV_IDX], bv = rgb2yuv[BV_IDX]; int y; const int chromWidth = width >> 1; for (y = 0; y < height; y += 2) { int i; for (i = 0; i < chromWidth; i++) { unsigned int b = src[6 * i + 0]; unsigned int g = src[6 * i + 1]; unsigned int r = src[6 * i + 2]; unsigned int Y = ((ry * r + gy * g + by * b) >> RGB2YUV_SHIFT) + 16; unsigned int V = ((rv * r + gv * g + bv * b) >> RGB2YUV_SHIFT) + 128; unsigned int U = ((ru * r + gu * g + bu * b) >> RGB2YUV_SHIFT) + 128; udst[i] = U; vdst[i] = V; ydst[2 * i] = Y; b = src[6 * i + 3]; g = src[6 * i + 4]; r = src[6 * i + 5]; Y = ((ry * r + gy * g + by * b) >> RGB2YUV_SHIFT) + 16; ydst[2 * i + 1] = Y; } ydst += lumStride; src += srcStride; if (y+1 == height) break; for (i = 0; i < chromWidth; i++) { unsigned int b = src[6 * i + 0]; unsigned int g = src[6 * i + 1]; unsigned int r = src[6 * i + 2]; unsigned int Y = ((ry * r + gy * g + by * b) >> RGB2YUV_SHIFT) + 16; ydst[2 * i] = Y; b = src[6 * i + 3]; g = src[6 * i + 4]; r = src[6 * i + 5]; Y = ((ry * r +