source: mainline/kernel/genarch/src/fb/fb.c@ 925fdd7

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since 925fdd7 was 925fdd7, checked in by Pavel Rimsky <rimskyp@…>, 17 years ago

Fixed the bug when on SunBlade1500 we wrote to an address outside the framebuffer memory. A nasty hack to the 8-bit palette so that on sb1500 we do not have to turn black into white and white into black.
  • Property mode set to 100644
File size: 13.9 KB
Line 
1/*
2 * Copyright (c) 2006 Ondrej Palkovsky
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 *
9 * - Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * - Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * - The name of the author may not be used to endorse or promote products
15 * derived from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29/** @addtogroup genarch
30 * @{
31 */
32/** @file
33 */
34
35#include <genarch/fb/font-8x16.h>
36#include <genarch/fb/visuals.h>
37#include <genarch/fb/fb.h>
38#include <console/chardev.h>
39#include <console/console.h>
40#include <sysinfo/sysinfo.h>
41#include <mm/slab.h>
42#include <panic.h>
43#include <memstr.h>
44#include <config.h>
45#include <bitops.h>
46#include <print.h>
47#include <ddi/ddi.h>
48#include <arch/types.h>
49
50#include "helenos.xbm"
51
52static parea_t fb_parea; /**< Physical memory area for fb. */
53
54SPINLOCK_INITIALIZE(fb_lock);
55
56static uint8_t *fbaddress = NULL;
57
58static uint8_t *blankline = NULL;
59static uint8_t *dbbuffer = NULL; /* Buffer for fast scrolling console */
60static index_t dboffset;
61
62static unsigned int xres = 0;
63static unsigned int yres = 0;
64static unsigned int scanline = 0;
65static unsigned int pixelbytes = 0;
66#ifdef FB_INVERT_COLORS
67static bool invert_colors = true;
68#else
69static bool invert_colors = false;
70#endif
71
72static unsigned int position = 0;
73static unsigned int columns = 0;
74static unsigned int rows = 0;
75
76#define COL_WIDTH 8
77#define ROW_BYTES (scanline * FONT_SCANLINES)
78
79#define BGCOLOR 0x000080
80#define FGCOLOR 0xffff00
81#define LOGOCOLOR 0x2020b0
82
83#define RED(x, bits) ((x >> (8 + 8 + 8 - bits)) & ((1 << bits) - 1))
84#define GREEN(x, bits) ((x >> (8 + 8 - bits)) & ((1 << bits) - 1))
85#define BLUE(x, bits) ((x >> (8 - bits)) & ((1 << bits) - 1))
86
87#define POINTPOS(x, y) ((y) * scanline + (x) * pixelbytes)
88
89/***************************************************************/
90/* Pixel specific fuctions */
91
92static void (*rgb2scr)(void *, int);
93static int (*scr2rgb)(void *);
94
95static inline int COLOR(int color)
96{
97 return invert_colors ? ~color : color;
98}
99
100/* Conversion routines between different color representations */
101static void rgb_byte0888(void *dst, int rgb)
102{
103 *((int *) dst) = rgb;
104}
105
106static int byte0888_rgb(void *src)
107{
108 return (*((int *) src)) & 0xffffff;
109}
110
111static void bgr_byte0888(void *dst, int rgb)
112{
113 *((uint32_t *) dst) = BLUE(rgb, 8) << 16 | GREEN(rgb, 8) << 8 |
114 RED(rgb, 8);
115}
116
117static int byte0888_bgr(void *src)
118{
119 int color = *(uint32_t *)(src);
120 return ((color & 0xff) << 16) | (((color >> 8) & 0xff) << 8) |
121 ((color >> 16) & 0xff);
122}
123
124static void rgb_byte888(void *dst, int rgb)
125{
126 uint8_t *scr = (uint8_t *) dst;
127#if defined(FB_INVERT_ENDIAN)
128 scr[0] = RED(rgb, 8);
129 scr[1] = GREEN(rgb, 8);
130 scr[2] = BLUE(rgb, 8);
131#else
132 scr[2] = RED(rgb, 8);
133 scr[1] = GREEN(rgb, 8);
134 scr[0] = BLUE(rgb, 8);
135#endif
136}
137
138static int byte888_rgb(void *src)
139{
140 uint8_t *scr = (uint8_t *) src;
141#if defined(FB_INVERT_ENDIAN)
142 return scr[0] << 16 | scr[1] << 8 | scr[2];
143#else
144 return scr[2] << 16 | scr[1] << 8 | scr[0];
145#endif
146}
147
148/** 16-bit depth (5:5:5) */
149static void rgb_byte555(void *dst, int rgb)
150{
151 /* 5-bit, 5-bits, 5-bits */
152 *((uint16_t *) dst) = RED(rgb, 5) << 10 | GREEN(rgb, 5) << 5 |
153 BLUE(rgb, 5);
154}
155
156/** 16-bit depth (5:5:5) */
157static int byte555_rgb(void *src)
158{
159 int color = *(uint16_t *)(src);
160 return (((color >> 10) & 0x1f) << (16 + 3)) |
161 (((color >> 5) & 0x1f) << (8 + 3)) | ((color & 0x1f) << 3);
162}
163
164/** 16-bit depth (5:6:5) */
165static void rgb_byte565(void *dst, int rgb)
166{
167 /* 5-bit, 6-bits, 5-bits */
168 *((uint16_t *) dst) = RED(rgb, 5) << 11 | GREEN(rgb, 6) << 5 |
169 BLUE(rgb, 5);
170}
171
172/** 16-bit depth (5:6:5) */
173static int byte565_rgb(void *src)
174{
175 int color = *(uint16_t *)(src);
176 return (((color >> 11) & 0x1f) << (16 + 3)) |
177 (((color >> 5) & 0x3f) << (8 + 2)) | ((color & 0x1f) << 3);
178}
179
180/** Put pixel - 8-bit depth (color palette/3:2:3, inverted)
181 *
182 * Even though we try 3:2:3 color scheme here, an 8-bit framebuffer
183 * will most likely use a color palette. The color appearance
184 * will be pretty random and depend on the default installed
185 * palette. This could be fixed by supporting custom palette
186 * and setting it to simulate the 8-bit truecolor.
187 *
188 * Currently we set the palette on the sparc64 port.
189 *
190 * Note that the byte is being inverted by this function. The reason is
191 * that we would like to use a color palette where the white color code
192 * is 0 and the black color code is 255, as some machines (SunBlade 1500)
193 * use these codes for black and white and prevent to set codes
194 * 0 and 255 to other colors.
195 */
196static void rgb_byte8(void *dst, int rgb)
197{
198 *((uint8_t *) dst) = 255 - (RED(rgb, 3) << 5 | GREEN(rgb, 2) << 3 |
199 BLUE(rgb, 3));
200}
201
202/** Return pixel color - 8-bit depth (color palette/3:2:3)
203 *
204 * See the comment for rgb_byte().
205 */
206static int byte8_rgb(void *src)
207{
208 int color = 255 - (*(uint8_t *)src);
209 return (((color >> 5) & 0x7) << (16 + 5)) |
210 (((color >> 3) & 0x3) << (8 + 6)) | ((color & 0x7) << 5);
211}
212
213static void putpixel(unsigned int x, unsigned int y, int color)
214{
215 (*rgb2scr)(&fbaddress[POINTPOS(x, y)], COLOR(color));
216
217 if (dbbuffer) {
218 int dline = (y + dboffset) % yres;
219 (*rgb2scr)(&dbbuffer[POINTPOS(x, dline)], COLOR(color));
220 }
221}
222
223/** Get pixel from viewport */
224static int getpixel(unsigned int x, unsigned int y)
225{
226 if (dbbuffer) {
227 int dline = (y + dboffset) % yres;
228 return COLOR((*scr2rgb)(&dbbuffer[POINTPOS(x, dline)]));
229 }
230 return COLOR((*scr2rgb)(&fbaddress[POINTPOS(x, y)]));
231}
232
233
234/** Fill screen with background color */
235static void clear_screen(void)
236{
237 unsigned int y;
238
239 for (y = 0; y < yres; y++) {
240 memcpy(&fbaddress[scanline * y], blankline, xres * pixelbytes);
241 if (dbbuffer)
242 memcpy(&dbbuffer[scanline * y], blankline,
243 xres * pixelbytes);
244 }
245}
246
247
248/** Scroll screen one row up */
249static void scroll_screen(void)
250{
251 if (dbbuffer) {
252 count_t first;
253
254 /* Clear the last row */
255 memcpy(&dbbuffer[dboffset * scanline], blankline, ROW_BYTES);
256
257 dboffset = (dboffset + FONT_SCANLINES) % yres;
258 first = yres - dboffset;
259
260 /* Move all rows one row up */
261 if (xres * pixelbytes == scanline) {
262 memcpy(fbaddress, &dbbuffer[dboffset * scanline],
263 first * scanline);
264 memcpy(&fbaddress[first * scanline], dbbuffer,
265 dboffset * scanline);
266 } else {
267 /*
268 * When the scanline is bigger than number of bytes
269 * in the X-resolution, chances are that the
270 * frame buffer memory past the X-resolution is special
271 * in some way. For example, the SUNW,ffb framebuffer
272 * wraps this area around the beginning of the same
273 * line. To avoid troubles, copy only memory as
274 * specified by the resolution.
275 */
276 unsigned int i;
277
278 for (i = 0; i < first; i++)
279 memcpy(&fbaddress[i * scanline],
280 &dbbuffer[(dboffset + i) * scanline],
281 xres * pixelbytes);
282 for (i = 0; i < dboffset; i++)
283 memcpy(&fbaddress[(first + i) * scanline],
284 &dbbuffer[i * scanline], xres * pixelbytes);
285 }
286 } else {
287 uint8_t *lastline = &fbaddress[(rows - 1) * ROW_BYTES];
288
289 if (xres * pixelbytes == scanline) {
290 /* Move all rows one row up */
291 memcpy((void *) fbaddress,
292 (void *) &fbaddress[ROW_BYTES],
293 scanline * yres - ROW_BYTES);
294 /* Clear the last row */
295 memcpy((void *) lastline, (void *) blankline,
296 ROW_BYTES);
297 } else {
298 /*
299 * See the comment in the dbbuffer case.
300 */
301 unsigned int i;
302
303 /* Move all rows one row up */
304 for (i = 0; i < yres - FONT_SCANLINES; i++)
305 memcpy(&fbaddress[i * scanline],
306 &fbaddress[(i + FONT_SCANLINES) * scanline],
307 xres * pixelbytes);
308 /* Clear the last row */
309 for (i = 0; i < FONT_SCANLINES; i++)
310 memcpy(&lastline[i * scanline],
311 &blankline[i * scanline],
312 xres * pixelbytes);
313 }
314 }
315}
316
317
318static void invert_pixel(unsigned int x, unsigned int y)
319{
320 putpixel(x, y, ~getpixel(x, y));
321}
322
323
324/** Draw one line of glyph at a given position */
325static void draw_glyph_line(unsigned int glline, unsigned int x, unsigned int y)
326{
327 unsigned int i;
328
329 for (i = 0; i < 8; i++)
330 if (glline & (1 << (7 - i))) {
331 putpixel(x + i, y, FGCOLOR);
332 } else
333 putpixel(x + i, y, BGCOLOR);
334}
335
336/***************************************************************/
337/* Character-console functions */
338
339/** Draw character at given position */
340static void draw_glyph(uint8_t glyph, unsigned int col, unsigned int row)
341{
342 unsigned int y;
343
344 for (y = 0; y < FONT_SCANLINES; y++)
345 draw_glyph_line(fb_font[glyph * FONT_SCANLINES + y],
346 col * COL_WIDTH, row * FONT_SCANLINES + y);
347}
348
349/** Invert character at given position */
350static void invert_char(unsigned int col, unsigned int row)
351{
352 unsigned int x;
353 unsigned int y;
354
355 for (x = 0; x < COL_WIDTH; x++)
356 for (y = 0; y < FONT_SCANLINES; y++)
357 invert_pixel(col * COL_WIDTH + x,
358 row * FONT_SCANLINES + y);
359}
360
361/** Draw character at default position */
362static void draw_char(char chr)
363{
364 draw_glyph(chr, position % columns, position / columns);
365}
366
367static void draw_logo(unsigned int startx, unsigned int starty)
368{
369 unsigned int x;
370 unsigned int y;
371 unsigned int byte;
372 unsigned int rowbytes;
373
374 rowbytes = (helenos_width - 1) / 8 + 1;
375
376 for (y = 0; y < helenos_height; y++)
377 for (x = 0; x < helenos_width; x++) {
378 byte = helenos_bits[rowbytes * y + x / 8];
379 byte >>= x % 8;
380 if (byte & 1)
381 putpixel(startx + x, starty + y,
382 COLOR(LOGOCOLOR));
383 }
384}
385
386/***************************************************************/
387/* Stdout specific functions */
388
389static void invert_cursor(void)
390{
391 invert_char(position % columns, position / columns);
392}
393
394/** Print character to screen
395 *
396 * Emulate basic terminal commands
397 */
398static void fb_putchar(chardev_t *dev, char ch)
399{
400 spinlock_lock(&fb_lock);
401
402 switch (ch) {
403 case '\n':
404 invert_cursor();
405 position += columns;
406 position -= position % columns;
407 break;
408 case '\r':
409 invert_cursor();
410 position -= position % columns;
411 break;
412 case '\b':
413 invert_cursor();
414 if (position % columns)
415 position--;
416 break;
417 case '\t':
418 invert_cursor();
419 do {
420 draw_char(' ');
421 position++;
422 } while ((position % 8) && position < columns * rows);
423 break;
424 default:
425 draw_char(ch);
426 position++;
427 }
428
429 if (position >= columns * rows) {
430 position -= columns;
431 scroll_screen();
432 }
433
434 invert_cursor();
435
436 spinlock_unlock(&fb_lock);
437}
438
439static chardev_t framebuffer;
440static chardev_operations_t fb_ops = {
441 .write = fb_putchar,
442};
443
444
445/** Initialize framebuffer as a chardev output device
446 *
447 * @param props Properties of the framebuffer device.
448 */
449void fb_init(fb_properties_t *props)
450{
451 switch (props->visual) {
452 case VISUAL_INDIRECT_8:
453 rgb2scr = rgb_byte8;
454 scr2rgb = byte8_rgb;
455 pixelbytes = 1;
456 break;
457 case VISUAL_RGB_5_5_5:
458 rgb2scr = rgb_byte555;
459 scr2rgb = byte555_rgb;
460 pixelbytes = 2;
461 break;
462 case VISUAL_RGB_5_6_5:
463 rgb2scr = rgb_byte565;
464 scr2rgb = byte565_rgb;
465 pixelbytes = 2;
466 break;
467 case VISUAL_RGB_8_8_8:
468 rgb2scr = rgb_byte888;
469 scr2rgb = byte888_rgb;
470 pixelbytes = 3;
471 break;
472 case VISUAL_RGB_8_8_8_0:
473 rgb2scr = rgb_byte888;
474 scr2rgb = byte888_rgb;
475 pixelbytes = 4;
476 break;
477 case VISUAL_RGB_0_8_8_8:
478 rgb2scr = rgb_byte0888;
479 scr2rgb = byte0888_rgb;
480 pixelbytes = 4;
481 break;
482 case VISUAL_BGR_0_8_8_8:
483 rgb2scr = bgr_byte0888;
484 scr2rgb = byte0888_bgr;
485 pixelbytes = 4;
486 break;
487 default:
488 panic("Unsupported visual.\n");
489 }
490
491 unsigned int fbsize = props->scan * props->y;
492
493 /* Map the framebuffer */
494 fbaddress = (uint8_t *) hw_map((uintptr_t) props->addr,
495 fbsize + props->offset);
496 fbaddress += props->offset;
497
498 xres = props->x;
499 yres = props->y;
500 scanline = props->scan;
501
502 rows = props->y / FONT_SCANLINES;
503 columns = props->x / COL_WIDTH;
504
505 fb_parea.pbase = (uintptr_t) props->addr + props->offset;
506 fb_parea.vbase = (uintptr_t) fbaddress;
507 fb_parea.frames = SIZE2FRAMES(fbsize);
508 fb_parea.cacheable = false;
509 ddi_parea_register(&fb_parea);
510
511 sysinfo_set_item_val("fb", NULL, true);
512 sysinfo_set_item_val("fb.kind", NULL, 1);
513 sysinfo_set_item_val("fb.width", NULL, xres);
514 sysinfo_set_item_val("fb.height", NULL, yres);
515 sysinfo_set_item_val("fb.scanline", NULL, props->scan);
516 sysinfo_set_item_val("fb.visual", NULL, props->visual);
517 sysinfo_set_item_val("fb.address.physical", NULL, props->addr);
518 sysinfo_set_item_val("fb.offset", NULL, props->offset);
519 sysinfo_set_item_val("fb.invert-colors", NULL, invert_colors);
520
521 /* Allocate double buffer */
522 unsigned int order = fnzb(SIZE2FRAMES(fbsize) - 1) + 1;
523 dbbuffer = (uint8_t *) frame_alloc(order, FRAME_ATOMIC | FRAME_KA);
524 if (!dbbuffer)
525 printf("Failed to allocate scroll buffer.\n");
526 dboffset = 0;
527
528 /* Initialized blank line */
529 blankline = (uint8_t *) malloc(ROW_BYTES, FRAME_ATOMIC);
530 if (!blankline)
531 panic("Failed to allocate blank line for framebuffer.");
532 unsigned int x, y;
533 for (y = 0; y < FONT_SCANLINES; y++)
534 for (x = 0; x < xres; x++)
535 (*rgb2scr)(&blankline[POINTPOS(x, y)], COLOR(BGCOLOR));
536
537 clear_screen();
538
539 /* Update size of screen to match text area */
540 yres = rows * FONT_SCANLINES;
541
542 draw_logo(xres - helenos_width, 0);
543 invert_cursor();
544
545 chardev_initialize("fb", &framebuffer, &fb_ops);
546 stdout = &framebuffer;
547}
548
549/** @}
550 */
Note: See TracBrowser for help on using the repository browser.