BSP Drivers
Dependencies: CMSIS_STM32L4xx CMSIS_DSP_401 STM32L4xx_HAL_Driver
Diff: Adafruit_Shield/stm32_adafruit_lcd.c
- Revision:
- 4:a1219ef3537f
- Parent:
- 2:a9f205b30d61
--- a/Adafruit_Shield/stm32_adafruit_lcd.c Thu Nov 12 20:53:23 2015 +0000 +++ /dev/null Thu Jan 01 00:00:00 1970 +0000 @@ -1,1061 +0,0 @@ -/** - ****************************************************************************** - * @file stm32_adafruit_lcd.c - * @author MCD Application Team - * @version V2.0.0 - * @date 10-September-2015 - * @brief This file includes the driver for Liquid Crystal Display (LCD) module - * mounted on the Adafruit 1.8" TFT LCD shield (reference ID 802), - * that is used with the STM32 Nucleo board through SPI interface. - ****************************************************************************** - * @attention - * - * <h2><center>© COPYRIGHT(c) 2015 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. - * - ****************************************************************************** - */ - -/* File Info : ----------------------------------------------------------------- - User NOTES -1. How To use this driver: --------------------------- - - The LCD st7735 component driver MUST be included with this driver. - -2. Driver description: ---------------------- - + Initialization steps: - o Initialize the LCD using the BSP_LCD_Init() function. - - + Display on LCD - o Clear the whole LCD using the 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, ..) - on LCD using a set of functions. - -------------------------------------------------------------------------------*/ - -/* Includes ------------------------------------------------------------------*/ -#include "stm32_adafruit_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 STM32_ADAFRUIT - * @{ - */ - -/** @addtogroup STM32_ADAFRUIT_LCD - * @{ - */ - -/** @defgroup STM32_ADAFRUIT_LCD_Private_TypesDefinitions - * @{ - */ - -/** - * @} - */ - -/** @defgroup STM32_ADAFRUIT_LCD_Private_Defines - * @{ - */ -#define POLY_X(Z) ((int32_t)((Points + (Z))->X)) -#define POLY_Y(Z) ((int32_t)((Points + (Z))->Y)) -#define NULL (void *)0 - -#define MAX_HEIGHT_FONT 17 -#define MAX_WIDTH_FONT 24 -#define OFFSET_BITMAP 54 -/** - * @} - */ - -/** @defgroup STM32_ADAFRUIT_LCD_Private_Macros - * @{ - */ -#define ABS(X) ((X) > 0 ? (X) : -(X)) - -/** - * @} - */ - -/** @defgroup STM32_ADAFRUIT_LCD_Private_Variables - * @{ - */ -LCD_DrawPropTypeDef DrawProp; - -static LCD_DrvTypeDef *lcd_drv; - -/* Max size of bitmap will based on a font24 (17x24) */ -static uint8_t bitmap[MAX_HEIGHT_FONT*MAX_WIDTH_FONT*2+OFFSET_BITMAP] = {0}; - -/** - * @} - */ - -/** @defgroup STM32_ADAFRUIT_LCD_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 SetDisplayWindow(uint16_t Xpos, uint16_t Ypos, uint16_t Width, uint16_t Height); -/** - * @} - */ - - -/** @defgroup STM32_ADAFRUIT_LCD_Private_Functions - * @{ - */ - -/** - * @brief Initializes the LCD. - * @param None - * @retval LCD state - */ -uint8_t BSP_LCD_Init(void) -{ - uint8_t ret = LCD_ERROR; - - /* Default value for draw propriety */ - DrawProp.BackColor = 0xFFFF; - DrawProp.pFont = &Font24; - DrawProp.TextColor = 0x0000; - - lcd_drv = &st7735_drv; - - /* LCD Init */ - lcd_drv->Init(); - - /* Clear the LCD screen */ - BSP_LCD_Clear(LCD_COLOR_WHITE); - - /* Initialize the font */ - BSP_LCD_SetFont(&LCD_DEFAULT_FONT); - - ret = LCD_OK; - - return ret; -} - -/** - * @brief Gets the LCD X size. - * @param None - * @retval Used LCD X size - */ -uint32_t BSP_LCD_GetXSize(void) -{ - return(lcd_drv->GetLcdPixelWidth()); -} - -/** - * @brief Gets the LCD Y size. - * @param None - * @retval Used LCD Y size - */ -uint32_t BSP_LCD_GetYSize(void) -{ - return(lcd_drv->GetLcdPixelHeight()); -} - -/** - * @brief Gets the LCD text color. - * @param None - * @retval Used text color. - */ -uint16_t BSP_LCD_GetTextColor(void) -{ - return DrawProp.TextColor; -} - -/** - * @brief Gets the LCD background color. - * @param None - * @retval Used background color - */ -uint16_t BSP_LCD_GetBackColor(void) -{ - return DrawProp.BackColor; -} - -/** - * @brief Sets the LCD text color. - * @param Color: Text color code RGB(5-6-5) - * @retval None - */ -void BSP_LCD_SetTextColor(uint16_t Color) -{ - DrawProp.TextColor = Color; -} - -/** - * @brief Sets the LCD background color. - * @param Color: Background color code RGB(5-6-5) - * @retval None - */ -void BSP_LCD_SetBackColor(uint16_t Color) -{ - DrawProp.BackColor = Color; -} - -/** - * @brief Sets the LCD text font. - * @param fonts: Font to be used - * @retval None - */ -void BSP_LCD_SetFont(sFONT *pFonts) -{ - DrawProp.pFont = pFonts; -} - -/** - * @brief Gets the LCD text font. - * @param None - * @retval Used font - */ -sFONT *BSP_LCD_GetFont(void) -{ - return DrawProp.pFont; -} - -/** - * @brief Clears the hole LCD. - * @param Color: Color of the background - * @retval None - */ -void BSP_LCD_Clear(uint16_t Color) -{ - uint32_t counter = 0; - uint32_t color_backup = DrawProp.TextColor; - DrawProp.TextColor = Color; - - for(counter = 0; counter < BSP_LCD_GetYSize(); counter++) - { - BSP_LCD_DrawHLine(0, counter, BSP_LCD_GetXSize()); - } - DrawProp.TextColor = color_backup; - BSP_LCD_SetTextColor(DrawProp.TextColor); -} - -/** - * @brief Clears the selected line. - * @param Line: Line to be cleared - * This parameter can be one of the following values: - * @arg 0..9: if the Current fonts is Font16x24 - * @arg 0..19: if the Current fonts is Font12x12 or Font8x12 - * @arg 0..29: if the Current fonts is Font8x8 - * @retval None - */ -void BSP_LCD_ClearStringLine(uint16_t Line) -{ - uint32_t color_backup = DrawProp.TextColor; - DrawProp.TextColor = DrawProp.BackColor;; - - /* Draw a rectangle with background color */ - BSP_LCD_FillRect(0, (Line * DrawProp.pFont->Height), BSP_LCD_GetXSize(), DrawProp.pFont->Height); - - DrawProp.TextColor = color_backup; - BSP_LCD_SetTextColor(DrawProp.TextColor); -} - -/** - * @brief Displays one character. - * @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.pFont->table[(Ascii-' ') *\ - DrawProp.pFont->Height * ((DrawProp.pFont->Width + 7) / 8)]); -} - -/** - * @brief Displays characters on the LCD. - * @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, Line_ModeTypdef 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.pFont->Width); - - switch (Mode) - { - case CENTER_MODE: - { - refcolumn = Xpos + ((xsize - size)* DrawProp.pFont->Width) / 2; - break; - } - case LEFT_MODE: - { - refcolumn = Xpos; - break; - } - case RIGHT_MODE: - { - refcolumn = - Xpos + ((xsize - size)*DrawProp.pFont->Width); - break; - } - default: - { - refcolumn = Xpos; - break; - } - } - - /* Send the string character by character on lCD */ - while ((*Text != 0) & (((BSP_LCD_GetXSize() - (i*DrawProp.pFont->Width)) & 0xFFFF) >= DrawProp.pFont->Width)) - { - /* Display one character on LCD */ - BSP_LCD_DisplayChar(refcolumn, Ypos, *Text); - /* Decrement the column position by 16 */ - refcolumn += DrawProp.pFont->Width; - /* Point on the next character */ - Text++; - i++; - } -} - -/** - * @brief Displays a character on the LCD. - * @param Line: Line where to display the character shape - * This parameter can be one of the following values: - * @arg 0..19: if the Current fonts is Font8 - * @arg 0..12: if the Current fonts is Font12 - * @arg 0...9: if the Current fonts is Font16 - * @arg 0...7: if the Current fonts is Font20 - * @arg 0...5: if the Current fonts is Font24 - * @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 a pixel on LCD. - * @param Xpos: X position - * @param Ypos: Y position - * @param RGB_Code: Pixel color in RGB mode (5-6-5) - * @retval None - */ -void BSP_LCD_DrawPixel(uint16_t Xpos, uint16_t Ypos, uint16_t RGB_Code) -{ - if(lcd_drv->WritePixel != NULL) - { - lcd_drv->WritePixel(Xpos, Ypos, RGB_Code); - } -} - -/** - * @brief Draws an horizontal line. - * @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 index = 0; - - if(lcd_drv->DrawHLine != NULL) - { - lcd_drv->DrawHLine(DrawProp.TextColor, Xpos, Ypos, Length); - } - else - { - for(index = 0; index < Length; index++) - { - BSP_LCD_DrawPixel((Xpos + index), Ypos, DrawProp.TextColor); - } - } -} - -/** - * @brief Draws a vertical line. - * @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 index = 0; - - if(lcd_drv->DrawVLine != NULL) - { - lcd_drv->DrawVLine(DrawProp.TextColor, Xpos, Ypos, Length); - } - else - { - for(index = 0; index < Length; index++) - { - BSP_LCD_DrawPixel(Xpos, Ypos + index, DrawProp.TextColor); - } - } -} - -/** - * @brief Draws an uni-line (between two 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 - * @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.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. - * @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. - * @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.TextColor); - - BSP_LCD_DrawPixel((Xpos - CurX), (Ypos - CurY), DrawProp.TextColor); - - BSP_LCD_DrawPixel((Xpos + CurY), (Ypos - CurX), DrawProp.TextColor); - - BSP_LCD_DrawPixel((Xpos - CurY), (Ypos - CurX), DrawProp.TextColor); - - BSP_LCD_DrawPixel((Xpos + CurX), (Ypos + CurY), DrawProp.TextColor); - - BSP_LCD_DrawPixel((Xpos - CurX), (Ypos + CurY), DrawProp.TextColor); - - BSP_LCD_DrawPixel((Xpos + CurY), (Ypos + CurX), DrawProp.TextColor); - - BSP_LCD_DrawPixel((Xpos - CurY), (Ypos + CurX), DrawProp.TextColor); - - /* Initialize the font */ - BSP_LCD_SetFont(&LCD_DEFAULT_FONT); - - if (D < 0) - { - D += (CurX << 2) + 6; - } - else - { - D += ((CurX - CurY) << 2) + 10; - CurY--; - } - CurX++; - } -} - -/** - * @brief Draws an poly-line (between many points). - * @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. - * @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.TextColor); - BSP_LCD_DrawPixel((Xpos+(uint16_t)(x/K)), (Ypos+y), DrawProp.TextColor); - BSP_LCD_DrawPixel((Xpos+(uint16_t)(x/K)), (Ypos-y), DrawProp.TextColor); - BSP_LCD_DrawPixel((Xpos-(uint16_t)(x/K)), (Ypos-y), DrawProp.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 STM32 MCU internal memory. - * @param Xpos: Bmp X position in the LCD - * @param Ypos: Bmp Y position in the LCD - * @param pBmp: Pointer to Bmp picture address - * @retval None - */ -void BSP_LCD_DrawBitmap(uint16_t Xpos, uint16_t Ypos, uint8_t *pBmp) -{ - uint32_t height = 0, width = 0; - - /* 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; - - /* Remap Ypos, st7735 works with inverted X in case of bitmap */ - /* X = 0, cursor is on Top corner */ - if(lcd_drv == &st7735_drv) - { - Ypos = BSP_LCD_GetYSize() - Ypos - height; - } - - SetDisplayWindow(Xpos, Ypos, width, height); - - if(lcd_drv->DrawBitmap != NULL) - { - lcd_drv->DrawBitmap(Xpos, Ypos, pBmp); - } - SetDisplayWindow(0, 0, BSP_LCD_GetXSize(), BSP_LCD_GetYSize()); -} - -/** - * @brief Draws a full rectangle. - * @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) -{ - BSP_LCD_SetTextColor(DrawProp.TextColor); - do - { - BSP_LCD_DrawHLine(Xpos, Ypos++, Width); - } - while(Height--); -} - -/** - * @brief Draws a full circle. - * @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.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.TextColor); - BSP_LCD_DrawCircle(Xpos, Ypos, Radius); -} - -/** - * @brief Draws a full poly-line (between many points). - * @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. - * @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 Enables the display. - * @param None - * @retval None - */ -void BSP_LCD_DisplayOn(void) -{ - lcd_drv->DisplayOn(); -} - -/** - * @brief Disables the display. - * @param None - * @retval None - */ -void BSP_LCD_DisplayOff(void) -{ - lcd_drv->DisplayOff(); -} - -/******************************************************************************* - Static Functions -*******************************************************************************/ - -/** - * @brief Draws a character on LCD. - * @param Xpos: Line where to display the character shape - * @param Ypos: Start column address - * @param pChar: Pointer to the character data - * @retval None - */ -static void DrawChar(uint16_t Xpos, uint16_t Ypos, const uint8_t *pChar) -{ - uint32_t counterh = 0, counterw = 0, index = 0; - uint16_t height = 0, width = 0; - uint8_t offset = 0; - uint8_t *pchar = NULL; - uint32_t line = 0; - - height = DrawProp.pFont->Height; - width = DrawProp.pFont->Width; - - /* Fill bitmap header*/ - *(uint16_t *) (bitmap + 2) = (uint16_t)(height*width*2+OFFSET_BITMAP); - *(uint16_t *) (bitmap + 4) = (uint16_t)((height*width*2+OFFSET_BITMAP)>>16); - *(uint16_t *) (bitmap + 10) = OFFSET_BITMAP; - *(uint16_t *) (bitmap + 18) = (uint16_t)(width); - *(uint16_t *) (bitmap + 20) = (uint16_t)((width)>>16); - *(uint16_t *) (bitmap + 22) = (uint16_t)(height); - *(uint16_t *) (bitmap + 24) = (uint16_t)((height)>>16); - - offset = 8 *((width + 7)/8) - width ; - - for(counterh = 0; counterh < height; counterh++) - { - pchar = ((uint8_t *)pChar + (width + 7)/8 * counterh); - - if(((width + 7)/8) == 3) - { - line = (pchar[0]<< 16) | (pchar[1]<< 8) | pchar[2]; - } - - if(((width + 7)/8) == 2) - { - line = (pchar[0]<< 8) | pchar[1]; - } - - if(((width + 7)/8) == 1) - { - line = pchar[0]; - } - - for (counterw = 0; counterw < width; counterw++) - { - /* Image in the bitmap is written from the bottom to the top */ - /* Need to invert image in the bitmap */ - index = (((height-counterh-1)*width)+(counterw))*2+OFFSET_BITMAP; - if(line & (1 << (width- counterw + offset- 1))) - { - bitmap[index] = (uint8_t)DrawProp.TextColor; - bitmap[index+1] = (uint8_t)(DrawProp.TextColor >> 8); - } - else - { - bitmap[index] = (uint8_t)DrawProp.BackColor; - bitmap[index+1] = (uint8_t)(DrawProp.BackColor >> 8); - } - } - } - - BSP_LCD_DrawBitmap(Xpos, Ypos, bitmap); -} - -/** - * @brief Fills a triangle (between 3 points). - * @param Points: Pointer to the points array - * @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 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 - * @retval None - */ -static void SetDisplayWindow(uint16_t Xpos, uint16_t Ypos, uint16_t Width, uint16_t Height) -{ - if(lcd_drv->SetDisplayWindow != NULL) - { - lcd_drv->SetDisplayWindow(Xpos, Ypos, Width, Height); - } -} - -/** - * @} - */ - -/** - * @} - */ - -/** - * @} - */ - -/** - * @} - */ -/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/ -