WebSVN – HelenOS – Diff – /branches/sparc/kernel/genarch/src/fb/fb.c


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

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

Subversion Repositories HelenOS

(root)/branches/sparc/kernel/genarch/src/fb/fb.c @ 3747 – Rev 1837 → 1869