1
2
3
4
5
6
7
8#include <common.h>
9#include <lcd.h>
10#include <video_font.h>
11
12static 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
32static 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
46static 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}
65static 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
87static 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
98static 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
114static 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
134static 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
147static 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
165static 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
173void 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}
196
