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 <mm/as.h>

#include <bitops.h>

#include <align.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 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 (*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);

#if (defined(BIG_ENDIAN) || defined(FB_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);

#if (defined(BIG_ENDIAN) || defined(FB_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 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:

            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");

    }

    unsigned int fbsize = scan * y;

    unsigned int fborder;

    if (fbsize <= FRAME_SIZE)

        fborder = 0;

    else

        fborder = (fnzb32(fbsize - 1) + 1) - FRAME_WIDTH;

    /* Map the framebuffer */

    fbaddress = (__u8 *) PA2KA(PFN2ADDR(frame_alloc(fborder, FRAME_KA)));

    pfn_t i;

    for (i = 0; i < ADDR2PFN(ALIGN_UP(fbsize, PAGE_SIZE)); i++)

        page_mapping_insert(AS_KERNEL, (__address) fbaddress + PFN2ADDR(i), addr + PFN2ADDR(i), PAGE_NOT_CACHEABLE);

    xres = x;

    yres = y;

    bitspp = bpp;

    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("fb", NULL, true);

    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);

}