WebSVN – HelenOS-historic – Diff – /kernel/trunk/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.
 */
 
#include <genarch/fb/font-8x16.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 "helenos.xbm"
 
SPINLOCK_INITIALIZE(fb_lock);
 
static __u8 *fbaddress = NULL;
 
static __u8 *blankline = NULL;
 
static unsigned int xres = 0;
static unsigned int yres = 0;
static unsigned int scanline = 0;
static unsigned int pixelbytes = 0;
 
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 (*putpixel)(unsigned int x, unsigned int y, int color);
static int (*getpixel)(unsigned int x, unsigned int y);
 
/** Put pixel - 24-bit depth, 1 free byte */
static void putpixel_4byte(unsigned int x, unsigned int y, int color)
{
    *((__u32 *)(fbaddress + POINTPOS(x, y))) = color;
}
 
/** Return pixel color - 24-bit depth, 1 free byte */
static int getpixel_4byte(unsigned int x, unsigned int y)
{
    return *((__u32 *)(fbaddress + POINTPOS(x, y))) & 0xffffff;
}
 
/** Put pixel - 24-bit depth */
static void putpixel_3byte(unsigned int x, unsigned int y, int color)
{
    unsigned int startbyte = POINTPOS(x, y);
 
#ifdef BIG_ENDIAN
    fbaddress[startbyte] = RED(color, 8);
    fbaddress[startbyte + 1] = GREEN(color, 8);
    fbaddress[startbyte + 2] = BLUE(color, 8);
#else
    fbaddress[startbyte + 2] = RED(color, 8);
    fbaddress[startbyte + 1] = GREEN(color, 8);
    fbaddress[startbyte + 0] = BLUE(color, 8);
#endif  
}
 
/** Return pixel color - 24-bit depth */
static int getpixel_3byte(unsigned int x, unsigned int y)
{
    unsigned int startbyte = POINTPOS(x, y);
 
#ifdef BIG_ENDIAN
    return fbaddress[startbyte] << 16 | fbaddress[startbyte + 1] << 8 | fbaddress[startbyte + 2];
#else
    return fbaddress[startbyte + 2] << 16 | fbaddress[startbyte + 1] << 8 | fbaddress[startbyte + 0];
#endif  
}
 
/** Put pixel - 16-bit depth (5:6:6) */
static void putpixel_2byte(unsigned int x, unsigned int y, int color)
{
    /* 5-bit, 5-bits, 5-bits */
    *((__u16 *)(fbaddress + POINTPOS(x, y))) = RED(color, 5) << 11 | GREEN(color, 6) << 5 | BLUE(color, 5);
}
 
/** Return pixel color - 16-bit depth (5:6:6) */
static int getpixel_2byte(unsigned int x, unsigned int y)
{
    int color = *((__u16 *)(fbaddress + POINTPOS(x, y)));
    return (((color >> 11) & 0x1f) << (16 + 3)) | (((color >> 5) & 0x3f) << (8 + 2)) | ((color & 0x1f) << 3);
}
 
/** Put pixel - 8-bit depth (3:2:3) */
static void putpixel_1byte(unsigned int x, unsigned int y, int color)
{
    fbaddress[POINTPOS(x, y)] = RED(color, 3) << 5 | GREEN(color, 2) << 3 | BLUE(color, 3);
}
 
/** Return pixel color - 8-bit depth (3:2:3) */
static int getpixel_1byte(unsigned int x, unsigned int y)
{
    int color = fbaddress[POINTPOS(x, y)];
    return (((color >> 5) & 0x7) << (16 + 5)) | (((color >> 3) & 0x3) << (8 + 6)) | ((color & 0x7) << 5);
}
 
/** Fill line with color BGCOLOR */
static void clear_line(unsigned int y)
{
    unsigned int x;
   
    for (x = 0; x < xres; x++)
        (*putpixel)(x, y, BGCOLOR);
}
 
 
/** Fill screen with background color */
static void clear_screen(void)
{
    unsigned int y;
 
    for (y = 0; y < yres; y++)
        clear_line(y);
}
 
 
/** Scroll screen one row up */
static void scroll_screen(void)
{
    unsigned int i;
    __u8 *lastline = &fbaddress[(rows - 1) * ROW_BYTES];
 
    memcpy((void *) fbaddress, (void *) &fbaddress[ROW_BYTES], scanline * yres - ROW_BYTES);
 
    /* Clear last row */
    if (blankline) {
        memcpy((void *) lastline, (void *) blankline, ROW_BYTES);
    } else {
        for (i = 0; i < FONT_SCANLINES; i++)
            clear_line((rows - 1) * FONT_SCANLINES + i);
 
        if (config.mm_initialized) {
            /* Save a blank line aside. */
            blankline = (__u8 *) malloc(ROW_BYTES, FRAME_ATOMIC);
            if (blankline)
                memcpy((void *) blankline, (void *) lastline, 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(__u8 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, 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 Address of theframebuffer
 * @param x    Screen width in pixels
 * @param y    Screen height in pixels
 * @param bpp  Bits per pixel (8, 16, 24, 32)
 * @param scan Bytes per one scanline
 *
 */
void fb_init(__address addr, unsigned int x, unsigned int y, unsigned int bpp, unsigned int scan)
{
    switch (bpp) {
        case 8:
            putpixel = putpixel_1byte;
            getpixel = getpixel_1byte;
            pixelbytes = 1;
            break;
        case 16:
            putpixel = putpixel_2byte;
            getpixel = getpixel_2byte;
            pixelbytes = 2;
            break;
        case 24:
            putpixel = putpixel_3byte;
            getpixel = getpixel_3byte;
            pixelbytes = 3;
            break;
        case 32:
            putpixel = putpixel_4byte;
            getpixel = getpixel_4byte;
            pixelbytes = 4;
            break;
        default:
            panic("Unsupported bpp");
    }
       
    fbaddress = (unsigned char *) addr;
    xres = x;
    yres = y;
    scanline = scan;
   
    rows = y / FONT_SCANLINES;
    columns = x / COL_WIDTH;
 
    clear_screen();
    draw_logo(xres - helenos_width, 0);
    invert_cursor();
 
    chardev_initialize("fb", &framebuffer, &fb_ops);
    stdout = &framebuffer;
   
    sysinfo_set_item_val("Framebuffer",NULL,true);
    sysinfo_set_item_val("Framebuffer.width",NULL,x);
    sysinfo_set_item_val("Framebuffer.height",NULL,y);
    sysinfo_set_item_val("Framebuffer.scanline",NULL,scan);
    sysinfo_set_item_val("Framebuffer.bpp",NULL,bpp);
    sysinfo_set_item_val("Framebuffer.address.virtual",NULL,addr);
   
 
 
}
 

Rev 1317	Rev 1318
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	#include <genarch/fb/font-8x16.h>	29	#include <genarch/fb/font-8x16.h>
30	#include <genarch/fb/fb.h>	30	#include <genarch/fb/fb.h>
31	#include <console/chardev.h>	31	#include <console/chardev.h>
32	#include <console/console.h>	32	#include <console/console.h>
33	#include <sysinfo/sysinfo.h>	33	#include <sysinfo/sysinfo.h>
34	#include <mm/slab.h>	34	#include <mm/slab.h>
35	#include <panic.h>	35	#include <panic.h>
36	#include <memstr.h>	36	#include <memstr.h>
37	#include <config.h>	37	#include <config.h>
38		38
39	#include "helenos.xbm"	39	#include "helenos.xbm"
40		40
41	SPINLOCK_INITIALIZE(fb_lock);	41	SPINLOCK_INITIALIZE(fb_lock);
42		42
43	static __u8 *fbaddress = NULL;	43	static __u8 *fbaddress = NULL;
44		44
45	static __u8 *blankline = NULL;	45	static __u8 *blankline = NULL;
46		46
47	static unsigned int xres = 0;	47	static unsigned int xres = 0;
48	static unsigned int yres = 0;	48	static unsigned int yres = 0;
49	static unsigned int scanline = 0;	49	static unsigned int scanline = 0;
50	static unsigned int pixelbytes = 0;	50	static unsigned int pixelbytes = 0;
51		51
52	static unsigned int position = 0;	52	static unsigned int position = 0;
53	static unsigned int columns = 0;	53	static unsigned int columns = 0;
54	static unsigned int rows = 0;	54	static unsigned int rows = 0;
55		55
56		56
57	#define COL_WIDTH 8	57	#define COL_WIDTH 8
58	#define ROW_BYTES (scanline * FONT_SCANLINES)	58	#define ROW_BYTES (scanline * FONT_SCANLINES)
59		59
60	#define BGCOLOR 0x000080	60	#define BGCOLOR 0x000080
61	#define FGCOLOR 0xffff00	61	#define FGCOLOR 0xffff00
62	#define LOGOCOLOR 0x2020b0	62	#define LOGOCOLOR 0x2020b0
63		63
64	#define RED(x, bits) ((x >> (16 + 8 - bits)) & ((1 << bits) - 1))	64	#define RED(x, bits) ((x >> (16 + 8 - bits)) & ((1 << bits) - 1))
65	#define GREEN(x, bits) ((x >> (8 + 8 - bits)) & ((1 << bits) - 1))	65	#define GREEN(x, bits) ((x >> (8 + 8 - bits)) & ((1 << bits) - 1))
66	#define BLUE(x, bits) ((x >> (8 - bits)) & ((1 << bits) - 1))	66	#define BLUE(x, bits) ((x >> (8 - bits)) & ((1 << bits) - 1))
67		67
68	#define POINTPOS(x, y) (y * scanline + x * pixelbytes)	68	#define POINTPOS(x, y) (y * scanline + x * pixelbytes)
69		69
70	/***************************************************************/	70	/***************************************************************/
71	/* Pixel specific fuctions */	71	/* Pixel specific fuctions */
72		72
73	static void (*putpixel)(unsigned int x, unsigned int y, int color);	73	static void (*putpixel)(unsigned int x, unsigned int y, int color);
74	static int (*getpixel)(unsigned int x, unsigned int y);	74	static int (*getpixel)(unsigned int x, unsigned int y);
75		75
76	/** Put pixel - 24-bit depth, 1 free byte */	76	/** Put pixel - 24-bit depth, 1 free byte */
77	static void putpixel_4byte(unsigned int x, unsigned int y, int color)	77	static void putpixel_4byte(unsigned int x, unsigned int y, int color)
78	{	78	{
79	((__u32 )(fbaddress + POINTPOS(x, y))) = color;	79	((__u32 )(fbaddress + POINTPOS(x, y))) = color;
80	}	80	}
81		81
82	/** Return pixel color - 24-bit depth, 1 free byte */	82	/** Return pixel color - 24-bit depth, 1 free byte */
83	static int getpixel_4byte(unsigned int x, unsigned int y)	83	static int getpixel_4byte(unsigned int x, unsigned int y)
84	{	84	{
85	return ((__u32 )(fbaddress + POINTPOS(x, y))) & 0xffffff;	85	return ((__u32 )(fbaddress + POINTPOS(x, y))) & 0xffffff;
86	}	86	}
87		87
88	/** Put pixel - 24-bit depth */	88	/** Put pixel - 24-bit depth */
89	static void putpixel_3byte(unsigned int x, unsigned int y, int color)	89	static void putpixel_3byte(unsigned int x, unsigned int y, int color)
90	{	90	{
91	unsigned int startbyte = POINTPOS(x, y);	91	unsigned int startbyte = POINTPOS(x, y);
92		92
93	#ifdef BIG_ENDIAN	93	#ifdef BIG_ENDIAN
94	fbaddress[startbyte] = RED(color, 8);	94	fbaddress[startbyte] = RED(color, 8);
95	fbaddress[startbyte + 1] = GREEN(color, 8);	95	fbaddress[startbyte + 1] = GREEN(color, 8);
96	fbaddress[startbyte + 2] = BLUE(color, 8);	96	fbaddress[startbyte + 2] = BLUE(color, 8);
97	#else	97	#else
98	fbaddress[startbyte + 2] = RED(color, 8);	98	fbaddress[startbyte + 2] = RED(color, 8);
99	fbaddress[startbyte + 1] = GREEN(color, 8);	99	fbaddress[startbyte + 1] = GREEN(color, 8);
100	fbaddress[startbyte + 0] = BLUE(color, 8);	100	fbaddress[startbyte + 0] = BLUE(color, 8);
101	#endif	101	#endif
102	}	102	}
103		103
104	/** Return pixel color - 24-bit depth */	104	/** Return pixel color - 24-bit depth */
105	static int getpixel_3byte(unsigned int x, unsigned int y)	105	static int getpixel_3byte(unsigned int x, unsigned int y)
106	{	106	{
107	unsigned int startbyte = POINTPOS(x, y);	107	unsigned int startbyte = POINTPOS(x, y);
108		108
109	#ifdef BIG_ENDIAN	109	#ifdef BIG_ENDIAN
110	return fbaddress[startbyte] << 16 \| fbaddress[startbyte + 1] << 8 \| fbaddress[startbyte + 2];	110	return fbaddress[startbyte] << 16 \| fbaddress[startbyte + 1] << 8 \| fbaddress[startbyte + 2];
111	#else	111	#else
112	return fbaddress[startbyte + 2] << 16 \| fbaddress[startbyte + 1] << 8 \| fbaddress[startbyte + 0];	112	return fbaddress[startbyte + 2] << 16 \| fbaddress[startbyte + 1] << 8 \| fbaddress[startbyte + 0];
113	#endif	113	#endif
114	}	114	}
115		115
116	/** Put pixel - 16-bit depth (5:6:6) */	116	/** Put pixel - 16-bit depth (5:6:6) */
117	static void putpixel_2byte(unsigned int x, unsigned int y, int color)	117	static void putpixel_2byte(unsigned int x, unsigned int y, int color)
118	{	118	{
119	/* 5-bit, 5-bits, 5-bits */	119	/* 5-bit, 5-bits, 5-bits */
120	((__u16 )(fbaddress + POINTPOS(x, y))) = RED(color, 5) << 11 \| GREEN(color, 6) << 5 \| BLUE(color, 5);	120	((__u16 )(fbaddress + POINTPOS(x, y))) = RED(color, 5) << 11 \| GREEN(color, 6) << 5 \| BLUE(color, 5);
121	}	121	}
122		122
123	/** Return pixel color - 16-bit depth (5:6:6) */	123	/** Return pixel color - 16-bit depth (5:6:6) */
124	static int getpixel_2byte(unsigned int x, unsigned int y)	124	static int getpixel_2byte(unsigned int x, unsigned int y)
125	{	125	{
126	int color = ((__u16 )(fbaddress + POINTPOS(x, y)));	126	int color = ((__u16 )(fbaddress + POINTPOS(x, y)));
127	return (((color >> 11) & 0x1f) << (16 + 3)) \| (((color >> 5) & 0x3f) << (8 + 2)) \| ((color & 0x1f) << 3);	127	return (((color >> 11) & 0x1f) << (16 + 3)) \| (((color >> 5) & 0x3f) << (8 + 2)) \| ((color & 0x1f) << 3);
128	}	128	}
129		129
130	/** Put pixel - 8-bit depth (3:2:3) */	130	/** Put pixel - 8-bit depth (3:2:3) */
131	static void putpixel_1byte(unsigned int x, unsigned int y, int color)	131	static void putpixel_1byte(unsigned int x, unsigned int y, int color)
132	{	132	{
133	fbaddress[POINTPOS(x, y)] = RED(color, 3) << 5 \| GREEN(color, 2) << 3 \| BLUE(color, 3);	133	fbaddress[POINTPOS(x, y)] = RED(color, 3) << 5 \| GREEN(color, 2) << 3 \| BLUE(color, 3);
134	}	134	}
135		135
136	/** Return pixel color - 8-bit depth (3:2:3) */	136	/** Return pixel color - 8-bit depth (3:2:3) */
137	static int getpixel_1byte(unsigned int x, unsigned int y)	137	static int getpixel_1byte(unsigned int x, unsigned int y)
138	{	138	{
139	int color = fbaddress[POINTPOS(x, y)];	139	int color = fbaddress[POINTPOS(x, y)];
140	return (((color >> 5) & 0x7) << (16 + 5)) \| (((color >> 3) & 0x3) << (8 + 6)) \| ((color & 0x7) << 5);	140	return (((color >> 5) & 0x7) << (16 + 5)) \| (((color >> 3) & 0x3) << (8 + 6)) \| ((color & 0x7) << 5);
141	}	141	}
142		142
143	/** Fill line with color BGCOLOR */	143	/** Fill line with color BGCOLOR */
144	static void clear_line(unsigned int y)	144	static void clear_line(unsigned int y)
145	{	145	{
146	unsigned int x;	146	unsigned int x;
147		147
148	for (x = 0; x < xres; x++)	148	for (x = 0; x < xres; x++)
149	(*putpixel)(x, y, BGCOLOR);	149	(*putpixel)(x, y, BGCOLOR);
150	}	150	}
151		151
152		152
153	/** Fill screen with background color */	153	/** Fill screen with background color */
154	static void clear_screen(void)	154	static void clear_screen(void)
155	{	155	{
156	unsigned int y;	156	unsigned int y;
157		157
158	for (y = 0; y < yres; y++)	158	for (y = 0; y < yres; y++)
159	clear_line(y);	159	clear_line(y);
160	}	160	}
161		161
162		162
163	/** Scroll screen one row up */	163	/** Scroll screen one row up */
164	static void scroll_screen(void)	164	static void scroll_screen(void)
165	{	165	{
166	unsigned int i;	166	unsigned int i;
167	__u8 lastline = &fbaddress[(rows - 1) ROW_BYTES];	167	__u8 lastline = &fbaddress[(rows - 1) ROW_BYTES];
168		168
169	memcpy((void ) fbaddress, (void ) &fbaddress[ROW_BYTES], scanline * yres - ROW_BYTES);	169	memcpy((void ) fbaddress, (void ) &fbaddress[ROW_BYTES], scanline * yres - ROW_BYTES);
170		170
171	/* Clear last row */	171	/* Clear last row */
172	if (blankline) {	172	if (blankline) {
173	memcpy((void ) lastline, (void ) blankline, ROW_BYTES);	173	memcpy((void ) lastline, (void ) blankline, ROW_BYTES);
174	} else {	174	} else {
175	for (i = 0; i < FONT_SCANLINES; i++)	175	for (i = 0; i < FONT_SCANLINES; i++)
176	clear_line((rows - 1) * FONT_SCANLINES + i);	176	clear_line((rows - 1) * FONT_SCANLINES + i);
177		177
178	if (config.mm_initialized) {	178	if (config.mm_initialized) {
179	/* Save a blank line aside. */	179	/* Save a blank line aside. */
180	blankline = (__u8 *) malloc(ROW_BYTES, FRAME_ATOMIC);	180	blankline = (__u8 *) malloc(ROW_BYTES, FRAME_ATOMIC);
181	if (blankline)	181	if (blankline)
182	memcpy((void ) blankline, (void ) lastline, ROW_BYTES);	182	memcpy((void ) blankline, (void ) lastline, ROW_BYTES);
183	}	183	}
184	}	184	}
185	}	185	}
186		186
187		187
188	static void invert_pixel(unsigned int x, unsigned int y)	188	static void invert_pixel(unsigned int x, unsigned int y)
189	{	189	{
190	(putpixel)(x, y, ~(getpixel)(x, y));	190	(putpixel)(x, y, ~(getpixel)(x, y));
191	}	191	}
192		192
193		193
194	/** Draw one line of glyph at a given position */	194	/** Draw one line of glyph at a given position */
195	static void draw_glyph_line(unsigned int glline, unsigned int x, unsigned int y)	195	static void draw_glyph_line(unsigned int glline, unsigned int x, unsigned int y)
196	{	196	{
197	unsigned int i;	197	unsigned int i;
198		198
199	for (i = 0; i < 8; i++)	199	for (i = 0; i < 8; i++)
200	if (glline & (1 << (7 - i))) {	200	if (glline & (1 << (7 - i))) {
201	(*putpixel)(x + i, y, FGCOLOR);	201	(*putpixel)(x + i, y, FGCOLOR);
202	} else	202	} else
203	(*putpixel)(x + i, y, BGCOLOR);	203	(*putpixel)(x + i, y, BGCOLOR);
204	}	204	}
205		205
206	/***************************************************************/	206	/***************************************************************/
207	/* Character-console functions */	207	/* Character-console functions */
208		208
209	/** Draw character at given position */	209	/** Draw character at given position */
210	static void draw_glyph(__u8 glyph, unsigned int col, unsigned int row)	210	static void draw_glyph(__u8 glyph, unsigned int col, unsigned int row)
211	{	211	{
212	unsigned int y;	212	unsigned int y;
213		213
214	for (y = 0; y < FONT_SCANLINES; y++)	214	for (y = 0; y < FONT_SCANLINES; y++)
215	draw_glyph_line(fb_font[glyph * FONT_SCANLINES + y], col * COL_WIDTH, row * FONT_SCANLINES + y);	215	draw_glyph_line(fb_font[glyph * FONT_SCANLINES + y], col * COL_WIDTH, row * FONT_SCANLINES + y);
216	}	216	}
217		217
218	/** Invert character at given position */	218	/** Invert character at given position */
219	static void invert_char(unsigned int col, unsigned int row)	219	static void invert_char(unsigned int col, unsigned int row)
220	{	220	{
221	unsigned int x;	221	unsigned int x;
222	unsigned int y;	222	unsigned int y;
223		223
224	for (x = 0; x < COL_WIDTH; x++)	224	for (x = 0; x < COL_WIDTH; x++)
225	for (y = 0; y < FONT_SCANLINES; y++)	225	for (y = 0; y < FONT_SCANLINES; y++)
226	invert_pixel(col * COL_WIDTH + x, row * FONT_SCANLINES + y);	226	invert_pixel(col * COL_WIDTH + x, row * FONT_SCANLINES + y);
227	}	227	}
228		228
229	/** Draw character at default position */	229	/** Draw character at default position */
230	static void draw_char(char chr)	230	static void draw_char(char chr)
231	{	231	{
232	draw_glyph(chr, position % columns, position / columns);	232	draw_glyph(chr, position % columns, position / columns);
233	}	233	}
234		234
235	static void draw_logo(unsigned int startx, unsigned int starty)	235	static void draw_logo(unsigned int startx, unsigned int starty)
236	{	236	{
237	unsigned int x;	237	unsigned int x;
238	unsigned int y;	238	unsigned int y;
239	unsigned int byte;	239	unsigned int byte;
240	unsigned int rowbytes;	240	unsigned int rowbytes;
241		241
242	rowbytes = (helenos_width - 1) / 8 + 1;	242	rowbytes = (helenos_width - 1) / 8 + 1;
243		243
244	for (y = 0; y < helenos_height; y++)	244	for (y = 0; y < helenos_height; y++)
245	for (x = 0; x < helenos_width; x++) {	245	for (x = 0; x < helenos_width; x++) {
246	byte = helenos_bits[rowbytes * y + x / 8];	246	byte = helenos_bits[rowbytes * y + x / 8];
247	byte >>= x % 8;	247	byte >>= x % 8;
248	if (byte & 1)	248	if (byte & 1)
249	(*putpixel)(startx + x, starty + y, LOGOCOLOR);	249	(*putpixel)(startx + x, starty + y, LOGOCOLOR);
250	}	250	}
251	}	251	}
252		252
253	/***************************************************************/	253	/***************************************************************/
254	/* Stdout specific functions */	254	/* Stdout specific functions */
255		255
256	static void invert_cursor(void)	256	static void invert_cursor(void)
257	{	257	{
258	invert_char(position % columns, position / columns);	258	invert_char(position % columns, position / columns);
259	}	259	}
260		260
261	/** Print character to screen	261	/** Print character to screen
262	*	262	*
263	* Emulate basic terminal commands	263	* Emulate basic terminal commands
264	*/	264	*/
265	static void fb_putchar(chardev_t *dev, char ch)	265	static void fb_putchar(chardev_t *dev, char ch)
266	{	266	{
267	spinlock_lock(&fb_lock);	267	spinlock_lock(&fb_lock);
268		268
269	switch (ch) {	269	switch (ch) {
270	case '\n':	270	case '\n':
271	invert_cursor();	271	invert_cursor();
272	position += columns;	272	position += columns;
273	position -= position % columns;	273	position -= position % columns;
274	break;	274	break;
275	case '\r':	275	case '\r':
276	invert_cursor();	276	invert_cursor();
277	position -= position % columns;	277	position -= position % columns;
278	break;	278	break;
279	case '\b':	279	case '\b':
280	invert_cursor();	280	invert_cursor();
281	if (position % columns)	281	if (position % columns)
282	position--;	282	position--;
283	break;	283	break;
284	case '\t':	284	case '\t':
285	invert_cursor();	285	invert_cursor();
286	do {	286	do {
287	draw_char(' ');	287	draw_char(' ');
288	position++;	288	position++;
289	} while ((position % 8) && position < columns * rows);	289	} while ((position % 8) && position < columns * rows);
290	break;	290	break;
291	default:	291	default:
292	draw_char(ch);	292	draw_char(ch);
293	position++;	293	position++;
294	}	294	}
295		295
296	if (position >= columns * rows) {	296	if (position >= columns * rows) {
297	position -= columns;	297	position -= columns;
298	scroll_screen();	298	scroll_screen();
299	}	299	}
300		300
301	invert_cursor();	301	invert_cursor();
302		302
303	spinlock_unlock(&fb_lock);	303	spinlock_unlock(&fb_lock);
304	}	304	}
305		305
306	static chardev_t framebuffer;	306	static chardev_t framebuffer;
307	static chardev_operations_t fb_ops = {	307	static chardev_operations_t fb_ops = {
308	.write = fb_putchar,	308	.write = fb_putchar,
309	};	309	};
310		310
311		311
312	/** Initialize framebuffer as a chardev output device	312	/** Initialize framebuffer as a chardev output device
313	*	313	*
314	* @param addr Address of theframebuffer	314	* @param addr Address of theframebuffer
315	* @param x Screen width in pixels	315	* @param x Screen width in pixels
316	* @param y Screen height in pixels	316	* @param y Screen height in pixels
317	* @param bpp Bits per pixel (8, 16, 24, 32)	317	* @param bpp Bits per pixel (8, 16, 24, 32)
318	* @param scan Bytes per one scanline	318	* @param scan Bytes per one scanline
319	*	319	*
320	*/	320	*/
321	void fb_init(__address addr, unsigned int x, unsigned int y, unsigned int bpp, unsigned int scan)	321	void fb_init(__address addr, unsigned int x, unsigned int y, unsigned int bpp, unsigned int scan)
322	{	322	{
323	switch (bpp) {	323	switch (bpp) {
324	case 8:	324	case 8:
325	putpixel = putpixel_1byte;	325	putpixel = putpixel_1byte;
326	getpixel = getpixel_1byte;	326	getpixel = getpixel_1byte;
327	pixelbytes = 1;	327	pixelbytes = 1;
328	break;	328	break;
329	case 16:	329	case 16:
330	putpixel = putpixel_2byte;	330	putpixel = putpixel_2byte;
331	getpixel = getpixel_2byte;	331	getpixel = getpixel_2byte;
332	pixelbytes = 2;	332	pixelbytes = 2;
333	break;	333	break;
334	case 24:	334	case 24:
335	putpixel = putpixel_3byte;	335	putpixel = putpixel_3byte;
336	getpixel = getpixel_3byte;	336	getpixel = getpixel_3byte;
337	pixelbytes = 3;	337	pixelbytes = 3;
338	break;	338	break;
339	case 32:	339	case 32:
340	putpixel = putpixel_4byte;	340	putpixel = putpixel_4byte;
341	getpixel = getpixel_4byte;	341	getpixel = getpixel_4byte;
342	pixelbytes = 4;	342	pixelbytes = 4;
343	break;	343	break;
344	default:	344	default:
345	panic("Unsupported bpp");	345	panic("Unsupported bpp");
346	}	346	}
347		347
348	fbaddress = (unsigned char *) addr;	348	fbaddress = (unsigned char *) addr;
349	xres = x;	349	xres = x;
350	yres = y;	350	yres = y;
351	scanline = scan;	351	scanline = scan;
352		352
353	rows = y / FONT_SCANLINES;	353	rows = y / FONT_SCANLINES;
354	columns = x / COL_WIDTH;	354	columns = x / COL_WIDTH;
355		355
356	clear_screen();	356	clear_screen();
357	draw_logo(xres - helenos_width, 0);	357	draw_logo(xres - helenos_width, 0);
358	invert_cursor();	358	invert_cursor();
359		359
360	chardev_initialize("fb", &framebuffer, &fb_ops);	360	chardev_initialize("fb", &framebuffer, &fb_ops);
361	stdout = &framebuffer;	361	stdout = &framebuffer;
362		362
363	sysinfo_set_item_val("Framebuffer",NULL,true);	363	sysinfo_set_item_val("Framebuffer",NULL,true);
364	sysinfo_set_item_val("Framebuffer.width",NULL,x);	364	sysinfo_set_item_val("Framebuffer.width",NULL,x);
365	sysinfo_set_item_val("Framebuffer.height",NULL,y);	365	sysinfo_set_item_val("Framebuffer.height",NULL,y);
366	sysinfo_set_item_val("Framebuffer.scanline",NULL,scan);	366	sysinfo_set_item_val("Framebuffer.scanline",NULL,scan);
367	sysinfo_set_item_val("Framebuffer.bpp",NULL,bpp);	367	sysinfo_set_item_val("Framebuffer.bpp",NULL,bpp);
368	sysinfo_set_item_val("Framebuffer.address",NULL,addr);	368	sysinfo_set_item_val("Framebuffer.address.virtual",NULL,addr);
369		369
370		370
371		371
372	}	372	}
373		373

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/genarch/src/fb/fb.c – Rev 1317 → 1318