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_putc_xy(ushort x, ushort y, char c) 59 { 60 uchar *dest; 61 ushort row; 62 int fg_color, bg_color; 63 int i; 64 65 dest = (uchar *)(lcd_console_address + 66 y * lcd_line_length + x * NBITS(LCD_BPP) / 8); 67 68 for (row = 0; row < VIDEO_FONT_HEIGHT; ++row, dest += lcd_line_length) { 69 #if LCD_BPP == LCD_COLOR16 70 ushort *d = (ushort *)dest; 71 #elif LCD_BPP == LCD_COLOR32 72 u32 *d = (u32 *)dest; 73 #else 74 uchar *d = dest; 75 #endif 76 77 fg_color = lcd_getfgcolor(); 78 bg_color = lcd_getbgcolor(); 79 80 uchar bits; 81 bits = video_fontdata[c * VIDEO_FONT_HEIGHT + row]; 82 83 for (i = 0; i < 8; ++i) { 84 *d++ = (bits & 0x80) ? fg_color : bg_color; 85 bits <<= 1; 86 } 87 } 88 } 89 90 static void console_scrollup(void) 91 { 92 const int rows = CONFIG_CONSOLE_SCROLL_LINES; 93 int bg_color = lcd_getbgcolor(); 94 95 /* Copy up rows ignoring those that will be overwritten */ 96 memcpy(CONSOLE_ROW_FIRST, 97 lcd_console_address + CONSOLE_ROW_SIZE * rows, 98 CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows); 99 100 /* Clear the last rows */ 101 #if (LCD_BPP != LCD_COLOR32) 102 memset(lcd_console_address + CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows, 103 bg_color, CONSOLE_ROW_SIZE * rows); 104 #else 105 u32 *ppix = lcd_console_address + 106 CONSOLE_SIZE - CONSOLE_ROW_SIZE * rows; 107 u32 i; 108 for (i = 0; 109 i < (CONSOLE_ROW_SIZE * rows) / NBYTES(panel_info.vl_bpix); 110 i++) { 111 *ppix++ = bg_color; 112 } 113 #endif 114 lcd_sync(); 115 console_curr_row -= rows; 116 } 117 118 static inline void console_back(void) 119 { 120 if (--console_curr_col < 0) { 121 console_curr_col = console_cols - 1; 122 if (--console_curr_row < 0) 123 console_curr_row = 0; 124 } 125 126 lcd_putc_xy(console_curr_col * VIDEO_FONT_WIDTH, 127 console_curr_row * VIDEO_FONT_HEIGHT, ' '); 128 } 129 130 static inline void console_newline(void) 131 { 132 console_curr_col = 0; 133 134 /* Check if we need to scroll the terminal */ 135 if (++console_curr_row >= console_rows) 136 console_scrollup(); 137 else 138 lcd_sync(); 139 } 140 141 void lcd_putc(const char c) 142 { 143 if (!lcd_is_enabled) { 144 serial_putc(c); 145 146 return; 147 } 148 149 switch (c) { 150 case '\r': 151 console_curr_col = 0; 152 153 return; 154 case '\n': 155 console_newline(); 156 157 return; 158 case '\t': /* Tab (8 chars alignment) */ 159 console_curr_col += 8; 160 console_curr_col &= ~7; 161 162 if (console_curr_col >= console_cols) 163 console_newline(); 164 165 return; 166 case '\b': 167 console_back(); 168 169 return; 170 default: 171 lcd_putc_xy(console_curr_col * VIDEO_FONT_WIDTH, 172 console_curr_row * VIDEO_FONT_HEIGHT, c); 173 if (++console_curr_col >= console_cols) 174 console_newline(); 175 } 176 } 177 178 void lcd_puts(const char *s) 179 { 180 if (!lcd_is_enabled) { 181 serial_puts(s); 182 183 return; 184 } 185 186 while (*s) 187 lcd_putc(*s++); 188 189 lcd_sync(); 190 } 191 192 void lcd_printf(const char *fmt, ...) 193 { 194 va_list args; 195 char buf[CONFIG_SYS_PBSIZE]; 196 197 va_start(args, fmt); 198 vsprintf(buf, fmt, args); 199 va_end(args); 200 201 lcd_puts(buf); 202 } 203 204 static int do_lcd_setcursor(cmd_tbl_t *cmdtp, int flag, int argc, 205 char *const argv[]) 206 { 207 unsigned int col, row; 208 209 if (argc != 3) 210 return CMD_RET_USAGE; 211 212 col = simple_strtoul(argv[1], NULL, 10); 213 row = simple_strtoul(argv[2], NULL, 10); 214 lcd_position_cursor(col, row); 215 216 return 0; 217 } 218 219 static int do_lcd_puts(cmd_tbl_t *cmdtp, int flag, int argc, 220 char *const argv[]) 221 { 222 if (argc != 2) 223 return CMD_RET_USAGE; 224 225 lcd_puts(argv[1]); 226 227 return 0; 228 } 229 230 U_BOOT_CMD( 231 setcurs, 3, 1, do_lcd_setcursor, 232 "set cursor position within screen", 233 " <col> <row> in character" 234 ); 235 236 U_BOOT_CMD( 237 lcdputs, 2, 1, do_lcd_puts, 238 "print string on lcd-framebuffer", 239 " <string>" 240 ); 241 242