1 /*
2 * linux/drivers/video/cfb8.c -- Low level frame buffer operations for 8 bpp
3 * packed pixels
4 *
5 * Created 5 Apr 1997 by Geert Uytterhoeven
6 *
7 * This file is subject to the terms and conditions of the GNU General Public
8 * License. See the file COPYING in the main directory of this archive for
9 * more details.
10 */
11
12 #include <linux/module.h>
13 #include <linux/tty.h>
14 #include <linux/console.h>
15 #include <linux/string.h>
16 #include <linux/fb.h>
17
18 #include <video/fbcon.h>
19 #include <video/fbcon-cfb8.h>
20
21
22 /*
23 * 8 bpp packed pixels
24 */
25
26 static u32 nibbletab_cfb8[] = {
27 #if defined(__BIG_ENDIAN)
28 0x00000000,0x000000ff,0x0000ff00,0x0000ffff,
29 0x00ff0000,0x00ff00ff,0x00ffff00,0x00ffffff,
30 0xff000000,0xff0000ff,0xff00ff00,0xff00ffff,
31 0xffff0000,0xffff00ff,0xffffff00,0xffffffff
32 #elif defined(__LITTLE_ENDIAN)
33 0x00000000,0xff000000,0x00ff0000,0xffff0000,
34 0x0000ff00,0xff00ff00,0x00ffff00,0xffffff00,
35 0x000000ff,0xff0000ff,0x00ff00ff,0xffff00ff,
36 0x0000ffff,0xff00ffff,0x00ffffff,0xffffffff
37 #else
38 #error FIXME: No endianness??
39 #endif
40 };
41
fbcon_cfb8_setup(struct display * p)42 void fbcon_cfb8_setup(struct display *p)
43 {
44 p->next_line = p->line_length ? p->line_length : p->var.xres_virtual;
45 p->next_plane = 0;
46 }
47
fbcon_cfb8_bmove(struct display * p,int sy,int sx,int dy,int dx,int height,int width)48 void fbcon_cfb8_bmove(struct display *p, int sy, int sx, int dy, int dx,
49 int height, int width)
50 {
51 int bytes = p->next_line, linesize = bytes * fontheight(p), rows;
52 u8 *src,*dst;
53
54 if (sx == 0 && dx == 0 && width * fontwidth(p) == bytes) {
55 fb_memmove(p->screen_base + dy * linesize,
56 p->screen_base + sy * linesize,
57 height * linesize);
58 return;
59 }
60 if (fontwidthlog(p)) {
61 sx <<= fontwidthlog(p); dx <<= fontwidthlog(p); width <<= fontwidthlog(p);
62 } else {
63 sx *= fontwidth(p); dx *= fontwidth(p); width *= fontwidth(p);
64 }
65 if (dy < sy || (dy == sy && dx < sx)) {
66 src = p->screen_base + sy * linesize + sx;
67 dst = p->screen_base + dy * linesize + dx;
68 for (rows = height * fontheight(p) ; rows-- ;) {
69 fb_memmove(dst, src, width);
70 src += bytes;
71 dst += bytes;
72 }
73 } else {
74 src = p->screen_base + (sy+height) * linesize + sx - bytes;
75 dst = p->screen_base + (dy+height) * linesize + dx - bytes;
76 for (rows = height * fontheight(p) ; rows-- ;) {
77 fb_memmove(dst, src, width);
78 src -= bytes;
79 dst -= bytes;
80 }
81 }
82 }
83
rectfill(u8 * dest,int width,int height,u8 data,int linesize)84 static inline void rectfill(u8 *dest, int width, int height, u8 data,
85 int linesize)
86 {
87 while (height-- > 0) {
88 fb_memset(dest, data, width);
89 dest += linesize;
90 }
91 }
92
fbcon_cfb8_clear(struct vc_data * conp,struct display * p,int sy,int sx,int height,int width)93 void fbcon_cfb8_clear(struct vc_data *conp, struct display *p, int sy, int sx,
94 int height, int width)
95 {
96 u8 *dest;
97 int bytes=p->next_line,lines=height * fontheight(p);
98 u8 bgx;
99
100 dest = p->screen_base + sy * fontheight(p) * bytes + sx * fontwidth(p);
101
102 bgx=attr_bgcol_ec(p,conp);
103
104 width *= fontwidth(p);
105 if (width == bytes)
106 rectfill(dest, lines * width, 1, bgx, bytes);
107 else
108 rectfill(dest, width, lines, bgx, bytes);
109 }
110
fbcon_cfb8_putc(struct vc_data * conp,struct display * p,int c,int yy,int xx)111 void fbcon_cfb8_putc(struct vc_data *conp, struct display *p, int c, int yy,
112 int xx)
113 {
114 u8 *dest,*cdat;
115 int bytes=p->next_line,rows;
116 u32 eorx,fgx,bgx;
117
118 dest = p->screen_base + yy * fontheight(p) * bytes + xx * fontwidth(p);
119 if (fontwidth(p) <= 8)
120 cdat = p->fontdata + (c & p->charmask) * fontheight(p);
121 else
122 cdat = p->fontdata + ((c & p->charmask) * fontheight(p) << 1);
123
124 fgx=attr_fgcol(p,c);
125 bgx=attr_bgcol(p,c);
126 fgx |= (fgx << 8);
127 fgx |= (fgx << 16);
128 bgx |= (bgx << 8);
129 bgx |= (bgx << 16);
130 eorx = fgx ^ bgx;
131
132 switch (fontwidth(p)) {
133 case 4:
134 for (rows = fontheight(p) ; rows-- ; dest += bytes)
135 fb_writel((nibbletab_cfb8[*cdat++ >> 4] & eorx) ^ bgx, dest);
136 break;
137 case 8:
138 for (rows = fontheight(p) ; rows-- ; dest += bytes) {
139 fb_writel((nibbletab_cfb8[*cdat >> 4] & eorx) ^ bgx, dest);
140 fb_writel((nibbletab_cfb8[*cdat++ & 0xf] & eorx) ^ bgx, dest+4);
141 }
142 break;
143 case 12:
144 case 16:
145 for (rows = fontheight(p) ; rows-- ; dest += bytes) {
146 fb_writel((nibbletab_cfb8[*cdat >> 4] & eorx) ^ bgx, dest);
147 fb_writel((nibbletab_cfb8[*cdat++ & 0xf] & eorx) ^ bgx, dest+4);
148 fb_writel((nibbletab_cfb8[(*cdat >> 4) & 0xf] & eorx) ^ bgx, dest+8);
149 if (fontwidth(p) == 16)
150 fb_writel((nibbletab_cfb8[*cdat & 0xf] & eorx) ^ bgx, dest+12);
151 cdat++;
152 }
153 break;
154 }
155 }
156
fbcon_cfb8_putcs(struct vc_data * conp,struct display * p,const unsigned short * s,int count,int yy,int xx)157 void fbcon_cfb8_putcs(struct vc_data *conp, struct display *p,
158 const unsigned short *s, int count, int yy, int xx)
159 {
160 u8 *cdat, *dest, *dest0;
161 u16 c;
162 int rows,bytes=p->next_line;
163 u32 eorx, fgx, bgx;
164
165 dest0 = p->screen_base + yy * fontheight(p) * bytes + xx * fontwidth(p);
166 c = scr_readw(s);
167 fgx = attr_fgcol(p, c);
168 bgx = attr_bgcol(p, c);
169 fgx |= (fgx << 8);
170 fgx |= (fgx << 16);
171 bgx |= (bgx << 8);
172 bgx |= (bgx << 16);
173 eorx = fgx ^ bgx;
174 switch (fontwidth(p)) {
175 case 4:
176 while (count--) {
177 c = scr_readw(s++) & p->charmask;
178 cdat = p->fontdata + c * fontheight(p);
179
180 for (rows = fontheight(p), dest = dest0; rows-- ; dest += bytes)
181 fb_writel((nibbletab_cfb8[*cdat++ >> 4] & eorx) ^ bgx, dest);
182 dest0+=4;
183 }
184 break;
185 case 8:
186 while (count--) {
187 c = scr_readw(s++) & p->charmask;
188 cdat = p->fontdata + c * fontheight(p);
189
190 for (rows = fontheight(p), dest = dest0; rows-- ; dest += bytes) {
191 fb_writel((nibbletab_cfb8[*cdat >> 4] & eorx) ^ bgx, dest);
192 fb_writel((nibbletab_cfb8[*cdat++ & 0xf] & eorx) ^ bgx, dest+4);
193 }
194 dest0+=8;
195 }
196 break;
197 case 12:
198 case 16:
199 while (count--) {
200 c = scr_readw(s++) & p->charmask;
201 cdat = p->fontdata + (c * fontheight(p) << 1);
202
203 for (rows = fontheight(p), dest = dest0; rows-- ; dest += bytes) {
204 fb_writel((nibbletab_cfb8[*cdat >> 4] & eorx) ^ bgx, dest);
205 fb_writel((nibbletab_cfb8[*cdat++ & 0xf] & eorx) ^ bgx, dest+4);
206 fb_writel((nibbletab_cfb8[(*cdat >> 4) & 0xf] & eorx) ^ bgx, dest+8);
207 if (fontwidth(p) == 16)
208 fb_writel((nibbletab_cfb8[*cdat & 0xf] & eorx) ^ bgx, dest+12);
209 cdat++;
210 }
211 dest0+=fontwidth(p);
212 }
213 break;
214 }
215 }
216
fbcon_cfb8_revc(struct display * p,int xx,int yy)217 void fbcon_cfb8_revc(struct display *p, int xx, int yy)
218 {
219 u8 *dest;
220 int bytes=p->next_line, rows;
221
222 dest = p->screen_base + yy * fontheight(p) * bytes + xx * fontwidth(p);
223 for (rows = fontheight(p) ; rows-- ; dest += bytes) {
224 switch (fontwidth(p)) {
225 case 16: fb_writel(fb_readl(dest+12) ^ 0x0f0f0f0f, dest+12); /* fall thru */
226 case 12: fb_writel(fb_readl(dest+8) ^ 0x0f0f0f0f, dest+8); /* fall thru */
227 case 8: fb_writel(fb_readl(dest+4) ^ 0x0f0f0f0f, dest+4); /* fall thru */
228 case 4: fb_writel(fb_readl(dest) ^ 0x0f0f0f0f, dest); /* fall thru */
229 default: break;
230 }
231 }
232 }
233
fbcon_cfb8_clear_margins(struct vc_data * conp,struct display * p,int bottom_only)234 void fbcon_cfb8_clear_margins(struct vc_data *conp, struct display *p,
235 int bottom_only)
236 {
237 int bytes=p->next_line;
238 u8 bgx;
239
240 unsigned int right_start = conp->vc_cols*fontwidth(p);
241 unsigned int bottom_start = conp->vc_rows*fontheight(p);
242 unsigned int right_width, bottom_width;
243
244 bgx=attr_bgcol_ec(p,conp);
245
246 if (!bottom_only && (right_width = p->var.xres-right_start))
247 rectfill(p->screen_base+right_start, right_width, p->var.yres_virtual,
248 bgx, bytes);
249 if ((bottom_width = p->var.yres-bottom_start))
250 rectfill(p->screen_base+(p->var.yoffset+bottom_start)*bytes,
251 right_start, bottom_width, bgx, bytes);
252 }
253
254
255 /*
256 * `switch' for the low level operations
257 */
258
259 struct display_switch fbcon_cfb8 = {
260 setup: fbcon_cfb8_setup,
261 bmove: fbcon_cfb8_bmove,
262 clear: fbcon_cfb8_clear,
263 putc: fbcon_cfb8_putc,
264 putcs: fbcon_cfb8_putcs,
265 revc: fbcon_cfb8_revc,
266 clear_margins: fbcon_cfb8_clear_margins,
267 fontwidthmask: FONTWIDTH(4)|FONTWIDTH(8)|FONTWIDTH(12)|FONTWIDTH(16)
268 };
269
270
271 #ifdef MODULE
272 MODULE_LICENSE("GPL");
273
init_module(void)274 int init_module(void)
275 {
276 return 0;
277 }
278
cleanup_module(void)279 void cleanup_module(void)
280 {}
281 #endif /* MODULE */
282
283
284 /*
285 * Visible symbols for modules
286 */
287
288 EXPORT_SYMBOL(fbcon_cfb8);
289 EXPORT_SYMBOL(fbcon_cfb8_setup);
290 EXPORT_SYMBOL(fbcon_cfb8_bmove);
291 EXPORT_SYMBOL(fbcon_cfb8_clear);
292 EXPORT_SYMBOL(fbcon_cfb8_putc);
293 EXPORT_SYMBOL(fbcon_cfb8_putcs);
294 EXPORT_SYMBOL(fbcon_cfb8_revc);
295 EXPORT_SYMBOL(fbcon_cfb8_clear_margins);
296