cscframe.c

SAMSUNG S3C6410 CPU BSP for winmobile6

#include <stdio.h>
#include <string.h>
//#include <math.h>



long int crv_tab[256];
long int cbu_tab[256];
long int cgu_tab[256];
long int cgv_tab[256];
long int tab_76309[256];
unsigned char clp[1024];

extern void _initConvTab();

#define CRGBY	65535
#define CRV		90111
#define CBU		114686
#define CGU		21504
#define CGV		45055

/*
 R = Y + (                + 90111*(V-128) ) >> 16
 G = Y - (  21504*(U-128) + 45055*(V-128) ) >> 16
 B = Y + ( 114686*(U-128)                 ) >> 16
*/

void _initConvTab()
{
	static int finitTab = 0;

	long int crv, cbu, cgu, cgv;
	int i, ind;

	if (finitTab != 0)
		return;


	crv = CRV; cbu = CBU;
	cgu = CGU; cgv = CGV;

	for (i = 0; i < 256; i++) {
		crv_tab[i] = (i-128) * crv;
		cbu_tab[i] = (i-128) * cbu;
		cgu_tab[i] = (i-128) * cgu;
		cgv_tab[i] = (i-128) * cgv;
		tab_76309[i] = CRGBY * i;
	}

	for (i=0; i<384; i++)
		clp[i] =0;
	ind=384;
	for (i=0;i<256; i++)
		clp[ind++]=i;
	ind=640;
	for (i=0;i<384;i++)
		clp[ind++]=255;

	finitTab = 1;
}

void _yuv420ToRgb565(unsigned char *p_lum, unsigned char *p_cb, unsigned char *p_cr, int w_src, int h_src,
                     unsigned char *dest,  int w_dst, int h_dst,
					int topdown)
{
	int i, j;
	int y1, y2, u, v;
	unsigned char *py1, *py2, *pu, *pv;
	int c1, c2, c3, c4;
	unsigned short *d1, *d2;
	unsigned short *ptrarr[640];

	unsigned char r, g, b;

	// s_dw, s_dh: 家胶 捞固瘤俊辑 skip且 width客 height剧
	// d_dw, d_dh: 搬苞 捞固瘤俊辑 skip且 width客 height剧
	// 家胶 捞固瘤狼 width啊 搬苞 捞固瘤狼 width焊促 奴 版快, width clipping捞 鞘夸窍促.
	// 捞 锭, skip阑 烹秦辑 clipping阑 茄促. s_dw=(w_src-w_dst)捞 登绊, d_dw=0捞 等促.
	int s_dw, s_dh, d_dw, d_dh;

	// yuv-to-rgb甫 荐青窍绰 角力 width客 height.
	int width, height;

	width =  ((w_src < w_dst) ? w_src : w_dst);
	height = ((h_src < h_dst) ? h_src : h_dst);

	if (w_src > w_dst) {
		s_dw = w_src - w_dst;
		d_dw = 0;
	}
	else {
		s_dw = 0;
		d_dw = w_dst - w_src;
	}
	if (h_src > h_dst) {
		s_dh = h_src - h_dst;
		d_dh = 0;
	}
	else {
		s_dh = 0;
		d_dh = h_dst - h_src;
	}

	//Initialization
	py1 = p_lum;
	py2 = py1 + w_src;
	pu  = p_cb;
	pv  = p_cr;

	switch (topdown) {
	case 0:	// Top -> Down
		ptrarr[0] = (unsigned short *) dest;
		for (j = 1; j < height; j++) {
			ptrarr[j] = ptrarr[j-1] + w_dst;
		}
		break;

	default: // Down -> Top
		ptrarr[0] = ((unsigned short *) dest) + (w_dst * (h_dst-1));		// 谅惑窜
		for (j = 1; j < height; j++) {
			ptrarr[j] = ptrarr[j-1] - w_dst;
		}
		break;
	}

	for (j = 0; j < height; j += 2) {

		d1 = ptrarr[j];
		d2 = ptrarr[j + 1];

		for (i = 0; i < width; i += 2) {

			u = *pu++;
			v = *pv++;

			c1 = crv_tab[v];
			c2 = cgu_tab[u];
			c3 = cgv_tab[v];
			c4 = cbu_tab[u];

			//up-left
			y1 = tab_76309[*py1++];
			r = clp[384+((y1 + c1)>>16)];		// R
			g = clp[384+((y1 - c2 - c3)>>16)];	// G
			b = clp[384+((y1 + c4)>>16)];		// B
			*d1++ = ((r & 0xF8) << 8) | ((g & 0xFC) << 3) | (b >> 3);

			//up-right
			y1 = tab_76309[*py1++];
			r = clp[384+((y1 + c1)>>16)];		// R
			g = clp[384+((y1 - c2 - c3)>>16)];	// G
			b = clp[384+((y1 + c4)>>16)];		// B
			*d1++ = ((r & 0xF8) << 8) | ((g & 0xFC) << 3) | (b >> 3);

			//down-left
			y2 = tab_76309[*py2++];
			r = clp[384+((y2 + c1)>>16)];		// R
			g = clp[384+((y2 - c2 - c3)>>16)];	// G
			b = clp[384+((y2 + c4)>>16)];		// B
			*d2++ = ((r & 0xF8) << 8) | ((g & 0xFC) << 3) | (b >> 3);

			//down-right
			y2 = tab_76309[*py2++];
			r = clp[384+((y2 + c1)>>16)];		// R
			g = clp[384+((y2 - c2 - c3)>>16)];	// G
			b = clp[384+((y2 + c4)>>16)];		// B
			*d2++ = ((r & 0xF8) << 8) | ((g & 0xFC) << 3) | (b >> 3);
		}
		py1 += (w_src + s_dw);
		py2 += (w_src + s_dw);
		pu  += (s_dw>>1);
		pv  += (s_dw>>1);
	}

}