1 /* 2 * (C) Copyright 2001-2014 3 * DENX Software Engineering -- wd@denx.de 4 * Compulab Ltd - http://compulab.co.il/ 5 * 6 * SPDX-License-Identifier: GPL-2.0+ 7 */ 8 9 #include <common.h> 10 #include <lcd.h> 11 #include <video_font.h> /* Get font data, width and height */ 12 13 #define CONSOLE_ROW_SIZE (VIDEO_FONT_HEIGHT * lcd_line_length) 14 #define CONSOLE_ROW_FIRST lcd_console_address 15 #define CONSOLE_SIZE (CONSOLE_ROW_SIZE * console_rows) 16 17 static short console_curr_col; 18 static short console_curr_row; 19 static short console_cols; 20 static short console_rows; 21 static void *lcd_console_address; 22 23 void lcd_init_console(void *address, int rows, int cols) 24 { 25 console_curr_col = 0; 26 console_curr_row = 0; 27 console_cols = cols; 28 console_rows = rows; 29 lcd_console_address = address; 30 } 31 32 void lcd_set_col(short col) 33 { 34 console_curr_col = col; 35 } 36 37 void lcd_set_row(short row) 38 { 39 console_curr_row = row; 40 } 41 42 void lcd_position_cursor(unsigned col, unsigned row) 43 { 44 console_curr_col = min_t(short, col, console_cols - 1); 45 console_curr_row = min_t(short, row, console_rows - 1); 46 } 47 48 int lcd_get_screen_rows(void) 49 { 50 return console_rows; 51 } 52 53 int lcd_get_screen_columns(void) 54 { 55 return console_cols; 56 } 57 58 static void lcd_drawchars(ushort x, ushort y, uchar *str, int count) 59 { 60 uchar *dest; 61 ushort row; 62 int fg_color, bg_color; 63 64 dest = (uchar *)(lcd_console_address + 65 y * lcd_line_length + x * NBITS(LCD_BPP) / 8); 66 67 for (row = 0; row < VIDEO_FONT_HEIGHT; ++row, dest += lcd_line_length) { 68 uchar *s = str; 69 int i; 70 #if LCD_BPP == LCD_COLOR16 71 ushort *d = (ushort *)dest; 72 #elif LCD_BPP == LCD_COLOR32 73 u32 *d = (u32 *)dest; 74 #else 75 uchar *d = dest; 76 #endif 77 78 fg_color = lcd_getfgcolor(); 79 bg_color = lcd_getbgcolor(); 80 for (i = 0; i < count; ++i) { 81 uchar c, bits; 82 83 c = *s++; 84 bits = video_fontdata[c * VIDEO_FONT_HEIGHT + row]; 85 86 for (c = 0; c < 8; ++c) { 87 *d++ = (bits & 0x80) ? fg_color : bg_color; 88 bits <<= 1; 89 } 90 } 91 } 92 } 93 94 static inline void lcd_putc_xy(ushort x, ushort y, uchar c) 95 { 96 lcd_drawchars(x, y, &c, 1); 97 } 98 99 static void console_scrollup(void) 100 { 101 const int rows = CONFIG_CONSOLE_SCROLL_LINES; 102 int bg_color = lcd_getbgcolor(); 103 104 /* Copy up rows ignoring those that will be overwritten */ 105 memcpy(CONSOLE_ROW_FIRST, 106 lcd_console_address + CONSOLE_ROW_SIZE * rows, 107 CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows); 108 109 /* Clear the last rows */ 110 #if (LCD_BPP != LCD_COLOR32) 111 memset(lcd_console_address + CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows, 112 bg_color, CONSOLE_ROW_SIZE * rows); 113 #else 114 u32 *ppix = lcd_console_address + 115 CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows; 116 u32 i; 117 for (i = 0; 118 i < (CONSOLE_ROW_SIZE * rows) / NBYTES(panel_info.vl_bpix); 119 i++) { 120 *ppix++ = bg_color; 121 } 122 #endif 123 lcd_sync(); 124 console_curr_row -= rows; 125 } 126 127 static inline void console_back(void) 128 { 129 if (--console_curr_col < 0) { 130 console_curr_col = console_cols - 1; 131 if (--console_curr_row < 0) 132 console_curr_row = 0; 133 } 134 135 lcd_putc_xy(console_curr_col * VIDEO_FONT_WIDTH, 136 console_curr_row * VIDEO_FONT_HEIGHT, ' '); 137 } 138 139 static inline void console_newline(void) 140 { 141 console_curr_col = 0; 142 143 /* Check if we need to scroll the terminal */ 144 if (++console_curr_row >= console_rows) 145 console_scrollup(); 146 else 147 lcd_sync(); 148 } 149 150 void lcd_putc(const char c) 151 { 152 if (!lcd_is_enabled) { 153 serial_putc(c); 154 155 return; 156 } 157 158 switch (c) { 159 case '\r': 160 console_curr_col = 0; 161 162 return; 163 case '\n': 164 console_newline(); 165 166 return; 167 case '\t': /* Tab (8 chars alignment) */ 168 console_curr_col += 8; 169 console_curr_col &= ~7; 170 171 if (console_curr_col >= console_cols) 172 console_newline(); 173 174 return; 175 case '\b': 176 console_back(); 177 178 return; 179 default: 180 lcd_putc_xy(console_curr_col * VIDEO_FONT_WIDTH, 181 console_curr_row * VIDEO_FONT_HEIGHT, c); 182 if (++console_curr_col >= console_cols) 183 console_newline(); 184 } 185 } 186 187 void lcd_puts(const char *s) 188 { 189 if (!lcd_is_enabled) { 190 serial_puts(s); 191 192 return; 193 } 194 195 while (*s) 196 lcd_putc(*s++); 197 198 lcd_sync(); 199 } 200 201 void lcd_printf(const char *fmt, ...) 202 { 203 va_list args; 204 char buf[CONFIG_SYS_PBSIZE]; 205 206 va_start(args, fmt); 207 vsprintf(buf, fmt, args); 208 va_end(args); 209 210 lcd_puts(buf); 211 } 212