From 044ad7c3987460ede48ff27afd6bdb0ca05a0432 Mon Sep 17 00:00:00 2001 From: Harald Welte Date: Mon, 4 Jul 2011 20:52:54 +0200 Subject: import at91lib from at91lib_20100901_softpack_1_9_v_1_0_svn_v15011 it's sad to see that atmel doesn't publish their svn repo or has a centralized location or even puts proper version/release info into the library itself --- peripherals/isi/isi.c | 261 ++++++++++++++++++++++++++++++++++++++++++++++++ peripherals/isi/isi.dir | 42 ++++++++ peripherals/isi/isi.h | 99 ++++++++++++++++++ peripherals/isi/isi2.c | 246 +++++++++++++++++++++++++++++++++++++++++++++ 4 files changed, 648 insertions(+) create mode 100644 peripherals/isi/isi.c create mode 100644 peripherals/isi/isi.dir create mode 100644 peripherals/isi/isi.h create mode 100644 peripherals/isi/isi2.c (limited to 'peripherals/isi') diff --git a/peripherals/isi/isi.c b/peripherals/isi/isi.c new file mode 100644 index 0000000..05feb4b --- /dev/null +++ b/peripherals/isi/isi.c @@ -0,0 +1,261 @@ +/* ---------------------------------------------------------------------------- + * ATMEL Microcontroller Software Support + * ---------------------------------------------------------------------------- + * Copyright (c) 2008, Atmel Corporation + * + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * - Redistributions of source code must retain the above copyright notice, + * this list of conditions and the disclaimer below. + * + * Atmel's name may not be used to endorse or promote products derived from + * this software without specific prior written permission. + * + * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR + * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF + * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE + * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT + * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, + * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF + * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING + * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, + * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. + * ---------------------------------------------------------------------------- + */ + +//------------------------------------------------------------------------------ +/// \unit +/// +/// !Purpose +/// +/// Image Sensor Interface (ISI) driver +/// +/// !Usage +/// +/// Explanation on the usage of the code made available through the header file. +//------------------------------------------------------------------------------ + +//------------------------------------------------------------------------------ +// Headers +//------------------------------------------------------------------------------ + +#include +#include +#include +#include "isi.h" + +#if !defined (BOARD_ISI_V200) + +//----------------------------------------------------------------------------- +/// Enable ISI +//----------------------------------------------------------------------------- +void ISI_Enable(void) +{ + AT91C_BASE_ISI->ISI_CR1 &= ~AT91C_ISI_DIS; +} + +//----------------------------------------------------------------------------- +/// Disable ISI +//----------------------------------------------------------------------------- +void ISI_Disable(void) +{ + AT91C_BASE_ISI->ISI_CR1 |= AT91C_ISI_DIS; +} + +//----------------------------------------------------------------------------- +/// Enable ISI interrupt +/// \param flag of interrupt to enable +//----------------------------------------------------------------------------- +void ISI_EnableInterrupt(unsigned int flag) +{ + AT91C_BASE_ISI->ISI_IER = flag; +} + +//----------------------------------------------------------------------------- +/// Disable ISI interrupt +/// \param flag of interrupt to disable +//----------------------------------------------------------------------------- +void ISI_DisableInterrupt(unsigned int flag) +{ + AT91C_BASE_ISI->ISI_IDR = flag; +} + +//----------------------------------------------------------------------------- +/// Return ISI status register +/// \return Status of ISI register +//----------------------------------------------------------------------------- +unsigned int ISI_StatusRegister(void) +{ + return(AT91C_BASE_ISI->ISI_SR); +} + +//----------------------------------------------------------------------------- +/// Enable Codec path for capture next frame +//----------------------------------------------------------------------------- +void ISI_CodecPathFull(void) +{ + // The codec path is enabled and the next frame is captured. + // Both codec and preview datapaths are working simultaneously + AT91C_BASE_ISI->ISI_CR1 |= AT91C_ISI_CODEC_ON | AT91C_ISI_FULL; +} + +//----------------------------------------------------------------------------- +/// Set frame rate +/// \param frate frame rate capture +/// \return +//----------------------------------------------------------------------------- +void ISI_SetFrame(unsigned int frate) +{ + if( frate > 7 ) { + TRACE_ERROR("FRate too big\n\r"); + frate = 7; + } + AT91C_BASE_ISI->ISI_CR1 |= ((frate<<8) & AT91C_ISI_FRATE); +} + +//----------------------------------------------------------------------------- +/// Get the number of byte per pixels +/// \param bmpRgb BMP type can be YUV or RGB +/// \return Number of byte for one pixel +//----------------------------------------------------------------------------- +unsigned char ISI_BytesForOnePixel(unsigned char bmpRgb) +{ + unsigned char nbByte_Pixel; + + if (bmpRgb == RGB) { + if ((AT91C_BASE_ISI->ISI_CR2 & AT91C_ISI_RGB_MODE) == AT91C_ISI_RGB_MODE_RGB_565){ + // RGB: 5:6:5 16bits/pixels + nbByte_Pixel = 2; + } + else { + // RGB: 8:8:8 24bits/pixels + nbByte_Pixel = 3; + } + } + else { + // YUV: 2 pixels for 4 bytes + nbByte_Pixel = 2; + } + return nbByte_Pixel; +} + +//----------------------------------------------------------------------------- +/// Reset ISI +//----------------------------------------------------------------------------- +void ISI_Reset(void) +{ + unsigned int timeout=0; + + // Resets the image sensor interface. + // Finish capturing the current frame and then shut down the module. + AT91C_BASE_ISI->ISI_CR1 = AT91C_ISI_RST | AT91C_ISI_DIS; + // wait Software reset has completed successfully. + while( (!(volatile int)AT91C_BASE_ISI->ISI_SR & AT91C_ISI_SOFTRST) + && (timeout < 0x5000) ){ + timeout++; + } + if( timeout == 0x5000 ) { + TRACE_ERROR("ISI-Reset timeout\n\r"); + } +} + +//----------------------------------------------------------------------------- +/// 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); +} + +#endif // !defined (BOARD_ISI_V200) + diff --git a/peripherals/isi/isi.dir b/peripherals/isi/isi.dir new file mode 100644 index 0000000..c44b439 --- /dev/null +++ b/peripherals/isi/isi.dir @@ -0,0 +1,42 @@ +/* ---------------------------------------------------------------------------- + * ATMEL Microcontroller Software Support + * ---------------------------------------------------------------------------- + * Copyright (c) 2008, Atmel Corporation + * + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * - Redistributions of source code must retain the above copyright notice, + * this list of conditions and the disclaimer below. + * + * Atmel's name may not be used to endorse or promote products derived from + * this software without specific prior written permission. + * + * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR + * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF + * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE + * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT + * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, + * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF + * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING + * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, + * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. + * ---------------------------------------------------------------------------- + */ + +//------------------------------------------------------------------------------ +/// \dir +/// +/// !!!Purpose +/// +/// This directory contains an API for configuring the Peripheral ISI (Image +/// Sensor Interface). +/// +/// !!!Contents +/// +/// Contains code for initialize, reset, enable ISI peripheral. +//------------------------------------------------------------------------------ + diff --git a/peripherals/isi/isi.h b/peripherals/isi/isi.h new file mode 100644 index 0000000..0a81437 --- /dev/null +++ b/peripherals/isi/isi.h @@ -0,0 +1,99 @@ +/* ---------------------------------------------------------------------------- + * ATMEL Microcontroller Software Support + * ---------------------------------------------------------------------------- + * Copyright (c) 2008, Atmel Corporation + * + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * - Redistributions of source code must retain the above copyright notice, + * this list of conditions and the disclaimer below. + * + * Atmel's name may not be used to endorse or promote products derived from + * this software without specific prior written permission. + * + * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR + * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF + * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE + * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT + * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, + * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF + * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING + * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, + * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. + * ---------------------------------------------------------------------------- + */ + +//------------------------------------------------------------------------------ +/// \unit +/// +/// !Purpose +/// +/// Interface for configuration the Image Sensor Interface (ISI) peripheral. +/// +/// !Usage +/// +/// -# ISI_Init: initialize ISI with default parameters +/// -# ISI_EnableInterrupt: enable one or more interrupts +/// -# ISI_DisableInterrupt: disable one or more interrupts +/// -# ISI_Enable: enable isi module +/// -# ISI_Disable: disable isi module +/// -# ISI_CodecPathFull: enable codec path +/// -# ISI_SetFrame: set frame rate +/// -# ISI_BytesForOnePixel: return number of byte for one pixel +/// -# ISI_StatusRegister: return ISI status register +/// -# ISI_Reset: make a software reset +//------------------------------------------------------------------------------ + +#ifndef ISI_H +#define ISI_H + +//------------------------------------------------------------------------------ +// Types +//------------------------------------------------------------------------------ + +/// ISI descriptors +typedef struct +{ + /// Current LCD index, used with AT91C_ISI_MAX_PREV_BUFFER + unsigned int CurrentLcdIndex; + /// set if Fifo Codec Empty is present + volatile unsigned int DisplayCodec; + /// upgrade for each Fifo Codec Overflow (statistics use) + unsigned int nb_codec_ovf; + /// upgrade for each Fifo Preview Overflow (statistics use) + unsigned int nb_prev_ovf; +}ISI_Descriptors; + +/// Frame Buffer Descriptors +typedef struct +{ + /// Address of the Current FrameBuffer + unsigned int Current; +#if defined (BOARD_ISI_V200) + /// Address of the Control + unsigned int Control; +#endif + /// Address of the Next FrameBuffer + unsigned int Next; +}ISI_FrameBufferDescriptors; + +//------------------------------------------------------------------------------ +// Exported functions +//------------------------------------------------------------------------------ +extern void ISI_Enable(void); +extern void ISI_Disable(void); +extern void ISI_EnableInterrupt(unsigned int flag); +extern void ISI_DisableInterrupt(unsigned int flag); +extern void ISI_CodecPathFull(void); +extern void ISI_SetFrame(unsigned int frate); +extern unsigned char ISI_BytesForOnePixel(unsigned char bmpRgb); +extern void ISI_Reset(void); +extern void ISI_Init(AT91PS_VIDEO pVideo); +extern unsigned int ISI_StatusRegister(void); + +#endif //#ifndef ISI_H + diff --git a/peripherals/isi/isi2.c b/peripherals/isi/isi2.c new file mode 100644 index 0000000..9ed61f8 --- /dev/null +++ b/peripherals/isi/isi2.c @@ -0,0 +1,246 @@ +/* ---------------------------------------------------------------------------- + * ATMEL Microcontroller Software Support + * ---------------------------------------------------------------------------- + * Copyright (c) 2008, Atmel Corporation + * + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * - Redistributions of source code must retain the above copyright notice, + * this list of conditions and the disclaimer below. + * + * Atmel's name may not be used to endorse or promote products derived from + * this software without specific prior written permission. + * + * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR + * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF + * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE + * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT + * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, + * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF + * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING + * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, + * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. + * ---------------------------------------------------------------------------- + */ + +//------------------------------------------------------------------------------ +// Headers +//------------------------------------------------------------------------------ + +#include +#include +#include +#include "isi.h" + +#if defined (BOARD_ISI_V200) + +//----------------------------------------------------------------------------- +/// Enable ISI +//----------------------------------------------------------------------------- +void ISI_Enable(void) +{ + AT91C_BASE_ISI->ISI_CTRL |= AT91C_ISI_EN_1; + while( (AT91C_BASE_ISI->ISI_SR & AT91C_ISI_EN_1)!=AT91C_ISI_EN_1); + AT91C_BASE_ISI->ISI_DMACHER |= AT91C_ISI_P_CH_EN_1; +} + +//----------------------------------------------------------------------------- +/// Disable ISI +//----------------------------------------------------------------------------- +void ISI_Disable(void) +{ + AT91C_BASE_ISI->ISI_CTRL |= AT91C_ISI_DIS_1; + AT91C_BASE_ISI->ISI_DMACHDR &= ~AT91C_ISI_P_CH_DIS_1; +} + +//----------------------------------------------------------------------------- +/// Enable ISI interrupt +/// \param flag of interrupt to enable +//----------------------------------------------------------------------------- +void ISI_EnableInterrupt(unsigned int flag) +{ + AT91C_BASE_ISI->ISI_IER = flag; +} + +//----------------------------------------------------------------------------- +/// Disable ISI interrupt +/// \param flag of interrupt to disable +//----------------------------------------------------------------------------- +void ISI_DisableInterrupt(unsigned int flag) +{ + AT91C_BASE_ISI->ISI_IDR = flag; +} + +//----------------------------------------------------------------------------- +/// Return ISI status register +/// \return Status of ISI register +//----------------------------------------------------------------------------- +unsigned int ISI_StatusRegister(void) +{ + return(AT91C_BASE_ISI->ISI_SR); +} + +//----------------------------------------------------------------------------- +/// Enable Codec path for capture next frame +//----------------------------------------------------------------------------- +void ISI_CodecPathFull(void) +{ + // The codec path is enabled and the next frame is captured. + // Both codec and preview datapaths are working simultaneously + AT91C_BASE_ISI->ISI_CTRL |= AT91C_ISI_CDC_1; + AT91C_BASE_ISI->ISI_CFG1 |= AT91C_ISI_FULL; +} + +//----------------------------------------------------------------------------- +/// Set frame rate +/// \param frate frame rate capture +/// \return +//----------------------------------------------------------------------------- +void ISI_SetFrame(unsigned int frate) +{ + if( frate > 7 ) { + TRACE_ERROR("FRate too big\n\r"); + frate = 7; + } + AT91C_BASE_ISI->ISI_CFG1 |= ((frate<<8) & AT91C_ISI_FRATE); +} + +//----------------------------------------------------------------------------- +/// Get the number of byte per pixels +/// \param bmpRgb BMP type can be YUV or RGB +/// \return Number of byte for one pixel +//----------------------------------------------------------------------------- +unsigned char ISI_BytesForOnePixel(unsigned char bmpRgb) +{ + unsigned char nbByte_Pixel; + + if (bmpRgb == RGB) { + if ((AT91C_BASE_ISI->ISI_CFG2 & AT91C_ISI_RGB_MODE) == AT91C_ISI_RGB_MODE_RGB_565){ + // RGB: 5:6:5 16bits/pixels + nbByte_Pixel = 2; + } + else { + // RGB: 8:8:8 24bits/pixels + nbByte_Pixel = 3; + } + } + else { + // YUV: 2 pixels for 4 bytes + nbByte_Pixel = 2; + } + return nbByte_Pixel; +} + +//----------------------------------------------------------------------------- +/// Reset ISI +//----------------------------------------------------------------------------- +void ISI_Reset(void) +{ + unsigned int timeout=0; + + // Resets the image sensor interface. + // Finish capturing the current frame and then shut down the module. + AT91C_BASE_ISI->ISI_CTRL = AT91C_ISI_SRST_1 | AT91C_ISI_DIS_1; + // wait Software reset has completed successfully. + while( (!(volatile int)AT91C_BASE_ISI->ISI_SR & AT91C_ISI_SRST) + && (timeout < 0x5000) ){ + timeout++; + } + if( timeout == 0x5000 ) { + TRACE_ERROR("ISI-Reset timeout\n\r"); + } +} + +//----------------------------------------------------------------------------- +/// ISI initialize +/// \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_CFG1 |= ((pVideo->Hblank << 16) & AT91C_ISI_SLD) + + ((pVideo->Vblank << 24) & AT91C_ISI_SFD); + TRACE_DEBUG("ISI_CFG1=0x%X\n\r", AT91C_BASE_ISI->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 + AT91C_BASE_ISI->ISI_CFG2 = ((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_CFG2 |= AT91C_ISI_COL_SPACE | AT91C_ISI_RGB_MODE_RGB_565 + | AT91C_ISI_RGB_CFG_RGB_DEFAULT; + } + else { + // AT91C_BASE_HISI->ISI_CFG2 &= ~AT91C_ISI_COL_SPACE; + } + TRACE_DEBUG("ISI_CFG2=0x%X\n\r", AT91C_BASE_ISI->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 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; + } + + AT91C_BASE_ISI->ISI_DMAPDSCR = pVideo->Isi_fbd_base; + AT91C_BASE_ISI->ISI_DMAPCTRL = AT91C_ISI_P_FETCH_ENABLE; + AT91C_BASE_ISI->ISI_DMAPADDR = pVideo->lcd_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); +} + +#endif // defined (BOARD_ISI_V200) + -- cgit v1.2.3