]> git.sur5r.net Git - u-boot/blob - common/lcd_console.c
bfin: make env offset sector aligned for bct-brettl2 and ibf-dsp561 boards
[u-boot] / common / lcd_console.c
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 }