/**
* \brief ISI initialize
* \param pVideo structure of video driver
*/
void ISI_Init(pIsi_Video pVideo)
{
uint32_t hRatio, vRatio;
ISI_Reset();
// SLD pixel clock periods to wait before the beginning of a line.
// SFD lines are skipped at the beginning of the frame.
REG_ISI_CFG1 |= ISI_CFG1_SLD(pVideo->Hblank) + ISI_CFG1_SFD(pVideo->Vblank);
TRACE_DEBUG("ISI_CFG1=0x%X\n\r", REG_ISI_CFG1);
// IM_VSIZE: Vertical size of the Image sensor [0..2047]
// Vertical size = IM_VSIZE + 1
// IM_HSIZE: Horizontal size of the Image sensor [0..2047]
// Horizontal size = IM_HSIZE + 1
// YCC_SWAP : YCC image data
REG_ISI_CFG2 = ISI_CFG2_IM_VSIZE(pVideo->codec_vsize - 1)
+ ISI_CFG2_IM_HSIZE(pVideo->codec_hsize - 1);
if (pVideo->rgb_or_yuv == RGB) {
REG_ISI_CFG2 |= ISI_CFG2_COL_SPACE | ISI_CFG2_RGB_MODE ;
}
else {
REG_ISI_CFG2|= ISI_CFG2_YCC_SWAP(2) ;
}
TRACE_DEBUG("ISI_CFG2=0x%X\n\r", REG_ISI_CFG2);
// Vertical Preview size = PREV_VSIZE + 1 (480 max only in RGB mode).
// Horizontal Preview size = PREV_HSIZE + 1 (640 max only in RGB mode).
if( (pVideo->lcd_vsize > 480) || (pVideo->lcd_hsize > 800)) {
TRACE_ERROR("Size LCD bad define %u, %u\n\r",(unsigned int)pVideo->lcd_vsize ,(unsigned int)pVideo->lcd_hsize);
REG_ISI_PSIZE = ((480 - 1) ) + (((800-1) << 16) );
}
else {
REG_ISI_PSIZE = ((pVideo->lcd_vsize -1)) + (((pVideo->lcd_hsize -1) << 16) );
}
// DEC_FACTOR is 8-bit width, range is from 16 to 255.
// Values from 0 to 16 do not perform any decimation.
//REG_ISI_PDECF = (16 * pVideo->codec_hsize)/640;
hRatio = (16 * pVideo->codec_hsize)/(pVideo->lcd_hsize);
vRatio = (16 * pVideo->codec_vsize)/(pVideo->lcd_vsize);
REG_ISI_PDECF = (hRatio > vRatio )? vRatio: hRatio;
if (REG_ISI_PDECF < 16) REG_ISI_PDECF = 16;
REG_ISI_DMA_P_DSCR = pVideo->Isi_fbd_base;
REG_ISI_DMA_P_CTRL = ISI_DMA_P_CTRL_P_FETCH;
REG_ISI_DMA_P_ADDR = pVideo->lcd_fb_addr;
REG_ISI_DMA_C_DSCR = pVideo->codec_fbd_base;
REG_ISI_DMA_C_CTRL = ISI_DMA_C_CTRL_C_FETCH;
REG_ISI_DMA_C_ADDR = pVideo->codec_fb_addr;
// C0: Color Space Conversion Matrix Coefficient C0
// C1: Color Space Conversion Matrix Coefficient C1
// C2: Color Space Conversion Matrix Coefficient C2
// C3: Color Space Conversion Matrix Coefficient C3
REG_ISI_Y2R_SET0 = ISI_Y2R_SET0_C0(0x95)
+ ISI_Y2R_SET0_C1(0xFF)
+ ISI_Y2R_SET0_C2(0x68)
+ ISI_Y2R_SET0_C3(0x32);
// C4: Color Space Conversion Matrix coefficient C4
// Yoff: Color Space Conversion Luminance 128 offset
// Croff: Color Space Conversion Red Chrominance 16 offset
// Cboff: Color Space Conversion Blue Chrominance 16 offset
REG_ISI_Y2R_SET1 = ISI_Y2R_SET1_C4(0xCC)
+ ISI_Y2R_SET1_Yoff
+ ISI_Y2R_SET1_Croff
+ ISI_Y2R_SET1_Cboff;
}
//-----------------------------------------------------------------------------
/// ISI initialize with the pVideo parameters.
/// By default, put ISI in RGB mode 565, YCC mode 3, different value for
/// Color Space Conversion Matrix Coefficient
/// \param pVideo structure of video driver
//-----------------------------------------------------------------------------
void ISI_Init(AT91PS_VIDEO pVideo)
{
ISI_Reset();
// AT91C_ISI_HSYNC_POL Horizontal synchronisation polarity
// AT91C_ISI_VSYNC_POL Vertical synchronisation polarity
// AT91C_ISI_PIXCLK_POL Pixel Clock Polarity
// SLD pixel clock periods to wait before the beginning of a line.
// SFD lines are skipped at the beginning of the frame.
AT91C_BASE_ISI->ISI_CR1 |= ((pVideo->Hblank << 16) & AT91C_ISI_SLD)
+ ((pVideo->Vblank << 24) & AT91C_ISI_SFD);
TRACE_DEBUG("ISI_CR1=0x%X\n\r", AT91C_BASE_ISI->ISI_CR1);
// IM_VSIZE: Vertical size of the Image sensor [0..2047]
// Vertical size = IM_VSIZE + 1
// IM_HSIZE: Horizontal size of the Image sensor [0..2047]
// Horizontal size = IM_HSIZE + 1
// YCC_SWAP : YCC image data
AT91C_BASE_ISI->ISI_CR2 = ((pVideo->codec_vsize-1) & AT91C_ISI_IM_VSIZE)
+ (((pVideo->codec_hsize-1) << 16) & AT91C_ISI_IM_HSIZE)
+ AT91C_ISI_YCC_SWAP_YCC_MODE2;
if (pVideo->rgb_or_yuv == RGB) {
AT91C_BASE_ISI->ISI_CR2 |= AT91C_ISI_COL_SPACE | AT91C_ISI_RGB_MODE_RGB_565
| AT91C_ISI_RGB_CFG_RGB_DEFAULT;
} else {
// AT91C_BASE_HISI->ISI_CR2 &= ~AT91C_ISI_COL_SPACE;
}
TRACE_DEBUG("ISI_CR2=0x%X\n\r", AT91C_BASE_ISI->ISI_CR2);
// Vertical Preview size = PREV_VSIZE + 1 (480 max only in RGB mode).
// Horizontal Preview size = PREV_HSIZE + 1 (640 max only in RGB mode).
#if defined (AT91C_ID_LCDC)
if( (pVideo->lcd_vsize > 480) || (pVideo->lcd_hsize > 640)) {
TRACE_ERROR("Size LCD bad define\n\r");
AT91C_BASE_ISI->ISI_PSIZE = ((BOARD_LCD_HEIGHT-1) & AT91C_ISI_PREV_VSIZE)
+ (((BOARD_LCD_WIDTH-1) << 16) & AT91C_ISI_PREV_HSIZE);
} else {
AT91C_BASE_ISI->ISI_PSIZE = ((pVideo->lcd_vsize -1) & AT91C_ISI_PREV_VSIZE)
+ (((pVideo->lcd_hsize -1) << 16) & AT91C_ISI_PREV_HSIZE);
}
#endif
// DEC_FACTOR is 8-bit width, range is from 16 to 255.
// Values from 0 to 16 do not perform any decimation.
AT91C_BASE_ISI->ISI_PDECF = (16 * pVideo->codec_hsize) / pVideo->lcd_hsize;
TRACE_DEBUG("codec_hsize: %d\n\r", pVideo->codec_hsize);
TRACE_DEBUG("lcd_hsize: %d\n\r", pVideo->lcd_hsize);
TRACE_DEBUG("ISI_PDECF: %d\n\r", AT91C_BASE_ISI->ISI_PDECF);
if( AT91C_BASE_ISI->ISI_PDECF <16) {
TRACE_ERROR("ISI_PDECF, forbidden value: %d\n\r", AT91C_BASE_ISI->ISI_PDECF);
AT91C_BASE_ISI->ISI_PDECF = 16;
}
// Written with the address of the start of the preview frame buffer queue,
// reads as a pointer to the current buffer being used.
// The frame buffer is forced to word alignment.
AT91C_BASE_ISI->ISI_PPFBD = pVideo->Isi_fbd_base;
// This register contains codec datapath start address of buffer location.
// CODEC_DMA_ADDR: Base address for codec DMA
AT91C_BASE_ISI->ISI_CDBA = pVideo->codec_fb_addr;
// C0: Color Space Conversion Matrix Coefficient C0
// C1: Color Space Conversion Matrix Coefficient C1
// C2: Color Space Conversion Matrix Coefficient C2
// C3: Color Space Conversion Matrix Coefficient C3
AT91C_BASE_ISI->ISI_Y2RSET0 = ( (0x95<< 0) & AT91C_ISI_Y2R_C0)
+ ( (0xFF<< 8) & AT91C_ISI_Y2R_C1)
+ ( (0x68<<16) & AT91C_ISI_Y2R_C2)
+ ( (0x32<<24) & AT91C_ISI_Y2R_C3);
// C4: Color Space Conversion Matrix coefficient C4
// Yoff: Color Space Conversion Luminance 128 offset
// Croff: Color Space Conversion Red Chrominance 16 offset
// Cboff: Color Space Conversion Blue Chrominance 16 offset
AT91C_BASE_ISI->ISI_Y2RSET1 = ( (0xCC<< 0) & AT91C_ISI_Y2R_C4)
+ ( AT91C_ISI_Y2R_YOFF_128)
+ ( AT91C_ISI_Y2R_CROFF_16)
+ ( AT91C_ISI_Y2R_CBOFF_16);
}
