]> git.sur5r.net Git - u-boot/blob - common/lcd_console_rotation.c
tools: moveconfig: do not check clean tree and compilers for -H option
[u-boot] / common / lcd_console_rotation.c
1 /*
2  * (C) Copyright 2015
3  * Bernecker & Rainer Industrieelektronik GmbH - http://www.br-automation.com
4  *
5  * SPDX-License-Identifier:     GPL-2.0+
6  */
7
8 #include <common.h>
9 #include <lcd.h>
10 #include <video_font.h>         /* Get font data, width and height */
11
12 static void lcd_putc_xy90(struct console_t *pcons, ushort x, ushort y, char c)
13 {
14         int fg_color = lcd_getfgcolor();
15         int bg_color = lcd_getbgcolor();
16         int col, i;
17
18         fbptr_t *dst = (fbptr_t *)pcons->fbbase +
19                                   (x+1) * pcons->lcdsizex -
20                                   y;
21
22         uchar msk = 0x80;
23         uchar *pfont = video_fontdata + c * VIDEO_FONT_HEIGHT;
24         for (col = 0; col < VIDEO_FONT_WIDTH; ++col) {
25                 for (i = 0; i < VIDEO_FONT_HEIGHT; ++i)
26                         *dst-- = (*(pfont + i) & msk) ? fg_color : bg_color;
27                 msk >>= 1;
28                 dst += (pcons->lcdsizex + VIDEO_FONT_HEIGHT);
29         }
30 }
31
32 static inline void console_setrow90(struct console_t *pcons, u32 row, int clr)
33 {
34         int i, j;
35         fbptr_t *dst = (fbptr_t *)pcons->fbbase +
36                                   pcons->lcdsizex -
37                                   row*VIDEO_FONT_HEIGHT+1;
38
39         for (j = 0; j < pcons->lcdsizey; j++) {
40                 for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
41                         *dst-- = clr;
42                 dst += (pcons->lcdsizex + VIDEO_FONT_HEIGHT);
43         }
44 }
45
46 static inline void console_moverow90(struct console_t *pcons,
47                                       u32 rowdst, u32 rowsrc)
48 {
49         int i, j;
50         fbptr_t *dst = (fbptr_t *)pcons->fbbase +
51                                   pcons->lcdsizex -
52                                   (rowdst*VIDEO_FONT_HEIGHT+1);
53
54         fbptr_t *src = (fbptr_t *)pcons->fbbase +
55                                   pcons->lcdsizex -
56                                   (rowsrc*VIDEO_FONT_HEIGHT+1);
57
58         for (j = 0; j < pcons->lcdsizey; j++) {
59                 for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
60                         *dst-- = *src--;
61                 src += (pcons->lcdsizex + VIDEO_FONT_HEIGHT);
62                 dst += (pcons->lcdsizex + VIDEO_FONT_HEIGHT);
63         }
64 }
65 static void lcd_putc_xy180(struct console_t *pcons, ushort x, ushort y, char c)
66 {
67         int fg_color = lcd_getfgcolor();
68         int bg_color = lcd_getbgcolor();
69         int i, row;
70         fbptr_t *dst = (fbptr_t *)pcons->fbbase +
71                                   pcons->lcdsizex +
72                                   pcons->lcdsizey * pcons->lcdsizex -
73                                   y * pcons->lcdsizex -
74                                   (x+1);
75
76         for (row = 0; row < VIDEO_FONT_HEIGHT; row++) {
77                 uchar bits = video_fontdata[c * VIDEO_FONT_HEIGHT + row];
78
79                 for (i = 0; i < VIDEO_FONT_WIDTH; ++i) {
80                         *dst-- = (bits & 0x80) ? fg_color : bg_color;
81                         bits <<= 1;
82                 }
83                 dst -= (pcons->lcdsizex - VIDEO_FONT_WIDTH);
84         }
85 }
86
87 static inline void console_setrow180(struct console_t *pcons, u32 row, int clr)
88 {
89         int i;
90         fbptr_t *dst = (fbptr_t *)pcons->fbbase +
91                                   (pcons->rows-row-1) * VIDEO_FONT_HEIGHT *
92                                   pcons->lcdsizex;
93
94         for (i = 0; i < (VIDEO_FONT_HEIGHT * pcons->lcdsizex); i++)
95                 *dst++ = clr;
96 }
97
98 static inline void console_moverow180(struct console_t *pcons,
99                                       u32 rowdst, u32 rowsrc)
100 {
101         int i;
102         fbptr_t *dst = (fbptr_t *)pcons->fbbase +
103                                   (pcons->rows-rowdst-1) * VIDEO_FONT_HEIGHT *
104                                   pcons->lcdsizex;
105
106         fbptr_t *src = (fbptr_t *)pcons->fbbase +
107                                   (pcons->rows-rowsrc-1) * VIDEO_FONT_HEIGHT *
108                                   pcons->lcdsizex;
109
110         for (i = 0; i < (VIDEO_FONT_HEIGHT * pcons->lcdsizex); i++)
111                 *dst++ = *src++;
112 }
113
114 static void lcd_putc_xy270(struct console_t *pcons, ushort x, ushort y, char c)
115 {
116         int fg_color = lcd_getfgcolor();
117         int bg_color = lcd_getbgcolor();
118         int i, col;
119         fbptr_t *dst = (fbptr_t *)pcons->fbbase +
120                                   pcons->lcdsizey * pcons->lcdsizex -
121                                   (x+1) * pcons->lcdsizex +
122                                   y;
123
124         uchar msk = 0x80;
125         uchar *pfont = video_fontdata + c * VIDEO_FONT_HEIGHT;
126         for (col = 0; col < VIDEO_FONT_WIDTH; ++col) {
127                 for (i = 0; i < VIDEO_FONT_HEIGHT; ++i)
128                         *dst++ = (*(pfont + i) & msk) ? fg_color : bg_color;
129                 msk >>= 1;
130                 dst -= (pcons->lcdsizex + VIDEO_FONT_HEIGHT);
131         }
132 }
133
134 static inline void console_setrow270(struct console_t *pcons, u32 row, int clr)
135 {
136         int i, j;
137         fbptr_t *dst = (fbptr_t *)pcons->fbbase +
138                                   row*VIDEO_FONT_HEIGHT;
139
140         for (j = 0; j < pcons->lcdsizey; j++) {
141                 for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
142                         *dst++ = clr;
143                 dst += (pcons->lcdsizex - VIDEO_FONT_HEIGHT);
144         }
145 }
146
147 static inline void console_moverow270(struct console_t *pcons,
148                                      u32 rowdst, u32 rowsrc)
149 {
150         int i, j;
151         fbptr_t *dst = (fbptr_t *)pcons->fbbase +
152                                   rowdst*VIDEO_FONT_HEIGHT;
153
154         fbptr_t *src = (fbptr_t *)pcons->fbbase +
155                                   rowsrc*VIDEO_FONT_HEIGHT;
156
157         for (j = 0; j < pcons->lcdsizey; j++) {
158                 for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
159                         *dst++ = *src++;
160                 src += (pcons->lcdsizex - VIDEO_FONT_HEIGHT);
161                 dst += (pcons->lcdsizex - VIDEO_FONT_HEIGHT);
162         }
163 }
164
165 static void console_calc_rowcol_rot(struct console_t *pcons)
166 {
167         if (pcons->lcdrot == 1 || pcons->lcdrot == 3)
168                 console_calc_rowcol(pcons, pcons->lcdsizey, pcons->lcdsizex);
169         else
170                 console_calc_rowcol(pcons, pcons->lcdsizex, pcons->lcdsizey);
171 }
172
173 void lcd_init_console_rot(struct console_t *pcons)
174 {
175         if (pcons->lcdrot == 0) {
176                 return;
177         } else if (pcons->lcdrot == 1) {
178                 pcons->fp_putc_xy = &lcd_putc_xy90;
179                 pcons->fp_console_moverow = &console_moverow90;
180                 pcons->fp_console_setrow = &console_setrow90;
181         } else if (pcons->lcdrot == 2) {
182                 pcons->fp_putc_xy = &lcd_putc_xy180;
183                 pcons->fp_console_moverow = &console_moverow180;
184                 pcons->fp_console_setrow = &console_setrow180;
185         } else if (pcons->lcdrot == 3) {
186                 pcons->fp_putc_xy = &lcd_putc_xy270;
187                 pcons->fp_console_moverow = &console_moverow270;
188                 pcons->fp_console_setrow = &console_setrow270;
189         } else {
190                 printf("%s: invalid framebuffer rotation (%d)!\n",
191                        __func__, pcons->lcdrot);
192                 return;
193         }
194         console_calc_rowcol_rot(pcons);
195 }