WebSVN – HelenOS – Diff – /trunk/kernel/genarch/src/fb/fb.c


/*
 * Copyright (c) 2006 Ondrej Palkovsky
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
/** @addtogroup genarch
 * @{
 */
/** @file
 */
 
#include <genarch/fb/font-8x16.h>
#include <genarch/fb/visuals.h>
#include <genarch/fb/fb.h>
#include <console/chardev.h>
#include <console/console.h>
#include <sysinfo/sysinfo.h>
#include <mm/slab.h>
#include <panic.h>
#include <memstr.h>
#include <config.h>
#include <bitops.h>
#include <print.h>
#include <ddi/ddi.h>
#include <arch/types.h>
#include <typedefs.h>
 
#include "helenos.xbm"
 
static parea_t fb_parea;        /**< Physical memory area for fb. */
 
SPINLOCK_INITIALIZE(fb_lock);
 
static uint8_t *fbaddress = NULL;
 
static uint8_t *blankline = NULL;
static uint8_t *dbbuffer = NULL;    /* Buffer for fast scrolling console */
static index_t dboffset;
 
static unsigned int xres = 0;
static unsigned int yres = 0;
static unsigned int scanline = 0;
static unsigned int pixelbytes = 0;
#ifdef FB_INVERT_COLORS
static bool invert_colors = true;
#else
static bool invert_colors = false;
#endif
 
static unsigned int position = 0;
static unsigned int columns = 0;
static unsigned int rows = 0;
 
#define COL_WIDTH   8
#define ROW_BYTES   (scanline * FONT_SCANLINES)
 
#define BGCOLOR     0x000080
#define FGCOLOR     0xffff00
#define LOGOCOLOR   0x2020b0
 
#define RED(x, bits)    ((x >> (16 + 8 - bits)) & ((1 << bits) - 1))
#define GREEN(x, bits)  ((x >> (8 + 8 - bits)) & ((1 << bits) - 1))
#define BLUE(x, bits)   ((x >> (8 - bits)) & ((1 << bits) - 1))
 
#define POINTPOS(x, y)  ((y) * scanline + (x) * pixelbytes)
 
/***************************************************************/
/* Pixel specific fuctions */
 
static void (*rgb2scr)(void *, int);
static int (*scr2rgb)(void *);
 
static inline int COLOR(int color)
{
    return invert_colors ? ~color : color;
}
 
/* Conversion routines between different color representations */
static void rgb_byte0888(void *dst, int rgb)
{
    *((int *) dst) = rgb;
}
 
static int byte0888_rgb(void *src)
{
    return (*((int *) src)) & 0xffffff;
}
 
static void bgr_byte0888(void *dst, int rgb)
{
    *((uint32_t *) dst) = BLUE(rgb, 8) << 16 | GREEN(rgb, 8) << 8 | RED(rgb,
        8);
}
 
static int byte0888_bgr(void *src)
{
    int color = *(uint32_t *)(src);
    return ((color & 0xff) << 16) | (((color >> 8) & 0xff) << 8) | ((color
        >> 16) & 0xff);
}
 
static void rgb_byte888(void *dst, int rgb)
{
    uint8_t *scr = dst;
#if defined(FB_INVERT_ENDIAN)
    scr[0] = RED(rgb, 8);
    scr[1] = GREEN(rgb, 8);
    scr[2] = BLUE(rgb, 8);
#else
    scr[2] = RED(rgb, 8);
    scr[1] = GREEN(rgb, 8);
    scr[0] = BLUE(rgb, 8);
#endif
}
 
static int byte888_rgb(void *src)
{
    uint8_t *scr = src;
#if defined(FB_INVERT_ENDIAN)
    return scr[0] << 16 | scr[1] << 8 | scr[2];
#else
    return scr[2] << 16 | scr[1] << 8 | scr[0];
#endif  
}
 
/**  16-bit depth (5:5:5) */
static void rgb_byte555(void *dst, int rgb)
{
    /* 5-bit, 5-bits, 5-bits */
    *((uint16_t *) dst) = RED(rgb, 5) << 10 | GREEN(rgb, 5) << 5 | BLUE(rgb,
        5);
}
 
/** 16-bit depth (5:5:5) */
static int byte555_rgb(void *src)
{
    int color = *(uint16_t *)(src);
    return (((color >> 10) & 0x1f) << (16 + 3)) | (((color >> 5) & 0x1f) <<
        (8 + 3)) | ((color & 0x1f) << 3);
}
 
/**  16-bit depth (5:6:5) */
static void rgb_byte565(void *dst, int rgb)
{
    /* 5-bit, 6-bits, 5-bits */
    *((uint16_t *) dst) = RED(rgb, 5) << 11 | GREEN(rgb, 6) << 5 | BLUE(rgb,        5);
}
 
/** 16-bit depth (5:6:5) */
static int byte565_rgb(void *src)
{
    int color = *(uint16_t *)(src);
    return (((color >> 11) & 0x1f) << (16 + 3)) | (((color >> 5) & 0x3f) <<
        (8 + 2)) | ((color & 0x1f) << 3);
}
 
/** Put pixel - 8-bit depth (color palette/3:2:3)
 *
 * Even though we try 3:2:3 color scheme here, an 8-bit framebuffer
 * will most likely use a color palette. The color appearance
 * will be pretty random and depend on the default installed
 * palette. This could be fixed by supporting custom palette
 * and setting it to simulate the 8-bit truecolor.
 */
static void rgb_byte8(void *dst, int rgb)
{
    *((uint8_t *) dst) = RED(rgb, 3) << 5 | GREEN(rgb, 2) << 3 | BLUE(rgb,
        3);
}
 
/** Return pixel color - 8-bit depth (color palette/3:2:3)
 *
 * See the comment for rgb_byte().
 */
static int byte8_rgb(void *src)
{
    int color = *(uint8_t *)src;
    return (((color >> 5) & 0x7) << (16 + 5)) | (((color >> 3) & 0x3) << (8
        + 6)) | ((color & 0x7) << 5);
}
 
static void putpixel(unsigned int x, unsigned int y, int color)
{
    (*rgb2scr)(&fbaddress[POINTPOS(x, y)], COLOR(color));
 
    if (dbbuffer) {
        int dline = (y + dboffset) % yres;
        (*rgb2scr)(&dbbuffer[POINTPOS(x, dline)], COLOR(color));
    }
}
 
/** Get pixel from viewport */
static int getpixel(unsigned int x, unsigned int y)
{
    if (dbbuffer) {
        int dline = (y + dboffset) % yres;
        return COLOR((*scr2rgb)(&dbbuffer[POINTPOS(x, dline)]));
    }
    return COLOR((*scr2rgb)(&fbaddress[POINTPOS(x, y)]));
}
 
 
/** Fill screen with background color */
static void clear_screen(void)
{
    unsigned int y;
 
    for (y = 0; y < yres; y++) {
        memcpy(&fbaddress[scanline * y], blankline, xres * pixelbytes);
        if (dbbuffer)
            memcpy(&dbbuffer[scanline * y], blankline, xres *
                pixelbytes);
    }
}
 
 
/** Scroll screen one row up */
static void scroll_screen(void)
{
    if (dbbuffer) {
        count_t first;
       
        memcpy(&dbbuffer[dboffset * scanline], blankline, ROW_BYTES);
       
        dboffset = (dboffset + FONT_SCANLINES) % yres;
        first = yres - dboffset;
 
        memcpy(fbaddress, &dbbuffer[scanline * dboffset], first *
            scanline);
        memcpy(&fbaddress[first * scanline], dbbuffer, dboffset *
            scanline);
    } else {
        uint8_t *lastline = &fbaddress[(rows - 1) * ROW_BYTES];
       
        memcpy((void *) fbaddress, (void *) &fbaddress[ROW_BYTES],
            scanline * yres - ROW_BYTES);
        /* Clear last row */
        memcpy((void *) lastline, (void *) blankline, ROW_BYTES);
    }
}
 
 
static void invert_pixel(unsigned int x, unsigned int y)
{
    putpixel(x, y, ~getpixel(x, y));
}
 
 
/** Draw one line of glyph at a given position */
static void draw_glyph_line(unsigned int glline, unsigned int x, unsigned int y)
{
    unsigned int i;
 
    for (i = 0; i < 8; i++)
        if (glline & (1 << (7 - i))) {
            putpixel(x + i, y, FGCOLOR);
        } else
            putpixel(x + i, y, BGCOLOR);
}
 
/***************************************************************/
/* Character-console functions */
 
/** Draw character at given position */
static void draw_glyph(uint8_t glyph, unsigned int col, unsigned int row)
{
    unsigned int y;
 
    for (y = 0; y < FONT_SCANLINES; y++)
        draw_glyph_line(fb_font[glyph * FONT_SCANLINES + y], col *
            COL_WIDTH, row * FONT_SCANLINES + y);
}
 
/** Invert character at given position */
static void invert_char(unsigned int col, unsigned int row)
{
    unsigned int x;
    unsigned int y;
 
    for (x = 0; x < COL_WIDTH; x++)
        for (y = 0; y < FONT_SCANLINES; y++)
            invert_pixel(col * COL_WIDTH + x, row * FONT_SCANLINES +
                y);
}
 
/** Draw character at default position */
static void draw_char(char chr)
{
    draw_glyph(chr, position % columns, position / columns);
}
 
static void draw_logo(unsigned int startx, unsigned int starty)
{
    unsigned int x;
    unsigned int y;
    unsigned int byte;
    unsigned int rowbytes;
 
    rowbytes = (helenos_width - 1) / 8 + 1;
 
    for (y = 0; y < helenos_height; y++)
        for (x = 0; x < helenos_width; x++) {
            byte = helenos_bits[rowbytes * y + x / 8];
            byte >>= x % 8;
            if (byte & 1)
                putpixel(startx + x, starty + y,
                    COLOR(LOGOCOLOR));
        }
}
 
/***************************************************************/
/* Stdout specific functions */
 
static void invert_cursor(void)
{
    invert_char(position % columns, position / columns);
}
 
/** Print character to screen
 *
 *  Emulate basic terminal commands
 */
static void fb_putchar(chardev_t *dev, char ch)
{
    spinlock_lock(&fb_lock);
   
    switch (ch) {
    case '\n':
        invert_cursor();
        position += columns;
        position -= position % columns;
        break;
    case '\r':
        invert_cursor();
        position -= position % columns;
        break;
    case '\b':
        invert_cursor();
        if (position % columns)
            position--;
        break;
    case '\t':
        invert_cursor();
        do {
            draw_char(' ');
            position++;
        } while ((position % 8) && position < columns * rows);
        break;
    default:
        draw_char(ch);
        position++;
    }
   
    if (position >= columns * rows) {
        position -= columns;
        scroll_screen();
    }
   
    invert_cursor();
   
    spinlock_unlock(&fb_lock);
}
 
static chardev_t framebuffer;
static chardev_operations_t fb_ops = {
    .write = fb_putchar,
};
 
 
/** Initialize framebuffer as a chardev output device
 *
 * @param addr   Physical address of the framebuffer
 * @param x      Screen width in pixels
 * @param y      Screen height in pixels
 * @param scan   Bytes per one scanline
 * @param visual Color model
 *
 */
void fb_init(uintptr_t addr, unsigned int x, unsigned int y, unsigned int scan,
    unsigned int visual)
{
    switch (visual) {
    case VISUAL_INDIRECT_8:
        rgb2scr = rgb_byte8;
        scr2rgb = byte8_rgb;
        pixelbytes = 1;
        break;
    case VISUAL_RGB_5_5_5:
        rgb2scr = rgb_byte555;
        scr2rgb = byte555_rgb;
        pixelbytes = 2;
        break;
    case VISUAL_RGB_5_6_5:
        rgb2scr = rgb_byte565;
        scr2rgb = byte565_rgb;
        pixelbytes = 2;
        break;
    case VISUAL_RGB_8_8_8:
        rgb2scr = rgb_byte888;
        scr2rgb = byte888_rgb;
        pixelbytes = 3;
        break;
    case VISUAL_RGB_8_8_8_0:
        rgb2scr = rgb_byte888;
        scr2rgb = byte888_rgb;
        pixelbytes = 4;
        break;
    case VISUAL_RGB_0_8_8_8:
        rgb2scr = rgb_byte0888;
        scr2rgb = byte0888_rgb;
        pixelbytes = 4;
        break;
    case VISUAL_BGR_0_8_8_8:
        rgb2scr = bgr_byte0888;
        scr2rgb = byte0888_bgr;
        pixelbytes = 4;
        break;
    default:
        panic("Unsupported visual.\n");
    }
   
    unsigned int fbsize = scan * y;
   
    /* Map the framebuffer */
    fbaddress = (uint8_t *) hw_map((uintptr_t) addr, fbsize);
   
    xres = x;
    yres = y;
    scanline = scan;
   
    rows = y / FONT_SCANLINES;
    columns = x / COL_WIDTH;
 
    fb_parea.pbase = (uintptr_t) addr;
    fb_parea.vbase = (uintptr_t) fbaddress;
    fb_parea.frames = SIZE2FRAMES(fbsize);
    fb_parea.cacheable = false;
    ddi_parea_register(&fb_parea);
 
    sysinfo_set_item_val("fb", NULL, true);
    sysinfo_set_item_val("fb.kind", NULL, 1);
    sysinfo_set_item_val("fb.width", NULL, xres);
    sysinfo_set_item_val("fb.height", NULL, yres);
    sysinfo_set_item_val("fb.scanline", NULL, scan);
    sysinfo_set_item_val("fb.visual", NULL, visual);
    sysinfo_set_item_val("fb.address.physical", NULL, addr);
    sysinfo_set_item_val("fb.address.color", NULL, PAGE_COLOR((uintptr_t)
        fbaddress));
    sysinfo_set_item_val("fb.invert-colors", NULL, invert_colors);
 
    /* Allocate double buffer */
    unsigned int order = fnzb(SIZE2FRAMES(fbsize) - 1) + 1;
    dbbuffer = (uint8_t *) frame_alloc(order, FRAME_ATOMIC | FRAME_KA);
    if (!dbbuffer)
        printf("Failed to allocate scroll buffer.\n");
    dboffset = 0;
 
    /* Initialized blank line */
    blankline = (uint8_t *) malloc(ROW_BYTES, FRAME_ATOMIC);
    if (!blankline)
        panic("Failed to allocate blank line for framebuffer.");
    for (y = 0; y < FONT_SCANLINES; y++)
        for (x = 0; x < xres; x++)
            (*rgb2scr)(&blankline[POINTPOS(x, y)], COLOR(BGCOLOR));
   
    clear_screen();
 
    /* Update size of screen to match text area */
    yres = rows * FONT_SCANLINES;
 
    draw_logo(xres - helenos_width, 0);
    invert_cursor();
 
    chardev_initialize("fb", &framebuffer, &fb_ops);
    stdout = &framebuffer;
}
 
/** @}
 */
 

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

Subversion Repositories HelenOS

(root)/trunk/kernel/genarch/src/fb/fb.c – Rev 2054 → 2071