OV7670 Support

Fork of BSP_DISCO_F746NG by Huseyin Buyukesmeli

Revision:
6:e1d9da7fe856
Child:
8:ff634d7a9d9f
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Drivers/BSP/STM32746G-Discovery/stm32746g_discovery.c	Thu Nov 10 09:57:11 2016 +0100
@@ -0,0 +1,902 @@
+/**
+  ******************************************************************************
+  * @file    stm32746g_discovery.c
+  * @author  MCD Application Team
+  * @version V1.1.1
+  * @date    02-June-2016
+  * @brief   This file provides a set of firmware functions to manage LEDs, 
+  *          push-buttons and COM ports available on STM32746G-Discovery
+  *          board(MB1191) from STMicroelectronics.
+  ******************************************************************************
+  * @attention
+  *
+  * <h2><center>&copy; COPYRIGHT(c) 2016 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 "stm32746g_discovery.h"
+
+void wait_ms(int ms); // MBED to replace HAL_Delay function
+
+/** @addtogroup BSP
+  * @{
+  */ 
+
+/** @addtogroup STM32746G_DISCOVERY
+  * @{
+  */
+
+/** @defgroup STM32746G_DISCOVERY_LOW_LEVEL STM32746G_DISCOVERY_LOW_LEVEL
+  * @{
+  */
+
+/** @defgroup STM32746G_DISCOVERY_LOW_LEVEL_Private_TypesDefinitions STM32746G_DISCOVERY_LOW_LEVEL Private Types Definitions
+  * @{
+  */
+/**
+  * @}
+  */
+
+/** @defgroup STM32746G_DISCOVERY_LOW_LEVEL_Private_Defines STM32746G_DISCOVERY_LOW_LEVEL Private Defines
+  * @{
+  */
+/**
+ * @brief STM32746G DISCOVERY BSP Driver version number V1.1.1
+   */
+#define __STM32746G_DISCO_BSP_VERSION_MAIN   (0x01) /*!< [31:24] main version */
+#define __STM32746G_DISCO_BSP_VERSION_SUB1   (0x01) /*!< [23:16] sub1 version */
+#define __STM32746G_DISCO_BSP_VERSION_SUB2   (0x01) /*!< [15:8]  sub2 version */
+#define __STM32746G_DISCO_BSP_VERSION_RC     (0x00) /*!< [7:0]  release candidate */
+#define __STM32746G_DISCO_BSP_VERSION         ((__STM32746G_DISCO_BSP_VERSION_MAIN << 24)\
+                                             |(__STM32746G_DISCO_BSP_VERSION_SUB1 << 16)\
+                                             |(__STM32746G_DISCO_BSP_VERSION_SUB2 << 8 )\
+                                             |(__STM32746G_DISCO_BSP_VERSION_RC))
+/**
+  * @}
+  */
+
+/** @defgroup STM32746G_DISCOVERY_LOW_LEVEL_Private_Macros STM32746G_DISCOVERY_LOW_LEVEL Private Macros
+  * @{
+  */
+/**
+  * @}
+  */
+
+/** @defgroup STM32746G_DISCOVERY_LOW_LEVEL_Private_Variables STM32746G_DISCOVERY_LOW_LEVEL Private Variables
+  * @{
+  */
+
+const uint32_t GPIO_PIN[LEDn] = {LED1_PIN};
+
+GPIO_TypeDef* BUTTON_PORT[BUTTONn] = {WAKEUP_BUTTON_GPIO_PORT,
+                                      TAMPER_BUTTON_GPIO_PORT,
+                                      KEY_BUTTON_GPIO_PORT};
+
+const uint16_t BUTTON_PIN[BUTTONn] = {WAKEUP_BUTTON_PIN,
+                                      TAMPER_BUTTON_PIN,
+                                      KEY_BUTTON_PIN};
+
+const uint16_t BUTTON_IRQn[BUTTONn] = {WAKEUP_BUTTON_EXTI_IRQn,
+                                       TAMPER_BUTTON_EXTI_IRQn,
+                                       KEY_BUTTON_EXTI_IRQn};
+
+USART_TypeDef* COM_USART[COMn] = {DISCOVERY_COM1};
+
+GPIO_TypeDef* COM_TX_PORT[COMn] = {DISCOVERY_COM1_TX_GPIO_PORT};
+
+GPIO_TypeDef* COM_RX_PORT[COMn] = {DISCOVERY_COM1_RX_GPIO_PORT};
+
+const uint16_t COM_TX_PIN[COMn] = {DISCOVERY_COM1_TX_PIN};
+
+const uint16_t COM_RX_PIN[COMn] = {DISCOVERY_COM1_RX_PIN};
+
+const uint16_t COM_TX_AF[COMn] = {DISCOVERY_COM1_TX_AF};
+
+const uint16_t COM_RX_AF[COMn] = {DISCOVERY_COM1_RX_AF};
+
+static I2C_HandleTypeDef hI2cAudioHandler = {0};
+static I2C_HandleTypeDef hI2cExtHandler = {0};
+
+/**
+  * @}
+  */
+
+/** @defgroup STM32746G_DISCOVERY_LOW_LEVEL_Private_FunctionPrototypes STM32746G_DISCOVERY_LOW_LEVEL Private Function Prototypes
+  * @{
+  */
+static void     I2Cx_MspInit(I2C_HandleTypeDef *i2c_handler);
+static void     I2Cx_Init(I2C_HandleTypeDef *i2c_handler);
+
+static HAL_StatusTypeDef I2Cx_ReadMultiple(I2C_HandleTypeDef *i2c_handler, uint8_t Addr, uint16_t Reg, uint16_t MemAddSize, uint8_t *Buffer, uint16_t Length);
+static HAL_StatusTypeDef I2Cx_WriteMultiple(I2C_HandleTypeDef *i2c_handler, uint8_t Addr, uint16_t Reg, uint16_t MemAddSize, uint8_t *Buffer, uint16_t Length);
+static HAL_StatusTypeDef I2Cx_IsDeviceReady(I2C_HandleTypeDef *i2c_handler, uint16_t DevAddress, uint32_t Trials);
+static void              I2Cx_Error(I2C_HandleTypeDef *i2c_handler, uint8_t Addr);
+
+/* AUDIO IO functions */
+void            AUDIO_IO_Init(void);
+void            AUDIO_IO_DeInit(void);
+void            AUDIO_IO_Write(uint8_t Addr, uint16_t Reg, uint16_t Value);
+uint16_t        AUDIO_IO_Read(uint8_t Addr, uint16_t Reg);
+void            AUDIO_IO_Delay(uint32_t Delay);
+
+/* TOUCHSCREEN IO functions */
+void            TS_IO_Init(void);
+void            TS_IO_Write(uint8_t Addr, uint8_t Reg, uint8_t Value);
+uint8_t         TS_IO_Read(uint8_t Addr, uint8_t Reg);
+void            TS_IO_Delay(uint32_t Delay);
+
+/* CAMERA IO functions */
+void            CAMERA_IO_Init(void);
+void            CAMERA_Delay(uint32_t Delay);
+void            CAMERA_IO_Write(uint8_t Addr, uint8_t Reg, uint8_t Value);
+uint8_t         CAMERA_IO_Read(uint8_t Addr, uint8_t Reg);
+
+/* I2C EEPROM IO function */
+void                EEPROM_IO_Init(void);
+HAL_StatusTypeDef   EEPROM_IO_WriteData(uint16_t DevAddress, uint16_t MemAddress, uint8_t* pBuffer, uint32_t BufferSize);
+HAL_StatusTypeDef   EEPROM_IO_ReadData(uint16_t DevAddress, uint16_t MemAddress, uint8_t* pBuffer, uint32_t BufferSize);
+HAL_StatusTypeDef   EEPROM_IO_IsDeviceReady(uint16_t DevAddress, uint32_t Trials);
+/**
+  * @}
+  */
+
+/** @defgroup STM32746G_DISCOVERY_LOW_LEVEL_Exported_Functions STM32746G_DISCOVERY_LOW_LEVELSTM32746G_DISCOVERY_LOW_LEVEL Exported Functions
+  * @{
+  */ 
+
+  /**
+  * @brief  This method returns the STM32746G DISCOVERY BSP Driver revision
+  * @retval version: 0xXYZR (8bits for each decimal, R for RC)
+  */
+uint32_t BSP_GetVersion(void)
+{
+  return __STM32746G_DISCO_BSP_VERSION;
+}
+
+/**
+  * @brief  Configures LED on GPIO.
+  * @param  Led: LED to be configured. 
+  *          This parameter can be one of the following values:
+  *            @arg  LED1
+  * @retval None
+  */
+void BSP_LED_Init(Led_TypeDef Led)
+{
+  GPIO_InitTypeDef  gpio_init_structure;
+  GPIO_TypeDef*     gpio_led;
+
+  if (Led == DISCO_LED1) // MBED
+  {
+    gpio_led = LED1_GPIO_PORT;
+    /* Enable the GPIO_LED clock */
+    LED1_GPIO_CLK_ENABLE();
+
+    /* Configure the GPIO_LED pin */
+    gpio_init_structure.Pin = GPIO_PIN[Led];
+    gpio_init_structure.Mode = GPIO_MODE_OUTPUT_PP;
+    gpio_init_structure.Pull = GPIO_PULLUP;
+    gpio_init_structure.Speed = GPIO_SPEED_HIGH;
+  
+    HAL_GPIO_Init(gpio_led, &gpio_init_structure);
+    
+    /* By default, turn off LED */
+    HAL_GPIO_WritePin(gpio_led, GPIO_PIN[Led], GPIO_PIN_RESET);
+  }
+}
+
+/**
+  * @brief  DeInit LEDs.
+  * @param  Led: LED to be configured. 
+  *          This parameter can be one of the following values:
+  *            @arg  LED1
+  * @note Led DeInit does not disable the GPIO clock
+  * @retval None
+  */
+void BSP_LED_DeInit(Led_TypeDef Led)
+{
+  GPIO_InitTypeDef  gpio_init_structure;
+  GPIO_TypeDef*     gpio_led;
+
+  if (Led == DISCO_LED1) // MBED
+  {
+    gpio_led = LED1_GPIO_PORT;
+    /* Turn off LED */
+    HAL_GPIO_WritePin(gpio_led, GPIO_PIN[Led], GPIO_PIN_RESET);
+    /* Configure the GPIO_LED pin */
+    gpio_init_structure.Pin = GPIO_PIN[Led];
+    HAL_GPIO_DeInit(gpio_led, gpio_init_structure.Pin);
+  }
+}
+
+/**
+  * @brief  Turns selected LED On.
+  * @param  Led: LED to be set on 
+  *          This parameter can be one of the following values:
+  *            @arg  LED1
+  * @retval None
+  */
+void BSP_LED_On(Led_TypeDef Led)
+{
+  GPIO_TypeDef*     gpio_led;
+
+  if (Led == DISCO_LED1)	/* Switch On LED connected to GPIO */ // MBED
+  {
+    gpio_led = LED1_GPIO_PORT;
+    HAL_GPIO_WritePin(gpio_led, GPIO_PIN[Led], GPIO_PIN_SET);
+  }
+}
+
+/**
+  * @brief  Turns selected LED Off. 
+  * @param  Led: LED to be set off
+  *          This parameter can be one of the following values:
+  *            @arg  LED1
+  * @retval None
+  */
+void BSP_LED_Off(Led_TypeDef Led)
+{
+  GPIO_TypeDef*     gpio_led;
+
+  if (Led == DISCO_LED1) /* Switch Off LED connected to GPIO */ // MBED
+  {
+    gpio_led = LED1_GPIO_PORT;
+    HAL_GPIO_WritePin(gpio_led, GPIO_PIN[Led], GPIO_PIN_RESET);
+  }
+}
+
+/**
+  * @brief  Toggles the selected LED.
+  * @param  Led: LED to be toggled
+  *          This parameter can be one of the following values:
+  *            @arg  LED1
+  * @retval None
+  */
+void BSP_LED_Toggle(Led_TypeDef Led)
+{
+  GPIO_TypeDef*     gpio_led;
+
+  if (Led == DISCO_LED1)	/* Toggle LED connected to GPIO */ // MBED
+  {
+    gpio_led = LED1_GPIO_PORT;
+    HAL_GPIO_TogglePin(gpio_led, GPIO_PIN[Led]);
+  }
+}
+
+/**
+  * @brief  Configures button GPIO and EXTI Line.
+  * @param  Button: Button to be configured
+  *          This parameter can be one of the following values:
+  *            @arg  BUTTON_WAKEUP: Wakeup Push Button 
+  *            @arg  BUTTON_TAMPER: Tamper Push Button  
+  *            @arg  BUTTON_KEY: Key Push Button
+  * @param  ButtonMode: Button mode
+  *          This parameter can be one of the following values:
+  *            @arg  BUTTON_MODE_GPIO: Button will be used as simple IO
+  *            @arg  BUTTON_MODE_EXTI: Button will be connected to EXTI line 
+  *                                    with interrupt generation capability
+  * @note On STM32746G-Discovery board, the three buttons (Wakeup, Tamper and key buttons)
+  *       are mapped on the same push button named "User"
+  *       on the board serigraphy.
+  * @retval None
+  */
+void BSP_PB_Init(Button_TypeDef Button, ButtonMode_TypeDef ButtonMode)
+{
+  GPIO_InitTypeDef gpio_init_structure;
+  
+  /* Enable the BUTTON clock */
+  BUTTONx_GPIO_CLK_ENABLE(Button);
+  
+  if(ButtonMode == BUTTON_MODE_GPIO)
+  {
+    /* Configure Button pin as input */
+    gpio_init_structure.Pin = BUTTON_PIN[Button];
+    gpio_init_structure.Mode = GPIO_MODE_INPUT;
+    gpio_init_structure.Pull = GPIO_NOPULL;
+    gpio_init_structure.Speed = GPIO_SPEED_FAST;
+    HAL_GPIO_Init(BUTTON_PORT[Button], &gpio_init_structure);
+  }
+  
+  if(ButtonMode == BUTTON_MODE_EXTI)
+  {
+    /* Configure Button pin as input with External interrupt */
+    gpio_init_structure.Pin = BUTTON_PIN[Button];
+    gpio_init_structure.Pull = GPIO_NOPULL;
+    gpio_init_structure.Speed = GPIO_SPEED_FAST;
+    
+    if(Button != BUTTON_WAKEUP)
+    {
+      gpio_init_structure.Mode = GPIO_MODE_IT_FALLING; 
+    }
+    else
+    {
+      gpio_init_structure.Mode = GPIO_MODE_IT_RISING;
+    }
+    
+    HAL_GPIO_Init(BUTTON_PORT[Button], &gpio_init_structure);
+    
+    /* Enable and set Button EXTI Interrupt to the lowest priority */
+    HAL_NVIC_SetPriority((IRQn_Type)(BUTTON_IRQn[Button]), 0x0F, 0x00);
+    HAL_NVIC_EnableIRQ((IRQn_Type)(BUTTON_IRQn[Button]));
+  }
+}
+
+/**
+  * @brief  Push Button DeInit.
+  * @param  Button: Button to be configured
+  *          This parameter can be one of the following values:
+  *            @arg  BUTTON_WAKEUP: Wakeup Push Button 
+  *            @arg  BUTTON_TAMPER: Tamper Push Button  
+  *            @arg  BUTTON_KEY: Key Push Button
+  * @note On STM32746G-Discovery board, the three buttons (Wakeup, Tamper and key buttons) 
+  *       are mapped on the same push button named "User"
+  *       on the board serigraphy.
+  * @note PB DeInit does not disable the GPIO clock
+  * @retval None
+  */
+void BSP_PB_DeInit(Button_TypeDef Button)
+{
+    GPIO_InitTypeDef gpio_init_structure;
+
+    gpio_init_structure.Pin = BUTTON_PIN[Button];
+    HAL_NVIC_DisableIRQ((IRQn_Type)(BUTTON_IRQn[Button]));
+    HAL_GPIO_DeInit(BUTTON_PORT[Button], gpio_init_structure.Pin);
+}
+
+
+/**
+  * @brief  Returns the selected button state.
+  * @param  Button: Button to be checked
+  *          This parameter can be one of the following values:
+  *            @arg  BUTTON_WAKEUP: Wakeup Push Button 
+  *            @arg  BUTTON_TAMPER: Tamper Push Button 
+  *            @arg  BUTTON_KEY: Key Push Button
+  * @note On STM32746G-Discovery board, the three buttons (Wakeup, Tamper and key buttons) 
+  *       are mapped on the same push button named "User"
+  *       on the board serigraphy.
+  * @retval The Button GPIO pin value
+  */
+uint32_t BSP_PB_GetState(Button_TypeDef Button)
+{
+  return HAL_GPIO_ReadPin(BUTTON_PORT[Button], BUTTON_PIN[Button]);
+}
+
+/**
+  * @brief  Configures COM port.
+  * @param  COM: COM port to be configured.
+  *          This parameter can be one of the following values:
+  *            @arg  COM1 
+  *            @arg  COM2 
+  * @param  huart: Pointer to a UART_HandleTypeDef structure that contains the
+  *                configuration information for the specified USART peripheral.
+  * @retval None
+  */
+void BSP_COM_Init(COM_TypeDef COM, UART_HandleTypeDef *huart)
+{
+  GPIO_InitTypeDef gpio_init_structure;
+
+  /* Enable GPIO clock */
+  DISCOVERY_COMx_TX_GPIO_CLK_ENABLE(COM);
+  DISCOVERY_COMx_RX_GPIO_CLK_ENABLE(COM);
+
+  /* Enable USART clock */
+  DISCOVERY_COMx_CLK_ENABLE(COM);
+
+  /* Configure USART Tx as alternate function */
+  gpio_init_structure.Pin = COM_TX_PIN[COM];
+  gpio_init_structure.Mode = GPIO_MODE_AF_PP;
+  gpio_init_structure.Speed = GPIO_SPEED_FAST;
+  gpio_init_structure.Pull = GPIO_PULLUP;
+  gpio_init_structure.Alternate = COM_TX_AF[COM];
+  HAL_GPIO_Init(COM_TX_PORT[COM], &gpio_init_structure);
+
+  /* Configure USART Rx as alternate function */
+  gpio_init_structure.Pin = COM_RX_PIN[COM];
+  gpio_init_structure.Mode = GPIO_MODE_AF_PP;
+  gpio_init_structure.Alternate = COM_RX_AF[COM];
+  HAL_GPIO_Init(COM_RX_PORT[COM], &gpio_init_structure);
+
+  /* USART configuration */
+  huart->Instance = COM_USART[COM];
+  HAL_UART_Init(huart);
+}
+
+/**
+  * @brief  DeInit COM port.
+  * @param  COM: COM port to be configured.
+  *          This parameter can be one of the following values:
+  *            @arg  COM1 
+  *            @arg  COM2 
+  * @param  huart: Pointer to a UART_HandleTypeDef structure that contains the
+  *                configuration information for the specified USART peripheral.
+  * @retval None
+  */
+void BSP_COM_DeInit(COM_TypeDef COM, UART_HandleTypeDef *huart)
+{
+  /* USART configuration */
+  huart->Instance = COM_USART[COM];
+  HAL_UART_DeInit(huart);
+
+  /* Enable USART clock */
+  DISCOVERY_COMx_CLK_DISABLE(COM);
+
+  /* DeInit GPIO pins can be done in the application 
+     (by surcharging this __weak function) */
+
+  /* GPIO pins clock, DMA clock can be shut down in the application 
+     by surcharging this __weak function */
+}
+
+/*******************************************************************************
+                            BUS OPERATIONS
+*******************************************************************************/
+
+/******************************* I2C Routines *********************************/
+/**
+  * @brief  Initializes I2C MSP.
+  * @param  i2c_handler : I2C handler
+  * @retval None
+  */
+static void I2Cx_MspInit(I2C_HandleTypeDef *i2c_handler)
+{
+  GPIO_InitTypeDef  gpio_init_structure;
+  
+  if (i2c_handler == (I2C_HandleTypeDef*)(&hI2cAudioHandler))
+  {
+    /* AUDIO and LCD I2C MSP init */
+
+    /*** Configure the GPIOs ***/
+    /* Enable GPIO clock */
+    DISCOVERY_AUDIO_I2Cx_SCL_SDA_GPIO_CLK_ENABLE();
+
+    /* Configure I2C Tx as alternate function */
+    gpio_init_structure.Pin = DISCOVERY_AUDIO_I2Cx_SCL_PIN;
+    gpio_init_structure.Mode = GPIO_MODE_AF_OD;
+    gpio_init_structure.Pull = GPIO_NOPULL;
+    gpio_init_structure.Speed = GPIO_SPEED_FAST;
+    gpio_init_structure.Alternate = DISCOVERY_AUDIO_I2Cx_SCL_SDA_AF;
+    HAL_GPIO_Init(DISCOVERY_AUDIO_I2Cx_SCL_SDA_GPIO_PORT, &gpio_init_structure);
+
+    /* Configure I2C Rx as alternate function */
+    gpio_init_structure.Pin = DISCOVERY_AUDIO_I2Cx_SDA_PIN;
+    HAL_GPIO_Init(DISCOVERY_AUDIO_I2Cx_SCL_SDA_GPIO_PORT, &gpio_init_structure);
+
+    /*** Configure the I2C peripheral ***/
+    /* Enable I2C clock */
+    DISCOVERY_AUDIO_I2Cx_CLK_ENABLE();
+
+    /* Force the I2C peripheral clock reset */
+    DISCOVERY_AUDIO_I2Cx_FORCE_RESET();
+
+    /* Release the I2C peripheral clock reset */
+    DISCOVERY_AUDIO_I2Cx_RELEASE_RESET();
+
+    /* Enable and set I2Cx Interrupt to a lower priority */
+    HAL_NVIC_SetPriority(DISCOVERY_AUDIO_I2Cx_EV_IRQn, 0x0F, 0);
+    HAL_NVIC_EnableIRQ(DISCOVERY_AUDIO_I2Cx_EV_IRQn);
+
+    /* Enable and set I2Cx Interrupt to a lower priority */
+    HAL_NVIC_SetPriority(DISCOVERY_AUDIO_I2Cx_ER_IRQn, 0x0F, 0);
+    HAL_NVIC_EnableIRQ(DISCOVERY_AUDIO_I2Cx_ER_IRQn);
+  }
+  else
+  {
+    /* External, camera and Arduino connector I2C MSP init */
+
+    /*** Configure the GPIOs ***/
+    /* Enable GPIO clock */
+    DISCOVERY_EXT_I2Cx_SCL_SDA_GPIO_CLK_ENABLE();
+
+    /* Configure I2C Tx as alternate function */
+    gpio_init_structure.Pin = DISCOVERY_EXT_I2Cx_SCL_PIN;
+    gpio_init_structure.Mode = GPIO_MODE_AF_OD;
+    gpio_init_structure.Pull = GPIO_NOPULL;
+    gpio_init_structure.Speed = GPIO_SPEED_FAST;
+    gpio_init_structure.Alternate = DISCOVERY_EXT_I2Cx_SCL_SDA_AF;
+    HAL_GPIO_Init(DISCOVERY_EXT_I2Cx_SCL_SDA_GPIO_PORT, &gpio_init_structure);
+
+    /* Configure I2C Rx as alternate function */
+    gpio_init_structure.Pin = DISCOVERY_EXT_I2Cx_SDA_PIN;
+    HAL_GPIO_Init(DISCOVERY_EXT_I2Cx_SCL_SDA_GPIO_PORT, &gpio_init_structure);
+
+    /*** Configure the I2C peripheral ***/
+    /* Enable I2C clock */
+    DISCOVERY_EXT_I2Cx_CLK_ENABLE();
+
+    /* Force the I2C peripheral clock reset */
+    DISCOVERY_EXT_I2Cx_FORCE_RESET();
+
+    /* Release the I2C peripheral clock reset */
+    DISCOVERY_EXT_I2Cx_RELEASE_RESET();
+
+    /* Enable and set I2Cx Interrupt to a lower priority */
+    HAL_NVIC_SetPriority(DISCOVERY_EXT_I2Cx_EV_IRQn, 0x0F, 0);
+    HAL_NVIC_EnableIRQ(DISCOVERY_EXT_I2Cx_EV_IRQn);
+
+    /* Enable and set I2Cx Interrupt to a lower priority */
+    HAL_NVIC_SetPriority(DISCOVERY_EXT_I2Cx_ER_IRQn, 0x0F, 0);
+    HAL_NVIC_EnableIRQ(DISCOVERY_EXT_I2Cx_ER_IRQn);
+  }
+}
+
+/**
+  * @brief  Initializes I2C HAL.
+  * @param  i2c_handler : I2C handler
+  * @retval None
+  */
+static void I2Cx_Init(I2C_HandleTypeDef *i2c_handler)
+{
+  if(HAL_I2C_GetState(i2c_handler) == HAL_I2C_STATE_RESET)
+  {
+    if (i2c_handler == (I2C_HandleTypeDef*)(&hI2cAudioHandler))
+    {
+      /* Audio and LCD I2C configuration */
+      i2c_handler->Instance = DISCOVERY_AUDIO_I2Cx;
+    }
+    else
+    {
+      /* External, camera and Arduino connector  I2C configuration */
+      i2c_handler->Instance = DISCOVERY_EXT_I2Cx;
+    }
+    i2c_handler->Init.Timing           = DISCOVERY_I2Cx_TIMING;
+    i2c_handler->Init.OwnAddress1      = 0;
+    i2c_handler->Init.AddressingMode   = I2C_ADDRESSINGMODE_7BIT;
+    i2c_handler->Init.DualAddressMode  = I2C_DUALADDRESS_DISABLE;
+    i2c_handler->Init.OwnAddress2      = 0;
+    i2c_handler->Init.GeneralCallMode  = I2C_GENERALCALL_DISABLE;
+    i2c_handler->Init.NoStretchMode    = I2C_NOSTRETCH_DISABLE;
+
+    /* Init the I2C */
+    I2Cx_MspInit(i2c_handler);
+    HAL_I2C_Init(i2c_handler);
+  }
+}
+
+/**
+  * @brief  Reads multiple data.
+  * @param  i2c_handler : I2C handler
+  * @param  Addr: I2C address
+  * @param  Reg: Reg address 
+  * @param  MemAddress: Memory address 
+  * @param  Buffer: Pointer to data buffer
+  * @param  Length: Length of the data
+  * @retval Number of read data
+  */
+static HAL_StatusTypeDef I2Cx_ReadMultiple(I2C_HandleTypeDef *i2c_handler,
+                                           uint8_t Addr,
+                                           uint16_t Reg,
+                                           uint16_t MemAddress,
+                                           uint8_t *Buffer,
+                                           uint16_t Length)
+{
+  HAL_StatusTypeDef status = HAL_OK;
+
+  status = HAL_I2C_Mem_Read(i2c_handler, Addr, (uint16_t)Reg, MemAddress, Buffer, Length, 1000);
+
+  /* Check the communication status */
+  if(status != HAL_OK)
+  {
+    /* I2C error occurred */
+    I2Cx_Error(i2c_handler, Addr);
+  }
+  return status;    
+}
+
+/**
+  * @brief  Writes a value in a register of the device through BUS in using DMA mode.
+  * @param  i2c_handler : I2C handler
+  * @param  Addr: Device address on BUS Bus.  
+  * @param  Reg: The target register address to write
+  * @param  MemAddress: Memory address 
+  * @param  Buffer: The target register value to be written 
+  * @param  Length: buffer size to be written
+  * @retval HAL status
+  */
+static HAL_StatusTypeDef I2Cx_WriteMultiple(I2C_HandleTypeDef *i2c_handler,
+                                            uint8_t Addr,
+                                            uint16_t Reg,
+                                            uint16_t MemAddress,
+                                            uint8_t *Buffer,
+                                            uint16_t Length)
+{
+  HAL_StatusTypeDef status = HAL_OK;
+  
+  status = HAL_I2C_Mem_Write(i2c_handler, Addr, (uint16_t)Reg, MemAddress, Buffer, Length, 1000);
+  
+  /* Check the communication status */
+  if(status != HAL_OK)
+  {
+    /* Re-Initiaize the I2C Bus */
+    I2Cx_Error(i2c_handler, Addr);
+  }
+  return status;
+}
+
+/**
+  * @brief  Checks if target device is ready for communication. 
+  * @note   This function is used with Memory devices
+  * @param  i2c_handler : I2C handler
+  * @param  DevAddress: Target device address
+  * @param  Trials: Number of trials
+  * @retval HAL status
+  */
+static HAL_StatusTypeDef I2Cx_IsDeviceReady(I2C_HandleTypeDef *i2c_handler, uint16_t DevAddress, uint32_t Trials)
+{ 
+  return (HAL_I2C_IsDeviceReady(i2c_handler, DevAddress, Trials, 1000));
+}
+
+/**
+  * @brief  Manages error callback by re-initializing I2C.
+  * @param  i2c_handler : I2C handler
+  * @param  Addr: I2C Address
+  * @retval None
+  */
+static void I2Cx_Error(I2C_HandleTypeDef *i2c_handler, uint8_t Addr)
+{
+  /* De-initialize the I2C communication bus */
+  HAL_I2C_DeInit(i2c_handler);
+  
+  /* Re-Initialize the I2C communication bus */
+  I2Cx_Init(i2c_handler);
+}
+
+/*******************************************************************************
+                            LINK OPERATIONS
+*******************************************************************************/
+
+/********************************* LINK AUDIO *********************************/
+
+/**
+  * @brief  Initializes Audio low level.
+  * @retval None
+  */
+void AUDIO_IO_Init(void) 
+{
+  I2Cx_Init(&hI2cAudioHandler);
+}
+
+/**
+  * @brief  Deinitializes Audio low level.
+  * @retval None
+  */
+void AUDIO_IO_DeInit(void)
+{
+}
+
+/**
+  * @brief  Writes a single data.
+  * @param  Addr: I2C address
+  * @param  Reg: Reg address 
+  * @param  Value: Data to be written
+  * @retval None
+  */
+void AUDIO_IO_Write(uint8_t Addr, uint16_t Reg, uint16_t Value)
+{
+  uint16_t tmp = Value;
+  
+  Value = ((uint16_t)(tmp >> 8) & 0x00FF);
+  
+  Value |= ((uint16_t)(tmp << 8)& 0xFF00);
+  
+  I2Cx_WriteMultiple(&hI2cAudioHandler, Addr, Reg, I2C_MEMADD_SIZE_16BIT,(uint8_t*)&Value, 2);
+}
+
+/**
+  * @brief  Reads a single data.
+  * @param  Addr: I2C address
+  * @param  Reg: Reg address 
+  * @retval Data to be read
+  */
+uint16_t AUDIO_IO_Read(uint8_t Addr, uint16_t Reg)
+{
+  uint16_t read_value = 0, tmp = 0;
+  
+  I2Cx_ReadMultiple(&hI2cAudioHandler, Addr, Reg, I2C_MEMADD_SIZE_16BIT, (uint8_t*)&read_value, 2);
+  
+  tmp = ((uint16_t)(read_value >> 8) & 0x00FF);
+  
+  tmp |= ((uint16_t)(read_value << 8)& 0xFF00);
+  
+  read_value = tmp;
+  
+  return read_value;
+}
+
+/**
+  * @brief  AUDIO Codec delay 
+  * @param  Delay: Delay in ms
+  * @retval None
+  */
+void AUDIO_IO_Delay(uint32_t Delay)
+{
+  //HAL_Delay(Delay); // MBED
+  wait_ms(Delay); // MBED
+}
+
+/********************************* LINK CAMERA ********************************/
+
+/**
+  * @brief  Initializes Camera low level.
+  * @retval None
+  */
+void CAMERA_IO_Init(void) 
+{
+  I2Cx_Init(&hI2cExtHandler);
+}
+
+/**
+  * @brief  Camera writes single data.
+  * @param  Addr: I2C address
+  * @param  Reg: Register address 
+  * @param  Value: Data to be written
+  * @retval None
+  */
+void CAMERA_IO_Write(uint8_t Addr, uint8_t Reg, uint8_t Value)
+{
+  I2Cx_WriteMultiple(&hI2cExtHandler, Addr, (uint16_t)Reg, I2C_MEMADD_SIZE_8BIT,(uint8_t*)&Value, 1);
+}
+
+/**
+  * @brief  Camera reads single data.
+  * @param  Addr: I2C address
+  * @param  Reg: Register address 
+  * @retval Read data
+  */
+uint8_t CAMERA_IO_Read(uint8_t Addr, uint8_t Reg)
+{
+  uint8_t read_value = 0;
+
+  I2Cx_ReadMultiple(&hI2cExtHandler, Addr, Reg, I2C_MEMADD_SIZE_8BIT, (uint8_t*)&read_value, 1);
+
+  return read_value;
+}
+
+/**
+  * @brief  Camera delay 
+  * @param  Delay: Delay in ms
+  * @retval None
+  */
+void CAMERA_Delay(uint32_t Delay)
+{
+  //HAL_Delay(Delay); // MBED
+  wait_ms(Delay); // MBED
+}
+
+/******************************** LINK I2C EEPROM *****************************/
+
+/**
+  * @brief  Initializes peripherals used by the I2C EEPROM driver.
+  * @retval None
+  */
+void EEPROM_IO_Init(void)
+{
+  I2Cx_Init(&hI2cExtHandler);
+}
+
+/**
+  * @brief  Write data to I2C EEPROM driver in using DMA channel.
+  * @param  DevAddress: Target device address
+  * @param  MemAddress: Internal memory address
+  * @param  pBuffer: Pointer to data buffer
+  * @param  BufferSize: Amount of data to be sent
+  * @retval HAL status
+  */
+HAL_StatusTypeDef EEPROM_IO_WriteData(uint16_t DevAddress, uint16_t MemAddress, uint8_t* pBuffer, uint32_t BufferSize)
+{
+  return (I2Cx_WriteMultiple(&hI2cExtHandler, DevAddress, MemAddress, I2C_MEMADD_SIZE_16BIT, pBuffer, BufferSize));
+}
+
+/**
+  * @brief  Read data from I2C EEPROM driver in using DMA channel.
+  * @param  DevAddress: Target device address
+  * @param  MemAddress: Internal memory address
+  * @param  pBuffer: Pointer to data buffer
+  * @param  BufferSize: Amount of data to be read
+  * @retval HAL status
+  */
+HAL_StatusTypeDef EEPROM_IO_ReadData(uint16_t DevAddress, uint16_t MemAddress, uint8_t* pBuffer, uint32_t BufferSize)
+{
+  return (I2Cx_ReadMultiple(&hI2cExtHandler, DevAddress, MemAddress, I2C_MEMADD_SIZE_16BIT, pBuffer, BufferSize));
+}
+
+/**
+  * @brief  Checks if target device is ready for communication. 
+  * @note   This function is used with Memory devices
+  * @param  DevAddress: Target device address
+  * @param  Trials: Number of trials
+  * @retval HAL status
+  */
+HAL_StatusTypeDef EEPROM_IO_IsDeviceReady(uint16_t DevAddress, uint32_t Trials)
+{ 
+  return (I2Cx_IsDeviceReady(&hI2cExtHandler, DevAddress, Trials));
+}
+
+/********************************* LINK TOUCHSCREEN *********************************/
+
+/**
+  * @brief  Initializes Touchscreen low level.
+  * @retval None
+  */
+void TS_IO_Init(void)
+{
+  I2Cx_Init(&hI2cAudioHandler);
+}
+
+/**
+  * @brief  Writes a single data.
+  * @param  Addr: I2C address
+  * @param  Reg: Reg address
+  * @param  Value: Data to be written
+  * @retval None
+  */
+void TS_IO_Write(uint8_t Addr, uint8_t Reg, uint8_t Value)
+{
+  I2Cx_WriteMultiple(&hI2cAudioHandler, Addr, (uint16_t)Reg, I2C_MEMADD_SIZE_8BIT,(uint8_t*)&Value, 1);
+}
+
+/**
+  * @brief  Reads a single data.
+  * @param  Addr: I2C address
+  * @param  Reg: Reg address
+  * @retval Data to be read
+  */
+uint8_t TS_IO_Read(uint8_t Addr, uint8_t Reg)
+{
+  uint8_t read_value = 0;
+
+  I2Cx_ReadMultiple(&hI2cAudioHandler, Addr, Reg, I2C_MEMADD_SIZE_8BIT, (uint8_t*)&read_value, 1);
+
+  return read_value;
+}
+
+/**
+  * @brief  TS delay
+  * @param  Delay: Delay in ms
+  * @retval None
+  */
+void TS_IO_Delay(uint32_t Delay)
+{
+  //HAL_Delay(Delay); // MBED
+  wait_ms(Delay); // MBED
+}
+
+/**
+  * @}
+  */
+
+/**
+  * @}
+  */ 
+
+/**
+  * @}
+  */
+
+/**
+  * @}
+  */    
+    
+/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/