Subversion Repositories openrisc

/* ----------------------------------------------------------------------------

 *         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)