OrgST-Microelectronics
/
STM32CubeF7
mirror of https://github.com/STMicroelectronics/STM32CubeF7.git
1
0
Fork 0
Code Issues Releases Wiki Activity
STM32CubeF7/Drivers/BSP/STM32756G_EVAL/stm32756g_eval_camera.c

649 lines
17 KiB
C
Raw Blame History

/**
******************************************************************************
* @file stm32756g_eval_camera.c
* @author MCD Application Team
* @brief This file includes the driver for Camera modules mounted on
* STM32756G-EVAL and STM32746G-EVAL evaluation boards.
*
******************************************************************************
* @attention
*
* Copyright (c) 2016 STMicroelectronics.
* All rights reserved.
*
* This software is licensed under terms that can be found in the LICENSE file
* in the root directory of this software component.
* If no LICENSE file comes with this software, it is provided AS-IS.
*
******************************************************************************
@verbatim
How to use this driver:
-----------------------
- This driver is used to drive the camera.
- The S5K5CAG component driver MUST be included with this driver.
Driver description:
------------------
+ Initialization steps:
o Initialize the camera using the BSP_CAMERA_Init() function.
o Start the camera capture/snapshot using the CAMERA_Start() function.
o Suspend, resume or stop the camera capture using the following functions:
- BSP_CAMERA_Suspend()
- BSP_CAMERA_Resume()
- BSP_CAMERA_Stop()
+ Options
o Increase or decrease on the fly the brightness and/or contrast
using the following function:
- BSP_CAMERA_ContrastBrightnessConfig
o Add a special effect on the fly using the following functions:
- BSP_CAMERA_BlackWhiteConfig()
- BSP_CAMERA_ColorEffectConfig()
@endverbatim
******************************************************************************
*/
/* Dependencies
- stm32756g_eval.c
- stm32f7xx_hal_dcmi.c
- stm32f7xx_hal_dma.c
- stm32f7xx_hal_gpio.c
- stm32f7xx_hal_cortex.c
- stm32f7xx_hal_rcc_ex.h
- s5k5cag.c
EndDependencies */
/* Includes ------------------------------------------------------------------*/
#include "stm32756g_eval_camera.h"
/** @addtogroup BSP
* @{
*/
/** @addtogroup STM32756G_EVAL
* @{
*/
/** @defgroup STM32756G_EVAL_CAMERA STM32756G_EVAL CAMERA
* @{
*/
/** @defgroup STM32756G_EVAL_CAMERA_Private_TypesDefinitions CAMERA Private TypesDefinitions
* @{
*/
/**
* @}
*/
/** @defgroup STM32756G_EVAL_CAMERA_Private_Defines CAMERA Private Defines
* @{
*/
/**
* @}
*/
/** @defgroup STM32756G_EVAL_CAMERA_Private_Macros CAMERA Private Macros
* @{
*/
/**
* @}
*/
/** @defgroup STM32756G_EVAL_CAMERA_Private_Variables CAMERA Private Variables
* @{
*/
DCMI_HandleTypeDef hDcmiEval;
CAMERA_DrvTypeDef *camera_drv;
/* Camera current resolution naming (QQVGA, VGA, ...) */
static uint32_t CameraCurrentResolution;
/* Camera module I2C HW address */
static uint32_t CameraHwAddress;
/**
* @}
*/
/** @defgroup STM32756G_EVAL_CAMERA_Private_FunctionsPrototypes CAMERA Private Functions Prototypes
* @{
*/
static uint32_t GetSize(uint32_t resolution);
/**
* @}
*/
/** @defgroup STM32756G_EVAL_CAMERA_Private_Functions CAMERA Private Functions
* @{
*/
/**
* @brief Initializes the camera.
* @param Resolution : camera sensor requested resolution (x, y) : standard resolution
* naming QQVGA, QVGA, VGA ...
*
* @retval Camera status
*/
uint8_t BSP_CAMERA_Init(uint32_t Resolution)
{
DCMI_HandleTypeDef *phdcmi;
uint8_t status = CAMERA_ERROR;
/* Get the DCMI handle structure */
phdcmi = &hDcmiEval;
/*** Configures the DCMI to interface with the camera module ***/
/* DCMI configuration */
phdcmi->Init.CaptureRate = DCMI_CR_ALL_FRAME;
phdcmi->Init.HSPolarity = DCMI_HSPOLARITY_HIGH;
phdcmi->Init.SynchroMode = DCMI_SYNCHRO_HARDWARE;
phdcmi->Init.VSPolarity = DCMI_VSPOLARITY_HIGH;
phdcmi->Init.ExtendedDataMode = DCMI_EXTEND_DATA_8B;
phdcmi->Init.PCKPolarity = DCMI_PCKPOLARITY_RISING;
phdcmi->Instance = DCMI;
/* Configure IO functionalities for CAMERA detect pin */
BSP_IO_Init();
/* Apply Camera Module hardware reset */
BSP_CAMERA_HwReset();
/* Check if the CAMERA Module is plugged on board */
if(BSP_IO_ReadPin(CAM_PLUG_PIN) == BSP_IO_PIN_SET)
{
status = CAMERA_NOT_DETECTED;
return status; /* Exit with error */
}
/* Read ID of Camera module via I2C */
if (s5k5cag_ReadID(CAMERA_I2C_ADDRESS) == S5K5CAG_ID)
{
/* Initialize the camera driver structure */
camera_drv = &s5k5cag_drv;
CameraHwAddress = CAMERA_I2C_ADDRESS;
/* DCMI Initialization */
BSP_CAMERA_MspInit(&hDcmiEval, NULL);
HAL_DCMI_Init(phdcmi);
/* Camera Module Initialization via I2C to the wanted 'Resolution' */
camera_drv->Init(CameraHwAddress, Resolution);
CameraCurrentResolution = Resolution;
/* Return CAMERA_OK status */
status = CAMERA_OK;
}
else if(ov5640_ReadID(CAMERA_I2C_ADDRESS_2) == OV5640_ID)
{
/* Initialize the camera driver structure */
camera_drv = &ov5640_drv;
CameraHwAddress = CAMERA_I2C_ADDRESS_2;
/* DCMI Initialization */
BSP_CAMERA_MspInit(&hDcmiEval, NULL);
HAL_DCMI_Init(phdcmi);
/* Camera Module Initialization via I2C to the wanted 'Resolution' */
camera_drv->Init(CameraHwAddress, Resolution);
CameraCurrentResolution = Resolution;
/* Return CAMERA_OK status */
status = CAMERA_OK;
}
else
{
/* Return CAMERA_NOT_SUPPORTED status */
status = CAMERA_NOT_SUPPORTED;
}
return status;
}
/**
* @brief DeInitializes the camera.
* @retval Camera status
*/
uint8_t BSP_CAMERA_DeInit(void)
{
hDcmiEval.Instance = DCMI;
HAL_DCMI_DeInit(&hDcmiEval);
BSP_CAMERA_MspDeInit(&hDcmiEval, NULL);
return CAMERA_OK;
}
/**
* @brief Starts the camera capture in continuous mode.
* @param buff: pointer to the camera output buffer
* @retval None
*/
void BSP_CAMERA_ContinuousStart(uint8_t *buff)
{
/* Start the camera capture */
HAL_DCMI_Start_DMA(&hDcmiEval, DCMI_MODE_CONTINUOUS, (uint32_t)buff, GetSize(CameraCurrentResolution));
}
/**
* @brief Starts the camera capture in snapshot mode.
* @param buff: pointer to the camera output buffer
* @retval None
*/
void BSP_CAMERA_SnapshotStart(uint8_t *buff)
{
/* Start the camera capture */
HAL_DCMI_Start_DMA(&hDcmiEval, DCMI_MODE_SNAPSHOT, (uint32_t)buff, GetSize(CameraCurrentResolution));
}
/**
* @brief Suspend the CAMERA capture
* @retval None
*/
void BSP_CAMERA_Suspend(void)
{
/* Suspend the Camera Capture */
HAL_DCMI_Suspend(&hDcmiEval);
}
/**
* @brief Resume the CAMERA capture
* @retval None
*/
void BSP_CAMERA_Resume(void)
{
/* Start the Camera Capture */
HAL_DCMI_Resume(&hDcmiEval);
}
/**
* @brief Stop the CAMERA capture
* @retval Camera status
*/
uint8_t BSP_CAMERA_Stop(void)
{
uint8_t status = CAMERA_ERROR;
if(HAL_DCMI_Stop(&hDcmiEval) == HAL_OK)
{
status = CAMERA_OK;
}
/* Set Camera in Power Down */
BSP_CAMERA_PwrDown();
return status;
}
/**
* @brief CANERA hardware reset
* @retval None
*/
void BSP_CAMERA_HwReset(void)
{
/* Camera sensor RESET sequence */
BSP_IO_ConfigPin(RSTI_PIN, IO_MODE_OUTPUT);
BSP_IO_ConfigPin(XSDN_PIN, IO_MODE_OUTPUT);
/* Assert the camera STANDBY pin (active high) */
BSP_IO_WritePin(XSDN_PIN, BSP_IO_PIN_SET);
/* Assert the camera RSTI pin (active low) */
BSP_IO_WritePin(RSTI_PIN, BSP_IO_PIN_RESET);
HAL_Delay(100); /* RST and XSDN signals asserted during 100ms */
/* De-assert the camera STANDBY pin (active high) */
BSP_IO_WritePin(XSDN_PIN, BSP_IO_PIN_RESET);
HAL_Delay(3); /* RST de-asserted and XSDN asserted during 3ms */
/* De-assert the camera RSTI pin (active low) */
BSP_IO_WritePin(RSTI_PIN, BSP_IO_PIN_SET);
HAL_Delay(6); /* RST de-asserted during 3ms */
}
/**
* @brief CAMERA power down
* @retval None
*/
void BSP_CAMERA_PwrDown(void)
{
/* Camera power down sequence */
BSP_IO_ConfigPin(RSTI_PIN, IO_MODE_OUTPUT);
BSP_IO_ConfigPin(XSDN_PIN, IO_MODE_OUTPUT);
/* De-assert the camera STANDBY pin (active high) */
BSP_IO_WritePin(XSDN_PIN, BSP_IO_PIN_RESET);
/* Assert the camera RSTI pin (active low) */
BSP_IO_WritePin(RSTI_PIN, BSP_IO_PIN_RESET);
}
/**
* @brief Configures the camera contrast and brightness.
* @param contrast_level: Contrast level
* This parameter can be one of the following values:
* @arg CAMERA_CONTRAST_LEVEL4: for contrast +2
* @arg CAMERA_CONTRAST_LEVEL3: for contrast +1
* @arg CAMERA_CONTRAST_LEVEL2: for contrast 0
* @arg CAMERA_CONTRAST_LEVEL1: for contrast -1
* @arg CAMERA_CONTRAST_LEVEL0: for contrast -2
* @param brightness_level: Contrast level
* This parameter can be one of the following values:
* @arg CAMERA_BRIGHTNESS_LEVEL4: for brightness +2
* @arg CAMERA_BRIGHTNESS_LEVEL3: for brightness +1
* @arg CAMERA_BRIGHTNESS_LEVEL2: for brightness 0
* @arg CAMERA_BRIGHTNESS_LEVEL1: for brightness -1
* @arg CAMERA_BRIGHTNESS_LEVEL0: for brightness -2
* @retval None
*/
void BSP_CAMERA_ContrastBrightnessConfig(uint32_t contrast_level, uint32_t brightness_level)
{
if(camera_drv->Config != NULL)
{
camera_drv->Config(CameraHwAddress, CAMERA_CONTRAST_BRIGHTNESS, contrast_level, brightness_level);
}
}
/**
* @brief Configures the camera white balance.
* @param Mode: black_white mode
* This parameter can be one of the following values:
* @arg CAMERA_BLACK_WHITE_BW
* @arg CAMERA_BLACK_WHITE_NEGATIVE
* @arg CAMERA_BLACK_WHITE_BW_NEGATIVE
* @arg CAMERA_BLACK_WHITE_NORMAL
* @retval None
*/
void BSP_CAMERA_BlackWhiteConfig(uint32_t Mode)
{
if(camera_drv->Config != NULL)
{
camera_drv->Config(CameraHwAddress, CAMERA_BLACK_WHITE, Mode, 0);
}
}
/**
* @brief Configures the camera color effect.
* @param Effect: Color effect
* This parameter can be one of the following values:
* @arg CAMERA_COLOR_EFFECT_ANTIQUE
* @arg CAMERA_COLOR_EFFECT_BLUE
* @arg CAMERA_COLOR_EFFECT_GREEN
* @arg CAMERA_COLOR_EFFECT_RED
* @retval None
*/
void BSP_CAMERA_ColorEffectConfig(uint32_t Effect)
{
if(camera_drv->Config != NULL)
{
camera_drv->Config(CameraHwAddress, CAMERA_COLOR_EFFECT, Effect, 0);
}
}
/**
* @brief Get the capture size in pixels unit.
* @param resolution: the current resolution.
* @retval capture size in pixels unit.
*/
static uint32_t GetSize(uint32_t resolution)
{
uint32_t size = 0;
/* Get capture size */
switch (resolution)
{
case CAMERA_R160x120:
{
size = 0x2580;
}
break;
case CAMERA_R320x240:
{
size = 0x9600;
}
break;
case CAMERA_R480x272:
{
size = 0xFF00;
}
break;
case CAMERA_R640x480:
{
size = 0x25800;
}
break;
default:
{
break;
}
}
return size;
}
/**
* @brief Initializes the DCMI MSP.
* @param hdcmi: pointer to the DCMI handle
* @param Params
* @retval None
*/
__weak void BSP_CAMERA_MspInit(DCMI_HandleTypeDef *hdcmi, void *Params)
{
static DMA_HandleTypeDef hdma_eval;
GPIO_InitTypeDef gpio_init_structure;
/*** Enable peripherals and GPIO clocks ***/
/* Enable DCMI clock */
__HAL_RCC_DCMI_CLK_ENABLE();
/* Enable DMA2 clock */
__HAL_RCC_DMA2_CLK_ENABLE();
/* Enable GPIO clocks */
__HAL_RCC_GPIOA_CLK_ENABLE();
__HAL_RCC_GPIOB_CLK_ENABLE();
__HAL_RCC_GPIOC_CLK_ENABLE();
__HAL_RCC_GPIOD_CLK_ENABLE();
__HAL_RCC_GPIOE_CLK_ENABLE();
/*** Configure the GPIO ***/
/* Configure DCMI GPIO as alternate function */
/* On STM32756G-EVAL RevB, to use camera, ensure that JP23 is in position 1-2,
* LED3 is then no more usable */
gpio_init_structure.Pin = GPIO_PIN_4 | GPIO_PIN_6;
gpio_init_structure.Mode = GPIO_MODE_AF_PP;
gpio_init_structure.Pull = GPIO_PULLUP;
gpio_init_structure.Speed = GPIO_SPEED_HIGH;
gpio_init_structure.Alternate = GPIO_AF13_DCMI;
HAL_GPIO_Init(GPIOA, &gpio_init_structure);
gpio_init_structure.Pin = GPIO_PIN_7;
gpio_init_structure.Mode = GPIO_MODE_AF_PP;
gpio_init_structure.Pull = GPIO_PULLUP;
gpio_init_structure.Speed = GPIO_SPEED_HIGH;
gpio_init_structure.Alternate = GPIO_AF13_DCMI;
HAL_GPIO_Init(GPIOB, &gpio_init_structure);
gpio_init_structure.Pin = GPIO_PIN_6 | GPIO_PIN_7 | GPIO_PIN_8 |\
GPIO_PIN_9 | GPIO_PIN_11;
gpio_init_structure.Mode = GPIO_MODE_AF_PP;
gpio_init_structure.Pull = GPIO_PULLUP;
gpio_init_structure.Speed = GPIO_SPEED_HIGH;
gpio_init_structure.Alternate = GPIO_AF13_DCMI;
HAL_GPIO_Init(GPIOC, &gpio_init_structure);
gpio_init_structure.Pin = GPIO_PIN_3 | GPIO_PIN_6;
gpio_init_structure.Mode = GPIO_MODE_AF_PP;
gpio_init_structure.Pull = GPIO_PULLUP;
gpio_init_structure.Speed = GPIO_SPEED_HIGH;
gpio_init_structure.Alternate = GPIO_AF13_DCMI;
HAL_GPIO_Init(GPIOD, &gpio_init_structure);
gpio_init_structure.Pin = GPIO_PIN_5 | GPIO_PIN_6;
gpio_init_structure.Mode = GPIO_MODE_AF_PP;
gpio_init_structure.Pull = GPIO_PULLUP;
gpio_init_structure.Speed = GPIO_SPEED_HIGH;
gpio_init_structure.Alternate = GPIO_AF13_DCMI;
HAL_GPIO_Init(GPIOE, &gpio_init_structure);
/*** Configure the DMA ***/
/* Set the parameters to be configured */
hdma_eval.Init.Channel = DMA_CHANNEL_1;
hdma_eval.Init.Direction = DMA_PERIPH_TO_MEMORY;
hdma_eval.Init.PeriphInc = DMA_PINC_DISABLE;
hdma_eval.Init.MemInc = DMA_MINC_ENABLE;
hdma_eval.Init.PeriphDataAlignment = DMA_PDATAALIGN_WORD;
hdma_eval.Init.MemDataAlignment = DMA_MDATAALIGN_WORD;
hdma_eval.Init.Mode = DMA_CIRCULAR;
hdma_eval.Init.Priority = DMA_PRIORITY_HIGH;
hdma_eval.Init.FIFOMode = DMA_FIFOMODE_DISABLE;
hdma_eval.Init.FIFOThreshold = DMA_FIFO_THRESHOLD_FULL;
hdma_eval.Init.MemBurst = DMA_MBURST_SINGLE;
hdma_eval.Init.PeriphBurst = DMA_PBURST_SINGLE;
hdma_eval.Instance = DMA2_Stream1;
/* Associate the initialized DMA handle to the DCMI handle */
__HAL_LINKDMA(hdcmi, DMA_Handle, hdma_eval);
/*** Configure the NVIC for DCMI and DMA ***/
/* NVIC configuration for DCMI transfer complete interrupt */
HAL_NVIC_SetPriority(DCMI_IRQn, 0x0F, 0);
HAL_NVIC_EnableIRQ(DCMI_IRQn);
/* NVIC configuration for DMA2D transfer complete interrupt */
HAL_NVIC_SetPriority(DMA2_Stream1_IRQn, 0x0F, 0);
HAL_NVIC_EnableIRQ(DMA2_Stream1_IRQn);
/* Configure the DMA stream */
HAL_DMA_Init(hdcmi->DMA_Handle);
}
/**
* @brief DeInitializes the DCMI MSP.
* @param hdcmi: pointer to the DCMI handle
* @param Params
* @retval None
*/
__weak void BSP_CAMERA_MspDeInit(DCMI_HandleTypeDef *hdcmi, void *Params)
{
/* Disable NVIC for DCMI transfer complete interrupt */
HAL_NVIC_DisableIRQ(DCMI_IRQn);
/* Disable NVIC for DMA2 transfer complete interrupt */
HAL_NVIC_DisableIRQ(DMA2_Stream1_IRQn);
/* Configure the DMA stream */
HAL_DMA_DeInit(hdcmi->DMA_Handle);
/* Disable DCMI clock */
__HAL_RCC_DCMI_CLK_DISABLE();
/* GPIO pins clock and DMA clock can be shut down in the application
by surcharging this __weak function */
}
/**
* @brief Line event callback
* @param hdcmi: pointer to the DCMI handle
* @retval None
*/
void HAL_DCMI_LineEventCallback(DCMI_HandleTypeDef *hdcmi)
{
BSP_CAMERA_LineEventCallback();
}
/**
* @brief Line Event callback.
* @retval None
*/
__weak void BSP_CAMERA_LineEventCallback(void)
{
/* NOTE : This function Should not be modified, when the callback is needed,
the HAL_DCMI_LineEventCallback could be implemented in the user file
*/
}
/**
* @brief VSYNC event callback
* @param hdcmi: pointer to the DCMI handle
* @retval None
*/
void HAL_DCMI_VsyncEventCallback(DCMI_HandleTypeDef *hdcmi)
{
BSP_CAMERA_VsyncEventCallback();
}
/**
* @brief VSYNC Event callback.
* @retval None
*/
__weak void BSP_CAMERA_VsyncEventCallback(void)
{
/* NOTE : This function Should not be modified, when the callback is needed,
the HAL_DCMI_VsyncEventCallback could be implemented in the user file
*/
}
/**
* @brief Frame event callback
* @param hdcmi: pointer to the DCMI handle
* @retval None
*/
void HAL_DCMI_FrameEventCallback(DCMI_HandleTypeDef *hdcmi)
{
BSP_CAMERA_FrameEventCallback();
}
/**
* @brief Frame Event callback.
* @retval None
*/
__weak void BSP_CAMERA_FrameEventCallback(void)
{
/* NOTE : This function Should not be modified, when the callback is needed,
the HAL_DCMI_FrameEventCallback could be implemented in the user file
*/
}
/**
* @brief Error callback
* @param hdcmi: pointer to the DCMI handle
* @retval None
*/
void HAL_DCMI_ErrorCallback(DCMI_HandleTypeDef *hdcmi)
{
BSP_CAMERA_ErrorCallback();
}
/**
* @brief Error callback.
* @retval None
*/
__weak void BSP_CAMERA_ErrorCallback(void)
{
/* NOTE : This function Should not be modified, when the callback is needed,
the HAL_DCMI_ErrorCallback could be implemented in the user file
*/
}
/**
* @}
*/
/**
* @}
*/
/**
* @}
*/
/**
* @}
*/
Reference in New Issue View Git Blame Copy Permalink