WebSVN – HelenOS – Diff – /branches/sparc/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);
            }
        }
    }
   
    memcpy(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.\n");
    }
   
    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.\n");
   
    glyphs = (uint8_t *) malloc(glyphsize, 0);
    if (!glyphs)
        panic("Unable to allocate glyphs.\n");
   
    bgscan = malloc(bgscanbytes, 0);
    if (!bgscan)
        panic("Unable to allocate background pixel.\n");
   
    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 3742	Rev 3745
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;
-		225	}
224		226
225	unsigned int row;	227	unsigned int row;
226		228
227	for (row = 0; row < rows; row++) {	229	for (row = 0; row < rows; row++) {
228	unsigned int y = ROW2Y(row);	230	unsigned int y = ROW2Y(row);
229	unsigned int yd;	231	unsigned int yd;
230		232
231	for (yd = 0; yd < FONT_SCANLINES; yd++) {	233	for (yd = 0; yd < FONT_SCANLINES; yd++) {
232	unsigned int x;	234	unsigned int x;
233	unsigned int col;	235	unsigned int col;
234		236
235	for (col = 0, x = 0; col < cols; col++, x += FONT_WIDTH) {	237	for (col = 0, x = 0; col < cols; col++,
-		238	x += FONT_WIDTH) {
236	uint8_t glyph;	239	uint8_t glyph;
237		240
238	if (row < rows - 1) {	241	if (row < rows - 1) {
-		242	if (backbuf[BB_POS(col, row)] ==
239	if (backbuf[BB_POS(col, row)] == backbuf[BB_POS(col, row + 1)])	243	backbuf[BB_POS(col, row + 1)])
240	continue;	244	continue;
241		245
242	glyph = backbuf[BB_POS(col, row + 1)];	246	glyph = backbuf[BB_POS(col, row + 1)];
243	} else	247	} else
244	glyph = 0;	248	glyph = 0;
245		249
246	memcpy(&fb_addr[FB_POS(x, y + yd)],	250	memcpy(&fb_addr[FB_POS(x, y + yd)],
247	&glyphs[GLYPH_POS(glyph, yd)], glyphscanline);	251	&glyphs[GLYPH_POS(glyph, yd)],
-		252	glyphscanline);
248	}	253	}
249	}	254	}
250	}	255	}
251		256
252	memcpy(backbuf, backbuf + cols, cols * (rows - 1));	257	memcpy(backbuf, backbuf + cols, cols * (rows - 1));
253	memsetb(&backbuf[BB_POS(0, rows - 1)], cols, 0);	258	memsetb(&backbuf[BB_POS(0, rows - 1)], cols, 0);
254	}	259	}
255		260
256		261
257	static void cursor_put(void)	262	static void cursor_put(void)
258	{	263	{
259	glyph_draw(CURSOR, position % cols, position / cols);	264	glyph_draw(CURSOR, position % cols, position / cols);
260	}	265	}
261		266
262		267
263	static void cursor_remove(void)	268	static void cursor_remove(void)
264	{	269	{
265	glyph_draw(0, position % cols, position / cols);	270	glyph_draw(0, position % cols, position / cols);
266	}	271	}
267		272
268		273
269	/** Print character to screen	274	/** Print character to screen
270	*	275	*
271	* Emulate basic terminal commands.	276	* Emulate basic terminal commands.
272	*	277	*
273	*/	278	*/
274	static void fb_putchar(chardev_t *dev, char ch)	279	static void fb_putchar(chardev_t *dev, char ch)
275	{	280	{
276	spinlock_lock(&fb_lock);	281	spinlock_lock(&fb_lock);
277		282
278	switch (ch) {	283	switch (ch) {
279	case '\n':	284	case '\n':
280	cursor_remove();	285	cursor_remove();
281	position += cols;	286	position += cols;
282	position -= position % cols;	287	position -= position % cols;
283	break;	288	break;
284	case '\r':	289	case '\r':
285	cursor_remove();	290	cursor_remove();
286	position -= position % cols;	291	position -= position % cols;
287	break;	292	break;
288	case '\b':	293	case '\b':
289	cursor_remove();	294	cursor_remove();
290	if (position % cols)	295	if (position % cols)
291	position--;	296	position--;
292	break;	297	break;
293	case '\t':	298	case '\t':
294	cursor_remove();	299	cursor_remove();
295	do {	300	do {
296	glyph_draw((uint8_t) ' ', position % cols, position / cols);	301	glyph_draw((uint8_t) ' ', position % cols,
-		302	position / cols);
297	position++;	303	position++;
298	} while ((position % 8) && (position < cols * rows));	304	} while ((position % 8) && (position < cols * rows));
299	break;	305	break;
300	default:	306	default:
301	glyph_draw((uint8_t) ch, position % cols, position / cols);	307	glyph_draw((uint8_t) ch, position % cols, position / cols);
302	position++;	308	position++;
303	}	309	}
304		310
305	if (position >= cols * rows) {	311	if (position >= cols * rows) {
306	position -= cols;	312	position -= cols;
307	screen_scroll();	313	screen_scroll();
308	}	314	}
309		315
310	cursor_put();	316	cursor_put();
311		317
312	spinlock_unlock(&fb_lock);	318	spinlock_unlock(&fb_lock);
313	}	319	}
314		320
315	static chardev_t framebuffer;	321	static chardev_t framebuffer;
316	static chardev_operations_t fb_ops = {	322	static chardev_operations_t fb_ops = {
317	.write = fb_putchar,	323	.write = fb_putchar,
318	};	324	};
319		325
320		326
321	/** Render glyphs	327	/** Render glyphs
322	*	328	*
323	* Convert glyphs from device independent font	329	* Convert glyphs from device independent font
324	* description to current visual representation.	330	* description to current visual representation.
325	*	331	*
326	*/	332	*/
327	static void glyphs_render(void)	333	static void glyphs_render(void)
328	{	334	{
329	/* Prerender glyphs */	335	/* Prerender glyphs */
330	unsigned int glyph;	336	unsigned int glyph;
331		337
332	for (glyph = 0; glyph < FONT_GLYPHS; glyph++) {	338	for (glyph = 0; glyph < FONT_GLYPHS; glyph++) {
333	unsigned int y;	339	unsigned int y;
334		340
335	for (y = 0; y < FONT_SCANLINES; y++) {	341	for (y = 0; y < FONT_SCANLINES; y++) {
336	unsigned int x;	342	unsigned int x;
337		343
338	for (x = 0; x < FONT_WIDTH; x++)	344	for (x = 0; x < FONT_WIDTH; x++) {
339	rgb_conv(&glyphs[GLYPH_POS(glyph, y) + x * pixelbytes],	345	void *dst = &glyphs[GLYPH_POS(glyph, y) +
-		346	x * pixelbytes];
-		347	uint32_t rgb = (fb_font[ROW2Y(glyph) + y] &
340	(fb_font[ROW2Y(glyph) + y] & (1 << (7 - x))) ? FG_COLOR : BG_COLOR);	348	(1 << (7 - x))) ? FG_COLOR : BG_COLOR;
-		349	rgb_conv(dst, rgb);
-		350	}
341	}	351	}
342	}	352	}
343		353
344	/* Prerender background scanline */	354	/* Prerender background scanline */
345	unsigned int x;	355	unsigned int x;
346		356
347	for (x = 0; x < xres; x++)	357	for (x = 0; x < xres; x++)
348	rgb_conv(&bgscan[x * pixelbytes], BG_COLOR);	358	rgb_conv(&bgscan[x * pixelbytes], BG_COLOR);
349	}	359	}
350		360
351		361
352	/** Refresh the screen	362	/** Refresh the screen
353	*	363	*
354	*/	364	*/
355	void fb_redraw(void)	365	void fb_redraw(void)
356	{	366	{
357	if (ylogo > 0) {	367	if (ylogo > 0) {
358	unsigned int y;	368	unsigned int y;
359		369
360	for (y = 0; y < LOGO_HEIGHT; y++) {	370	for (y = 0; y < LOGO_HEIGHT; y++) {
361	unsigned int x;	371	unsigned int x;
362		372
363	for (x = 0; x < xres; x++)	373	for (x = 0; x < xres; x++)
364	rgb_conv(&fb_addr[FB_POS(x, y)],	374	rgb_conv(&fb_addr[FB_POS(x, y)],
-		375	(x < LOGO_WIDTH) ?
365	(x < LOGO_WIDTH) ? fb_logo[y * LOGO_WIDTH + x] : LOGO_COLOR);	376	fb_logo[y * LOGO_WIDTH + x] :
-		377	LOGO_COLOR);
366	}	378	}
367	}	379	}
368		380
369	unsigned int row;	381	unsigned int row;
370		382
371	for (row = 0; row < rowtrim; row++) {	383	for (row = 0; row < rowtrim; row++) {
372	unsigned int y = ylogo + ROW2Y(row);	384	unsigned int y = ylogo + ROW2Y(row);
373	unsigned int yd;	385	unsigned int yd;
374		386
375	for (yd = 0; yd < FONT_SCANLINES; yd++) {	387	for (yd = 0; yd < FONT_SCANLINES; yd++) {
376	unsigned int x;	388	unsigned int x;
377	unsigned int col;	389	unsigned int col;
378		390
379	for (col = 0, x = 0; col < cols; col++, x += FONT_WIDTH)	391	for (col = 0, x = 0; col < cols;
-		392	col++, x += FONT_WIDTH) {
380	memcpy(&fb_addr[FB_POS(x, y + yd)],	393	void *d = &fb_addr[FB_POS(x, y + yd)];
381	&glyphs[GLYPH_POS(backbuf[BB_POS(col, row)], yd)],	394	void *s = &glyphs[GLYPH_POS(backbuf[BB_POS(col,
-		395	row)], yd)];
382	glyphscanline);	396	memcpy(d, s, glyphscanline);
-		397	}
383	}	398	}
384	}	399	}
385		400
386	if (COL2X(cols) < xres) {	401	if (COL2X(cols) < xres) {
387	unsigned int y;	402	unsigned int y;
388	unsigned int size = (xres - COL2X(cols)) * pixelbytes;	403	unsigned int size = (xres - COL2X(cols)) * pixelbytes;
389		404
390	for (y = ylogo; y < yres; y++)	405	for (y = ylogo; y < yres; y++)
391	memcpy(&fb_addr[FB_POS(COL2X(cols), y)], bgscan, size);	406	memcpy(&fb_addr[FB_POS(COL2X(cols), y)], bgscan, size);
392	}	407	}
393		408
394	if (ROW2Y(rowtrim) < yres) {	409	if (ROW2Y(rowtrim) + ylogo < yres) {
395	unsigned int y;	410	unsigned int y;
396		411
397	for (y = ROW2Y(rowtrim); y < yres; y++)	412	for (y = ROW2Y(rowtrim) + ylogo; y < yres; y++)
398	memcpy(&fb_addr[FB_POS(0, y)], bgscan, bgscanbytes);	413	memcpy(&fb_addr[FB_POS(0, y)], bgscan, bgscanbytes);
399	}	414	}
400	}	415	}
401		416
402		417
403	/** Initialize framebuffer as a chardev output device	418	/** Initialize framebuffer as a chardev output device
404	*	419	*
405	* @param addr Physical address of the framebuffer	420	* @param addr Physical address of the framebuffer
406	* @param x Screen width in pixels	421	* @param x Screen width in pixels
407	* @param y Screen height in pixels	422	* @param y Screen height in pixels
408	* @param scan Bytes per one scanline	423	* @param scan Bytes per one scanline
409	* @param visual Color model	424	* @param visual Color model
410	*	425	*
411	*/	426	*/
412	void fb_init(fb_properties_t *props)	427	void fb_init(fb_properties_t *props)
413	{	428	{
414	switch (props->visual) {	429	switch (props->visual) {
415	case VISUAL_INDIRECT_8:	430	case VISUAL_INDIRECT_8:
416	rgb_conv = rgb_323;	431	rgb_conv = rgb_323;
417	pixelbytes = 1;	432	pixelbytes = 1;
418	break;	433	break;
419	case VISUAL_RGB_5_5_5:	434	case VISUAL_RGB_5_5_5:
420	rgb_conv = rgb_555;	435	rgb_conv = rgb_555;
421	pixelbytes = 2;	436	pixelbytes = 2;
422	break;	437	break;
423	case VISUAL_RGB_5_6_5:	438	case VISUAL_RGB_5_6_5:
424	rgb_conv = rgb_565;	439	rgb_conv = rgb_565;
425	pixelbytes = 2;	440	pixelbytes = 2;
426	break;	441	break;
427	case VISUAL_RGB_8_8_8:	442	case VISUAL_RGB_8_8_8:
428	rgb_conv = rgb_888;	443	rgb_conv = rgb_888;
429	pixelbytes = 3;	444	pixelbytes = 3;
430	break;	445	break;
431	case VISUAL_RGB_8_8_8_0:	446	case VISUAL_RGB_8_8_8_0:
432	rgb_conv = rgb_888;	447	rgb_conv = rgb_888;
433	pixelbytes = 4;	448	pixelbytes = 4;
434	break;	449	break;
435	case VISUAL_RGB_0_8_8_8:	450	case VISUAL_RGB_0_8_8_8:
436	rgb_conv = rgb_0888;	451	rgb_conv = rgb_0888;
437	pixelbytes = 4;	452	pixelbytes = 4;
438	break;	453	break;
439	case VISUAL_BGR_0_8_8_8:	454	case VISUAL_BGR_0_8_8_8:
440	rgb_conv = bgr_0888;	455	rgb_conv = bgr_0888;
441	pixelbytes = 4;	456	pixelbytes = 4;
442	break;	457	break;
443	default:	458	default:
444	panic("Unsupported visual.\n");	459	panic("Unsupported visual.\n");
445	}	460	}
446		461
447	xres = props->x;	462	xres = props->x;
448	yres = props->y;	463	yres = props->y;
449	scanline = props->scan;	464	scanline = props->scan;
450		465
451	cols = X2COL(xres);	466	cols = X2COL(xres);
452	rows = Y2ROW(yres);	467	rows = Y2ROW(yres);
453		468
454	if (yres > ylogo) {	469	if (yres > ylogo) {
455	ylogo = LOGO_HEIGHT;	470	ylogo = LOGO_HEIGHT;
456	rowtrim = rows - Y2ROW(ylogo);	471	rowtrim = rows - Y2ROW(ylogo);
457	if (ylogo % FONT_SCANLINES > 0)	472	if (ylogo % FONT_SCANLINES > 0)
458	rowtrim--;	473	rowtrim--;
459	ytrim = ROW2Y(rowtrim);	474	ytrim = ROW2Y(rowtrim);
460	} else {	475	} else {
461	ylogo = 0;	476	ylogo = 0;
462	ytrim = yres;	477	ytrim = yres;
463	rowtrim = rows;	478	rowtrim = rows;
464	}	479	}
465		480
466	glyphscanline = FONT_WIDTH * pixelbytes;	481	glyphscanline = FONT_WIDTH * pixelbytes;
467	glyphbytes = ROW2Y(glyphscanline);	482	glyphbytes = ROW2Y(glyphscanline);
468	bgscanbytes = xres * pixelbytes;	483	bgscanbytes = xres * pixelbytes;
469		484
470	unsigned int fbsize = scanline * yres;	485	unsigned int fbsize = scanline * yres;
471	unsigned int bbsize = cols * rows;	486	unsigned int bbsize = cols * rows;
472	unsigned int glyphsize = FONT_GLYPHS * glyphbytes;	487	unsigned int glyphsize = FONT_GLYPHS * glyphbytes;
473		488
474	backbuf = (uint8_t *) malloc(bbsize, 0);	489	backbuf = (uint8_t *) malloc(bbsize, 0);
475	if (!backbuf)	490	if (!backbuf)
476	panic("Unable to allocate backbuffer.\n");	491	panic("Unable to allocate backbuffer.\n");
477		492
478	glyphs = (uint8_t *) malloc(glyphsize, 0);	493	glyphs = (uint8_t *) malloc(glyphsize, 0);
479	if (!glyphs)	494	if (!glyphs)
480	panic("Unable to allocate glyphs.\n");	495	panic("Unable to allocate glyphs.\n");
481		496
482	bgscan = malloc(bgscanbytes, 0);	497	bgscan = malloc(bgscanbytes, 0);
483	if (!bgscan)	498	if (!bgscan)
484	panic("Unable to allocate background pixel.\n");	499	panic("Unable to allocate background pixel.\n");
485		500

Subversion Repositories HelenOS

(root)/branches/sparc/kernel/genarch/src/fb/fb.c – Rev 3742 → 3745