Subversion Repositories HelenOS

/*

 * 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 <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 __u8 *fbaddress = NULL;

static __u8 *blankline = NULL;

static __u8 *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)

{

	__u8 *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)

{

	__u8 *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 */ 

	*((__u16 *)(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 = *(__u16 *)(src);

	return (((color >> 11) & 0x1f) << (16 + 3)) | (((color >> 5) & 0x3f) << (8 + 2)) | ((color & 0x1f) << 3);

}

/** Put pixel - 8-bit depth (3:2:3) */

static void rgb_1byte(void *dst, int rgb)

{

	*(__u8 *)dst = RED(rgb, 3) << 5 | GREEN(rgb, 2) << 3 | BLUE(rgb, 3);

}

/** Return pixel color - 8-bit depth (3:2:3) */

static int byte1_rgb(void *src)

{

	int color = *(__u8 *)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)

{

	__u8 *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(__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 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

 *

 */

void fb_init(__address addr, unsigned int x, unsigned int y, unsigned int bpp, unsigned int scan)

{

	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;

			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 = (__u8 *) hw_map((__address) addr, fbsize);

	xres = x;

	yres = y;

	bitspp = bpp;

	scanline = scan;

	rows = y / FONT_SCANLINES;

	columns = x / COL_WIDTH;

	/* Allocate double buffer */

	int totsize = scanline * yres;

	int pages = SIZE2FRAMES(totsize);

	int order;

	int rc;

	if (pages == 1)

		order = 0;

	else

		order = fnzb(pages-1)+1;

	pfn_t frame = frame_alloc_rc(order,FRAME_ATOMIC,&rc);

	if (!rc)

		dbbuffer = (void *)PA2KA(PFN2ADDR(frame));

	else 

		printf("Failed to allocate scroll buffer.\n");

	dboffset = 0;

	/* Initialized blank line */

	blankline = (__u8 *) malloc(ROW_BYTES, FRAME_ATOMIC);

	ASSERT(blankline);

	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;

	sysinfo_set_item_val("fb", NULL, true);

	sysinfo_set_item_val("fb.kind", NULL, 1);

	sysinfo_set_item_val("fb.width", NULL, x);

	sysinfo_set_item_val("fb.height", NULL, y);

	sysinfo_set_item_val("fb.bpp", NULL, bpp);

	sysinfo_set_item_val("fb.scanline", NULL, scan);

	sysinfo_set_item_val("fb.address.physical", NULL, addr);

}