Implement lcd_display_text

This commit is contained in:
xoreo
2023-11-10 19:03:42 +01:00
parent 4ea21bc4cf
commit 94875d729a
3 changed files with 109 additions and 64 deletions

View File

@@ -2,7 +2,6 @@
* @file lcd_api.c
* @brief LCD API implementation
* @author Tim S.
* @todo Implement lcd_display_text(...)
* @todo Implement function to read images from fs
*/
@@ -11,7 +10,7 @@
static DMA2D_HandleTypeDef hDma2dHandler2;
void lcd_init(bool BL_On) {
void lcd_init(bool bl_on) {
BSP_LCD_Init();
BSP_LCD_LayerDefaultInit(1, LCD_FB_START_ADDRESS);
BSP_LCD_LayerDefaultInit(0, LCD_FB_START_ADDRESS + (BSP_LCD_GetXSize()*BSP_LCD_GetYSize()*4));
@@ -19,40 +18,77 @@ void lcd_init(bool BL_On) {
BSP_LCD_Clear(LCD_COLOR_BLACK);
BSP_LCD_SelectLayer(1);
BSP_LCD_Clear(LCD_COLOR_BLACK);
if (BL_On) {
if (bl_on) {
HAL_GPIO_WritePin(GPIOK, GPIO_PIN_3, GPIO_PIN_SET);
HAL_GPIO_WritePin(GPIOI, GPIO_PIN_12, GPIO_PIN_SET);
}else{
} else {
HAL_GPIO_WritePin(GPIOK, GPIO_PIN_3, GPIO_PIN_RESET);
HAL_GPIO_WritePin(GPIOI, GPIO_PIN_12, GPIO_PIN_RESET);
}
}
// TODO: implement this function
void lcd_display_text(const char* text, uint16_t x_pos, uint16_t y_pos, uint32_t color) {
void lcd_display_text(const char* text, uint16_t x_pos, uint16_t y_pos, uint32_t color, uint32_t bg_color, sFONT *font) {
uint16_t tot_length = x_pos + (strlen(text) * font->Width);
if ((x_pos % font->Width) != 0) {
x_pos -= (x_pos % font->Width);
}
BSP_LCD_SetTextColor(color);
BSP_LCD_SetBackColor(bg_color);
BSP_LCD_SetFont(font);
if (tot_length > BSP_LCD_GetXSize()) {
uint16_t wrap_idx = (BSP_LCD_GetXSize() - x_pos)/font->Width;
if (isalpha(text[wrap_idx - 1]) && isalpha(text[wrap_idx])) {
x_pos -= (font->Width-2);
char part_one[wrap_idx+2];
char part_two[(strlen(text) - wrap_idx)+1];
strncpy(part_one, text, wrap_idx);
part_one[wrap_idx] = '-';
part_one[wrap_idx+1] = '\00';
strncpy(part_two, &text[wrap_idx], (strlen(text) - wrap_idx));
part_two[(strlen(text) - wrap_idx)] = '\00';
BSP_LCD_DisplayStringAt(x_pos, y_pos, part_one, LEFT_MODE);
y_pos += font->Height;
x_pos = 0;
BSP_LCD_DisplayStringAt(x_pos, y_pos, part_two, LEFT_MODE);
} else {
char part_one[wrap_idx+1];
char part_two[(strlen(text) - wrap_idx)+1];
strncpy(part_one, text, wrap_idx);
part_one[wrap_idx] = '\00';
strncpy(part_two, &text[wrap_idx], (strlen(text) - wrap_idx));
part_two[(strlen(text) - wrap_idx)] = '\00';
BSP_LCD_DisplayStringAt(x_pos, y_pos, part_one, LEFT_MODE);
y_pos += font->Height;
x_pos = 0;
BSP_LCD_DisplayStringAt(x_pos, y_pos, part_two, LEFT_MODE);
}
} else {
BSP_LCD_DisplayStringAt(x_pos, y_pos, text, LEFT_MODE);
}
}
void lcd_draw_bmp(const void* pSrc, uint32_t xPos, uint32_t yPos, uint32_t xSize, uint32_t ySize, uint32_t ColorMode) {
void lcd_draw_bmp(const void* p_src, uint32_t x_pos, uint32_t y_pos, uint32_t x_size, uint32_t y_size, uint32_t color_mode) {
uint32_t address = hLtdcHandler.LayerCfg[1].FBStartAdress + (((BSP_LCD_GetXSize()*yPos) + xPos)*(4));
void *pDst = (void *)address;
uint32_t address = hLtdcHandler.LayerCfg[1].FBStartAdress + (((BSP_LCD_GetXSize()*y_pos) + x_pos)*(4));
void *p_dst = (void *)address;
hDma2dHandler2.Init.Mode = DMA2D_M2M_PFC;
hDma2dHandler2.Init.ColorMode = DMA2D_ARGB8888;
hDma2dHandler2.Init.OutputOffset = 480-xSize;
hDma2dHandler2.Init.OutputOffset = BSP_LCD_GetXSize()-x_size;
hDma2dHandler2.LayerCfg[1].AlphaMode = DMA2D_NO_MODIF_ALPHA;
hDma2dHandler2.LayerCfg[1].InputAlpha = 0xFF;
hDma2dHandler2.LayerCfg[1].InputColorMode = ColorMode;
hDma2dHandler2.LayerCfg[1].InputColorMode = color_mode;
hDma2dHandler2.LayerCfg[1].InputOffset = 0;
hDma2dHandler2.Instance = DMA2D;
if (HAL_DMA2D_Init(&hDma2dHandler2) == HAL_OK) {
if (HAL_DMA2D_ConfigLayer(&hDma2dHandler2, 1) == HAL_OK) {
if (HAL_DMA2D_Start(&hDma2dHandler2, (uint32_t)pSrc, (uint32_t)pDst, xSize, ySize) == HAL_OK) {
if (HAL_DMA2D_Start(&hDma2dHandler2, (uint32_t)p_src, (uint32_t)p_dst, x_size, y_size) == HAL_OK) {
HAL_DMA2D_PollForTransfer(&hDma2dHandler2, 10);
}
}

View File

@@ -25,8 +25,6 @@
#define LOGGER_LEVEL_ALL
#include "log.h"
//#include "test_img.h"
#include "stlogo.h"
#include "lcd_api.h"
/* USER CODE END Includes */
@@ -113,12 +111,8 @@ int main(void)
MX_LWIP_Init();
MX_QUADSPI_Init();
/* USER CODE BEGIN 2 */
//BSP_LCD_Init();
HAL_GPIO_WritePin(LCD_BL_CTRL_GPIO_Port,LCD_BL_CTRL_Pin,GPIO_PIN_SET);
/* Assert display enable LCD_DISP pin */
HAL_GPIO_WritePin(LCD_DISP_GPIO_Port, LCD_DISP_Pin, GPIO_PIN_SET);
lcd_init(true);
/* USER CODE END 2 */
init_lcd();
/* Infinite loop */
/* USER CODE BEGIN WHILE */
while (1)