mirror of
https://github.com/STMicroelectronics/STM32CubeF4.git
synced 2025-05-05 19:29:25 +08:00
472 lines
16 KiB
C
472 lines
16 KiB
C
/**
|
|
******************************************************************************
|
|
* @file DCMI/DCMI_CaptureMode/Src/main.c
|
|
* @author MCD Application Team
|
|
* @brief This example discribe how to configure the camera in continuous mode
|
|
* and QVGA resolution.
|
|
******************************************************************************
|
|
* @attention
|
|
*
|
|
* <h2><center>© COPYRIGHT(c) 2017 STMicroelectronics</center></h2>
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without modification,
|
|
* are permitted provided that the following conditions are met:
|
|
* 1. Redistributions of source code must retain the above copyright notice,
|
|
* this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright notice,
|
|
* this list of conditions and the following disclaimer in the documentation
|
|
* and/or other materials provided with the distribution.
|
|
* 3. Neither the name of STMicroelectronics nor the names of its contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
|
* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS 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.
|
|
*
|
|
******************************************************************************
|
|
*/
|
|
|
|
/* Includes ------------------------------------------------------------------*/
|
|
#include "main.h"
|
|
|
|
/** @addtogroup STM32F4xx_HAL_Examples
|
|
* @{
|
|
*/
|
|
|
|
/** @addtogroup DCMI_CaptureMode
|
|
* @{
|
|
*/
|
|
|
|
/* Private typedef -----------------------------------------------------------*/
|
|
/* Private define ------------------------------------------------------------*/
|
|
|
|
/* When value is 1 : Workaround to patch the LTDC pitch if not implemented in LTDC HAL */
|
|
/* When define below is 0, its means this is done in HAL LTDC, no patch needed */
|
|
#define WORKAROUND_PATCH_LTDC_PITCH 1
|
|
|
|
#define QVGA_RES_X 320
|
|
#define QVGA_RES_Y 240
|
|
|
|
#define WVGA_RES_X 800
|
|
#define WVGA_RES_Y 480
|
|
|
|
#define ARGB8888_BYTE_PER_PIXEL 4
|
|
#define RGB565_BYTE_PER_PIXEL 2
|
|
|
|
/* Private macro -------------------------------------------------------------*/
|
|
/* Private variables ---------------------------------------------------------*/
|
|
|
|
LCD_OrientationTypeDef lcd_display_orientation = LCD_ORIENTATION_INVALID;
|
|
|
|
/* Camera resolution is QVGA (320x240) */
|
|
static uint32_t CameraResX = QVGA_RES_X;
|
|
static uint32_t CameraResY = QVGA_RES_Y;
|
|
static uint32_t LcdResX = WVGA_RES_X; /* WVGA landscape */
|
|
static uint32_t LcdResY = WVGA_RES_Y;
|
|
|
|
static uint32_t offset_address_area_cam_in_lcd_buffer = 0;
|
|
|
|
static volatile uint32_t start_the_camera_capture = 0;
|
|
static volatile uint32_t cam_frame_buffer_ready = 0;
|
|
static uint32_t loopCnt = 0;
|
|
|
|
LTDC_Layer_TypeDef * LTDC_Layer1_Dbg = LTDC_Layer1;
|
|
LTDC_Layer_TypeDef * LTDC_Layer2_Dbg = LTDC_Layer2;
|
|
|
|
/* Private function prototypes -----------------------------------------------*/
|
|
static void SystemClock_Config(void);
|
|
|
|
|
|
static uint8_t CopyCamFrameBufferToLcdFrameBuffer(void *pSrc, void *pDst, uint32_t xSize, uint32_t ySize);
|
|
static uint8_t CameraFrameBufferRgb565_Init(uint32_t sizeX, uint32_t sizeY, uint32_t argb8888_Value);
|
|
|
|
#if (WORKAROUND_PATCH_LTDC_PITCH == 1)
|
|
static uint8_t LCD_LTDC_PatchPitch(void);
|
|
#endif /* WORKAROUND_PATCH_LTDC_PITCH == 1 */
|
|
|
|
static void OnError_Handler(uint32_t condition);
|
|
|
|
/* Exported functions ---------------------------------------------------------*/
|
|
|
|
/**
|
|
* @brief Main program
|
|
* @param None
|
|
* @retval None
|
|
*/
|
|
int main(void)
|
|
{
|
|
uint8_t lcd_status = LCD_OK;
|
|
CameraResX = QVGA_RES_X;
|
|
CameraResY = QVGA_RES_Y;
|
|
LcdResX = WVGA_RES_X; /* WVGA landscape */
|
|
LcdResY = WVGA_RES_Y;
|
|
loopCnt = 0;
|
|
start_the_camera_capture = 0;
|
|
cam_frame_buffer_ready = 0;
|
|
offset_address_area_cam_in_lcd_buffer = ((((LcdResY - CameraResY) / 2) * LcdResX)
|
|
+ ((LcdResX - CameraResX) / 2))
|
|
* ARGB8888_BYTE_PER_PIXEL;
|
|
|
|
LTDC_Layer1_Dbg = LTDC_Layer1;
|
|
LTDC_Layer2_Dbg = LTDC_Layer2;
|
|
|
|
/* STM32F4xx HAL library initialization:
|
|
- Configure the Flash prefetch, instruction and Data caches
|
|
- Systick timer is configured by default as source of time base, but user
|
|
can eventually implement his proper time base source (a general purpose
|
|
timer for example or other time source), keeping in mind that Time base
|
|
duration should be kept 1ms since PPP_TIMEOUT_VALUEs are defined and
|
|
handled in milliseconds basis.
|
|
- Set NVIC Group Priority to 4
|
|
- Low Level Initialization: global MSP (MCU Support Package) initialization
|
|
*/
|
|
HAL_Init();
|
|
|
|
/* Configure the system clock to 180 MHz */
|
|
SystemClock_Config();
|
|
|
|
/* Wait until MFX is ready after reset */
|
|
HAL_Delay(100);
|
|
|
|
/* Initialize MFX */
|
|
BSP_IO_Init();
|
|
|
|
/* Initialize used Leds */
|
|
BSP_LED_Init(LED3);
|
|
|
|
/*##-1- Initialize the LCD #################################################*/
|
|
// BSP_LCD_InitEx(LCD_ORIENTATION_PORTRAIT); /* uncomment if Portrait orientation is needed */
|
|
BSP_LCD_Init(); /* Uncomment if default config (landscape orientation) is needed */
|
|
while(lcd_status != LCD_OK);
|
|
|
|
BSP_LCD_LayerDefaultInit(0, LCD_FB_START_ADDRESS);
|
|
BSP_LCD_SelectLayer(0);
|
|
|
|
if(BSP_LCD_GetXSize() > BSP_LCD_GetYSize())
|
|
{
|
|
lcd_display_orientation = LCD_ORIENTATION_LANDSCAPE;
|
|
}
|
|
else
|
|
{
|
|
lcd_display_orientation = LCD_ORIENTATION_PORTRAIT;
|
|
}
|
|
|
|
/* Prepare using DMA2D the 800x480 LCD frame buffer to display background color black */
|
|
/* and title of the example */
|
|
BSP_LCD_Clear(LCD_COLOR_BLACK);
|
|
BSP_LCD_SetTextColor(LCD_COLOR_WHITE);
|
|
BSP_LCD_SetBackColor(LCD_COLOR_BLUE);
|
|
BSP_LCD_SetFont(&Font16);
|
|
|
|
/* Print example description */
|
|
BSP_LCD_DisplayStringAt(0, 440, (uint8_t *)"DCMI Capture example", CENTER_MODE);
|
|
|
|
HAL_Delay(100);
|
|
|
|
#if (WORKAROUND_PATCH_LTDC_PITCH == 1)
|
|
/* Patch the LTDC pitch */
|
|
lcd_status = LCD_LTDC_PatchPitch();
|
|
OnError_Handler(lcd_status != LCD_OK);
|
|
#endif /* WORKAROUND_PATCH_LTDC_PITCH == 1 */
|
|
|
|
/* Initialize the camera frame buffer 320x240 in RGB565 to a fixed grey pattern */
|
|
lcd_status = CameraFrameBufferRgb565_Init(CameraResX, CameraResY, 0x55555555);
|
|
OnError_Handler(lcd_status != LCD_OK);
|
|
|
|
/*##-2- Camera Initialization ############################*/
|
|
/* Initialize the Camera in QVGA mode */
|
|
BSP_CAMERA_Init(CAMERA_R320x240);
|
|
|
|
/* Wait 1s to let auto-loops in the camera module converge and lead to correct exposure */
|
|
HAL_Delay(1000);
|
|
|
|
/*##-3- Camera Continuous capture start in QVGA resolution ############################*/
|
|
BSP_CAMERA_ContinuousStart((uint8_t *)CAMERA_FRAME_BUFFER);
|
|
|
|
/* Wait until effective DMA P2M DCMI capture startup in Camera frame buffer */
|
|
while(start_the_camera_capture == 0) {;}
|
|
|
|
while (1)
|
|
{
|
|
loopCnt++;
|
|
|
|
/* Wait until camera frame buffer is filled with new picture */
|
|
while (cam_frame_buffer_ready == 0) { ; }
|
|
|
|
/* Blocking copy Camera Frame buffer to LCD frame buffer area */
|
|
/* Using the DMA2D in polling mode */
|
|
lcd_status = CopyCamFrameBufferToLcdFrameBuffer((void*) CAMERA_FRAME_BUFFER,
|
|
(void*) (LCD_FRAME_BUFFER + offset_address_area_cam_in_lcd_buffer),
|
|
CameraResX, CameraResY);
|
|
OnError_Handler(lcd_status != LCD_OK);
|
|
|
|
cam_frame_buffer_ready = 0;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief Camera Frame Event callback.
|
|
*/
|
|
void BSP_CAMERA_FrameEventCallback(void)
|
|
{
|
|
if(start_the_camera_capture == 0)
|
|
{
|
|
/* Wait the first camera end of frame to start capture as DMA is started at that time */
|
|
start_the_camera_capture = 1;
|
|
}
|
|
|
|
if((start_the_camera_capture == 1) && (cam_frame_buffer_ready == 0))
|
|
{
|
|
cam_frame_buffer_ready = 1;
|
|
}
|
|
}
|
|
|
|
|
|
/* Private functions ---------------------------------------------------------*/
|
|
|
|
/**
|
|
* @brief Copy and convert Camera frame buffer (CameraResX, CameraResY) of format RGB565
|
|
* to LCD frame buffer area of size (CameraResX, CameraResY) in ARGB8888.
|
|
* @param pSrc: Pointer to source buffer : Camera frame buffer start here
|
|
* @param pDst: Pointer to destination buffer LCD frame buffer area start here
|
|
* @param xSize: Buffer width (CameraResX here)
|
|
* @param ySize: Buffer height (CameraResY here)
|
|
* @retval LCD Status : LCD_OK or LCD_ERROR
|
|
*/
|
|
static uint8_t CopyCamFrameBufferToLcdFrameBuffer(void *pSrc, void *pDst, uint32_t xSize, uint32_t ySize)
|
|
{
|
|
DMA2D_HandleTypeDef hdma2d_eval;
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
uint8_t lcd_status = LCD_ERROR;
|
|
|
|
/* Configure the DMA2D Mode, Color Mode and output offset */
|
|
hdma2d_eval.Init.Mode = DMA2D_M2M_PFC;
|
|
hdma2d_eval.Init.ColorMode = DMA2D_ARGB8888; /* Output color out of PFC */
|
|
|
|
/* Output offset in pixels == nb of pixels to be added at end to come to the */
|
|
/* first pixel of the next line : on the output side of the DMA2D computation */
|
|
hdma2d_eval.Init.OutputOffset = (LcdResX - CameraResX);
|
|
|
|
/* Foreground Configuration */
|
|
hdma2d_eval.LayerCfg[1].AlphaMode = DMA2D_NO_MODIF_ALPHA;
|
|
hdma2d_eval.LayerCfg[1].InputAlpha = 0xFF; /* fully opaque */
|
|
hdma2d_eval.LayerCfg[1].InputColorMode = DMA2D_INPUT_RGB565;
|
|
hdma2d_eval.LayerCfg[1].InputOffset = 0;
|
|
|
|
hdma2d_eval.Instance = DMA2D;
|
|
|
|
/* DMA2D Initialization */
|
|
if(HAL_DMA2D_Init(&hdma2d_eval) == HAL_OK)
|
|
{
|
|
if(HAL_DMA2D_ConfigLayer(&hdma2d_eval, 1) == HAL_OK)
|
|
{
|
|
if (HAL_DMA2D_Start(&hdma2d_eval, (uint32_t)pSrc, (uint32_t)pDst, xSize, ySize) == HAL_OK)
|
|
{
|
|
/* Polling For DMA transfer */
|
|
hal_status = HAL_DMA2D_PollForTransfer(&hdma2d_eval, 10);
|
|
if(hal_status == HAL_OK)
|
|
{
|
|
/* return good status on exit */
|
|
lcd_status = LCD_OK;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
return(lcd_status);
|
|
}
|
|
|
|
/**
|
|
* @brief Init camera frame buffer with fixed color in format RGB565
|
|
* to a LCD display frame buffer line in format ARGB8888 using DMA2D service.
|
|
* @param sizeX: Size in X of rectangular region of the Camera frame buffer to initialize (in pixels unit)
|
|
* @param sizeX: Size in X of rectangular region of the Camera frame buffer to initialize (in pixels unit)
|
|
* @param argb_Value : Initialization value (pattern ARGB8888) to be applied to all rectangular region selected.
|
|
* @retval Status LCD_OK or LCD_ERROR
|
|
*/
|
|
static uint8_t CameraFrameBufferRgb565_Init(uint32_t sizeX, uint32_t sizeY, uint32_t argb8888_Value)
|
|
{
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
uint8_t lcd_status = LCD_ERROR;
|
|
DMA2D_HandleTypeDef hdma2d_eval;
|
|
|
|
if((sizeX <= CAMERA_VGA_RES_X) && (sizeY <= CAMERA_VGA_RES_Y))
|
|
{
|
|
/* Register to memory mode with RGB565 as colorMode */
|
|
hdma2d_eval.Init.Mode = DMA2D_R2M; /* Mode Register to Memory */
|
|
hdma2d_eval.Init.ColorMode = DMA2D_RGB565; /* Output color mode */
|
|
hdma2d_eval.Init.OutputOffset = 0x0; /* No offset in output */
|
|
|
|
hdma2d_eval.Instance = DMA2D;
|
|
|
|
hal_status = HAL_DMA2D_Init(&hdma2d_eval);
|
|
if(hal_status == HAL_OK)
|
|
{
|
|
if (HAL_DMA2D_Start(&hdma2d_eval, argb8888_Value, (uint32_t)CAMERA_FRAME_BUFFER, sizeX, sizeY) == HAL_OK)
|
|
{
|
|
/* Polling For DMA transfer */
|
|
HAL_DMA2D_PollForTransfer(&hdma2d_eval, 10);
|
|
|
|
/* Return good status on exit */
|
|
lcd_status = LCD_OK;
|
|
}
|
|
}
|
|
}
|
|
|
|
return (lcd_status);
|
|
}
|
|
|
|
#if (WORKAROUND_PATCH_LTDC_PITCH == 1)
|
|
/**
|
|
* @brief Patch the pitch when not well managed in HAL LTDC.
|
|
* @retval LCD_ERROR or LCD_OK
|
|
*/
|
|
static uint8_t LCD_LTDC_PatchPitch(void)
|
|
{
|
|
uint8_t lcd_status = LCD_ERROR;
|
|
uint32_t pitch_update = ((LcdResX * ARGB8888_BYTE_PER_PIXEL) << 16);
|
|
|
|
/* clear the wrong pitch set before by call to HAL_LTDC_ConfigLayer() */
|
|
LTDC_Layer2->CFBLR &= ~(LTDC_LxCFBLR_CFBP);
|
|
|
|
/* Sets immediate update of LTDC pitch configured above */
|
|
LTDC->SRCR |= LTDC_SRCR_IMR;
|
|
|
|
/* update pitch in bytes : LTDC address increment from one line to the next */
|
|
LTDC_Layer2->CFBLR |= pitch_update;
|
|
|
|
/* Sets immediate update of LTDC pitch configured above */
|
|
LTDC->SRCR |= LTDC_SRCR_IMR;
|
|
|
|
/* Return good status on exit */
|
|
lcd_status = LCD_OK;
|
|
|
|
return(lcd_status);
|
|
}
|
|
#endif /* WORKAROUND_PATCH_LTDC_PITCH == 1 */
|
|
|
|
/**
|
|
* @brief On Error Handler on condition TRUE.
|
|
* @param condition : Can be TRUE or FALSE
|
|
* @retval None
|
|
*/
|
|
static void OnError_Handler(uint32_t condition)
|
|
{
|
|
if(condition)
|
|
{
|
|
BSP_LED_On(LED3);
|
|
while(1) { ; } /* Blocking on error */
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief System Clock Configuration
|
|
* The system Clock is configured as follow :
|
|
* System Clock source = PLL (HSE)
|
|
* SYSCLK(Hz) = 180000000
|
|
* HCLK(Hz) = 180000000
|
|
* AHB Prescaler = 1
|
|
* APB1 Prescaler = 4
|
|
* APB2 Prescaler = 2
|
|
* HSE Frequency(Hz) = 25000000
|
|
* PLL_M = 25
|
|
* PLL_N = 360
|
|
* PLL_P = 2
|
|
* PLL_Q = 7
|
|
* PLL_R = 6
|
|
* VDD(V) = 3.3
|
|
* Main regulator output voltage = Scale1 mode
|
|
* Flash Latency(WS) = 5
|
|
* @param None
|
|
* @retval None
|
|
*/
|
|
static void SystemClock_Config(void)
|
|
{
|
|
RCC_ClkInitTypeDef RCC_ClkInitStruct;
|
|
RCC_OscInitTypeDef RCC_OscInitStruct;
|
|
HAL_StatusTypeDef ret = HAL_OK;
|
|
|
|
/* Enable Power Control clock */
|
|
__HAL_RCC_PWR_CLK_ENABLE();
|
|
|
|
/* The voltage scaling allows optimizing the power consumption when the device is
|
|
clocked below the maximum system frequency, to update the voltage scaling value
|
|
regarding system frequency refer to product datasheet. */
|
|
__HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE1);
|
|
|
|
/* Enable HSE Oscillator and activate PLL with HSE as source */
|
|
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
RCC_OscInitStruct.PLL.PLLM = 25;
|
|
RCC_OscInitStruct.PLL.PLLN = 360;
|
|
RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV2;
|
|
RCC_OscInitStruct.PLL.PLLQ = 7;
|
|
RCC_OscInitStruct.PLL.PLLR = 6;
|
|
|
|
ret = HAL_RCC_OscConfig(&RCC_OscInitStruct);
|
|
if(ret != HAL_OK)
|
|
{
|
|
while(1) { ; }
|
|
}
|
|
|
|
/* Activate the OverDrive to reach the 180 MHz Frequency */
|
|
ret = HAL_PWREx_EnableOverDrive();
|
|
if(ret != HAL_OK)
|
|
{
|
|
while(1) { ; }
|
|
}
|
|
|
|
/* Select PLL as system clock source and configure the HCLK, PCLK1 and PCLK2 clocks dividers */
|
|
RCC_ClkInitStruct.ClockType = (RCC_CLOCKTYPE_SYSCLK | RCC_CLOCKTYPE_HCLK | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2);
|
|
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV4;
|
|
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV2;
|
|
|
|
ret = HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_5);
|
|
if(ret != HAL_OK)
|
|
{
|
|
while(1) { ; }
|
|
}
|
|
}
|
|
|
|
#ifdef USE_FULL_ASSERT
|
|
/**
|
|
* @brief Reports the name of the source file and the source line number
|
|
* where the assert_param error has occurred.
|
|
* @param file: pointer to the source file name
|
|
* @param line: assert_param error line source number
|
|
* @retval None
|
|
*/
|
|
void assert_failed(uint8_t *file, uint32_t line)
|
|
{
|
|
/* User can add his own implementation to report the file name and line number,
|
|
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
|
|
/* Infinite loop */
|
|
while (1)
|
|
{
|
|
}
|
|
}
|
|
#endif /* USE_FULL_ASSERT */
|
|
|
|
/**
|
|
* @}
|
|
*/
|
|
|
|
/**
|
|
* @}
|
|
*/
|
|
|
|
/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
|