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


/*
 * Copyright (c) 2008 Martin Decky
 * 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/logo-196x66.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 <align.h>
#include <panic.h>
#include <memstr.h>
#include <config.h>
#include <bitops.h>
#include <print.h>
#include <ddi/ddi.h>
#include <arch/types.h>
 
SPINLOCK_INITIALIZE(fb_lock);
 
/**< Physical memory area for fb. */
static parea_t fb_parea;
 
static uint8_t *fb_addr;
static uint8_t *backbuf;
static uint8_t *glyphs;
static uint8_t *bgscan;
 
static unsigned int xres;
static unsigned int yres;
 
static unsigned int ylogo;
static unsigned int ytrim;
static unsigned int rowtrim;
 
static unsigned int scanline;
static unsigned int glyphscanline;
 
static unsigned int pixelbytes;
static unsigned int glyphbytes;
static unsigned int bgscanbytes;
 
static unsigned int cols;
static unsigned int rows;
static unsigned int position = 0;
 
#define BG_COLOR     0x000080
#define FG_COLOR     0xffff00
 
#define CURSOR       219
 
#define RED(x, bits)         ((x >> (8 + 8 + 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 COL2X(col)           ((col) * FONT_WIDTH)
#define ROW2Y(row)           ((row) * FONT_SCANLINES)
 
#define X2COL(x)             ((x) / FONT_WIDTH)
#define Y2ROW(y)             ((y) / FONT_SCANLINES)
 
#define FB_POS(x, y)         ((y) * scanline + (x) * pixelbytes)
#define BB_POS(col, row)     ((row) * cols + (col))
#define GLYPH_POS(glyph, y)  ((glyph) * glyphbytes + (y) * glyphscanline)
 
 
static void (*rgb_conv)(void *, uint32_t);
 
 
/** ARGB 8:8:8:8 conversion
 *
 */
static void rgb_0888(void *dst, uint32_t rgb)
{
    *((uint32_t *) dst) = rgb & 0xffffff;
}
 
 
/** ABGR 8:8:8:8 conversion
 *
 */
static void bgr_0888(void *dst, uint32_t rgb)
{
    *((uint32_t *) dst)
        = (BLUE(rgb, 8) << 16) | (GREEN(rgb, 8) << 8) | RED(rgb, 8);
}
 
 
/** BGR 8:8:8 conversion
 *
 */
static void rgb_888(void *dst, uint32_t rgb)
{
#if defined(FB_INVERT_ENDIAN)
    ((uint8_t *) dst)[0] = RED(rgb, 8);
    ((uint8_t *) dst)[1] = GREEN(rgb, 8);
    ((uint8_t *) dst)[2] = BLUE(rgb, 8);
#else
    ((uint8_t *) dst)[0] = BLUE(rgb, 8);
    ((uint8_t *) dst)[1] = GREEN(rgb, 8);
    ((uint8_t *) dst)[2] = RED(rgb, 8);
#endif
}
 
 
/** RGB 5:5:5 conversion
 *
 */
static void rgb_555(void *dst, uint32_t rgb)
{
    *((uint16_t *) dst)
        = (RED(rgb, 5) << 10) | (GREEN(rgb, 5) << 5) | BLUE(rgb, 5);
}
 
 
/** RGB 5:6:5 conversion
 *
 */
static void rgb_565(void *dst, uint32_t rgb)
{
    *((uint16_t *) dst)
        = (RED(rgb, 5) << 11) | (GREEN(rgb, 6) << 5) | BLUE(rgb, 5);
}
 
 
/** RGB 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.
 *
 * Currently we set the palette on the ia32, amd64 and sparc64 port.
 *
 * Note that the byte is being inverted by this function. The reason is
 * that we would like to use a color palette where the white color code
 * is 0 and the black color code is 255, as some machines (Sun Blade 1500)
 * use these codes for black and white and prevent to set codes
 * 0 and 255 to other colors.
 *
 */
static void rgb_323(void *dst, uint32_t rgb)
{
    *((uint8_t *) dst)
        = ~((RED(rgb, 3) << 5) | (GREEN(rgb, 2) << 3) | BLUE(rgb, 3));
}
 
 
/** Hide logo and refresh screen
 *
 */
static void logo_hide(void)
{
    ylogo = 0;
    ytrim = yres;
    rowtrim = rows;
    fb_redraw();
}
 
 
/** Draw character at given position
 *
 */
static void glyph_draw(uint8_t glyph, unsigned int col, unsigned int row)
{
    unsigned int x = COL2X(col);
    unsigned int y = ROW2Y(row);
    unsigned int yd;
   
    if (y >= ytrim)
        logo_hide();
   
    backbuf[BB_POS(col, row)] = glyph;
   
    for (yd = 0; yd < FONT_SCANLINES; yd++)
        memcpy(&fb_addr[FB_POS(x, y + yd + ylogo)],
            &glyphs[GLYPH_POS(glyph, yd)], glyphscanline);
}
 
 
/** Scroll screen down by one row
 *
 *
 */
static void screen_scroll(void)
{
    if (ylogo > 0) {
        logo_hide();
        return;
    }
   
    unsigned int row;
   
    for (row = 0; row < rows; row++) {
        unsigned int y = ROW2Y(row);
        unsigned int yd;
       
        for (yd = 0; yd < FONT_SCANLINES; yd++) {
            unsigned int x;
            unsigned int col;
           
            for (col = 0, x = 0; col < cols; col++,
                x += FONT_WIDTH) {
                uint8_t glyph;
               
                if (row < rows - 1) {
                    if (backbuf[BB_POS(col, row)] ==
                        backbuf[BB_POS(col, row + 1)])
                        continue;
                   
                    glyph = backbuf[BB_POS(col, row + 1)];
                } else
                    glyph = 0;
               
                memcpy(&fb_addr[FB_POS(x, y + yd)],
                    &glyphs[GLYPH_POS(glyph, yd)],
                    glyphscanline);
            }
        }
    }
   
    memmove(backbuf, backbuf + cols, cols * (rows - 1));
    memsetb(&backbuf[BB_POS(0, rows - 1)], cols, 0);
}
 
 
static void cursor_put(void)
{
    glyph_draw(CURSOR, position % cols, position / cols);
}
 
 
static void cursor_remove(void)
{
    glyph_draw(0, position % cols, position / cols);
}
 
 
/** 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':
        cursor_remove();
        position += cols;
        position -= position % cols;
        break;
    case '\r':
        cursor_remove();
        position -= position % cols;
        break;
    case '\b':
        cursor_remove();
        if (position % cols)
            position--;
        break;
    case '\t':
        cursor_remove();
        do {
            glyph_draw((uint8_t) ' ', position % cols,
                position / cols);
            position++;
        } while ((position % 8) && (position < cols * rows));
        break;
    default:
        glyph_draw((uint8_t) ch, position % cols, position / cols);
        position++;
    }
   
    if (position >= cols * rows) {
        position -= cols;
        screen_scroll();
    }
   
    cursor_put();
   
    spinlock_unlock(&fb_lock);
}
 
static chardev_t framebuffer;
static chardev_operations_t fb_ops = {
    .write = fb_putchar,
};
 
 
/** Render glyphs
 *
 * Convert glyphs from device independent font
 * description to current visual representation.
 *
 */
static void glyphs_render(void)
{
    /* Prerender glyphs */
    unsigned int glyph;
   
    for (glyph = 0; glyph < FONT_GLYPHS; glyph++) {
        unsigned int y;
       
        for (y = 0; y < FONT_SCANLINES; y++) {
            unsigned int x;
           
            for (x = 0; x < FONT_WIDTH; x++) {
                void *dst = &glyphs[GLYPH_POS(glyph, y) +
                    x * pixelbytes];
                uint32_t rgb = (fb_font[ROW2Y(glyph) + y] &
                    (1 << (7 - x))) ? FG_COLOR : BG_COLOR;
                rgb_conv(dst, rgb);
            }
        }
    }
   
    /* Prerender background scanline */
    unsigned int x;
   
    for (x = 0; x < xres; x++)
        rgb_conv(&bgscan[x * pixelbytes], BG_COLOR);
}
 
 
/** Refresh the screen
 *
 */
void fb_redraw(void)
{
    if (ylogo > 0) {
        unsigned int y;
       
        for (y = 0; y < LOGO_HEIGHT; y++) {
            unsigned int x;
           
            for (x = 0; x < xres; x++)
                rgb_conv(&fb_addr[FB_POS(x, y)],
                    (x < LOGO_WIDTH) ?
                    fb_logo[y * LOGO_WIDTH + x] :
                    LOGO_COLOR);
        }
    }
   
    unsigned int row;
   
    for (row = 0; row < rowtrim; row++) {
        unsigned int y = ylogo + ROW2Y(row);
        unsigned int yd;
       
        for (yd = 0; yd < FONT_SCANLINES; yd++) {
            unsigned int x;
            unsigned int col;
           
            for (col = 0, x = 0; col < cols;
                col++, x += FONT_WIDTH) {
                void *d = &fb_addr[FB_POS(x, y + yd)];
                void *s = &glyphs[GLYPH_POS(backbuf[BB_POS(col,
                    row)], yd)];
                memcpy(d, s, glyphscanline);
            }
        }
    }
   
    if (COL2X(cols) < xres) {
        unsigned int y;
        unsigned int size = (xres - COL2X(cols)) * pixelbytes;
       
        for (y = ylogo; y < yres; y++)
            memcpy(&fb_addr[FB_POS(COL2X(cols), y)], bgscan, size);
    }
   
    if (ROW2Y(rowtrim) + ylogo < yres) {
        unsigned int y;
       
        for (y = ROW2Y(rowtrim) + ylogo; y < yres; y++)
            memcpy(&fb_addr[FB_POS(0, y)], bgscan, bgscanbytes);
    }
}
 
 
/** 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(fb_properties_t *props)
{
    switch (props->visual) {
    case VISUAL_INDIRECT_8:
        rgb_conv = rgb_323;
        pixelbytes = 1;
        break;
    case VISUAL_RGB_5_5_5:
        rgb_conv = rgb_555;
        pixelbytes = 2;
        break;
    case VISUAL_RGB_5_6_5:
        rgb_conv = rgb_565;
        pixelbytes = 2;
        break;
    case VISUAL_RGB_8_8_8:
        rgb_conv = rgb_888;
        pixelbytes = 3;
        break;
    case VISUAL_RGB_8_8_8_0:
        rgb_conv = rgb_888;
        pixelbytes = 4;
        break;
    case VISUAL_RGB_0_8_8_8:
        rgb_conv = rgb_0888;
        pixelbytes = 4;
        break;
    case VISUAL_BGR_0_8_8_8:
        rgb_conv = bgr_0888;
        pixelbytes = 4;
        break;
    default:
        panic("Unsupported visual.");
    }
   
    xres = props->x;
    yres = props->y;
    scanline = props->scan;
   
    cols = X2COL(xres);
    rows = Y2ROW(yres);
   
    if (yres > ylogo) {
        ylogo = LOGO_HEIGHT;
        rowtrim = rows - Y2ROW(ylogo);
        if (ylogo % FONT_SCANLINES > 0)
            rowtrim--;
        ytrim = ROW2Y(rowtrim);
    } else {
        ylogo = 0;
        ytrim = yres;
        rowtrim = rows;
    }
   
    glyphscanline = FONT_WIDTH * pixelbytes;
    glyphbytes = ROW2Y(glyphscanline);
    bgscanbytes = xres * pixelbytes;
   
    unsigned int fbsize = scanline * yres;
    unsigned int bbsize = cols * rows;
    unsigned int glyphsize = FONT_GLYPHS * glyphbytes;
   
    backbuf = (uint8_t *) malloc(bbsize, 0);
    if (!backbuf)
        panic("Unable to allocate backbuffer.");
   
    glyphs = (uint8_t *) malloc(glyphsize, 0);
    if (!glyphs)
        panic("Unable to allocate glyphs.");
   
    bgscan = malloc(bgscanbytes, 0);
    if (!bgscan)
        panic("Unable to allocate background pixel.");
   
    memsetb(backbuf, bbsize, 0);
   
    glyphs_render();
   
    fb_addr = (uint8_t *) hw_map((uintptr_t) props->addr, fbsize);
   
    fb_parea.pbase = (uintptr_t) props->addr + props->offset;
    fb_parea.vbase = (uintptr_t) fb_addr;
    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, scanline);
    sysinfo_set_item_val("fb.visual", NULL, props->visual);
    sysinfo_set_item_val("fb.address.physical", NULL, props->addr);
   
    fb_redraw();
   
    chardev_initialize("fb", &framebuffer, &fb_ops);
    stdout = &framebuffer;
}
 
/** @}
 */
 

Rev 3752	Rev 3790
1	/*	1	/*
2	* Copyright (c) 2008 Martin Decky	2	* Copyright (c) 2008 Martin Decky
3	* Copyright (c) 2006 Ondrej Palkovsky	3	* Copyright (c) 2006 Ondrej Palkovsky
4	* All rights reserved.	4	* All rights reserved.
5	*	5	*
6	* Redistribution and use in source and binary forms, with or without	6	* Redistribution and use in source and binary forms, with or without
7	* modification, are permitted provided that the following conditions	7	* modification, are permitted provided that the following conditions
8	* are met:	8	* are met:
9	*	9	*
10	* - Redistributions of source code must retain the above copyright	10	* - Redistributions of source code must retain the above copyright
11	* notice, this list of conditions and the following disclaimer.	11	* notice, this list of conditions and the following disclaimer.
12	* - Redistributions in binary form must reproduce the above copyright	12	* - Redistributions in binary form must reproduce the above copyright
13	* notice, this list of conditions and the following disclaimer in the	13	* notice, this list of conditions and the following disclaimer in the
14	* documentation and/or other materials provided with the distribution.	14	* documentation and/or other materials provided with the distribution.
15	* - The name of the author may not be used to endorse or promote products	15	* - The name of the author may not be used to endorse or promote products
16	* derived from this software without specific prior written permission.	16	* derived from this software without specific prior written permission.
17	*	17	*
18	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	18	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	19	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	20	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	21	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	22	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	23	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	24	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	25	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	26	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	27	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28	*/	28	*/
29		29
30	/** @addtogroup genarch	30	/** @addtogroup genarch
31	* @{	31	* @{
32	*/	32	*/
33	/** @file	33	/** @file
34	*/	34	*/
35		35
36	#include <genarch/fb/font-8x16.h>	36	#include <genarch/fb/font-8x16.h>
37	#include <genarch/fb/logo-196x66.h>	37	#include <genarch/fb/logo-196x66.h>
38	#include <genarch/fb/visuals.h>	38	#include <genarch/fb/visuals.h>
39	#include <genarch/fb/fb.h>	39	#include <genarch/fb/fb.h>
40	#include <console/chardev.h>	40	#include <console/chardev.h>
41	#include <console/console.h>	41	#include <console/console.h>
42	#include <sysinfo/sysinfo.h>	42	#include <sysinfo/sysinfo.h>
43	#include <mm/slab.h>	43	#include <mm/slab.h>
44	#include <align.h>	44	#include <align.h>
45	#include <panic.h>	45	#include <panic.h>
46	#include <memstr.h>	46	#include <memstr.h>
47	#include <config.h>	47	#include <config.h>
48	#include <bitops.h>	48	#include <bitops.h>
49	#include <print.h>	49	#include <print.h>
50	#include <ddi/ddi.h>	50	#include <ddi/ddi.h>
51	#include <arch/types.h>	51	#include <arch/types.h>
52		52
53	SPINLOCK_INITIALIZE(fb_lock);	53	SPINLOCK_INITIALIZE(fb_lock);
54		54
55	/*< Physical memory area for fb. /	55	/*< Physical memory area for fb. /
56	static parea_t fb_parea;	56	static parea_t fb_parea;
57		57
58	static uint8_t *fb_addr;	58	static uint8_t *fb_addr;
59	static uint8_t *backbuf;	59	static uint8_t *backbuf;
60	static uint8_t *glyphs;	60	static uint8_t *glyphs;
61	static uint8_t *bgscan;	61	static uint8_t *bgscan;
62		62
63	static unsigned int xres;	63	static unsigned int xres;
64	static unsigned int yres;	64	static unsigned int yres;
65		65
66	static unsigned int ylogo;	66	static unsigned int ylogo;
67	static unsigned int ytrim;	67	static unsigned int ytrim;
68	static unsigned int rowtrim;	68	static unsigned int rowtrim;
69		69
70	static unsigned int scanline;	70	static unsigned int scanline;
71	static unsigned int glyphscanline;	71	static unsigned int glyphscanline;
72		72
73	static unsigned int pixelbytes;	73	static unsigned int pixelbytes;
74	static unsigned int glyphbytes;	74	static unsigned int glyphbytes;
75	static unsigned int bgscanbytes;	75	static unsigned int bgscanbytes;
76		76
77	static unsigned int cols;	77	static unsigned int cols;
78	static unsigned int rows;	78	static unsigned int rows;
79	static unsigned int position = 0;	79	static unsigned int position = 0;
80		80
81	#define BG_COLOR 0x000080	81	#define BG_COLOR 0x000080
82	#define FG_COLOR 0xffff00	82	#define FG_COLOR 0xffff00
83		83
84	#define CURSOR 219	84	#define CURSOR 219
85		85
86	#define RED(x, bits) ((x >> (8 + 8 + 8 - bits)) & ((1 << bits) - 1))	86	#define RED(x, bits) ((x >> (8 + 8 + 8 - bits)) & ((1 << bits) - 1))
87	#define GREEN(x, bits) ((x >> (8 + 8 - bits)) & ((1 << bits) - 1))	87	#define GREEN(x, bits) ((x >> (8 + 8 - bits)) & ((1 << bits) - 1))
88	#define BLUE(x, bits) ((x >> (8 - bits)) & ((1 << bits) - 1))	88	#define BLUE(x, bits) ((x >> (8 - bits)) & ((1 << bits) - 1))
89		89
90	#define COL2X(col) ((col) * FONT_WIDTH)	90	#define COL2X(col) ((col) * FONT_WIDTH)
91	#define ROW2Y(row) ((row) * FONT_SCANLINES)	91	#define ROW2Y(row) ((row) * FONT_SCANLINES)
92		92
93	#define X2COL(x) ((x) / FONT_WIDTH)	93	#define X2COL(x) ((x) / FONT_WIDTH)
94	#define Y2ROW(y) ((y) / FONT_SCANLINES)	94	#define Y2ROW(y) ((y) / FONT_SCANLINES)
95		95
96	#define FB_POS(x, y) ((y) * scanline + (x) * pixelbytes)	96	#define FB_POS(x, y) ((y) * scanline + (x) * pixelbytes)
97	#define BB_POS(col, row) ((row) * cols + (col))	97	#define BB_POS(col, row) ((row) * cols + (col))
98	#define GLYPH_POS(glyph, y) ((glyph) * glyphbytes + (y) * glyphscanline)	98	#define GLYPH_POS(glyph, y) ((glyph) * glyphbytes + (y) * glyphscanline)
99		99
100		100
101	static void (rgb_conv)(void , uint32_t);	101	static void (rgb_conv)(void , uint32_t);
102		102
103		103
104	/** ARGB 8:8:8:8 conversion	104	/** ARGB 8:8:8:8 conversion
105	*	105	*
106	*/	106	*/
107	static void rgb_0888(void *dst, uint32_t rgb)	107	static void rgb_0888(void *dst, uint32_t rgb)
108	{	108	{
109	((uint32_t ) dst) = rgb & 0xffffff;	109	((uint32_t ) dst) = rgb & 0xffffff;
110	}	110	}
111		111
112		112
113	/** ABGR 8:8:8:8 conversion	113	/** ABGR 8:8:8:8 conversion
114	*	114	*
115	*/	115	*/
116	static void bgr_0888(void *dst, uint32_t rgb)	116	static void bgr_0888(void *dst, uint32_t rgb)
117	{	117	{
118	((uint32_t ) dst)	118	((uint32_t ) dst)
119	= (BLUE(rgb, 8) << 16) \| (GREEN(rgb, 8) << 8) \| RED(rgb, 8);	119	= (BLUE(rgb, 8) << 16) \| (GREEN(rgb, 8) << 8) \| RED(rgb, 8);
120	}	120	}
121		121
122		122
123	/** BGR 8:8:8 conversion	123	/** BGR 8:8:8 conversion
124	*	124	*
125	*/	125	*/
126	static void rgb_888(void *dst, uint32_t rgb)	126	static void rgb_888(void *dst, uint32_t rgb)
127	{	127	{
128	#if defined(FB_INVERT_ENDIAN)	128	#if defined(FB_INVERT_ENDIAN)
129	((uint8_t *) dst)[0] = RED(rgb, 8);	129	((uint8_t *) dst)[0] = RED(rgb, 8);
130	((uint8_t *) dst)[1] = GREEN(rgb, 8);	130	((uint8_t *) dst)[1] = GREEN(rgb, 8);
131	((uint8_t *) dst)[2] = BLUE(rgb, 8);	131	((uint8_t *) dst)[2] = BLUE(rgb, 8);
132	#else	132	#else
133	((uint8_t *) dst)[0] = BLUE(rgb, 8);	133	((uint8_t *) dst)[0] = BLUE(rgb, 8);
134	((uint8_t *) dst)[1] = GREEN(rgb, 8);	134	((uint8_t *) dst)[1] = GREEN(rgb, 8);
135	((uint8_t *) dst)[2] = RED(rgb, 8);	135	((uint8_t *) dst)[2] = RED(rgb, 8);
136	#endif	136	#endif
137	}	137	}
138		138
139		139
140	/** RGB 5:5:5 conversion	140	/** RGB 5:5:5 conversion
141	*	141	*
142	*/	142	*/
143	static void rgb_555(void *dst, uint32_t rgb)	143	static void rgb_555(void *dst, uint32_t rgb)
144	{	144	{
145	((uint16_t ) dst)	145	((uint16_t ) dst)
146	= (RED(rgb, 5) << 10) \| (GREEN(rgb, 5) << 5) \| BLUE(rgb, 5);	146	= (RED(rgb, 5) << 10) \| (GREEN(rgb, 5) << 5) \| BLUE(rgb, 5);
147	}	147	}
148		148
149		149
150	/** RGB 5:6:5 conversion	150	/** RGB 5:6:5 conversion
151	*	151	*
152	*/	152	*/
153	static void rgb_565(void *dst, uint32_t rgb)	153	static void rgb_565(void *dst, uint32_t rgb)
154	{	154	{
155	((uint16_t ) dst)	155	((uint16_t ) dst)
156	= (RED(rgb, 5) << 11) \| (GREEN(rgb, 6) << 5) \| BLUE(rgb, 5);	156	= (RED(rgb, 5) << 11) \| (GREEN(rgb, 6) << 5) \| BLUE(rgb, 5);
157	}	157	}
158		158
159		159
160	/** RGB 3:2:3	160	/** RGB 3:2:3
161	*	161	*
162	* Even though we try 3:2:3 color scheme here, an 8-bit framebuffer	162	* Even though we try 3:2:3 color scheme here, an 8-bit framebuffer
163	* will most likely use a color palette. The color appearance	163	* will most likely use a color palette. The color appearance
164	* will be pretty random and depend on the default installed	164	* will be pretty random and depend on the default installed
165	* palette. This could be fixed by supporting custom palette	165	* palette. This could be fixed by supporting custom palette
166	* and setting it to simulate the 8-bit truecolor.	166	* and setting it to simulate the 8-bit truecolor.
167	*	167	*
168	* Currently we set the palette on the ia32, amd64 and sparc64 port.	168	* Currently we set the palette on the ia32, amd64 and sparc64 port.
169	*	169	*
170	* Note that the byte is being inverted by this function. The reason is	170	* Note that the byte is being inverted by this function. The reason is
171	* that we would like to use a color palette where the white color code	171	* that we would like to use a color palette where the white color code
172	* is 0 and the black color code is 255, as some machines (Sun Blade 1500)	172	* is 0 and the black color code is 255, as some machines (Sun Blade 1500)
173	* use these codes for black and white and prevent to set codes	173	* use these codes for black and white and prevent to set codes
174	* 0 and 255 to other colors.	174	* 0 and 255 to other colors.
175	*	175	*
176	*/	176	*/
177	static void rgb_323(void *dst, uint32_t rgb)	177	static void rgb_323(void *dst, uint32_t rgb)
178	{	178	{
179	((uint8_t ) dst)	179	((uint8_t ) dst)
180	= ~((RED(rgb, 3) << 5) \| (GREEN(rgb, 2) << 3) \| BLUE(rgb, 3));	180	= ~((RED(rgb, 3) << 5) \| (GREEN(rgb, 2) << 3) \| BLUE(rgb, 3));
181	}	181	}
182		182
183		183
184	/** Hide logo and refresh screen	184	/** Hide logo and refresh screen
185	*	185	*
186	*/	186	*/
187	static void logo_hide(void)	187	static void logo_hide(void)
188	{	188	{
189	ylogo = 0;	189	ylogo = 0;
190	ytrim = yres;	190	ytrim = yres;
191	rowtrim = rows;	191	rowtrim = rows;
192	fb_redraw();	192	fb_redraw();
193	}	193	}
194		194
195		195
196	/** Draw character at given position	196	/** Draw character at given position
197	*	197	*
198	*/	198	*/
199	static void glyph_draw(uint8_t glyph, unsigned int col, unsigned int row)	199	static void glyph_draw(uint8_t glyph, unsigned int col, unsigned int row)
200	{	200	{
201	unsigned int x = COL2X(col);	201	unsigned int x = COL2X(col);
202	unsigned int y = ROW2Y(row);	202	unsigned int y = ROW2Y(row);
203	unsigned int yd;	203	unsigned int yd;
204		204
205	if (y >= ytrim)	205	if (y >= ytrim)
206	logo_hide();	206	logo_hide();
207		207
208	backbuf[BB_POS(col, row)] = glyph;	208	backbuf[BB_POS(col, row)] = glyph;
209		209
210	for (yd = 0; yd < FONT_SCANLINES; yd++)	210	for (yd = 0; yd < FONT_SCANLINES; yd++)
211	memcpy(&fb_addr[FB_POS(x, y + yd + ylogo)],	211	memcpy(&fb_addr[FB_POS(x, y + yd + ylogo)],
212	&glyphs[GLYPH_POS(glyph, yd)], glyphscanline);	212	&glyphs[GLYPH_POS(glyph, yd)], glyphscanline);
213	}	213	}
214		214
215		215
216	/** Scroll screen down by one row	216	/** Scroll screen down by one row
217	*	217	*
218	*	218	*
219	*/	219	*/
220	static void screen_scroll(void)	220	static void screen_scroll(void)
221	{	221	{
222	if (ylogo > 0) {	222	if (ylogo > 0) {
223	logo_hide();	223	logo_hide();
224	return;	224	return;
225	}	225	}
226		226
227	unsigned int row;	227	unsigned int row;
228		228
229	for (row = 0; row < rows; row++) {	229	for (row = 0; row < rows; row++) {
230	unsigned int y = ROW2Y(row);	230	unsigned int y = ROW2Y(row);
231	unsigned int yd;	231	unsigned int yd;
232		232
233	for (yd = 0; yd < FONT_SCANLINES; yd++) {	233	for (yd = 0; yd < FONT_SCANLINES; yd++) {
234	unsigned int x;	234	unsigned int x;
235	unsigned int col;	235	unsigned int col;
236		236
237	for (col = 0, x = 0; col < cols; col++,	237	for (col = 0, x = 0; col < cols; col++,
238	x += FONT_WIDTH) {	238	x += FONT_WIDTH) {
239	uint8_t glyph;	239	uint8_t glyph;
240		240
241	if (row < rows - 1) {	241	if (row < rows - 1) {
242	if (backbuf[BB_POS(col, row)] ==	242	if (backbuf[BB_POS(col, row)] ==
243	backbuf[BB_POS(col, row + 1)])	243	backbuf[BB_POS(col, row + 1)])
244	continue;	244	continue;
245		245
246	glyph = backbuf[BB_POS(col, row + 1)];	246	glyph = backbuf[BB_POS(col, row + 1)];
247	} else	247	} else
248	glyph = 0;	248	glyph = 0;
249		249
250	memcpy(&fb_addr[FB_POS(x, y + yd)],	250	memcpy(&fb_addr[FB_POS(x, y + yd)],
251	&glyphs[GLYPH_POS(glyph, yd)],	251	&glyphs[GLYPH_POS(glyph, yd)],
252	glyphscanline);	252	glyphscanline);
253	}	253	}
254	}	254	}
255	}	255	}
256		256
257	memmove(backbuf, backbuf + cols, cols * (rows - 1));	257	memmove(backbuf, backbuf + cols, cols * (rows - 1));
258	memsetb(&backbuf[BB_POS(0, rows - 1)], cols, 0);	258	memsetb(&backbuf[BB_POS(0, rows - 1)], cols, 0);
259	}	259	}
260		260
261		261
262	static void cursor_put(void)	262	static void cursor_put(void)
263	{	263	{
264	glyph_draw(CURSOR, position % cols, position / cols);	264	glyph_draw(CURSOR, position % cols, position / cols);
265	}	265	}
266		266
267		267
268	static void cursor_remove(void)	268	static void cursor_remove(void)
269	{	269	{
270	glyph_draw(0, position % cols, position / cols);	270	glyph_draw(0, position % cols, position / cols);
271	}	271	}
272		272
273		273
274	/** Print character to screen	274	/** Print character to screen
275	*	275	*
276	* Emulate basic terminal commands.	276	* Emulate basic terminal commands.
277	*	277	*
278	*/	278	*/
279	static void fb_putchar(chardev_t *dev, char ch)	279	static void fb_putchar(chardev_t *dev, char ch)
280	{	280	{
281	spinlock_lock(&fb_lock);	281	spinlock_lock(&fb_lock);
282		282
283	switch (ch) {	283	switch (ch) {
284	case '\n':	284	case '\n':
285	cursor_remove();	285	cursor_remove();
286	position += cols;	286	position += cols;
287	position -= position % cols;	287	position -= position % cols;
288	break;	288	break;
289	case '\r':	289	case '\r':
290	cursor_remove();	290	cursor_remove();
291	position -= position % cols;	291	position -= position % cols;
292	break;	292	break;
293	case '\b':	293	case '\b':
294	cursor_remove();	294	cursor_remove();
295	if (position % cols)	295	if (position % cols)
296	position--;	296	position--;
297	break;	297	break;
298	case '\t':	298	case '\t':
299	cursor_remove();	299	cursor_remove();
300	do {	300	do {
301	glyph_draw((uint8_t) ' ', position % cols,	301	glyph_draw((uint8_t) ' ', position % cols,
302	position / cols);	302	position / cols);
303	position++;	303	position++;
304	} while ((position % 8) && (position < cols * rows));	304	} while ((position % 8) && (position < cols * rows));
305	break;	305	break;
306	default:	306	default:
307	glyph_draw((uint8_t) ch, position % cols, position / cols);	307	glyph_draw((uint8_t) ch, position % cols, position / cols);
308	position++;	308	position++;
309	}	309	}
310		310
311	if (position >= cols * rows) {	311	if (position >= cols * rows) {
312	position -= cols;	312	position -= cols;
313	screen_scroll();	313	screen_scroll();
314	}	314	}
315		315
316	cursor_put();	316	cursor_put();
317		317
318	spinlock_unlock(&fb_lock);	318	spinlock_unlock(&fb_lock);
319	}	319	}
320		320
321	static chardev_t framebuffer;	321	static chardev_t framebuffer;
322	static chardev_operations_t fb_ops = {	322	static chardev_operations_t fb_ops = {
323	.write = fb_putchar,	323	.write = fb_putchar,
324	};	324	};
325		325
326		326
327	/** Render glyphs	327	/** Render glyphs
328	*	328	*
329	* Convert glyphs from device independent font	329	* Convert glyphs from device independent font
330	* description to current visual representation.	330	* description to current visual representation.
331	*	331	*
332	*/	332	*/
333	static void glyphs_render(void)	333	static void glyphs_render(void)
334	{	334	{
335	/* Prerender glyphs */	335	/* Prerender glyphs */
336	unsigned int glyph;	336	unsigned int glyph;
337		337
338	for (glyph = 0; glyph < FONT_GLYPHS; glyph++) {	338	for (glyph = 0; glyph < FONT_GLYPHS; glyph++) {
339	unsigned int y;	339	unsigned int y;
340		340
341	for (y = 0; y < FONT_SCANLINES; y++) {	341	for (y = 0; y < FONT_SCANLINES; y++) {
342	unsigned int x;	342	unsigned int x;
343		343
344	for (x = 0; x < FONT_WIDTH; x++) {	344	for (x = 0; x < FONT_WIDTH; x++) {
345	void *dst = &glyphs[GLYPH_POS(glyph, y) +	345	void *dst = &glyphs[GLYPH_POS(glyph, y) +
346	x * pixelbytes];	346	x * pixelbytes];
347	uint32_t rgb = (fb_font[ROW2Y(glyph) + y] &	347	uint32_t rgb = (fb_font[ROW2Y(glyph) + y] &
348	(1 << (7 - x))) ? FG_COLOR : BG_COLOR;	348	(1 << (7 - x))) ? FG_COLOR : BG_COLOR;
349	rgb_conv(dst, rgb);	349	rgb_conv(dst, rgb);
350	}	350	}
351	}	351	}
352	}	352	}
353		353
354	/* Prerender background scanline */	354	/* Prerender background scanline */
355	unsigned int x;	355	unsigned int x;
356		356
357	for (x = 0; x < xres; x++)	357	for (x = 0; x < xres; x++)
358	rgb_conv(&bgscan[x * pixelbytes], BG_COLOR);	358	rgb_conv(&bgscan[x * pixelbytes], BG_COLOR);
359	}	359	}
360		360
361		361
362	/** Refresh the screen	362	/** Refresh the screen
363	*	363	*
364	*/	364	*/
365	void fb_redraw(void)	365	void fb_redraw(void)
366	{	366	{
367	if (ylogo > 0) {	367	if (ylogo > 0) {
368	unsigned int y;	368	unsigned int y;
369		369
370	for (y = 0; y < LOGO_HEIGHT; y++) {	370	for (y = 0; y < LOGO_HEIGHT; y++) {
371	unsigned int x;	371	unsigned int x;
372		372
373	for (x = 0; x < xres; x++)	373	for (x = 0; x < xres; x++)
374	rgb_conv(&fb_addr[FB_POS(x, y)],	374	rgb_conv(&fb_addr[FB_POS(x, y)],
375	(x < LOGO_WIDTH) ?	375	(x < LOGO_WIDTH) ?
376	fb_logo[y * LOGO_WIDTH + x] :	376	fb_logo[y * LOGO_WIDTH + x] :
377	LOGO_COLOR);	377	LOGO_COLOR);
378	}	378	}
379	}	379	}
380		380
381	unsigned int row;	381	unsigned int row;
382		382
383	for (row = 0; row < rowtrim; row++) {	383	for (row = 0; row < rowtrim; row++) {
384	unsigned int y = ylogo + ROW2Y(row);	384	unsigned int y = ylogo + ROW2Y(row);
385	unsigned int yd;	385	unsigned int yd;
386		386
387	for (yd = 0; yd < FONT_SCANLINES; yd++) {	387	for (yd = 0; yd < FONT_SCANLINES; yd++) {
388	unsigned int x;	388	unsigned int x;
389	unsigned int col;	389	unsigned int col;
390		390
391	for (col = 0, x = 0; col < cols;	391	for (col = 0, x = 0; col < cols;
392	col++, x += FONT_WIDTH) {	392	col++, x += FONT_WIDTH) {
393	void *d = &fb_addr[FB_POS(x, y + yd)];	393	void *d = &fb_addr[FB_POS(x, y + yd)];
394	void *s = &glyphs[GLYPH_POS(backbuf[BB_POS(col,	394	void *s = &glyphs[GLYPH_POS(backbuf[BB_POS(col,
395	row)], yd)];	395	row)], yd)];
396	memcpy(d, s, glyphscanline);	396	memcpy(d, s, glyphscanline);
397	}	397	}
398	}	398	}
399	}	399	}
400		400
401	if (COL2X(cols) < xres) {	401	if (COL2X(cols) < xres) {
402	unsigned int y;	402	unsigned int y;
403	unsigned int size = (xres - COL2X(cols)) * pixelbytes;	403	unsigned int size = (xres - COL2X(cols)) * pixelbytes;
404		404
405	for (y = ylogo; y < yres; y++)	405	for (y = ylogo; y < yres; y++)
406	memcpy(&fb_addr[FB_POS(COL2X(cols), y)], bgscan, size);	406	memcpy(&fb_addr[FB_POS(COL2X(cols), y)], bgscan, size);
407	}	407	}
408		408
409	if (ROW2Y(rowtrim) + ylogo < yres) {	409	if (ROW2Y(rowtrim) + ylogo < yres) {
410	unsigned int y;	410	unsigned int y;
411		411
412	for (y = ROW2Y(rowtrim) + ylogo; y < yres; y++)	412	for (y = ROW2Y(rowtrim) + ylogo; y < yres; y++)
413	memcpy(&fb_addr[FB_POS(0, y)], bgscan, bgscanbytes);	413	memcpy(&fb_addr[FB_POS(0, y)], bgscan, bgscanbytes);
414	}	414	}
415	}	415	}
416		416
417		417
418	/** Initialize framebuffer as a chardev output device	418	/** Initialize framebuffer as a chardev output device
419	*	419	*
420	* @param addr Physical address of the framebuffer	420	* @param addr Physical address of the framebuffer
421	* @param x Screen width in pixels	421	* @param x Screen width in pixels
422	* @param y Screen height in pixels	422	* @param y Screen height in pixels
423	* @param scan Bytes per one scanline	423	* @param scan Bytes per one scanline
424	* @param visual Color model	424	* @param visual Color model
425	*	425	*
426	*/	426	*/
427	void fb_init(fb_properties_t *props)	427	void fb_init(fb_properties_t *props)
428	{	428	{
429	switch (props->visual) {	429	switch (props->visual) {
430	case VISUAL_INDIRECT_8:	430	case VISUAL_INDIRECT_8:
431	rgb_conv = rgb_323;	431	rgb_conv = rgb_323;
432	pixelbytes = 1;	432	pixelbytes = 1;
433	break;	433	break;
434	case VISUAL_RGB_5_5_5:	434	case VISUAL_RGB_5_5_5:
435	rgb_conv = rgb_555;	435	rgb_conv = rgb_555;
436	pixelbytes = 2;	436	pixelbytes = 2;
437	break;	437	break;
438	case VISUAL_RGB_5_6_5:	438	case VISUAL_RGB_5_6_5:
439	rgb_conv = rgb_565;	439	rgb_conv = rgb_565;
440	pixelbytes = 2;	440	pixelbytes = 2;
441	break;	441	break;
442	case VISUAL_RGB_8_8_8:	442	case VISUAL_RGB_8_8_8:
443	rgb_conv = rgb_888;	443	rgb_conv = rgb_888;
444	pixelbytes = 3;	444	pixelbytes = 3;
445	break;	445	break;
446	case VISUAL_RGB_8_8_8_0:	446	case VISUAL_RGB_8_8_8_0:
447	rgb_conv = rgb_888;	447	rgb_conv = rgb_888;
448	pixelbytes = 4;	448	pixelbytes = 4;
449	break;	449	break;
450	case VISUAL_RGB_0_8_8_8:	450	case VISUAL_RGB_0_8_8_8:
451	rgb_conv = rgb_0888;	451	rgb_conv = rgb_0888;
452	pixelbytes = 4;	452	pixelbytes = 4;
453	break;	453	break;
454	case VISUAL_BGR_0_8_8_8:	454	case VISUAL_BGR_0_8_8_8:
455	rgb_conv = bgr_0888;	455	rgb_conv = bgr_0888;
456	pixelbytes = 4;	456	pixelbytes = 4;
457	break;	457	break;
458	default:	458	default:
459	panic("Unsupported visual.\n");	459	panic("Unsupported visual.");
460	}	460	}
461		461
462	xres = props->x;	462	xres = props->x;
463	yres = props->y;	463	yres = props->y;
464	scanline = props->scan;	464	scanline = props->scan;
465		465
466	cols = X2COL(xres);	466	cols = X2COL(xres);
467	rows = Y2ROW(yres);	467	rows = Y2ROW(yres);
468		468
469	if (yres > ylogo) {	469	if (yres > ylogo) {
470	ylogo = LOGO_HEIGHT;	470	ylogo = LOGO_HEIGHT;
471	rowtrim = rows - Y2ROW(ylogo);	471	rowtrim = rows - Y2ROW(ylogo);
472	if (ylogo % FONT_SCANLINES > 0)	472	if (ylogo % FONT_SCANLINES > 0)
473	rowtrim--;	473	rowtrim--;
474	ytrim = ROW2Y(rowtrim);	474	ytrim = ROW2Y(rowtrim);
475	} else {	475	} else {
476	ylogo = 0;	476	ylogo = 0;
477	ytrim = yres;	477	ytrim = yres;
478	rowtrim = rows;	478	rowtrim = rows;
479	}	479	}
480		480
481	glyphscanline = FONT_WIDTH * pixelbytes;	481	glyphscanline = FONT_WIDTH * pixelbytes;
482	glyphbytes = ROW2Y(glyphscanline);	482	glyphbytes = ROW2Y(glyphscanline);
483	bgscanbytes = xres * pixelbytes;	483	bgscanbytes = xres * pixelbytes;
484		484
485	unsigned int fbsize = scanline * yres;	485	unsigned int fbsize = scanline * yres;
486	unsigned int bbsize = cols * rows;	486	unsigned int bbsize = cols * rows;
487	unsigned int glyphsize = FONT_GLYPHS * glyphbytes;	487	unsigned int glyphsize = FONT_GLYPHS * glyphbytes;
488		488
489	backbuf = (uint8_t *) malloc(bbsize, 0);	489	backbuf = (uint8_t *) malloc(bbsize, 0);
490	if (!backbuf)	490	if (!backbuf)
491	panic("Unable to allocate backbuffer.\n");	491	panic("Unable to allocate backbuffer.");
492		492
493	glyphs = (uint8_t *) malloc(glyphsize, 0);	493	glyphs = (uint8_t *) malloc(glyphsize, 0);
494	if (!glyphs)	494	if (!glyphs)
495	panic("Unable to allocate glyphs.\n");	495	panic("Unable to allocate glyphs.");
496		496
497	bgscan = malloc(bgscanbytes, 0);	497	bgscan = malloc(bgscanbytes, 0);
498	if (!bgscan)	498	if (!bgscan)
499	panic("Unable to allocate background pixel.\n");	499	panic("Unable to allocate background pixel.");
500		500

Subversion Repositories HelenOS

(root)/trunk/kernel/genarch/src/fb/fb.c – Rev 3752 → 3790