diff options
Diffstat (limited to 'peripherals/isi/isi2.c')
| -rw-r--r-- | peripherals/isi/isi2.c | 246 |
1 files changed, 246 insertions, 0 deletions
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 <board.h>
+#include <utility/trace.h>
+#include <utility/video.h>
+#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)
+
|