ST
BSP files for STM32H747I-Discovery Copy from ST Cube delivery
Dependents: DISCO_H747I_LCD_demo DISCO_H747I_AUDIO_demo
Diff: STM32H747I-Discovery/stm32h747i_discovery_lcd.c
- Revision:
- 0:146cf26a9bbb
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/STM32H747I-Discovery/stm32h747i_discovery_lcd.c Wed Sep 25 13:37:39 2019 +0200
@@ -0,0 +1,1981 @@
+/**
+ ******************************************************************************
+ * @file stm32h747i_discovery_lcd.c
+ * @author MCD Application Team
+ * @brief This file includes the driver for Liquid Crystal Display (LCD) module
+ * mounted on STM32H747I_DISCOVERY board.
+ ******************************************************************************
+ * @attention
+ *
+ * <h2><center>© Copyright (c) 2019 STMicroelectronics.
+ * All rights reserved.</center></h2>
+ *
+ * This software component is licensed by ST under BSD 3-Clause license,
+ * the "License"; You may not use this file except in compliance with the
+ * License. You may obtain a copy of the License at:
+ * opensource.org/licenses/BSD-3-Clause
+ *
+ ******************************************************************************
+ */
+
+/* File Info: ------------------------------------------------------------------
+ User NOTES
+1. How To use this driver:
+--------------------------
+ - This driver is used to drive directly in video mode a LCD TFT using the DSI interface.
+ The following IPs are implied : DSI Host IP block working
+ in conjunction to the LTDC controller.
+ - This driver is linked by construction to LCD KoD mounted on board MB1166.
+
+2. Driver description:
+---------------------
+ + Initialization steps:
+ o Initialize the LCD using the BSP_LCD_Init() function.
+ o Select the LCD layer to be used using the BSP_LCD_SelectLayer() function.
+ o Enable the LCD display using the BSP_LCD_DisplayOn() function.
+
+ + Options
+ o Configure and enable the color keying functionality using the
+ BSP_LCD_SetColorKeying() function.
+ o Modify in the fly the transparency and/or the frame buffer address
+ using the following functions:
+ - BSP_LCD_SetTransparency()
+ - BSP_LCD_SetLayerAddress()
+
+ + Display on LCD
+ o Clear the whole LCD using BSP_LCD_Clear() function or only one specified string
+ line using the BSP_LCD_ClearStringLine() function.
+ o Display a character on the specified line and column using the BSP_LCD_DisplayChar()
+ function or a complete string line using the BSP_LCD_DisplayStringAtLine() function.
+ o Display a string line on the specified position (x,y in pixel) and align mode
+ using the BSP_LCD_DisplayStringAtLine() function.
+ o Draw and fill a basic shapes (dot, line, rectangle, circle, ellipse, .. bitmap)
+ on LCD using the available set of functions.
+
+------------------------------------------------------------------------------*/
+
+/* Includes ------------------------------------------------------------------*/
+#include "stm32h747i_discovery_lcd.h"
+#include "../Utilities/Fonts/fonts.h"
+// #include "../Utilities/Fonts/font24.c"
+// #include "../Utilities/Fonts/font20.c"
+// #include "../Utilities/Fonts/font16.c"
+// #include "../Utilities/Fonts/font12.c"
+// #include "../Utilities/Fonts/font8.c"
+
+/** @addtogroup BSP
+ * @{
+ */
+
+/** @addtogroup STM32H747I_DISCOVERY
+ * @{
+ */
+
+/** @defgroup STM32H747I_DISCOVERY_LCD STM32H747I_DISCOVERY_LCD
+ * @{
+ */
+
+/** @defgroup STM32H747I_DISCOVERY_LCD_Private_Defines Private Defines
+ * @{
+ */
+
+#if defined(USE_LCD_HDMI)
+#define HDMI_ASPECT_RATIO_16_9 ADV7533_ASPECT_RATIO_16_9
+#define HDMI_ASPECT_RATIO_4_3 ADV7533_ASPECT_RATIO_4_3
+#endif /* USE_LCD_HDMI */
+#define LCD_DSI_ID 0x11
+#define LCD_DSI_ID_REG 0xA8
+/**
+ * @}
+ */
+
+/** @defgroup STM32H747I_DISCOVERY_LCD_Private_Types Private Types
+ * @{
+ */
+
+#if defined(USE_LCD_HDMI)
+/**
+ * @brief DSI timming params used for different HDMI adpater
+ */
+typedef struct
+{
+ uint16_t HACT;
+ uint16_t HSYNC;
+ uint16_t HBP;
+ uint16_t HFP;
+ uint16_t VACT;
+ uint16_t VSYNC;
+ uint16_t VBP;
+ uint16_t VFP;
+ uint8_t ASPECT_RATIO;
+ uint8_t RGB_CODING;
+} HDMI_FormatTypeDef;
+
+/**
+ * @brief DSI packet params used for different HDMI adpater
+ */
+typedef struct
+{
+ uint16_t NullPacketSize;
+ uint16_t NumberOfChunks;
+ uint16_t PacketSize;
+} HDMI_DSIPacketTypeDef;
+
+/**
+ * @brief LTDC PLL params used for different HDMI adpater
+ */
+typedef struct
+{
+ uint16_t PLL_LTDC_N;
+ uint16_t PLL_LTDC_R;
+ uint32_t PCLK;
+ uint16_t IDF;
+ uint16_t NDIV;
+ uint16_t ODF;
+ uint16_t LaneByteClock;
+ uint16_t TXEscapeCkdiv;
+} HDMI_PLLConfigTypeDef;
+
+#endif /* USE_LCD_HDMI */
+/**
+ * @}
+ */
+
+/** @defgroup STM32H747I_DISCOVERY_LCD_Private_Macros Private Macros
+ * @{
+ */
+#define ABS(X) ((X) > 0 ? (X) : -(X))
+#define POLY_X(Z) ((int32_t)((Points + (Z))->X))
+#define POLY_Y(Z) ((int32_t)((Points + (Z))->Y))
+/**
+ * @}
+ */
+
+/** @defgroup STM32H747I_DISCOVERY_LCD_Exported_Variables Exported Variables
+ * @{
+ */
+DMA2D_HandleTypeDef hdma2d_discovery;
+LTDC_HandleTypeDef hltdc_discovery;
+DSI_HandleTypeDef hdsi_discovery;
+
+/**
+ * @}
+ */
+
+/** @defgroup STM32H747I_DISCOVERY_LCD_Private_Variables Private Variables
+ * @{
+ */
+static DSI_VidCfgTypeDef hdsivideo_handle;
+uint32_t lcd_x_size = OTM8009A_800X480_WIDTH;
+uint32_t lcd_y_size = OTM8009A_800X480_HEIGHT;
+
+#if defined(USE_LCD_HDMI)
+/**
+ * @brief DSI timming used for different HDMI resolution (720x480 and 720x576)
+ */
+HDMI_FormatTypeDef HDMI_Format[2] =
+{
+/* HA HS HB HF VA VS VB VF ASPECT BPP */
+ {720, 62, 60, 30, 480, 6, 19, 9, HDMI_ASPECT_RATIO_4_3, LCD_DSI_PIXEL_DATA_FMT_RBG888},
+ {720, 64, 68, 12, 576, 5, 39, 5, HDMI_ASPECT_RATIO_16_9, LCD_DSI_PIXEL_DATA_FMT_RBG888}
+
+};
+
+/**
+ * @brief DSI packet size used for different HDMI resolution (720x480 and 720x576)
+ */
+HDMI_DSIPacketTypeDef HDMI_DSIPacket[2] =
+{
+ /* NP NC VP */
+ {0, 1, 720},
+ {0, 1, 720}
+};
+
+/**
+ * @brief LTDC PLL settings used for different HDMI resolution (720x480 and 720x576)
+ */
+HDMI_PLLConfigTypeDef HDMI_PLLConfig[4] =
+{
+/* N DIV Pclk IDF NDIV ODF LBClk TXEscapeCkdiv*/
+ {13, 12, 27083, DSI_PLL_IN_DIV5, 65, DSI_PLL_OUT_DIV1, 40625, 3},
+ {13, 12, 27083, DSI_PLL_IN_DIV5, 65, DSI_PLL_OUT_DIV1, 40625, 3},
+
+};
+#endif /* USE_LCD_HDMI */
+
+/**
+ * @brief Default Active LTDC Layer in which drawing is made is LTDC Layer Background
+ */
+static uint32_t ActiveLayer = LTDC_ACTIVE_LAYER_BACKGROUND;
+
+/**
+ * @brief Current Drawing Layer properties variable
+ */
+static LCD_DrawPropTypeDef DrawProp[LTDC_MAX_LAYER_NUMBER];
+/**
+ * @}
+ */
+
+/** @defgroup STM32H747I_DISCOVERY_LCD_Private_FunctionPrototypes Private FunctionPrototypes
+ * @{
+ */
+static void DrawChar(uint16_t Xpos, uint16_t Ypos, const uint8_t *c);
+static void FillTriangle(uint16_t x1, uint16_t x2, uint16_t x3, uint16_t y1, uint16_t y2, uint16_t y3);
+static void LL_FillBuffer(uint32_t LayerIndex, void *pDst, uint32_t xSize, uint32_t ySize, uint32_t OffLine, uint32_t ColorIndex);
+static void LL_ConvertLineToARGB8888(void * pSrc, void *pDst, uint32_t xSize, uint32_t ColorMode);
+static uint16_t LCD_IO_GetID(void);
+/**
+ * @}
+ */
+
+/** @defgroup STM32H747I_DISCOVERY_LCD_Exported_Functions Exported Functions
+ * @{
+ */
+
+/**
+ * @brief Initializes the DSI LCD.
+ * @retval LCD state
+ */
+uint8_t BSP_LCD_Init(void)
+{
+ return (BSP_LCD_InitEx(LCD_ORIENTATION_LANDSCAPE));
+}
+
+/**
+ * @brief Initializes the DSI LCD.
+ * The ititialization is done as below:
+ * - DSI PLL ititialization
+ * - DSI ititialization
+ * - LTDC ititialization
+ * - OTM8009A LCD Display IC Driver ititialization
+ * @param orientation Display orientation
+ * @retval LCD state
+ */
+uint8_t BSP_LCD_InitEx(LCD_OrientationTypeDef orientation)
+{
+ DSI_PLLInitTypeDef dsiPllInit;
+ DSI_PHY_TimerTypeDef PhyTimings;
+ static RCC_PeriphCLKInitTypeDef PeriphClkInitStruct;
+ uint32_t LcdClock = 26400; /*!< LcdClk = 26400 kHz */
+ uint16_t read_id = 0;
+
+ uint32_t laneByteClk_kHz = 0;
+ uint32_t VSA; /*!< Vertical start active time in units of lines */
+ uint32_t VBP; /*!< Vertical Back Porch time in units of lines */
+ uint32_t VFP; /*!< Vertical Front Porch time in units of lines */
+ uint32_t VACT; /*!< Vertical Active time in units of lines = imageSize Y in pixels to display */
+ uint32_t HSA; /*!< Horizontal start active time in units of lcdClk */
+ uint32_t HBP; /*!< Horizontal Back Porch time in units of lcdClk */
+ uint32_t HFP; /*!< Horizontal Front Porch time in units of lcdClk */
+ uint32_t HACT; /*!< Horizontal Active time in units of lcdClk = imageSize X in pixels to display */
+
+ /* Toggle Hardware Reset of the DSI LCD using
+ * its XRES signal (active low) */
+ BSP_LCD_Reset();
+
+ /* Check the connected monitor */
+ read_id = LCD_IO_GetID();
+
+#if defined(USE_LCD_HDMI)
+ if(read_id == ADV7533_ID)
+ {
+ return BSP_LCD_HDMIInitEx(HDMI_FORMAT_720_576);
+ }
+ else if(read_id != LCD_DSI_ID)
+ {
+ return LCD_ERROR;
+ }
+#else
+ if(read_id != LCD_DSI_ID)
+ {
+ return LCD_ERROR;
+ }
+#endif /* USE_LCD_HDMI */
+
+ /* Call first MSP Initialize only in case of first initialization
+ * This will set IP blocks LTDC, DSI and DMA2D
+ * - out of reset
+ * - clocked
+ * - NVIC IRQ related to IP blocks enabled
+ */
+ BSP_LCD_MspInit();
+
+/*************************DSI Initialization***********************************/
+
+ /* Base address of DSI Host/Wrapper registers to be set before calling De-Init */
+ hdsi_discovery.Instance = DSI;
+
+ HAL_DSI_DeInit(&(hdsi_discovery));
+
+ dsiPllInit.PLLNDIV = 100;
+ dsiPllInit.PLLIDF = DSI_PLL_IN_DIV5;
+ dsiPllInit.PLLODF = DSI_PLL_OUT_DIV1;
+ laneByteClk_kHz = 62500; /* 500 MHz / 8 = 62.5 MHz = 62500 kHz */
+
+ /* Set number of Lanes */
+ hdsi_discovery.Init.NumberOfLanes = DSI_TWO_DATA_LANES;
+
+ /* TXEscapeCkdiv = f(LaneByteClk)/15.62 = 4 */
+ hdsi_discovery.Init.TXEscapeCkdiv = laneByteClk_kHz/15620;
+
+ HAL_DSI_Init(&(hdsi_discovery), &(dsiPllInit));
+
+ /* Timing parameters for all Video modes
+ * Set Timing parameters of LTDC depending on its chosen orientation
+ */
+ if(orientation == LCD_ORIENTATION_PORTRAIT)
+ {
+ lcd_x_size = OTM8009A_480X800_WIDTH; /* 480 */
+ lcd_y_size = OTM8009A_480X800_HEIGHT; /* 800 */
+ }
+ else
+ {
+ /* lcd_orientation == LCD_ORIENTATION_LANDSCAPE */
+ lcd_x_size = OTM8009A_800X480_WIDTH; /* 800 */
+ lcd_y_size = OTM8009A_800X480_HEIGHT; /* 480 */
+ }
+
+ HACT = lcd_x_size;
+ VACT = lcd_y_size;
+
+ /* The following values are same for portrait and landscape orientations */
+ VSA = OTM8009A_480X800_VSYNC; /* 10 */
+ VBP = OTM8009A_480X800_VBP; /* 15 */
+ VFP = OTM8009A_480X800_VFP; /* 16 */
+ HSA = OTM8009A_480X800_HSYNC; /* 2 */
+ HBP = OTM8009A_480X800_HBP; /* 20 */
+ HFP = OTM8009A_480X800_HFP; /* 20 */
+
+
+ hdsivideo_handle.VirtualChannelID = LCD_OTM8009A_ID;
+ hdsivideo_handle.ColorCoding = LCD_DSI_PIXEL_DATA_FMT_RBG888;
+ hdsivideo_handle.VSPolarity = DSI_VSYNC_ACTIVE_HIGH;
+ hdsivideo_handle.HSPolarity = DSI_HSYNC_ACTIVE_HIGH;
+ hdsivideo_handle.DEPolarity = DSI_DATA_ENABLE_ACTIVE_HIGH;
+ hdsivideo_handle.Mode = DSI_VID_MODE_BURST; /* Mode Video burst ie : one LgP per line */
+ hdsivideo_handle.NullPacketSize = 0xFFF;
+ hdsivideo_handle.NumberOfChunks = 0;
+ hdsivideo_handle.PacketSize = HACT; /* Value depending on display orientation choice portrait/landscape */
+ hdsivideo_handle.HorizontalSyncActive = (HSA * laneByteClk_kHz)/LcdClock;
+ hdsivideo_handle.HorizontalBackPorch = (HBP * laneByteClk_kHz)/LcdClock;
+ hdsivideo_handle.HorizontalLine = ((HACT + HSA + HBP + HFP) * laneByteClk_kHz)/LcdClock; /* Value depending on display orientation choice portrait/landscape */
+ hdsivideo_handle.VerticalSyncActive = VSA;
+ hdsivideo_handle.VerticalBackPorch = VBP;
+ hdsivideo_handle.VerticalFrontPorch = VFP;
+ hdsivideo_handle.VerticalActive = VACT; /* Value depending on display orientation choice portrait/landscape */
+
+ /* Enable or disable sending LP command while streaming is active in video mode */
+ hdsivideo_handle.LPCommandEnable = DSI_LP_COMMAND_ENABLE; /* Enable sending commands in mode LP (Low Power) */
+
+ /* Largest packet size possible to transmit in LP mode in VSA, VBP, VFP regions */
+ /* Only useful when sending LP packets is allowed while streaming is active in video mode */
+ hdsivideo_handle.LPLargestPacketSize = 16;
+
+ /* Largest packet size possible to transmit in LP mode in HFP region during VACT period */
+ /* Only useful when sending LP packets is allowed while streaming is active in video mode */
+ hdsivideo_handle.LPVACTLargestPacketSize = 0;
+
+
+ /* Specify for each region of the video frame, if the transmission of command in LP mode is allowed in this region */
+ /* while streaming is active in video mode */
+ hdsivideo_handle.LPHorizontalFrontPorchEnable = DSI_LP_HFP_ENABLE; /* Allow sending LP commands during HFP period */
+ hdsivideo_handle.LPHorizontalBackPorchEnable = DSI_LP_HBP_ENABLE; /* Allow sending LP commands during HBP period */
+ hdsivideo_handle.LPVerticalActiveEnable = DSI_LP_VACT_ENABLE; /* Allow sending LP commands during VACT period */
+ hdsivideo_handle.LPVerticalFrontPorchEnable = DSI_LP_VFP_ENABLE; /* Allow sending LP commands during VFP period */
+ hdsivideo_handle.LPVerticalBackPorchEnable = DSI_LP_VBP_ENABLE; /* Allow sending LP commands during VBP period */
+ hdsivideo_handle.LPVerticalSyncActiveEnable = DSI_LP_VSYNC_ENABLE; /* Allow sending LP commands during VSync = VSA period */
+
+ /* Configure DSI Video mode timings with settings set above */
+ HAL_DSI_ConfigVideoMode(&(hdsi_discovery), &(hdsivideo_handle));
+
+ /* Configure DSI PHY HS2LP and LP2HS timings */
+ PhyTimings.ClockLaneHS2LPTime = 35;
+ PhyTimings.ClockLaneLP2HSTime = 35;
+ PhyTimings.DataLaneHS2LPTime = 35;
+ PhyTimings.DataLaneLP2HSTime = 35;
+ PhyTimings.DataLaneMaxReadTime = 0;
+ PhyTimings.StopWaitTime = 10;
+ HAL_DSI_ConfigPhyTimer(&hdsi_discovery, &PhyTimings);
+
+/*************************End DSI Initialization*******************************/
+
+
+/************************LTDC Initialization***********************************/
+
+ /* Timing Configuration */
+ hltdc_discovery.Init.HorizontalSync = (HSA - 1);
+ hltdc_discovery.Init.AccumulatedHBP = (HSA + HBP - 1);
+ hltdc_discovery.Init.AccumulatedActiveW = (lcd_x_size + HSA + HBP - 1);
+ hltdc_discovery.Init.TotalWidth = (lcd_x_size + HSA + HBP + HFP - 1);
+
+ /* Initialize the LCD pixel width and pixel height */
+ hltdc_discovery.LayerCfg->ImageWidth = lcd_x_size;
+ hltdc_discovery.LayerCfg->ImageHeight = lcd_y_size;
+
+
+ /* LCD clock configuration */
+ /* PLL3_VCO Input = HSE_VALUE/PLL3M = 5 Mhz */
+ /* PLL3_VCO Output = PLL3_VCO Input * PLL3N = 480 Mhz */
+ /* PLLLCDCLK = PLL3_VCO Output/PLL3R = 480/18 = 26.666 Mhz */
+ /* LTDC clock frequency = PLLLCDCLK = 26.666 Mhz */
+ PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_LTDC;
+ PeriphClkInitStruct.PLL3.PLL3M = 5;
+ PeriphClkInitStruct.PLL3.PLL3N = 96;
+ PeriphClkInitStruct.PLL3.PLL3P = 2;
+ PeriphClkInitStruct.PLL3.PLL3Q = 10;
+ PeriphClkInitStruct.PLL3.PLL3R = 18;
+ HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct);
+
+ /* Background value */
+ hltdc_discovery.Init.Backcolor.Blue = 0;
+ hltdc_discovery.Init.Backcolor.Green = 0;
+ hltdc_discovery.Init.Backcolor.Red = 0;
+ hltdc_discovery.Init.PCPolarity = LTDC_PCPOLARITY_IPC;
+ hltdc_discovery.Instance = LTDC;
+
+ /* Get LTDC Configuration from DSI Configuration */
+ HAL_LTDC_StructInitFromVideoConfig(&(hltdc_discovery), &(hdsivideo_handle));
+
+ /* Initialize the LTDC */
+ HAL_LTDC_Init(&hltdc_discovery);
+
+ /* Enable the DSI host and wrapper : after LTDC */
+ /* To avoid any synchronization issue, the DSI shall be started after enabling the LTDC */
+ HAL_DSI_Start(&hdsi_discovery);
+
+#if !defined(DATA_IN_ExtSDRAM)
+ /* Initialize the SDRAM */
+ BSP_SDRAM_Init();
+#endif /* DATA_IN_ExtSDRAM */
+
+ /* Initialize the font */
+ BSP_LCD_SetFont(&LCD_DEFAULT_FONT);
+
+/************************End LTDC Initialization*******************************/
+
+
+/***********************OTM8009A Initialization********************************/
+
+ /* Initialize the OTM8009A LCD Display IC Driver (KoD LCD IC Driver)
+ * depending on configuration set in 'hdsivideo_handle'.
+ */
+ OTM8009A_Init(OTM8009A_FORMAT_RGB888, orientation);
+
+/***********************End OTM8009A Initialization****************************/
+
+ return LCD_OK;
+}
+
+#if defined(USE_LCD_HDMI)
+/**
+ * @brief Initializes the DSI for HDMI monitor.
+ * The ititialization is done as below:
+ * - DSI PLL ititialization
+ * - DSI ititialization
+ * - LTDC ititialization
+ * - DSI-HDMI ADV7533 adapter device ititialization
+ * @param format : HDMI format could be HDMI_FORMAT_720_480 or HDMI_FORMAT_720_576
+ * @retval LCD state
+ */
+uint8_t BSP_LCD_HDMIInitEx(uint8_t format)
+{
+ /************************ADV7533 Initialization******************************/
+
+ /* Initialize the ADV7533 HDMI Bridge
+ depending on configuration set in 'hdsivideo_handle'. */
+ adv7533ConfigTypeDef adv7533_config;
+
+ adv7533_config.DSI_LANES = 2;
+ adv7533_config.HACT = HDMI_Format[format].HACT;
+ adv7533_config.HSYNC = HDMI_Format[format].HSYNC;
+ adv7533_config.HBP = HDMI_Format[format].HBP;
+ adv7533_config.HFP = HDMI_Format[format].HFP;
+ adv7533_config.VACT = HDMI_Format[format].VACT;
+ adv7533_config.VSYNC = HDMI_Format[format].VSYNC;
+ adv7533_config.VBP = HDMI_Format[format].VBP;
+ adv7533_config.VFP = HDMI_Format[format].VFP;
+
+ ADV7533_Init();
+ ADV7533_Configure(&adv7533_config);
+ ADV7533_PowerOn();
+
+/************************ Update hdmi_x_size and hdmi_y_size *****************/
+ lcd_x_size = HDMI_Format[format].HACT;
+ lcd_y_size = HDMI_Format[format].VACT;
+
+/***********************End ADV7533 Initialization****************************/
+
+ DSI_PLLInitTypeDef dsiPllInit;
+ DSI_PHY_TimerTypeDef dsiPhyInit;
+ static RCC_PeriphCLKInitTypeDef PeriphClkInitStruct;
+
+ /* Call first MSP Initialize only in case of first initialization
+ * This will set IP blocks LTDC and DSI
+ * - out of reset
+ * - clocked
+ * - NVIC IRQ related to IP blocks enabled
+ */
+ BSP_LCD_MspInit();
+
+/*************************DSI Initialization***********************************/
+
+ /* Base address of DSI Host/Wrapper registers to be set before calling De-Init */
+ hdsi_discovery.Instance = DSI;
+
+ HAL_DSI_DeInit(&(hdsi_discovery));
+
+ /* Configure the DSI PLL */
+ dsiPllInit.PLLNDIV = HDMI_PLLConfig[format].NDIV;
+ dsiPllInit.PLLIDF = HDMI_PLLConfig[format].IDF;
+ dsiPllInit.PLLODF = HDMI_PLLConfig[format].ODF;
+
+ /* Set number of Lanes */
+ hdsi_discovery.Init.NumberOfLanes = DSI_TWO_DATA_LANES;
+ /* Set the TX escape clock division ratio */
+ hdsi_discovery.Init.TXEscapeCkdiv = HDMI_PLLConfig[format].TXEscapeCkdiv;
+ /* Disable the automatic clock lane control (the ADV7533 must be clocked) */
+ hdsi_discovery.Init.AutomaticClockLaneControl = DSI_AUTO_CLK_LANE_CTRL_DISABLE;
+
+ /* Init the DSI */
+ HAL_DSI_Init(&hdsi_discovery, &dsiPllInit);
+
+ /* Configure the D-PHY Timings */
+ dsiPhyInit.ClockLaneHS2LPTime = 0x14;
+ dsiPhyInit.ClockLaneLP2HSTime = 0x14;
+ dsiPhyInit.DataLaneHS2LPTime = 0x0A;
+ dsiPhyInit.DataLaneLP2HSTime = 0x0A;
+ dsiPhyInit.DataLaneMaxReadTime = 0x00;
+ dsiPhyInit.StopWaitTime = 0x0;
+ HAL_DSI_ConfigPhyTimer(&hdsi_discovery, &dsiPhyInit);
+
+ /* Virutal channel used by the ADV7533 */
+ hdsivideo_handle.VirtualChannelID = HDMI_ADV7533_ID;
+
+ /* Timing parameters for Video modes
+ Set Timing parameters of DSI depending on its chosen format */
+ hdsivideo_handle.ColorCoding = HDMI_Format[format].RGB_CODING;
+ hdsivideo_handle.LooselyPacked = DSI_LOOSELY_PACKED_DISABLE;
+ hdsivideo_handle.VSPolarity = DSI_VSYNC_ACTIVE_LOW;
+ hdsivideo_handle.HSPolarity = DSI_HSYNC_ACTIVE_LOW;
+ hdsivideo_handle.DEPolarity = DSI_DATA_ENABLE_ACTIVE_HIGH;
+ hdsivideo_handle.Mode = DSI_VID_MODE_NB_PULSES;
+ hdsivideo_handle.NullPacketSize = HDMI_DSIPacket[format].NullPacketSize;
+ hdsivideo_handle.NumberOfChunks = HDMI_DSIPacket[format].NumberOfChunks;
+ hdsivideo_handle.PacketSize = HDMI_DSIPacket[format].PacketSize;
+ hdsivideo_handle.HorizontalSyncActive = HDMI_Format[format].HSYNC*HDMI_PLLConfig[format].LaneByteClock/HDMI_PLLConfig[format].PCLK;
+ hdsivideo_handle.HorizontalBackPorch = HDMI_Format[format].HBP*HDMI_PLLConfig[format].LaneByteClock/HDMI_PLLConfig[format].PCLK;
+ hdsivideo_handle.HorizontalLine = (HDMI_Format[format].HACT + HDMI_Format[format].HSYNC + HDMI_Format[format].HBP + HDMI_Format[format].HFP)*HDMI_PLLConfig[format].LaneByteClock/HDMI_PLLConfig[format].PCLK;
+ hdsivideo_handle.VerticalSyncActive = HDMI_Format[format].VSYNC;
+ hdsivideo_handle.VerticalBackPorch = HDMI_Format[format].VBP;
+ hdsivideo_handle.VerticalFrontPorch = HDMI_Format[format].VFP;
+ hdsivideo_handle.VerticalActive = HDMI_Format[format].VACT;
+
+ /* Enable or disable sending LP command while streaming is active in video mode */
+ hdsivideo_handle.LPCommandEnable = DSI_LP_COMMAND_DISABLE; /* Enable sending commands in mode LP (Low Power) */
+
+ /* Largest packet size possible to transmit in LP mode in VSA, VBP, VFP regions */
+ /* Only useful when sending LP packets is allowed while streaming is active in video mode */
+ hdsivideo_handle.LPLargestPacketSize = 4;
+
+ /* Largest packet size possible to transmit in LP mode in HFP region during VACT period */
+ /* Only useful when sending LP packets is allowed while streaming is active in video mode */
+ hdsivideo_handle.LPVACTLargestPacketSize = 4;
+
+ /* Specify for each region, if the going in LP mode is allowed */
+ /* while streaming is active in video mode */
+ hdsivideo_handle.LPHorizontalFrontPorchEnable = DSI_LP_HFP_DISABLE;
+ hdsivideo_handle.LPHorizontalBackPorchEnable = DSI_LP_HBP_DISABLE;
+ hdsivideo_handle.LPVerticalActiveEnable = DSI_LP_VACT_DISABLE;
+ hdsivideo_handle.LPVerticalFrontPorchEnable = DSI_LP_VFP_DISABLE;
+ hdsivideo_handle.LPVerticalBackPorchEnable = DSI_LP_VBP_DISABLE;
+ hdsivideo_handle.LPVerticalSyncActiveEnable = DSI_LP_VSYNC_DISABLE;
+
+ /* No acknoledge at the end of a frame */
+ hdsivideo_handle.FrameBTAAcknowledgeEnable = DSI_FBTAA_DISABLE;
+
+ /* Configure DSI Video mode timings with settings set above */
+ HAL_DSI_ConfigVideoMode(&hdsi_discovery, &hdsivideo_handle);
+
+ /* Enable the DSI host and wrapper : but LTDC is not started yet at this stage */
+ HAL_DSI_Start(&hdsi_discovery);
+
+/*************************End DSI Initialization*******************************/
+
+
+/************************LTDC Initialization***********************************/
+
+ /* LCD clock configuration */
+ /* LCD clock configuration */
+ /* PLL3_VCO Input = HSE_VALUE/PLL3M = 25 Mhz */
+ /* PLL3_VCO Output = PLL3_VCO Input * PLL3N */
+ /* PLLLCDCLK = PLL3_VCO Output/PLL3R */
+ /* LTDC clock frequency = PLLLCDCLK */
+ PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_LTDC;
+ PeriphClkInitStruct.PLL3.PLL3M = 1;
+ PeriphClkInitStruct.PLL3.PLL3N = HDMI_PLLConfig[format].PLL_LTDC_N;
+ PeriphClkInitStruct.PLL3.PLL3P = 2;
+ PeriphClkInitStruct.PLL3.PLL3Q = 2;
+ PeriphClkInitStruct.PLL3.PLL3R = HDMI_PLLConfig[format].PLL_LTDC_R;
+ HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct);
+
+ /* Base address of LTDC registers to be set before calling De-Init */
+ hltdc_discovery.Instance = LTDC;
+
+ HAL_LTDC_DeInit(&(hltdc_discovery));
+
+ /* Timing Configuration */
+ hltdc_discovery.Init.HorizontalSync = (HDMI_Format[format].HSYNC - 1);
+ hltdc_discovery.Init.AccumulatedHBP = (HDMI_Format[format].HSYNC + HDMI_Format[format].HBP - 1);
+ hltdc_discovery.Init.AccumulatedActiveW = (HDMI_Format[format].HACT + HDMI_Format[format].HSYNC + HDMI_Format[format].HBP - 1);
+ hltdc_discovery.Init.TotalWidth = (HDMI_Format[format].HACT + HDMI_Format[format].HSYNC + HDMI_Format[format].HBP + HDMI_Format[format].HFP - 1);
+ hltdc_discovery.Init.VerticalSync = (HDMI_Format[format].VSYNC - 1);
+ hltdc_discovery.Init.AccumulatedVBP = (HDMI_Format[format].VSYNC + HDMI_Format[format].VBP - 1);
+ hltdc_discovery.Init.AccumulatedActiveH = (HDMI_Format[format].VACT + HDMI_Format[format].VSYNC + HDMI_Format[format].VBP - 1);
+ hltdc_discovery.Init.TotalHeigh = (HDMI_Format[format].VACT + HDMI_Format[format].VSYNC + HDMI_Format[format].VBP + HDMI_Format[format].VFP - 1);
+
+ /* background value */
+ hltdc_discovery.Init.Backcolor.Blue = 0x00;
+ hltdc_discovery.Init.Backcolor.Green = 0xFF;
+ hltdc_discovery.Init.Backcolor.Red = 0xFF;
+
+ /* Polarity */
+ hltdc_discovery.Init.HSPolarity = LTDC_HSPOLARITY_AL;
+ hltdc_discovery.Init.VSPolarity = LTDC_VSPOLARITY_AL;
+ hltdc_discovery.Init.DEPolarity = LTDC_DEPOLARITY_AL;
+ hltdc_discovery.Init.PCPolarity = LTDC_PCPOLARITY_IPC;
+
+ /* Initialize & Start the LTDC */
+ HAL_LTDC_Init(&hltdc_discovery);
+
+#if !defined(DATA_IN_ExtSDRAM)
+ /* Initialize the SDRAM */
+ BSP_SDRAM_Init();
+#endif /* DATA_IN_ExtSDRAM */
+
+ /* Initialize the font */
+ BSP_LCD_SetFont(&LCD_DEFAULT_FONT);
+/************************End LTDC Initialization*******************************/
+
+ return LCD_OK;
+}
+#endif /* USE_LCD_HDMI */
+
+/**
+ * @brief BSP LCD Reset
+ * Hw reset the LCD DSI activating its XRES signal (active low for some time)
+ * and deactivating it later.
+ * @retval None
+ */
+void BSP_LCD_Reset(void)
+{
+ GPIO_InitTypeDef gpio_init_structure;
+
+ __HAL_RCC_GPIOG_CLK_ENABLE();
+
+ /* Configure the GPIO on PG3 */
+ gpio_init_structure.Pin = GPIO_PIN_3;
+ gpio_init_structure.Mode = GPIO_MODE_OUTPUT_PP;
+ gpio_init_structure.Pull = GPIO_PULLUP;
+ gpio_init_structure.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
+
+ HAL_GPIO_Init(GPIOG, &gpio_init_structure);
+
+ /* Activate XRES active low */
+ HAL_GPIO_WritePin(GPIOG, GPIO_PIN_3, GPIO_PIN_RESET);
+
+ HAL_Delay(20); /* wait 20 ms */
+
+ /* Desactivate XRES */
+ HAL_GPIO_WritePin(GPIOG, GPIO_PIN_3, GPIO_PIN_SET);
+
+ /* Wait for 10ms after releasing XRES before sending commands */
+ HAL_Delay(10);
+}
+
+/**
+ * @brief Gets the LCD X size.
+ * @retval Used LCD X size
+ */
+uint32_t BSP_LCD_GetXSize(void)
+{
+ return (lcd_x_size);
+}
+
+/**
+ * @brief Gets the LCD Y size.
+ * @retval Used LCD Y size
+ */
+uint32_t BSP_LCD_GetYSize(void)
+{
+ return (lcd_y_size);
+}
+
+/**
+ * @brief Set the LCD X size.
+ * @param imageWidthPixels : uint32_t image width in pixels unit
+ * @retval None
+ */
+void BSP_LCD_SetXSize(uint32_t imageWidthPixels)
+{
+ hltdc_discovery.LayerCfg[ActiveLayer].ImageWidth = imageWidthPixels;
+}
+
+/**
+ * @brief Set the LCD Y size.
+ * @param imageHeightPixels : uint32_t image height in lines unit
+ */
+void BSP_LCD_SetYSize(uint32_t imageHeightPixels)
+{
+ hltdc_discovery.LayerCfg[ActiveLayer].ImageHeight = imageHeightPixels;
+}
+
+
+/**
+ * @brief Initializes the LCD layers.
+ * @param LayerIndex: Layer foreground or background
+ * @param FB_Address: Layer frame buffer
+ * @retval None
+ */
+void BSP_LCD_LayerDefaultInit(uint16_t LayerIndex, uint32_t FB_Address)
+{
+ LCD_LayerCfgTypeDef Layercfg;
+
+ /* Layer Init */
+ Layercfg.WindowX0 = 0;
+ Layercfg.WindowX1 = BSP_LCD_GetXSize();
+ Layercfg.WindowY0 = 0;
+ Layercfg.WindowY1 = BSP_LCD_GetYSize();
+ Layercfg.PixelFormat = LTDC_PIXEL_FORMAT_ARGB8888;
+ Layercfg.FBStartAdress = FB_Address;
+ Layercfg.Alpha = 255;
+ Layercfg.Alpha0 = 0;
+ Layercfg.Backcolor.Blue = 0;
+ Layercfg.Backcolor.Green = 0;
+ Layercfg.Backcolor.Red = 0;
+ Layercfg.BlendingFactor1 = LTDC_BLENDING_FACTOR1_PAxCA;
+ Layercfg.BlendingFactor2 = LTDC_BLENDING_FACTOR2_PAxCA;
+ Layercfg.ImageWidth = BSP_LCD_GetXSize();
+ Layercfg.ImageHeight = BSP_LCD_GetYSize();
+
+ HAL_LTDC_ConfigLayer(&hltdc_discovery, &Layercfg, LayerIndex);
+
+ DrawProp[LayerIndex].BackColor = LCD_COLOR_WHITE;
+ DrawProp[LayerIndex].pFont = &Font24;
+ DrawProp[LayerIndex].TextColor = LCD_COLOR_BLACK;
+}
+
+
+/**
+ * @brief Selects the LCD Layer.
+ * @param LayerIndex: Layer foreground or background
+ */
+void BSP_LCD_SelectLayer(uint32_t LayerIndex)
+{
+ ActiveLayer = LayerIndex;
+}
+
+/**
+ * @brief Sets an LCD Layer visible
+ * @param LayerIndex: Visible Layer
+ * @param State: New state of the specified layer
+ * This parameter can be one of the following values:
+ * @arg ENABLE
+ * @arg DISABLE
+ */
+void BSP_LCD_SetLayerVisible(uint32_t LayerIndex, FunctionalState State)
+{
+ if(State == ENABLE)
+ {
+ __HAL_LTDC_LAYER_ENABLE(&(hltdc_discovery), LayerIndex);
+ }
+ else
+ {
+ __HAL_LTDC_LAYER_DISABLE(&(hltdc_discovery), LayerIndex);
+ }
+ __HAL_LTDC_RELOAD_CONFIG(&(hltdc_discovery));
+
+}
+
+/**
+ * @brief Configures the transparency.
+ * @param LayerIndex: Layer foreground or background.
+ * @param Transparency: Transparency
+ * This parameter must be a number between Min_Data = 0x00 and Max_Data = 0xFF
+ */
+void BSP_LCD_SetTransparency(uint32_t LayerIndex, uint8_t Transparency)
+{
+
+ HAL_LTDC_SetAlpha(&(hltdc_discovery), Transparency, LayerIndex);
+
+}
+
+/**
+ * @brief Sets an LCD layer frame buffer address.
+ * @param LayerIndex: Layer foreground or background
+ * @param Address: New LCD frame buffer value
+ */
+void BSP_LCD_SetLayerAddress(uint32_t LayerIndex, uint32_t Address)
+{
+
+ HAL_LTDC_SetAddress(&(hltdc_discovery), Address, LayerIndex);
+
+}
+
+/**
+ * @brief Sets display window.
+ * @param LayerIndex: Layer index
+ * @param Xpos: LCD X position
+ * @param Ypos: LCD Y position
+ * @param Width: LCD window width
+ * @param Height: LCD window height
+ */
+void BSP_LCD_SetLayerWindow(uint16_t LayerIndex, uint16_t Xpos, uint16_t Ypos, uint16_t Width, uint16_t Height)
+{
+ /* Reconfigure the layer size */
+ HAL_LTDC_SetWindowSize(&(hltdc_discovery), Width, Height, LayerIndex);
+
+ /* Reconfigure the layer position */
+ HAL_LTDC_SetWindowPosition(&(hltdc_discovery), Xpos, Ypos, LayerIndex);
+
+}
+
+/**
+ * @brief Configures and sets the color keying.
+ * @param LayerIndex: Layer foreground or background
+ * @param RGBValue: Color reference
+ */
+void BSP_LCD_SetColorKeying(uint32_t LayerIndex, uint32_t RGBValue)
+{
+ /* Configure and Enable the color Keying for LCD Layer */
+ HAL_LTDC_ConfigColorKeying(&(hltdc_discovery), RGBValue, LayerIndex);
+ HAL_LTDC_EnableColorKeying(&(hltdc_discovery), LayerIndex);
+}
+
+/**
+ * @brief Disables the color keying.
+ * @param LayerIndex: Layer foreground or background
+ */
+void BSP_LCD_ResetColorKeying(uint32_t LayerIndex)
+{
+ /* Disable the color Keying for LCD Layer */
+ HAL_LTDC_DisableColorKeying(&(hltdc_discovery), LayerIndex);
+}
+
+/**
+ * @brief Sets the LCD text color.
+ * @param Color: Text color code ARGB(8-8-8-8)
+ */
+void BSP_LCD_SetTextColor(uint32_t Color)
+{
+ DrawProp[ActiveLayer].TextColor = Color;
+}
+
+/**
+ * @brief Gets the LCD text color.
+ * @retval Used text color.
+ */
+uint32_t BSP_LCD_GetTextColor(void)
+{
+ return DrawProp[ActiveLayer].TextColor;
+}
+
+/**
+ * @brief Sets the LCD background color.
+ * @param Color: Layer background color code ARGB(8-8-8-8)
+ */
+void BSP_LCD_SetBackColor(uint32_t Color)
+{
+ DrawProp[ActiveLayer].BackColor = Color;
+}
+
+/**
+ * @brief Gets the LCD background color.
+ * @retval Used background color
+ */
+uint32_t BSP_LCD_GetBackColor(void)
+{
+ return DrawProp[ActiveLayer].BackColor;
+}
+
+/**
+ * @brief Sets the LCD text font.
+ * @param fonts: Layer font to be used
+ */
+void BSP_LCD_SetFont(sFONT *fonts)
+{
+ DrawProp[ActiveLayer].pFont = fonts;
+}
+
+/**
+ * @brief Gets the LCD text font.
+ * @retval Used layer font
+ */
+sFONT *BSP_LCD_GetFont(void)
+{
+ return DrawProp[ActiveLayer].pFont;
+}
+
+/**
+ * @brief Reads an LCD pixel.
+ * @param Xpos: X position
+ * @param Ypos: Y position
+ * @retval RGB pixel color
+ */
+uint32_t BSP_LCD_ReadPixel(uint16_t Xpos, uint16_t Ypos)
+{
+ uint32_t ret = 0;
+
+ if(hltdc_discovery.LayerCfg[ActiveLayer].PixelFormat == LTDC_PIXEL_FORMAT_ARGB8888)
+ {
+ /* Read data value from SDRAM memory */
+ ret = *(__IO uint32_t*) (hltdc_discovery.LayerCfg[ActiveLayer].FBStartAdress + (4*(Ypos*BSP_LCD_GetXSize() + Xpos)));
+ }
+ else if(hltdc_discovery.LayerCfg[ActiveLayer].PixelFormat == LTDC_PIXEL_FORMAT_RGB888)
+ {
+ /* Read data value from SDRAM memory */
+ ret = (*(__IO uint32_t*) (hltdc_discovery.LayerCfg[ActiveLayer].FBStartAdress + (4*(Ypos*BSP_LCD_GetXSize() + Xpos))) & 0x00FFFFFF);
+ }
+ else if((hltdc_discovery.LayerCfg[ActiveLayer].PixelFormat == LTDC_PIXEL_FORMAT_RGB565) || \
+ (hltdc_discovery.LayerCfg[ActiveLayer].PixelFormat == LTDC_PIXEL_FORMAT_ARGB4444) || \
+ (hltdc_discovery.LayerCfg[ActiveLayer].PixelFormat == LTDC_PIXEL_FORMAT_AL88))
+ {
+ /* Read data value from SDRAM memory */
+ ret = *(__IO uint16_t*) (hltdc_discovery.LayerCfg[ActiveLayer].FBStartAdress + (2*(Ypos*BSP_LCD_GetXSize() + Xpos)));
+ }
+ else
+ {
+ /* Read data value from SDRAM memory */
+ ret = *(__IO uint8_t*) (hltdc_discovery.LayerCfg[ActiveLayer].FBStartAdress + (2*(Ypos*BSP_LCD_GetXSize() + Xpos)));
+ }
+
+ return ret;
+}
+
+/**
+ * @brief Clears the whole currently active layer of LTDC.
+ * @param Color: Color of the background
+ * @retval None
+ */
+void BSP_LCD_Clear(uint32_t Color)
+{
+ /* Clear the LCD */
+ LL_FillBuffer(ActiveLayer, (uint32_t *)(hltdc_discovery.LayerCfg[ActiveLayer].FBStartAdress), BSP_LCD_GetXSize(), BSP_LCD_GetYSize(), 0, Color);
+}
+
+/**
+ * @brief Clears the selected line in currently active layer.
+ * @param Line: Line to be cleared
+ * @retval None
+ */
+void BSP_LCD_ClearStringLine(uint32_t Line)
+{
+ uint32_t color_backup = DrawProp[ActiveLayer].TextColor;
+ DrawProp[ActiveLayer].TextColor = DrawProp[ActiveLayer].BackColor;
+
+ /* Draw rectangle with background color */
+ BSP_LCD_FillRect(0, (Line * DrawProp[ActiveLayer].pFont->Height), BSP_LCD_GetXSize(), DrawProp[ActiveLayer].pFont->Height);
+
+ DrawProp[ActiveLayer].TextColor = color_backup;
+ BSP_LCD_SetTextColor(DrawProp[ActiveLayer].TextColor);
+}
+
+/**
+ * @brief Displays one character in currently active layer.
+ * @param Xpos: Start column address
+ * @param Ypos: Line where to display the character shape.
+ * @param Ascii: Character ascii code
+ * This parameter must be a number between Min_Data = 0x20 and Max_Data = 0x7E
+ * @retval None
+ */
+void BSP_LCD_DisplayChar(uint16_t Xpos, uint16_t Ypos, uint8_t Ascii)
+{
+ DrawChar(Xpos, Ypos, &DrawProp[ActiveLayer].pFont->table[(Ascii-' ') *\
+ DrawProp[ActiveLayer].pFont->Height * ((DrawProp[ActiveLayer].pFont->Width + 7) / 8)]);
+}
+
+/**
+ * @brief Displays characters in currently active layer.
+ * @param Xpos: X position (in pixel)
+ * @param Ypos: Y position (in pixel)
+ * @param Text: Pointer to string to display on LCD
+ * @param Mode: Display mode
+ * This parameter can be one of the following values:
+ * @arg CENTER_MODE
+ * @arg RIGHT_MODE
+ * @arg LEFT_MODE
+ * @retval None
+ */
+void BSP_LCD_DisplayStringAt(uint16_t Xpos, uint16_t Ypos, uint8_t *Text, Text_AlignModeTypdef Mode)
+{
+ uint16_t refcolumn = 1, i = 0;
+ uint32_t size = 0, xsize = 0;
+ uint8_t *ptr = Text;
+
+ /* Get the text size */
+ while (*ptr++) size ++ ;
+
+ /* Characters number per line */
+ xsize = (BSP_LCD_GetXSize()/DrawProp[ActiveLayer].pFont->Width);
+
+ switch (Mode)
+ {
+ case CENTER_MODE:
+ {
+ refcolumn = Xpos + ((xsize - size)* DrawProp[ActiveLayer].pFont->Width) / 2;
+ break;
+ }
+ case LEFT_MODE:
+ {
+ refcolumn = Xpos;
+ break;
+ }
+ case RIGHT_MODE:
+ {
+ refcolumn = - Xpos + ((xsize - size)*DrawProp[ActiveLayer].pFont->Width);
+ break;
+ }
+ default:
+ {
+ refcolumn = Xpos;
+ break;
+ }
+ }
+
+ /* Check that the Start column is located in the screen */
+ if ((refcolumn < 1) || (refcolumn >= 0x8000))
+ {
+ refcolumn = 1;
+ }
+
+ /* Send the string character by character on LCD */
+ while ((*Text != 0) & (((BSP_LCD_GetXSize() - (i*DrawProp[ActiveLayer].pFont->Width)) & 0xFFFF) >= DrawProp[ActiveLayer].pFont->Width))
+ {
+ /* Display one character on LCD */
+ BSP_LCD_DisplayChar(refcolumn, Ypos, *Text);
+ /* Decrement the column position by 16 */
+ refcolumn += DrawProp[ActiveLayer].pFont->Width;
+
+ /* Point on the next character */
+ Text++;
+ i++;
+ }
+
+}
+
+/**
+ * @brief Displays a maximum of 60 characters on the LCD.
+ * @param Line: Line where to display the character shape
+ * @param ptr: Pointer to string to display on LCD
+ * @retval None
+ */
+void BSP_LCD_DisplayStringAtLine(uint16_t Line, uint8_t *ptr)
+{
+ BSP_LCD_DisplayStringAt(0, LINE(Line), ptr, LEFT_MODE);
+}
+
+/**
+ * @brief Draws an horizontal line in currently active layer.
+ * @param Xpos: X position
+ * @param Ypos: Y position
+ * @param Length: Line length
+ * @retval None
+ */
+void BSP_LCD_DrawHLine(uint16_t Xpos, uint16_t Ypos, uint16_t Length)
+{
+ uint32_t Xaddress = 0;
+
+ /* Get the line address */
+ Xaddress = (hltdc_discovery.LayerCfg[ActiveLayer].FBStartAdress) + 4*(BSP_LCD_GetXSize()*Ypos + Xpos);
+
+ /* Write line */
+ LL_FillBuffer(ActiveLayer, (uint32_t *)Xaddress, Length, 1, 0, DrawProp[ActiveLayer].TextColor);
+}
+
+/**
+ * @brief Draws a vertical line in currently active layer.
+ * @param Xpos: X position
+ * @param Ypos: Y position
+ * @param Length: Line length
+ * @retval None
+ */
+void BSP_LCD_DrawVLine(uint16_t Xpos, uint16_t Ypos, uint16_t Length)
+{
+ uint32_t Xaddress = 0;
+
+ /* Get the line address */
+ Xaddress = (hltdc_discovery.LayerCfg[ActiveLayer].FBStartAdress) + 4*(BSP_LCD_GetXSize()*Ypos + Xpos);
+
+ /* Write line */
+ LL_FillBuffer(ActiveLayer, (uint32_t *)Xaddress, 1, Length, (BSP_LCD_GetXSize() - 1), DrawProp[ActiveLayer].TextColor);
+}
+
+/**
+ * @brief Draws an uni-line (between two points) in currently active layer.
+ * @param x1: Point 1 X position
+ * @param y1: Point 1 Y position
+ * @param x2: Point 2 X position
+ * @param y2: Point 2 Y position
+ * @retval None
+ */
+void BSP_LCD_DrawLine(uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2)
+{
+ int16_t deltax = 0, deltay = 0, x = 0, y = 0, xinc1 = 0, xinc2 = 0,
+ yinc1 = 0, yinc2 = 0, den = 0, num = 0, numadd = 0, numpixels = 0,
+ curpixel = 0;
+
+ deltax = ABS(x2 - x1); /* The difference between the x's */
+ deltay = ABS(y2 - y1); /* The difference between the y's */
+ x = x1; /* Start x off at the first pixel */
+ y = y1; /* Start y off at the first pixel */
+
+ if (x2 >= x1) /* The x-values are increasing */
+ {
+ xinc1 = 1;
+ xinc2 = 1;
+ }
+ else /* The x-values are decreasing */
+ {
+ xinc1 = -1;
+ xinc2 = -1;
+ }
+
+ if (y2 >= y1) /* The y-values are increasing */
+ {
+ yinc1 = 1;
+ yinc2 = 1;
+ }
+ else /* The y-values are decreasing */
+ {
+ yinc1 = -1;
+ yinc2 = -1;
+ }
+
+ if (deltax >= deltay) /* There is at least one x-value for every y-value */
+ {
+ xinc1 = 0; /* Don't change the x when numerator >= denominator */
+ yinc2 = 0; /* Don't change the y for every iteration */
+ den = deltax;
+ num = deltax / 2;
+ numadd = deltay;
+ numpixels = deltax; /* There are more x-values than y-values */
+ }
+ else /* There is at least one y-value for every x-value */
+ {
+ xinc2 = 0; /* Don't change the x for every iteration */
+ yinc1 = 0; /* Don't change the y when numerator >= denominator */
+ den = deltay;
+ num = deltay / 2;
+ numadd = deltax;
+ numpixels = deltay; /* There are more y-values than x-values */
+ }
+
+ for (curpixel = 0; curpixel <= numpixels; curpixel++)
+ {
+ BSP_LCD_DrawPixel(x, y, DrawProp[ActiveLayer].TextColor); /* Draw the current pixel */
+ num += numadd; /* Increase the numerator by the top of the fraction */
+ if (num >= den) /* Check if numerator >= denominator */
+ {
+ num -= den; /* Calculate the new numerator value */
+ x += xinc1; /* Change the x as appropriate */
+ y += yinc1; /* Change the y as appropriate */
+ }
+ x += xinc2; /* Change the x as appropriate */
+ y += yinc2; /* Change the y as appropriate */
+ }
+}
+
+/**
+ * @brief Draws a rectangle in currently active layer.
+ * @param Xpos: X position
+ * @param Ypos: Y position
+ * @param Width: Rectangle width
+ * @param Height: Rectangle height
+ * @retval None
+ */
+void BSP_LCD_DrawRect(uint16_t Xpos, uint16_t Ypos, uint16_t Width, uint16_t Height)
+{
+ /* Draw horizontal lines */
+ BSP_LCD_DrawHLine(Xpos, Ypos, Width);
+ BSP_LCD_DrawHLine(Xpos, (Ypos+ Height), Width);
+
+ /* Draw vertical lines */
+ BSP_LCD_DrawVLine(Xpos, Ypos, Height);
+ BSP_LCD_DrawVLine((Xpos + Width), Ypos, Height);
+}
+
+/**
+ * @brief Draws a circle in currently active layer.
+ * @param Xpos: X position
+ * @param Ypos: Y position
+ * @param Radius: Circle radius
+ * @retval None
+ */
+void BSP_LCD_DrawCircle(uint16_t Xpos, uint16_t Ypos, uint16_t Radius)
+{
+ int32_t D; /* Decision Variable */
+ uint32_t CurX; /* Current X Value */
+ uint32_t CurY; /* Current Y Value */
+
+ D = 3 - (Radius << 1);
+ CurX = 0;
+ CurY = Radius;
+
+ while (CurX <= CurY)
+ {
+ BSP_LCD_DrawPixel((Xpos + CurX), (Ypos - CurY), DrawProp[ActiveLayer].TextColor);
+
+ BSP_LCD_DrawPixel((Xpos - CurX), (Ypos - CurY), DrawProp[ActiveLayer].TextColor);
+
+ BSP_LCD_DrawPixel((Xpos + CurY), (Ypos - CurX), DrawProp[ActiveLayer].TextColor);
+
+ BSP_LCD_DrawPixel((Xpos - CurY), (Ypos - CurX), DrawProp[ActiveLayer].TextColor);
+
+ BSP_LCD_DrawPixel((Xpos + CurX), (Ypos + CurY), DrawProp[ActiveLayer].TextColor);
+
+ BSP_LCD_DrawPixel((Xpos - CurX), (Ypos + CurY), DrawProp[ActiveLayer].TextColor);
+
+ BSP_LCD_DrawPixel((Xpos + CurY), (Ypos + CurX), DrawProp[ActiveLayer].TextColor);
+
+ BSP_LCD_DrawPixel((Xpos - CurY), (Ypos + CurX), DrawProp[ActiveLayer].TextColor);
+
+ if (D < 0)
+ {
+ D += (CurX << 2) + 6;
+ }
+ else
+ {
+ D += ((CurX - CurY) << 2) + 10;
+ CurY--;
+ }
+ CurX++;
+ }
+}
+
+/**
+ * @brief Draws an poly-line (between many points) in currently active layer.
+ * @param Points: Pointer to the points array
+ * @param PointCount: Number of points
+ * @retval None
+ */
+void BSP_LCD_DrawPolygon(pPoint Points, uint16_t PointCount)
+{
+ int16_t X = 0, Y = 0;
+
+ if(PointCount < 2)
+ {
+ return;
+ }
+
+ BSP_LCD_DrawLine(Points->X, Points->Y, (Points+PointCount-1)->X, (Points+PointCount-1)->Y);
+
+ while(--PointCount)
+ {
+ X = Points->X;
+ Y = Points->Y;
+ Points++;
+ BSP_LCD_DrawLine(X, Y, Points->X, Points->Y);
+ }
+}
+
+/**
+ * @brief Draws an ellipse on LCD in currently active layer.
+ * @param Xpos: X position
+ * @param Ypos: Y position
+ * @param XRadius: Ellipse X radius
+ * @param YRadius: Ellipse Y radius
+ * @retval None
+ */
+void BSP_LCD_DrawEllipse(int Xpos, int Ypos, int XRadius, int YRadius)
+{
+ int x = 0, y = -YRadius, err = 2-2*XRadius, e2;
+ float K = 0, rad1 = 0, rad2 = 0;
+
+ rad1 = XRadius;
+ rad2 = YRadius;
+
+ K = (float)(rad2/rad1);
+
+ do {
+ BSP_LCD_DrawPixel((Xpos-(uint16_t)(x/K)), (Ypos+y), DrawProp[ActiveLayer].TextColor);
+ BSP_LCD_DrawPixel((Xpos+(uint16_t)(x/K)), (Ypos+y), DrawProp[ActiveLayer].TextColor);
+ BSP_LCD_DrawPixel((Xpos+(uint16_t)(x/K)), (Ypos-y), DrawProp[ActiveLayer].TextColor);
+ BSP_LCD_DrawPixel((Xpos-(uint16_t)(x/K)), (Ypos-y), DrawProp[ActiveLayer].TextColor);
+
+ e2 = err;
+ if (e2 <= x) {
+ err += ++x*2+1;
+ if (-y == x && e2 <= y) e2 = 0;
+ }
+ if (e2 > y) err += ++y*2+1;
+ }
+ while (y <= 0);
+}
+
+/**
+ * @brief Draws a bitmap picture loaded in the internal Flash (32 bpp) in currently active layer.
+ * @param Xpos: Bmp X position in the LCD
+ * @param Ypos: Bmp Y position in the LCD
+ * @param pbmp: Pointer to Bmp picture address in the internal Flash
+ * @retval None
+ */
+void BSP_LCD_DrawBitmap(uint32_t Xpos, uint32_t Ypos, uint8_t *pbmp)
+{
+ uint32_t index = 0, width = 0, height = 0, bit_pixel = 0;
+ uint32_t Address;
+ uint32_t InputColorMode = 0;
+
+ /* Get bitmap data address offset */
+ index = *(__IO uint16_t *) (pbmp + 10);
+ index |= (*(__IO uint16_t *) (pbmp + 12)) << 16;
+
+ /* Read bitmap width */
+ width = *(uint16_t *) (pbmp + 18);
+ width |= (*(uint16_t *) (pbmp + 20)) << 16;
+
+ /* Read bitmap height */
+ height = *(uint16_t *) (pbmp + 22);
+ height |= (*(uint16_t *) (pbmp + 24)) << 16;
+
+ /* Read bit/pixel */
+ bit_pixel = *(uint16_t *) (pbmp + 28);
+
+ /* Set the address */
+ Address = hltdc_discovery.LayerCfg[ActiveLayer].FBStartAdress + (((BSP_LCD_GetXSize()*Ypos) + Xpos)*(4));
+
+ /* Get the layer pixel format */
+ if ((bit_pixel/8) == 4)
+ {
+ InputColorMode = DMA2D_INPUT_ARGB8888;
+ }
+ else if ((bit_pixel/8) == 2)
+ {
+ InputColorMode = DMA2D_INPUT_RGB565;
+ }
+ else
+ {
+ InputColorMode = DMA2D_INPUT_RGB888;
+ }
+
+ /* Bypass the bitmap header */
+ pbmp += (index + (width * (height - 1) * (bit_pixel/8)));
+
+ /* Convert picture to ARGB8888 pixel format */
+ for(index=0; index < height; index++)
+ {
+ /* Pixel format conversion */
+ LL_ConvertLineToARGB8888((uint32_t *)pbmp, (uint32_t *)Address, width, InputColorMode);
+
+ /* Increment the source and destination buffers */
+ Address+= (BSP_LCD_GetXSize()*4);
+ pbmp -= width*(bit_pixel/8);
+ }
+}
+
+/**
+ * @brief Draws a full rectangle in currently active layer.
+ * @param Xpos: X position
+ * @param Ypos: Y position
+ * @param Width: Rectangle width
+ * @param Height: Rectangle height
+ * @retval None
+ */
+void BSP_LCD_FillRect(uint16_t Xpos, uint16_t Ypos, uint16_t Width, uint16_t Height)
+{
+ uint32_t Xaddress = 0;
+
+ /* Set the text color */
+ BSP_LCD_SetTextColor(DrawProp[ActiveLayer].TextColor);
+
+ /* Get the rectangle start address */
+ Xaddress = (hltdc_discovery.LayerCfg[ActiveLayer].FBStartAdress) + 4*(BSP_LCD_GetXSize()*Ypos + Xpos);
+
+ /* Fill the rectangle */
+ LL_FillBuffer(ActiveLayer, (uint32_t *)Xaddress, Width, Height, (BSP_LCD_GetXSize() - Width), DrawProp[ActiveLayer].TextColor);
+}
+
+/**
+ * @brief Draws a full circle in currently active layer.
+ * @param Xpos: X position
+ * @param Ypos: Y position
+ * @param Radius: Circle radius
+ * @retval None
+ */
+void BSP_LCD_FillCircle(uint16_t Xpos, uint16_t Ypos, uint16_t Radius)
+{
+ int32_t D; /* Decision Variable */
+ uint32_t CurX; /* Current X Value */
+ uint32_t CurY; /* Current Y Value */
+
+ D = 3 - (Radius << 1);
+
+ CurX = 0;
+ CurY = Radius;
+
+ BSP_LCD_SetTextColor(DrawProp[ActiveLayer].TextColor);
+
+ while (CurX <= CurY)
+ {
+ if(CurY > 0)
+ {
+ BSP_LCD_DrawHLine(Xpos - CurY, Ypos + CurX, 2*CurY);
+ BSP_LCD_DrawHLine(Xpos - CurY, Ypos - CurX, 2*CurY);
+ }
+
+ if(CurX > 0)
+ {
+ BSP_LCD_DrawHLine(Xpos - CurX, Ypos - CurY, 2*CurX);
+ BSP_LCD_DrawHLine(Xpos - CurX, Ypos + CurY, 2*CurX);
+ }
+ if (D < 0)
+ {
+ D += (CurX << 2) + 6;
+ }
+ else
+ {
+ D += ((CurX - CurY) << 2) + 10;
+ CurY--;
+ }
+ CurX++;
+ }
+
+ BSP_LCD_SetTextColor(DrawProp[ActiveLayer].TextColor);
+ BSP_LCD_DrawCircle(Xpos, Ypos, Radius);
+}
+
+/**
+ * @brief Draws a full poly-line (between many points) in currently active layer.
+ * @param Points: Pointer to the points array
+ * @param PointCount: Number of points
+ * @retval None
+ */
+void BSP_LCD_FillPolygon(pPoint Points, uint16_t PointCount)
+{
+ int16_t X = 0, Y = 0, X2 = 0, Y2 = 0, X_center = 0, Y_center = 0, X_first = 0, Y_first = 0, pixelX = 0, pixelY = 0, counter = 0;
+ uint16_t IMAGE_LEFT = 0, IMAGE_RIGHT = 0, IMAGE_TOP = 0, IMAGE_BOTTOM = 0;
+
+ IMAGE_LEFT = IMAGE_RIGHT = Points->X;
+ IMAGE_TOP= IMAGE_BOTTOM = Points->Y;
+
+ for(counter = 1; counter < PointCount; counter++)
+ {
+ pixelX = POLY_X(counter);
+ if(pixelX < IMAGE_LEFT)
+ {
+ IMAGE_LEFT = pixelX;
+ }
+ if(pixelX > IMAGE_RIGHT)
+ {
+ IMAGE_RIGHT = pixelX;
+ }
+
+ pixelY = POLY_Y(counter);
+ if(pixelY < IMAGE_TOP)
+ {
+ IMAGE_TOP = pixelY;
+ }
+ if(pixelY > IMAGE_BOTTOM)
+ {
+ IMAGE_BOTTOM = pixelY;
+ }
+ }
+
+ if(PointCount < 2)
+ {
+ return;
+ }
+
+ X_center = (IMAGE_LEFT + IMAGE_RIGHT)/2;
+ Y_center = (IMAGE_BOTTOM + IMAGE_TOP)/2;
+
+ X_first = Points->X;
+ Y_first = Points->Y;
+
+ while(--PointCount)
+ {
+ X = Points->X;
+ Y = Points->Y;
+ Points++;
+ X2 = Points->X;
+ Y2 = Points->Y;
+
+ FillTriangle(X, X2, X_center, Y, Y2, Y_center);
+ FillTriangle(X, X_center, X2, Y, Y_center, Y2);
+ FillTriangle(X_center, X2, X, Y_center, Y2, Y);
+ }
+
+ FillTriangle(X_first, X2, X_center, Y_first, Y2, Y_center);
+ FillTriangle(X_first, X_center, X2, Y_first, Y_center, Y2);
+ FillTriangle(X_center, X2, X_first, Y_center, Y2, Y_first);
+}
+
+/**
+ * @brief Draws a full ellipse in currently active layer.
+ * @param Xpos: X position
+ * @param Ypos: Y position
+ * @param XRadius: Ellipse X radius
+ * @param YRadius: Ellipse Y radius
+ * @retval None
+ */
+void BSP_LCD_FillEllipse(int Xpos, int Ypos, int XRadius, int YRadius)
+{
+ int x = 0, y = -YRadius, err = 2-2*XRadius, e2;
+ float K = 0, rad1 = 0, rad2 = 0;
+
+ rad1 = XRadius;
+ rad2 = YRadius;
+
+ K = (float)(rad2/rad1);
+
+ do
+ {
+ BSP_LCD_DrawHLine((Xpos-(uint16_t)(x/K)), (Ypos+y), (2*(uint16_t)(x/K) + 1));
+ BSP_LCD_DrawHLine((Xpos-(uint16_t)(x/K)), (Ypos-y), (2*(uint16_t)(x/K) + 1));
+
+ e2 = err;
+ if (e2 <= x)
+ {
+ err += ++x*2+1;
+ if (-y == x && e2 <= y) e2 = 0;
+ }
+ if (e2 > y) err += ++y*2+1;
+ }
+ while (y <= 0);
+}
+
+/**
+ * @brief Switch back on the display if was switched off by previous call of BSP_LCD_DisplayOff().
+ * Exit DSI ULPM mode if was allowed and configured in Dsi Configuration.
+ * @retval None
+ */
+void BSP_LCD_DisplayOn(void)
+{
+#if defined(USE_LCD_HDMI)
+ if(ADV7533_ID == adv7533_drv.ReadID(ADV7533_CEC_DSI_I2C_ADDR))
+ {
+ return ; /* Not supported for HDMI display */
+ }
+ else
+#endif /* USE_LCD_HDMI */
+ {
+
+ /* Send Display on DCS command to display */
+ HAL_DSI_ShortWrite(&(hdsi_discovery),
+ hdsivideo_handle.VirtualChannelID,
+ DSI_DCS_SHORT_PKT_WRITE_P1,
+ OTM8009A_CMD_DISPON,
+ 0x00);
+ }
+
+}
+
+/**
+ * @brief Switch Off the display.
+ * Enter DSI ULPM mode if was allowed and configured in Dsi Configuration.
+ * @retval None
+ */
+void BSP_LCD_DisplayOff(void)
+{
+#if defined(USE_LCD_HDMI)
+ if(ADV7533_ID == adv7533_drv.ReadID(ADV7533_CEC_DSI_I2C_ADDR))
+ {
+ return ; /* Not supported for HDMI yet */
+ }
+ else
+#endif /* USE_LCD_HDMI */
+ {
+ /* Send Display off DCS Command to display */
+ HAL_DSI_ShortWrite(&(hdsi_discovery),
+ hdsivideo_handle.VirtualChannelID,
+ DSI_DCS_SHORT_PKT_WRITE_P1,
+ OTM8009A_CMD_DISPOFF,
+ 0x00);
+ }
+
+}
+
+/**
+ * @brief Set the brightness value
+ * @param BrightnessValue: [00: Min (black), 100 Max]
+ * @retval None
+ */
+void BSP_LCD_SetBrightness(uint8_t BrightnessValue)
+{
+#if defined(USE_LCD_HDMI)
+ if(ADV7533_ID == adv7533_drv.ReadID(ADV7533_CEC_DSI_I2C_ADDR))
+ {
+ return ; /* Not supported for HDMI display */
+ }
+ else
+#endif /* USE_LCD_HDMI */
+ {
+ /* Send Display on DCS command to display */
+ HAL_DSI_ShortWrite(&hdsi_discovery,
+ LCD_OTM8009A_ID,
+ DSI_DCS_SHORT_PKT_WRITE_P1,
+ OTM8009A_CMD_WRDISBV, (uint16_t)(BrightnessValue * 255)/100);
+ }
+
+}
+
+/**
+ * @brief DCS or Generic short/long write command
+ * @param NbrParams: Number of parameters. It indicates the write command mode:
+ * If inferior to 2, a long write command is performed else short.
+ * @param pParams: Pointer to parameter values table.
+ * @retval None
+ */
+void DSI_IO_WriteCmd(uint32_t NbrParams, uint8_t *pParams)
+{
+ if(NbrParams <= 1)
+ {
+ HAL_DSI_ShortWrite(&hdsi_discovery, LCD_OTM8009A_ID, DSI_DCS_SHORT_PKT_WRITE_P1, pParams[0], pParams[1]);
+ }
+ else
+ {
+ HAL_DSI_LongWrite(&hdsi_discovery, LCD_OTM8009A_ID, DSI_DCS_LONG_PKT_WRITE, NbrParams, pParams[NbrParams], pParams);
+ }
+}
+
+/**
+ * @brief Returns the ID of connected screen by checking the HDMI
+ * (adv7533 component) ID or LCD DSI (via TS ID) ID.
+ * @retval LCD ID
+ */
+static uint16_t LCD_IO_GetID(void)
+{
+#if defined(USE_LCD_HDMI)
+ HDMI_IO_Init();
+
+ HDMI_IO_Delay(120);
+
+ if(ADV7533_ID == adv7533_drv.ReadID(ADV7533_CEC_DSI_I2C_ADDR))
+ {
+ return ADV7533_ID;
+ }
+ else if(((HDMI_IO_Read(LCD_DSI_ADDRESS, LCD_DSI_ID_REG) == LCD_DSI_ID)) || \
+ (HDMI_IO_Read(LCD_DSI_ADDRESS_A02, LCD_DSI_ID_REG) == LCD_DSI_ID))
+ {
+ return LCD_DSI_ID;
+ }
+ else
+ {
+ return 0;
+ }
+#else
+ return LCD_DSI_ID;
+#endif /* USE_LCD_HDMI */
+
+}
+
+/*******************************************************************************
+ LTDC, DMA2D and DSI BSP Routines
+*******************************************************************************/
+/**
+ * @brief De-Initializes the BSP LCD Msp
+ * Application can surcharge if needed this function implementation.
+ * @retval None
+ */
+__weak void BSP_LCD_MspDeInit(void)
+{
+ /** @brief Disable IRQ of LTDC IP */
+ HAL_NVIC_DisableIRQ(LTDC_IRQn);
+
+ /** @brief Disable IRQ of DMA2D IP */
+ HAL_NVIC_DisableIRQ(DMA2D_IRQn);
+
+ /** @brief Disable IRQ of DSI IP */
+ HAL_NVIC_DisableIRQ(DSI_IRQn);
+
+ /** @brief Force and let in reset state LTDC, DMA2D and DSI Host + Wrapper IPs */
+ __HAL_RCC_LTDC_FORCE_RESET();
+ __HAL_RCC_DMA2D_FORCE_RESET();
+ __HAL_RCC_DSI_FORCE_RESET();
+
+ /** @brief Disable the LTDC, DMA2D and DSI Host and Wrapper clocks */
+ __HAL_RCC_LTDC_CLK_DISABLE();
+ __HAL_RCC_DMA2D_CLK_DISABLE();
+ __HAL_RCC_DSI_CLK_DISABLE();
+}
+
+/**
+ * @brief Initialize the BSP LCD Msp.
+ * Application can surcharge if needed this function implementation
+ * @retval None
+ */
+__weak void BSP_LCD_MspInit(void)
+{
+ /** @brief Enable the LTDC clock */
+ __HAL_RCC_LTDC_CLK_ENABLE();
+
+ /** @brief Toggle Sw reset of LTDC IP */
+ __HAL_RCC_LTDC_FORCE_RESET();
+ __HAL_RCC_LTDC_RELEASE_RESET();
+
+ /** @brief Enable the DMA2D clock */
+ __HAL_RCC_DMA2D_CLK_ENABLE();
+
+ /** @brief Toggle Sw reset of DMA2D IP */
+ __HAL_RCC_DMA2D_FORCE_RESET();
+ __HAL_RCC_DMA2D_RELEASE_RESET();
+
+ /** @brief Enable DSI Host and wrapper clocks */
+ __HAL_RCC_DSI_CLK_ENABLE();
+
+ /** @brief Soft Reset the DSI Host and wrapper */
+ __HAL_RCC_DSI_FORCE_RESET();
+ __HAL_RCC_DSI_RELEASE_RESET();
+
+ /** @brief NVIC configuration for LTDC interrupt that is now enabled */
+ HAL_NVIC_SetPriority(LTDC_IRQn, 0x0F, 0);
+ HAL_NVIC_EnableIRQ(LTDC_IRQn);
+
+ /** @brief NVIC configuration for DMA2D interrupt that is now enabled */
+ HAL_NVIC_SetPriority(DMA2D_IRQn, 0x0F, 0);
+ HAL_NVIC_EnableIRQ(DMA2D_IRQn);
+
+ /** @brief NVIC configuration for DSI interrupt that is now enabled */
+ HAL_NVIC_SetPriority(DSI_IRQn, 0x0F, 0);
+ HAL_NVIC_EnableIRQ(DSI_IRQn);
+}
+
+/**
+ * @brief Draws a pixel on LCD.
+ * @param Xpos: X position
+ * @param Ypos: Y position
+ * @param RGB_Code: Pixel color in ARGB mode (8-8-8-8)
+ * @retval None
+ */
+void BSP_LCD_DrawPixel(uint16_t Xpos, uint16_t Ypos, uint32_t RGB_Code)
+{
+ /* Write data value to all SDRAM memory */
+ *(__IO uint32_t*) (hltdc_discovery.LayerCfg[ActiveLayer].FBStartAdress + (4*(Ypos*BSP_LCD_GetXSize() + Xpos))) = RGB_Code;
+}
+/**
+ * @}
+ */
+
+/** @defgroup STM32H747I_DISCOVERY_LCD_Private_Functions Private Functions
+ * @{
+ */
+
+/**
+ * @brief Draws a character on LCD.
+ * @param Xpos: Line where to display the character shape
+ * @param Ypos: Start column address
+ * @param c: Pointer to the character data
+ * @retval None
+ */
+static void DrawChar(uint16_t Xpos, uint16_t Ypos, const uint8_t *c)
+{
+ uint32_t i = 0, j = 0;
+ uint16_t height, width;
+ uint8_t offset;
+ uint8_t *pchar;
+ uint32_t line;
+
+ height = DrawProp[ActiveLayer].pFont->Height;
+ width = DrawProp[ActiveLayer].pFont->Width;
+
+ offset = 8 *((width + 7)/8) - width ;
+
+ for(i = 0; i < height; i++)
+ {
+ pchar = ((uint8_t *)c + (width + 7)/8 * i);
+
+ switch(((width + 7)/8))
+ {
+
+ case 1:
+ line = pchar[0];
+ break;
+
+ case 2:
+ line = (pchar[0]<< 8) | pchar[1];
+ break;
+
+ case 3:
+ default:
+ line = (pchar[0]<< 16) | (pchar[1]<< 8) | pchar[2];
+ break;
+ }
+
+ for (j = 0; j < width; j++)
+ {
+ if(line & (1 << (width- j + offset- 1)))
+ {
+ BSP_LCD_DrawPixel((Xpos + j), Ypos, DrawProp[ActiveLayer].TextColor);
+ }
+ else
+ {
+ BSP_LCD_DrawPixel((Xpos + j), Ypos, DrawProp[ActiveLayer].BackColor);
+ }
+ }
+ Ypos++;
+ }
+}
+
+/**
+ * @brief Fills a triangle (between 3 points).
+ * @param x1: Point 1 X position
+ * @param y1: Point 1 Y position
+ * @param x2: Point 2 X position
+ * @param y2: Point 2 Y position
+ * @param x3: Point 3 X position
+ * @param y3: Point 3 Y position
+ * @retval None
+ */
+static void FillTriangle(uint16_t x1, uint16_t x2, uint16_t x3, uint16_t y1, uint16_t y2, uint16_t y3)
+{
+ int16_t deltax = 0, deltay = 0, x = 0, y = 0, xinc1 = 0, xinc2 = 0,
+ yinc1 = 0, yinc2 = 0, den = 0, num = 0, numadd = 0, numpixels = 0,
+ curpixel = 0;
+
+ deltax = ABS(x2 - x1); /* The difference between the x's */
+ deltay = ABS(y2 - y1); /* The difference between the y's */
+ x = x1; /* Start x off at the first pixel */
+ y = y1; /* Start y off at the first pixel */
+
+ if (x2 >= x1) /* The x-values are increasing */
+ {
+ xinc1 = 1;
+ xinc2 = 1;
+ }
+ else /* The x-values are decreasing */
+ {
+ xinc1 = -1;
+ xinc2 = -1;
+ }
+
+ if (y2 >= y1) /* The y-values are increasing */
+ {
+ yinc1 = 1;
+ yinc2 = 1;
+ }
+ else /* The y-values are decreasing */
+ {
+ yinc1 = -1;
+ yinc2 = -1;
+ }
+
+ if (deltax >= deltay) /* There is at least one x-value for every y-value */
+ {
+ xinc1 = 0; /* Don't change the x when numerator >= denominator */
+ yinc2 = 0; /* Don't change the y for every iteration */
+ den = deltax;
+ num = deltax / 2;
+ numadd = deltay;
+ numpixels = deltax; /* There are more x-values than y-values */
+ }
+ else /* There is at least one y-value for every x-value */
+ {
+ xinc2 = 0; /* Don't change the x for every iteration */
+ yinc1 = 0; /* Don't change the y when numerator >= denominator */
+ den = deltay;
+ num = deltay / 2;
+ numadd = deltax;
+ numpixels = deltay; /* There are more y-values than x-values */
+ }
+
+ for (curpixel = 0; curpixel <= numpixels; curpixel++)
+ {
+ BSP_LCD_DrawLine(x, y, x3, y3);
+
+ num += numadd; /* Increase the numerator by the top of the fraction */
+ if (num >= den) /* Check if numerator >= denominator */
+ {
+ num -= den; /* Calculate the new numerator value */
+ x += xinc1; /* Change the x as appropriate */
+ y += yinc1; /* Change the y as appropriate */
+ }
+ x += xinc2; /* Change the x as appropriate */
+ y += yinc2; /* Change the y as appropriate */
+ }
+}
+
+/**
+ * @brief Fills a buffer.
+ * @param LayerIndex: Layer index
+ * @param pDst: Pointer to destination buffer
+ * @param xSize: Buffer width
+ * @param ySize: Buffer height
+ * @param OffLine: Offset
+ * @param ColorIndex: Color index
+ * @retval None
+ */
+static void LL_FillBuffer(uint32_t LayerIndex, void *pDst, uint32_t xSize, uint32_t ySize, uint32_t OffLine, uint32_t ColorIndex)
+{
+ /* Register to memory mode with ARGB8888 as color Mode */
+ hdma2d_discovery.Init.Mode = DMA2D_R2M;
+ hdma2d_discovery.Init.ColorMode = DMA2D_OUTPUT_ARGB8888;
+ hdma2d_discovery.Init.OutputOffset = OffLine;
+
+ hdma2d_discovery.Instance = DMA2D;
+
+ /* DMA2D Initialization */
+ if(HAL_DMA2D_Init(&hdma2d_discovery) == HAL_OK)
+ {
+ if(HAL_DMA2D_ConfigLayer(&hdma2d_discovery, 1) == HAL_OK)
+ {
+ if (HAL_DMA2D_Start(&hdma2d_discovery, ColorIndex, (uint32_t)pDst, xSize, ySize) == HAL_OK)
+ {
+ /* Polling For DMA transfer */
+ HAL_DMA2D_PollForTransfer(&hdma2d_discovery, 25);
+ }
+ }
+ }
+}
+
+/**
+ * @brief Converts a line to an ARGB8888 pixel format.
+ * @param pSrc: Pointer to source buffer
+ * @param pDst: Output color
+ * @param xSize: Buffer width
+ * @param ColorMode: Input color mode
+ * @retval None
+ */
+static void LL_ConvertLineToARGB8888(void *pSrc, void *pDst, uint32_t xSize, uint32_t ColorMode)
+{
+ /* Configure the DMA2D Mode, Color Mode and output offset */
+ hdma2d_discovery.Init.Mode = DMA2D_M2M_PFC;
+ hdma2d_discovery.Init.ColorMode = DMA2D_OUTPUT_ARGB8888;
+ hdma2d_discovery.Init.OutputOffset = 0;
+
+ /* Foreground Configuration */
+ hdma2d_discovery.LayerCfg[1].AlphaMode = DMA2D_NO_MODIF_ALPHA;
+ hdma2d_discovery.LayerCfg[1].InputAlpha = 0xFF;
+ hdma2d_discovery.LayerCfg[1].InputColorMode = ColorMode;
+ hdma2d_discovery.LayerCfg[1].InputOffset = 0;
+
+ hdma2d_discovery.Instance = DMA2D;
+
+ /* DMA2D Initialization */
+ if(HAL_DMA2D_Init(&hdma2d_discovery) == HAL_OK)
+ {
+ if(HAL_DMA2D_ConfigLayer(&hdma2d_discovery, 1) == HAL_OK)
+ {
+ if (HAL_DMA2D_Start(&hdma2d_discovery, (uint32_t)pSrc, (uint32_t)pDst, xSize, 1) == HAL_OK)
+ {
+ /* Polling For DMA transfer */
+ HAL_DMA2D_PollForTransfer(&hdma2d_discovery, 25);
+ }
+ }
+ }
+}
+
+/**
+ * @}
+ */
+
+/**
+ * @}
+ */
+
+/**
+ * @}
+ */
+
+/**
+ * @}
+ */
+
+/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/