[U-Boot] [PATCH 4/4] common/lcd_console: introduce display/framebuffer rotation
Hannes Petermaier
oe5hpm at oevsv.at
Wed Mar 11 13:57:25 CET 2015
From: Hannes Petermaier <hannes.petermaier at br-automation.com>
Sometimes, for example if the display is mounted in portrait mode or even if it
mounted landscape but rotated by 180 degrees, we need to rotate our content of
the display respectively the framebuffer, so that user can read the messages
who are printed out.
For this we introduce the feature called "CONFIG_LCD_ROTATION", this may be
defined in the board-configuration if needed. After this the lcd_console will
be initialized with a given rotation from "vl_rot" out of "vidinfo_t" which is
provided by the board specific code.
If CONFIG_LCD_ROTATION is not defined, the console will be initialized with
0 degrees rotation - the screen behaves like the days before.
Signed-off-by: Hannes Petermaier <hannes.petermaier at br-automation.com>
Signed-off-by: Hannes Petermaier <oe5hpm at oevsv.at>
---
README | 17 +++
common/lcd.c | 22 ++--
common/lcd_console.c | 333 ++++++++++++++++++++++++++++++++++++++++---------
include/lcd.h | 1 +
include/lcd_console.h | 9 +-
5 files changed, 309 insertions(+), 73 deletions(-)
diff --git a/README b/README
index 3c4a2e6..a95b1e8 100644
--- a/README
+++ b/README
@@ -1933,6 +1933,23 @@ CBFS (Coreboot Filesystem) support
the console jump but can help speed up operation when scrolling
is slow.
+ CONFIG_LCD_ROTATION
+
+ Sometimes, for example if the display is mounted in portrait
+ mode or even if it mounted landscape but rotated by 180degree,
+ we need to rotate our content of the display respectively the
+ framebuffer, so that user can read the messages who are printed
+ out.
+ For this we introduce the feature called "CONFIG_LCD_ROTATION",
+ this may be defined in the board-configuration if needed. After
+ this the lcd_console will be initialized with a given rotation
+ from "vl_rot" out of "vidinfo_t" which is provided by the board
+ specific code.
+
+ If CONFIG_LCD_ROTATION is not defined, the console will be
+ initialized with 0degree rotation - the screen behaves like the
+ days before.
+
CONFIG_LCD_BMP_RLE8
Support drawing of RLE8-compressed bitmaps on the LCD.
diff --git a/common/lcd.c b/common/lcd.c
index f33942c..dfa4c69 100644
--- a/common/lcd.c
+++ b/common/lcd.c
@@ -167,7 +167,6 @@ int drv_lcd_init(void)
void lcd_clear(void)
{
- short console_rows, console_cols;
int bg_color;
char *s;
ulong addr;
@@ -211,16 +210,21 @@ void lcd_clear(void)
}
#endif
#endif
- /* Paint the logo and retrieve LCD base address */
- debug("[LCD] Drawing the logo...\n");
-#if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
- console_rows = (panel_info.vl_row - BMP_LOGO_HEIGHT);
- console_rows /= VIDEO_FONT_HEIGHT;
+ /* setup text-console */
+ debug("[LCD] setting up console...\n");
+#ifdef CONFIG_LCD_ROTATION
+ lcd_init_console(lcd_base,
+ panel_info.vl_col,
+ panel_info.vl_row,
+ panel_info.vl_rot);
#else
- console_rows = panel_info.vl_row / VIDEO_FONT_HEIGHT;
+ lcd_init_console(lcd_base,
+ panel_info.vl_col,
+ panel_info.vl_row,
+ 0);
#endif
- console_cols = panel_info.vl_col / VIDEO_FONT_WIDTH;
- lcd_init_console(lcd_base, console_rows, console_cols);
+ /* Paint the logo and retrieve LCD base address */
+ debug("[LCD] Drawing the logo...\n");
if (do_splash) {
s = getenv("splashimage");
if (s) {
diff --git a/common/lcd_console.c b/common/lcd_console.c
index cac77be..6199c9a 100644
--- a/common/lcd_console.c
+++ b/common/lcd_console.c
@@ -2,6 +2,7 @@
* (C) Copyright 2001-2014
* DENX Software Engineering -- wd at denx.de
* Compulab Ltd - http://compulab.co.il/
+ * Bernecker & Rainer Industrieelektronik GmbH - http://www.br-automation.com
*
* SPDX-License-Identifier: GPL-2.0+
*/
@@ -10,26 +11,27 @@
#include <lcd.h>
#include <video_font.h> /* Get font data, width and height */
-#define CONSOLE_ROW_SIZE (VIDEO_FONT_HEIGHT * lcd_line_length)
-#define CONSOLE_ROW_FIRST cons.lcd_address
-#define CONSOLE_SIZE (CONSOLE_ROW_SIZE * cons.rows)
+#define PIXLBYTES (NBYTES(LCD_BPP))
+
+#if LCD_BPP == LCD_COLOR16
+ #define fbptr_t ushort
+#elif LCD_BPP == LCD_COLOR32
+ #define fbptr_t u32
+#else
+ #define fbptr_t uchar
+#endif
struct console_t {
short curr_col, curr_row;
short cols, rows;
void *lcd_address;
+ u32 lcdsizex, lcdsizey;
+ void (*fp_putc_xy)(ushort x, ushort y, char c);
+ void (*fp_console_moverow)(u32 rowdst, u32 rowsrc);
+ void (*fp_console_setrow)(u32 row, int clr);
};
static struct console_t cons;
-void lcd_init_console(void *address, int rows, int cols)
-{
- memset(&cons, 0, sizeof(cons));
- cons.cols = cols;
- cons.rows = rows;
- cons.lcd_address = address;
-
-}
-
void lcd_set_col(short col)
{
cons.curr_col = col;
@@ -56,63 +58,221 @@ int lcd_get_screen_columns(void)
return cons.cols;
}
-static void lcd_putc_xy(ushort x, ushort y, char c)
+static void lcd_putc_xy0(ushort x, ushort y, char c)
{
- uchar *dest;
- ushort row;
int fg_color = lcd_getfgcolor();
int bg_color = lcd_getbgcolor();
+ int i, row;
+ uchar *dest = (uchar *)(cons.lcd_address +
+ y * cons.lcdsizex * PIXLBYTES +
+ x * PIXLBYTES);
+
+ for (row = 0; row < VIDEO_FONT_HEIGHT; row++) {
+ fbptr_t *d = (fbptr_t *)dest;
+ uchar bits;
+ bits = video_fontdata[c * VIDEO_FONT_HEIGHT + row];
+ for (i = 0; i < 8; ++i) {
+ *d++ = (bits & 0x80) ? fg_color : bg_color;
+ bits <<= 1;
+ }
+ dest += cons.lcdsizex * PIXLBYTES;
+ }
+}
+
+static inline void console_setrow0(u32 row, int clr)
+{
int i;
+ uchar *dst = (uchar *)(cons.lcd_address +
+ row * VIDEO_FONT_HEIGHT *
+ cons.lcdsizex * PIXLBYTES);
- dest = (uchar *)(cons.lcd_address +
- y * lcd_line_length + x * NBITS(LCD_BPP) / 8);
+ fbptr_t *d = (fbptr_t *)dst;
+ for (i = 0; i < (VIDEO_FONT_HEIGHT * cons.lcdsizex); i++)
+ *d++ = clr;
+}
- for (row = 0; row < VIDEO_FONT_HEIGHT; ++row, dest += lcd_line_length) {
-#if LCD_BPP == LCD_COLOR16
- ushort *d = (ushort *)dest;
-#elif LCD_BPP == LCD_COLOR32
- u32 *d = (u32 *)dest;
-#else
- uchar *d = dest;
-#endif
+static inline void console_moverow0(u32 rowdst, u32 rowsrc)
+{
+ int i;
+ uchar *dst = (uchar *)(cons.lcd_address +
+ rowdst * VIDEO_FONT_HEIGHT *
+ cons.lcdsizex * PIXLBYTES);
+
+ uchar *src = (uchar *)(cons.lcd_address +
+ rowsrc * VIDEO_FONT_HEIGHT *
+ cons.lcdsizex * PIXLBYTES);
+
+ fbptr_t *pdst = (fbptr_t *)dst;
+ fbptr_t *psrc = (fbptr_t *)src;
+ for (i = 0; i < (VIDEO_FONT_HEIGHT * cons.lcdsizex); i++)
+ *pdst++ = *psrc++;
+}
+#ifdef CONFIG_LCD_ROTATION
+static void lcd_putc_xy90(ushort x, ushort y, char c)
+{
+ int fg_color = lcd_getfgcolor();
+ int bg_color = lcd_getbgcolor();
+ int i, col;
+ uchar *dest = (uchar *)(cons.lcd_address +
+ cons.lcdsizey * cons.lcdsizex * PIXLBYTES -
+ (x+1) * cons.lcdsizex * PIXLBYTES +
+ y * PIXLBYTES);
+
+ fbptr_t *d = (fbptr_t *)dest;
+ uchar msk = 0x80;
+ uchar *pfont = video_fontdata + c * VIDEO_FONT_HEIGHT;
+ for (col = 0; col < VIDEO_FONT_WIDTH; ++col) {
+ for (i = 0; i < VIDEO_FONT_HEIGHT; ++i)
+ *d++ = (*(pfont + i) & msk) ? fg_color : bg_color;
+ msk >>= 1;
+ d -= (cons.lcdsizex + VIDEO_FONT_HEIGHT);
+ }
+}
+
+static inline void console_setrow90(u32 row, int clr)
+{
+ int i, j;
+ uchar *dst = (uchar *)(cons.lcd_address +
+ row*VIDEO_FONT_HEIGHT * PIXLBYTES);
+
+ for (j = 0; j < cons.lcdsizey; j++) {
+ fbptr_t *pdst = (fbptr_t *)dst;
+ for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
+ *pdst++ = clr;
+ dst += cons.lcdsizex * PIXLBYTES;
+ }
+}
+
+static inline void console_moverow90(u32 rowdst, u32 rowsrc)
+{
+ int i, j;
+ uchar *dst = (uchar *)(cons.lcd_address +
+ rowdst*VIDEO_FONT_HEIGHT * PIXLBYTES);
+
+ uchar *src = (uchar *)(cons.lcd_address +
+ rowsrc*VIDEO_FONT_HEIGHT * PIXLBYTES);
+
+ for (j = 0; j < cons.lcdsizey; j++) {
+ fbptr_t *psrc = (fbptr_t *)src;
+ fbptr_t *pdst = (fbptr_t *)dst;
+ for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
+ *pdst++ = *psrc++;
+ src += cons.lcdsizex * PIXLBYTES;
+ dst += cons.lcdsizex * PIXLBYTES;
+ }
+}
+
+static void lcd_putc_xy180(ushort x, ushort y, char c)
+{
+ int fg_color = lcd_getfgcolor();
+ int bg_color = lcd_getbgcolor();
+ int i, row;
+ uchar *dest = (uchar *)(cons.lcd_address +
+ cons.lcdsizex * PIXLBYTES +
+ cons.lcdsizey * cons.lcdsizex * PIXLBYTES -
+ y * cons.lcdsizex * PIXLBYTES -
+ (x+1) * PIXLBYTES);
+
+ for (row = 0; row < VIDEO_FONT_HEIGHT; row++) {
+ fbptr_t *d = (fbptr_t *)dest;
uchar bits;
bits = video_fontdata[c * VIDEO_FONT_HEIGHT + row];
for (i = 0; i < 8; ++i) {
- *d++ = (bits & 0x80) ? fg_color : bg_color;
+ *d-- = (bits & 0x80) ? fg_color : bg_color;
bits <<= 1;
}
+ dest -= cons.lcdsizex * PIXLBYTES;
}
}
-static void console_scrollup(void)
+static void lcd_putc_xy270(ushort x, ushort y, char c)
{
- const int rows = CONFIG_CONSOLE_SCROLL_LINES;
+ int fg_color = lcd_getfgcolor();
int bg_color = lcd_getbgcolor();
+ int col, i;
+ uchar *dest = (uchar *)(cons.lcd_address +
+ ((x+1) * cons.lcdsizex) * PIXLBYTES -
+ y * PIXLBYTES);
+
+ fbptr_t *d = (fbptr_t *)dest;
+ uchar msk = 0x80;
+ uchar *pfont = video_fontdata + c * VIDEO_FONT_HEIGHT;
+ for (col = 0; col < VIDEO_FONT_WIDTH; ++col) {
+ for (i = 0; i < VIDEO_FONT_HEIGHT; ++i)
+ *d-- = (*(pfont + i) & msk) ? fg_color : bg_color;
+ msk >>= 1;
+ d += (cons.lcdsizex + VIDEO_FONT_HEIGHT);
+ }
+}
- /* Copy up rows ignoring those that will be overwritten */
- memcpy(CONSOLE_ROW_FIRST,
- cons.lcd_address + CONSOLE_ROW_SIZE * rows,
- CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows);
+static inline void console_setrow270(u32 row, int clr)
+{
+ int i, j;
+ uchar *dst = (uchar *)(cons.lcd_address +
+ cons.lcdsizex * PIXLBYTES -
+ (row*VIDEO_FONT_HEIGHT+1) * PIXLBYTES);
+
+ for (j = 0; j < cons.lcdsizey; j++) {
+ fbptr_t *pdst = (fbptr_t *)dst;
+ for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
+ *pdst-- = clr;
+ dst += cons.lcdsizex * PIXLBYTES;
+ }
+}
- /* Clear the last rows */
-#if (LCD_BPP != LCD_COLOR32)
- memset(lcd_console_address + CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows,
- bg_color, CONSOLE_ROW_SIZE * rows);
-#else
- u32 *ppix = cons.lcd_address +
- CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows;
- u32 i;
- for (i = 0;
- i < (CONSOLE_ROW_SIZE * rows) / NBYTES(panel_info.vl_bpix);
- i++) {
- *ppix++ = bg_color;
+static inline void console_moverow270(u32 rowdst, u32 rowsrc)
+{
+ int i, j;
+ uchar *dst = (uchar *)(cons.lcd_address +
+ cons.lcdsizex * PIXLBYTES -
+ (rowdst*VIDEO_FONT_HEIGHT+1) * PIXLBYTES);
+
+ uchar *src = (uchar *)(cons.lcd_address +
+ cons.lcdsizex * PIXLBYTES -
+ (rowsrc*VIDEO_FONT_HEIGHT+1) * PIXLBYTES);
+
+ for (j = 0; j < cons.lcdsizey; j++) {
+ fbptr_t *psrc = (fbptr_t *)src;
+ fbptr_t *pdst = (fbptr_t *)dst;
+ for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
+ *pdst-- = *psrc--;
+ src += cons.lcdsizex * PIXLBYTES;
+ dst += cons.lcdsizex * PIXLBYTES;
}
-#endif
- lcd_sync();
- cons.curr_row -= rows;
}
+static inline void console_setrow180(u32 row, int clr)
+{
+ int i;
+ uchar *dst = (uchar *)(cons.lcd_address +
+ (cons.rows-row-1) * VIDEO_FONT_HEIGHT *
+ cons.lcdsizex * PIXLBYTES);
+
+ fbptr_t *d = (fbptr_t *)dst;
+ for (i = 0; i < (VIDEO_FONT_HEIGHT * cons.lcdsizex); i++)
+ *d++ = clr;
+}
+
+static inline void console_moverow180(u32 rowdst, u32 rowsrc)
+{
+ int i;
+ uchar *dst = (uchar *)(cons.lcd_address +
+ (cons.rows-rowdst-1) * VIDEO_FONT_HEIGHT *
+ cons.lcdsizex * PIXLBYTES);
+
+ uchar *src = (uchar *)(cons.lcd_address +
+ (cons.rows-rowsrc-1) * VIDEO_FONT_HEIGHT *
+ cons.lcdsizex * PIXLBYTES);
+
+ fbptr_t *pdst = (fbptr_t *)dst;
+ fbptr_t *psrc = (fbptr_t *)src;
+ for (i = 0; i < (VIDEO_FONT_HEIGHT * cons.lcdsizex); i++)
+ *pdst++ = *psrc++;
+}
+
+#endif /* CONFIG_LCD_ROTATION */
+
static inline void console_back(void)
{
if (--cons.curr_col < 0) {
@@ -121,26 +281,83 @@ static inline void console_back(void)
cons.curr_row = 0;
}
- lcd_putc_xy(cons.curr_col * VIDEO_FONT_WIDTH,
- cons.curr_row * VIDEO_FONT_HEIGHT, ' ');
+ cons.fp_putc_xy(cons.curr_col * VIDEO_FONT_WIDTH,
+ cons.curr_row * VIDEO_FONT_HEIGHT, ' ');
}
static inline void console_newline(void)
{
+ const int rows = CONFIG_CONSOLE_SCROLL_LINES;
+ int bg_color = lcd_getbgcolor();
+ int i;
+
cons.curr_col = 0;
/* Check if we need to scroll the terminal */
- if (++cons.curr_row >= cons.rows)
- console_scrollup();
- else
- lcd_sync();
+ if (++cons.curr_row >= cons.rows) {
+ for (i = 0; i < cons.rows-rows; i++)
+ cons.fp_console_moverow(i, i+rows);
+ for (i = 0; i < rows; i++)
+ cons.fp_console_setrow(cons.rows-i-1, bg_color);
+ cons.curr_row -= rows;
+ }
+ lcd_sync();
+}
+
+static void console_calc_rowcol(int vl_cols, int vl_rows, short *cl, short *rw)
+{
+ *cl = vl_cols / VIDEO_FONT_WIDTH;
+#if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
+ *rw = (vl_rows - BMP_LOGO_HEIGHT);
+ *rw /= VIDEO_FONT_HEIGHT;
+#else
+ *rw = vl_rows / VIDEO_FONT_HEIGHT;
+#endif
+}
+
+void lcd_init_console(void *address, int vl_cols, int vl_rows, int vl_rot)
+{
+ memset(&cons, 0, sizeof(cons));
+ cons.lcd_address = address;
+
+ cons.lcdsizex = vl_cols;
+ cons.lcdsizey = vl_rows;
+
+ if (vl_rot == 0) {
+ cons.fp_putc_xy = &lcd_putc_xy0;
+ cons.fp_console_moverow = &console_moverow0;
+ cons.fp_console_setrow = &console_setrow0;
+ console_calc_rowcol(vl_cols, vl_rows, &cons.cols, &cons.rows);
+#ifdef CONFIG_LCD_ROTATION
+ } else if (vl_rot == 90) {
+ cons.fp_putc_xy = &lcd_putc_xy90;
+ cons.fp_console_moverow = &console_moverow90;
+ cons.fp_console_setrow = &console_setrow90;
+ console_calc_rowcol(vl_rows, vl_cols, &cons.cols, &cons.rows);
+ } else if (vl_rot == 180) {
+ cons.fp_putc_xy = &lcd_putc_xy180;
+ cons.fp_console_moverow = &console_moverow180;
+ cons.fp_console_setrow = &console_setrow180;
+ console_calc_rowcol(vl_cols, vl_rows, &cons.cols, &cons.rows);
+ } else if (vl_rot == 270) {
+ cons.fp_putc_xy = &lcd_putc_xy270;
+ cons.fp_console_moverow = &console_moverow270;
+ cons.fp_console_setrow = &console_setrow270;
+ console_calc_rowcol(vl_rows, vl_cols, &cons.cols, &cons.rows);
+#endif
+ } else {
+ puts("lcd_init_console: invalid framebuffer rotation!\n");
+ }
+
+ debug("lcd_console: have %d/%d col/rws on scr %dx%d (%d deg rotated)\n",
+ cons.cols, cons.rows, cons.lcdsizex, cons.lcdsizey, vl_rot);
+
}
void lcd_putc(const char c)
{
if (!lcd_is_enabled) {
serial_putc(c);
-
return;
}
@@ -150,7 +367,6 @@ void lcd_putc(const char c)
return;
case '\n':
console_newline();
-
return;
case '\t': /* Tab (8 chars alignment) */
cons.curr_col += 8;
@@ -158,15 +374,13 @@ void lcd_putc(const char c)
if (cons.curr_col >= cons.cols)
console_newline();
-
return;
case '\b':
console_back();
-
return;
default:
- lcd_putc_xy(cons.curr_col * VIDEO_FONT_WIDTH,
- cons.curr_row * VIDEO_FONT_HEIGHT, c);
+ cons.fp_putc_xy(cons.curr_col * VIDEO_FONT_WIDTH,
+ cons.curr_row * VIDEO_FONT_HEIGHT, c);
if (++cons.curr_col >= cons.cols)
console_newline();
}
@@ -176,7 +390,6 @@ void lcd_puts(const char *s)
{
if (!lcd_is_enabled) {
serial_puts(s);
-
return;
}
diff --git a/include/lcd.h b/include/lcd.h
index f049fd3..41e0c11 100644
--- a/include/lcd.h
+++ b/include/lcd.h
@@ -51,6 +51,7 @@ void lcd_set_flush_dcache(int flush);
typedef struct vidinfo {
ushort vl_col; /* Number of columns (i.e. 160) */
ushort vl_row; /* Number of rows (i.e. 100) */
+ ushort vl_rot; /* Rotation of Display (i.e. 90) */
u_char vl_bpix; /* Bits per pixel, 0 = 1 */
ushort *cmap; /* Pointer to the colormap */
void *priv; /* Pointer to driver-specific data */
diff --git a/include/lcd_console.h b/include/lcd_console.h
index 429214d..2244b3f 100644
--- a/include/lcd_console.h
+++ b/include/lcd_console.h
@@ -16,11 +16,12 @@
* console has.
*
* @address: Console base address
- * @rows: Number of rows in the console
- * @cols: Number of columns in the console
+ * @vl_rows: Number of rows in the console
+ * @vl_cols: Number of columns in the console
+ * @vl_rot: Rotation of display in degree (0 - 90 - 180 - 270) counterlockwise
*/
-void lcd_init_console(void *address, int rows, int cols);
-
+/*void lcd_init_console(void *address, int rows, int cols); */
+void lcd_init_console(void *address, int vl_cols, int vl_rows, int vl_rot);
/**
* lcd_set_col() - Set the number of the current lcd console column
*
--
1.7.9.5
More information about the U-Boot
mailing list