s3c6410_tv_scaler.c
来自「6410BSP3」· C语言 代码 · 共 640 行 · 第 1/2 页
C
640 行
}
else if (Mode == TVSC_INTERLACE)
{
g_pTVSCReg->MODE |= INTERLACE;
}
else
{
TVSC_ERR((_T("[TVSC:ERR] TVSC_set_mode() : Unknown Scan Mode %d)\n\r"), Scan));
error = TVSC_ERROR_ILLEGAL_PARAMETER;
}
switch(SrcType)
{
case TVSC_SRC_RGB16:
g_pTVSCReg->MODE |= SRCFMT_RGB | SRCRGB_RGB565 | SRCYUV_YUV422 | SRC_INTERLEAVE;
break;
case TVSC_SRC_RGB24:
g_pTVSCReg->MODE |= SRCFMT_RGB | SRCRGB_RGB24 | SRCYUV_YUV422 | SRC_INTERLEAVE;
break;
case TVSC_SRC_YUV420:
g_pTVSCReg->MODE |= SRCFMT_YUV | SRCRGB_RGB24 | SRCYUV_YUV420 | SRC_NOT_INTERLEAVE;
break;
case TVSC_SRC_YUV422_YCBYCR:
g_pTVSCReg->MODE |= SRCFMT_YUV | SRCRGB_RGB24 | SRCYUV_YUV422 | SRC_INTERLEAVE | SRCYUV_YCBYCR;
break;
case TVSC_SRC_YUV422_CBYCRY:
g_pTVSCReg->MODE |= SRCFMT_YUV | SRCRGB_RGB24 | SRCYUV_YUV422 | SRC_INTERLEAVE | SRCYUV_CBYCRY;
break;
case TVSC_SRC_YUV422_YCRYCB:
g_pTVSCReg->MODE |= SRCFMT_YUV | SRCRGB_RGB24 | SRCYUV_YUV422 | SRC_INTERLEAVE | SRCYUV_YCRYCB;
break;
case TVSC_SRC_YUV422_CRYCBY:
g_pTVSCReg->MODE |= SRCFMT_YUV | SRCRGB_RGB24 | SRCYUV_YUV422 | SRC_INTERLEAVE | SRCYUV_CRYCBY;
break;
case TVSC_SRC_FIFO:
g_pTVSCReg->MODE |= FIFO_IN_ENABLE;
break;
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 void TVSC_set_source_size(unsigned int BaseWidth, unsigned int BaseHeight, unsigned int Width, unsigned int Height, unsigned int OffsetX, unsigned int OffsetY)
{
// To use TV Scaler, Image Width is limited to WORD(4Byte) boundary, 32Bpp->1Pixel, 16Bpp->2Pixel
// This must be considered from Caller Application
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;
TVSC_MSG((_T("[TVSC]--TVSC_set_source_size() : %d\n\r"), error));
}
static void TVSC_set_destination_size(unsigned int BaseWidth, unsigned int BaseHeight, unsigned int Width, unsigned int Height, unsigned int OffsetX, unsigned int OffsetY)
{
// To use TV Scaler, Image Width is limited to WORD(4Byte) boundary, 32Bpp->1Pixel, 16Bpp->2Pixel
// This must be considered from Caller Application
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;
TVSC_MSG((_T("[TVSC]--TVSC_set_destination_size() : %d\n\r"), error));
}
static TVSC_ERROR TVSC_get_prescaler_shiftvalue(unsigned int *MainShift, unsigned int SrcValue, unsigned int DstValue)
{
TVSC_ERROR error = TVSC_SUCCESS;
if (SrcValue >= 64*DstValue)
{
TVSC_ERR((_T("[TVSC:ERR] TVSC_get_prescaler_shiftvalue() : Out of Range\r\n")));
error = TVSC_ERROR_PRESCALER_OUT_OF_SCALE_RANGE;
}
else if (SrcValue >= 32*DstValue)
{
*MainShift = 5;
}
else if (SrcValue >= 16*DstValue)
{
*MainShift = 4;
}
else if (SrcValue >= 8*DstValue)
{
*MainShift = 3;
}
else if (SrcValue >= 4*DstValue)
{
*MainShift = 2;
}
else if (SrcValue >= 2*DstValue)
{
*MainShift = 1;
}
else
{
*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_shiftvalue(&MainHozShift, g_TVSCConfig.SrcWidth, g_TVSCConfig.DstWidth);
if (error == TVSC_SUCCESS)
{
PreHozRatio = (1<<MainHozShift);
error = TVSC_get_prescaler_shiftvalue(&MainVerShift, g_TVSCConfig.SrcHeight, g_TVSCConfig.DstHeight);
if (error == TVSC_SUCCESS)
{
PreVerRatio = (1<<MainVerShift);
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;
}
⌨️ 快捷键说明
复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?