s3c6410_tv_scaler.c

SAMSUNG S3C6410 CPU BSP for winmobile6

	default:
		TVSC_ERR((_T("[TVSC:ERR] TVSC_set_mode() : Unknown Source Type %d)\n\r"), SrcType));
		error = TVSC_ERROR_ILLEGAL_PARAMETER;
		break;
	}

	switch(DstType)
	{
	case TVSC_DST_RGB16:
		g_pTVSCReg->MODE |= OUTFMT_RGB | OUTRGB_RGB565;
		break;
	case TVSC_DST_RGB24:
		g_pTVSCReg->MODE |= OUTFMT_RGB | OUTRGB_RGB24;
		break;
	case TVSC_DST_YUV420:
		g_pTVSCReg->MODE |= OUTFMT_YUV | OUTYUV_YUV420;
		break;
	case TVSC_DST_YUV422_YCBYCR:
		g_pTVSCReg->MODE |= OUTFMT_YUV | OUTYUV_YUV422 | OUTYUV_YCBYCR;
		break;
	case TVSC_DST_YUV422_CBYCRY:
		g_pTVSCReg->MODE |= OUTFMT_YUV | OUTYUV_YUV422 | OUTYUV_CBYCRY;
		break;
	case TVSC_DST_YUV422_YCRYCB:
		g_pTVSCReg->MODE |= OUTFMT_YUV | OUTYUV_YUV422 | OUTYUV_YCRYCB;
		break;
	case TVSC_DST_YUV422_CRYCBY:
		g_pTVSCReg->MODE |= OUTFMT_YUV | OUTYUV_YUV422 | OUTYUV_CRYCBY;
		break;
	case TVSC_DST_FIFO_YUV444:
		g_pTVSCReg->MODE |= OUTFMT_YUV | FIFO_OUT_ENABLE;
		break;
	case TVSC_DST_FIFO_RGB888:
		g_pTVSCReg->MODE |= OUTFMT_RGB | FIFO_OUT_ENABLE;
		break;
	default:
		TVSC_ERR((_T("[TVSC:ERR] TVSC_set_mode() : Unknown Destination Type %d)\n\r"), DstType));
		error = TVSC_ERROR_ILLEGAL_PARAMETER;
		break;
	}

	TVSC_MSG((_T("[TVSC]--TVSC_set_mode() : %d\n\r"), error));

	return error;
}

static TVSC_ERROR TVSC_set_source_size(unsigned int BaseWidth, unsigned int BaseHeight, unsigned int Width, unsigned int Height, unsigned int OffsetX, unsigned int OffsetY)
{
	TVSC_ERROR error = TVSC_SUCCESS;

	TVSC_MSG((_T("[TVSC]++TVSC_set_source_size(%d, %d, %d, %d, %d, %d)\n\r"), BaseWidth, BaseHeight, Width, Height, OffsetX, OffsetY));

	g_TVSCConfig.SrcBaseWidth = BaseWidth;
	g_TVSCConfig.SrcBaseHeight = BaseHeight;
	g_TVSCConfig.SrcWidth = Width;
	g_TVSCConfig.SrcHeight = Height;
	g_TVSCConfig.SrcOffsetX = OffsetX;
	g_TVSCConfig.SrcOffsetY = OffsetY;

	// TODO: Check Validity

	TVSC_MSG((_T("[TVSC]--TVSC_set_source_size() : %d\n\r"), error));

	return error;
}

static TVSC_ERROR TVSC_set_destination_size(unsigned int BaseWidth, unsigned int BaseHeight, unsigned int Width, unsigned int Height, unsigned int OffsetX, unsigned int OffsetY)
{
	TVSC_ERROR error = TVSC_SUCCESS;

	TVSC_MSG((_T("[TVSC]++TVSC_set_destination_size(%d, %d, %d, %d, %d, %d)\n\r"), BaseWidth, BaseHeight, Width, Height, OffsetX, OffsetY));

	g_TVSCConfig.DstBaseWidth = BaseWidth;
	g_TVSCConfig.DstBaseHeight = BaseHeight;
	g_TVSCConfig.DstWidth = Width;
	g_TVSCConfig.DstHeight = Height;
	g_TVSCConfig.DstOffsetX = OffsetX;
	g_TVSCConfig.DstOffsetY = OffsetY;

	// TODO: Check Validity

	TVSC_MSG((_T("[TVSC]--TVSC_set_destination_size() : %d\n\r"), error));

	return error;
}

static TVSC_ERROR TVSC_get_prescaler_horizontal_value(unsigned int *PrescalerRatio, unsigned int *MainShift)
{
	TVSC_ERROR error = TVSC_SUCCESS;

	if (g_TVSCConfig.SrcWidth >= 64*g_TVSCConfig.DstWidth)
	{
		TVSC_ERR((_T("[TVSC:ERR] TVSC_get_prescaler_horizontal_value() : Out of Range\r\n")));
		error = TVSC_ERROR_PRESCALER_OUT_OF_SCALE_RANGE;
	}
	else if (g_TVSCConfig.SrcWidth >= 32*g_TVSCConfig.DstWidth)
	{
		*PrescalerRatio = 32;
		*MainShift = 5;
	}
	else if (g_TVSCConfig.SrcWidth >= 16*g_TVSCConfig.DstWidth)
	{
		*PrescalerRatio = 16;
		*MainShift = 4;
	}
	else if (g_TVSCConfig.SrcWidth >= 8*g_TVSCConfig.DstWidth)
	{
		*PrescalerRatio = 8;
		*MainShift = 3;
	}
	else if (g_TVSCConfig.SrcWidth >= 4*g_TVSCConfig.DstWidth)
	{
		*PrescalerRatio = 4;
		*MainShift = 2;
	}
	else if (g_TVSCConfig.SrcWidth >= 2*g_TVSCConfig.DstWidth)
	{
		*PrescalerRatio = 2;
		*MainShift = 1;
	}
	else
	{
		*PrescalerRatio = 1;
		*MainShift = 0;
	}

	return error;
}

static TVSC_ERROR TVSC_get_prescaler_vertical_value(unsigned int *PrescalerRatio, unsigned int *MainShift)
{
	TVSC_ERROR error = TVSC_SUCCESS;

	if (g_TVSCConfig.SrcHeight >= 64*g_TVSCConfig.DstHeight)
	{
		TVSC_ERR((_T("[TVSC:ERR] TVSC_get_prescaler_vertical_value() : Out of Range\r\n")));
		error = TVSC_ERROR_PRESCALER_OUT_OF_SCALE_RANGE;
	}
	else if (g_TVSCConfig.SrcHeight >= 32*g_TVSCConfig.DstHeight)
	{
		*PrescalerRatio = 32;
		*MainShift = 5;
	}
	else if (g_TVSCConfig.SrcHeight >= 16*g_TVSCConfig.DstHeight)
	{
		*PrescalerRatio = 16;
		*MainShift = 4;
	}
	else if (g_TVSCConfig.SrcHeight >= 8*g_TVSCConfig.DstHeight)
	{
		*PrescalerRatio = 8;
		*MainShift = 3;
	}
	else if (g_TVSCConfig.SrcHeight >= 4*g_TVSCConfig.DstHeight)
	{
		*PrescalerRatio = 4;
		*MainShift = 2;
	}
	else if (g_TVSCConfig.SrcHeight >= 2*g_TVSCConfig.DstHeight)
	{
		*PrescalerRatio = 2;
		*MainShift = 1;
	}
	else
	{
		*PrescalerRatio = 1;
		*MainShift = 0;
	}

	return error;
}

static TVSC_ERROR TVSC_update_condition(void)
{
	TVSC_ERROR error = TVSC_SUCCESS;

	unsigned int PreHozRatio, PreVerRatio;
	unsigned int MainHozShift, MainVerShift;

	TVSC_MSG((_T("[TVSC]++TVSC_update_condition()\n\r")));

	error = TVSC_get_prescaler_horizontal_value(&PreHozRatio, &MainHozShift);
	if (error == TVSC_SUCCESS)
	{
		error = TVSC_get_prescaler_vertical_value(&PreVerRatio, &MainVerShift);
		if (error == TVSC_SUCCESS)
		{
			g_pTVSCReg->PreScale_Ratio = PRESCALE_V_RATIO(PreVerRatio) | PRESCALE_H_RATIO(PreHozRatio);
			g_pTVSCReg->PreScaleImgSize = PRESCALE_WIDTH(g_TVSCConfig.SrcWidth/PreHozRatio) | PRESCALE_HEIGHT(g_TVSCConfig.SrcHeight/PreVerRatio);
			g_pTVSCReg->SRCImgSize = SRC_WIDTH(g_TVSCConfig.SrcWidth) | SRC_HEIGHT(g_TVSCConfig.SrcHeight);
			g_pTVSCReg->MainScale_H_Ratio = MAINSCALE_H_RATIO((g_TVSCConfig.SrcWidth<<8)/(g_TVSCConfig.DstWidth<<MainHozShift));
			g_pTVSCReg->MainScale_V_Ratio = MAINSCALE_V_RATIO((g_TVSCConfig.SrcHeight<<8)/(g_TVSCConfig.DstHeight<<MainVerShift));
			g_pTVSCReg->DSTImgSize = DST_WIDTH(g_TVSCConfig.DstWidth) | DST_HEIGHT(g_TVSCConfig.DstHeight);
			g_pTVSCReg->PreScale_SHFactor = PRESCALE_SHFACTOR(10-(MainHozShift+MainVerShift));
		}
	}

	TVSC_MSG((_T("[TVSC]--TVSC_update_condition() : %d\n\r"), error));

	return error;
}

static TVSC_ERROR TVSC_set_dma_address(TVSC_DMA_ADDRESS DMA, unsigned int AddrY, unsigned int AddrCb, unsigned int AddrCr)
{
	TVSC_ERROR error = TVSC_SUCCESS;

	unsigned int AddrStart_Y=0, AddrStart_Cb=0, AddrStart_Cr=0;
	unsigned int AddrEnd_Y=0, AddrEnd_Cb=0, AddrEnd_Cr=0;
	unsigned int Offset_Y=0, Offset_Cb=0, Offset_Cr=0;

	TVSC_MSG((_T("[TVSC]++TVSC_set_dma_address(%d, 0x%08x, 0x%08x, 0x%08x)\n\r"), DMA, AddrY, AddrCb, AddrCr));

	if (DMA == TVSC_SRC_ADDRESS || DMA == TVSC_NEXT_SRC_ADDRESS)
	{
		switch(g_TVSCConfig.SrcType)
		{
		case TVSC_SRC_RGB16:
		case TVSC_SRC_YUV422_YCBYCR:
		case TVSC_SRC_YUV422_CBYCRY:
		case TVSC_SRC_YUV422_YCRYCB:
		case TVSC_SRC_YUV422_CRYCBY:
			Offset_Y = (g_TVSCConfig.SrcBaseWidth - g_TVSCConfig.SrcWidth)*2;
			AddrStart_Y = AddrY+(g_TVSCConfig.SrcBaseWidth*g_TVSCConfig.SrcOffsetY)*2 + g_TVSCConfig.SrcOffsetX*2;
			AddrEnd_Y = AddrStart_Y+(g_TVSCConfig.SrcWidth*g_TVSCConfig.SrcHeight)*2 + (g_TVSCConfig.SrcHeight-1)*Offset_Y;
			break;
		case TVSC_SRC_RGB24:
			Offset_Y = (g_TVSCConfig.SrcBaseWidth - g_TVSCConfig.SrcWidth)*4;
			AddrStart_Y = AddrY+(g_TVSCConfig.SrcBaseWidth*g_TVSCConfig.SrcOffsetY)*4 + g_TVSCConfig.SrcOffsetX*4;
			AddrEnd_Y = AddrStart_Y+(g_TVSCConfig.SrcWidth*g_TVSCConfig.SrcHeight)*4 + (g_TVSCConfig.SrcHeight-1)*Offset_Y;
			break;
		case TVSC_SRC_YUV420:
			Offset_Y = (g_TVSCConfig.SrcBaseWidth - g_TVSCConfig.SrcWidth);
			Offset_Cb = Offset_Y/2;
			Offset_Cr = Offset_Y/2;
			AddrStart_Y = AddrY+(g_TVSCConfig.SrcBaseWidth*g_TVSCConfig.SrcOffsetY) + g_TVSCConfig.SrcOffsetX;
			AddrEnd_Y = AddrStart_Y+(g_TVSCConfig.SrcWidth*g_TVSCConfig.SrcHeight) + (g_TVSCConfig.SrcHeight-1)*Offset_Y;
			AddrStart_Cb = AddrCb+(g_TVSCConfig.SrcBaseWidth/2)*(g_TVSCConfig.SrcOffsetY/2) + g_TVSCConfig.SrcOffsetX/2;
			AddrEnd_Cb = AddrStart_Cb+(g_TVSCConfig.SrcWidth/2)*(g_TVSCConfig.SrcHeight/2) + (g_TVSCConfig.SrcHeight/2-1)*Offset_Cb;
			AddrStart_Cr = AddrCr+(g_TVSCConfig.SrcBaseWidth/2)*(g_TVSCConfig.SrcOffsetY/2) + g_TVSCConfig.SrcOffsetX/2;
			AddrEnd_Cr = AddrStart_Cr+(g_TVSCConfig.SrcWidth/2)*(g_TVSCConfig.SrcHeight/2) + (g_TVSCConfig.SrcHeight/2-1)*Offset_Cr;
			break;
		default:
			TVSC_ERR((_T("[TVSC:ERR] TVSC_set_dma_address() : Unknown Format %d\r\n"), g_TVSCConfig.SrcType));
			error = TVSC_ERROR_ILLEGAL_PARAMETER;
		}
	}
	else if (DMA == TVSC_DST_ADDRESS || DMA == TVSC_NEXT_DST_ADDRESS)
	{
		switch(g_TVSCConfig.DstType)
		{
		case TVSC_DST_RGB16:
		case TVSC_DST_YUV422_YCBYCR:
		case TVSC_DST_YUV422_CBYCRY:
		case TVSC_DST_YUV422_YCRYCB:
		case TVSC_DST_YUV422_CRYCBY:
			Offset_Y = (g_TVSCConfig.DstBaseWidth - g_TVSCConfig.DstWidth)*2;
			AddrStart_Y = AddrY+(g_TVSCConfig.DstBaseWidth*g_TVSCConfig.DstOffsetY)*2 + g_TVSCConfig.DstOffsetX*2;
			AddrEnd_Y = AddrStart_Y+(g_TVSCConfig.DstWidth*g_TVSCConfig.DstHeight)*2 + (g_TVSCConfig.DstHeight-1)*Offset_Y;
			break;
		case TVSC_DST_RGB24:
			Offset_Y = (g_TVSCConfig.DstBaseWidth - g_TVSCConfig.DstWidth)*4;
			AddrStart_Y = AddrY+(g_TVSCConfig.DstBaseWidth*g_TVSCConfig.DstOffsetY)*4 + g_TVSCConfig.DstOffsetX*4;
			AddrEnd_Y = AddrStart_Y+(g_TVSCConfig.DstWidth*g_TVSCConfig.DstHeight)*4 + (g_TVSCConfig.DstHeight-1)*Offset_Y;
			break;
		case TVSC_DST_YUV420:
			Offset_Y = (g_TVSCConfig.DstBaseWidth - g_TVSCConfig.DstWidth);
			Offset_Cb = Offset_Y/2;
			Offset_Cr = Offset_Y/2;
			AddrStart_Y = AddrY+(g_TVSCConfig.DstBaseWidth*g_TVSCConfig.DstOffsetY) + g_TVSCConfig.DstOffsetX;
			AddrEnd_Y = AddrStart_Y+(g_TVSCConfig.DstWidth*g_TVSCConfig.DstHeight) + (g_TVSCConfig.DstHeight-1)*Offset_Y;
			AddrStart_Cb = AddrCb+(g_TVSCConfig.DstBaseWidth/2)*(g_TVSCConfig.DstOffsetY/2) + g_TVSCConfig.DstOffsetX/2;
			AddrEnd_Cb = AddrStart_Cb+(g_TVSCConfig.DstWidth/2)*(g_TVSCConfig.DstHeight/2) + (g_TVSCConfig.DstHeight/2-1)*Offset_Cb;
			AddrStart_Cr = AddrCr+(g_TVSCConfig.DstBaseWidth/2)*(g_TVSCConfig.DstOffsetY/2) + g_TVSCConfig.DstOffsetX/2;
			AddrEnd_Cr = AddrStart_Cr+(g_TVSCConfig.DstWidth/2)*(g_TVSCConfig.DstHeight/2) + (g_TVSCConfig.DstHeight/2-1)*Offset_Cr;
			break;
		default:
			TVSC_ERR((_T("[TVSC:ERR] TVSC_set_dma_address() : Unknown Format %d\r\n"), g_TVSCConfig.DstType));
			error = TVSC_ERROR_ILLEGAL_PARAMETER;
		}
	}
	else
	{
		TVSC_ERR((_T("[TVSC:ERR] TVSC_set_dma_address() : Unknown DMA address %d\r\n"), DMA));
		error = TVSC_ERROR_ILLEGAL_PARAMETER;
	}

	switch(DMA)
	{
	case TVSC_SRC_ADDRESS:
		g_pTVSCReg->ADDRStart_Y = AddrStart_Y;
		g_pTVSCReg->ADDREnd_Y = AddrEnd_Y;
		g_pTVSCReg->ADDRStart_Cb = AddrStart_Cb;
		g_pTVSCReg->ADDREnd_Cb = AddrEnd_Cb;
		g_pTVSCReg->ADDRStart_Cr = AddrStart_Cr;
		g_pTVSCReg->ADDREnd_Cr = AddrEnd_Cr;
		g_pTVSCReg->Offset_Y= Offset_Y;
		g_pTVSCReg->Offset_Cb= Offset_Cb;
		g_pTVSCReg->Offset_Cr= Offset_Cr;
		break;
	case TVSC_NEXT_SRC_ADDRESS:
		g_pTVSCReg->MODE_2 |= ADDR_CHANGE_DISABLE;	// for Safe
		g_pTVSCReg->NxtADDRStart_Y = AddrStart_Y;
		g_pTVSCReg->NxtADDREnd_Y = AddrEnd_Y;
		g_pTVSCReg->NxtADDRStart_Cb = AddrStart_Cb;
		g_pTVSCReg->NxtADDREnd_Cb = AddrEnd_Cb;
		g_pTVSCReg->NxtADDRStart_Cr = AddrStart_Cr;
		g_pTVSCReg->NxtADDREnd_Cr = AddrEnd_Cr;
		g_pTVSCReg->MODE_2 &= ~ADDR_CHANGE_DISABLE;	// for Safe
		break;
	case TVSC_DST_ADDRESS:
		g_pTVSCReg->ADDRStart_RGB = AddrStart_Y;
		g_pTVSCReg->ADDREnd_RGB = AddrEnd_Y;
		g_pTVSCReg->ADDRStart_oCb = AddrStart_Cb;
		g_pTVSCReg->ADDREnd_oCb = AddrEnd_Cb;
		g_pTVSCReg->ADDRStart_oCr = AddrStart_Cr;
		g_pTVSCReg->ADDREnd_oCr = AddrEnd_Cr;
		g_pTVSCReg->Offset_RGB= Offset_Y;
		g_pTVSCReg->Offset_oCb= Offset_Cb;
		g_pTVSCReg->Offset_oCr= Offset_Cr;
		break;
	case TVSC_NEXT_DST_ADDRESS:
		g_pTVSCReg->MODE_2 |= ADDR_CHANGE_DISABLE;	// for Safe
		g_pTVSCReg->NxtADDRStart_RGB = AddrStart_Y;
		g_pTVSCReg->NxtADDREnd_RGB = AddrEnd_Y;
		g_pTVSCReg->NxtADDRStart_oCb = AddrStart_Cb;
		g_pTVSCReg->NxtADDREnd_oCb = AddrEnd_Cb;
		g_pTVSCReg->NxtADDRStart_oCr = AddrStart_Cr;
		g_pTVSCReg->NxtADDREnd_oCr = AddrEnd_Cr;
		g_pTVSCReg->MODE_2 &= ~ADDR_CHANGE_DISABLE;	// for Safe
		break;
	}

	TVSC_MSG((_T("[TVSC]--TVSC_set_dma_address() : %d\n\r"), error));

	return error;
}