source: mainline/uspace/srv/fb/fb.c@ d1e9321

/*
 * Copyright (c) 2006 Jakub Vana
 * 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.
 */

/**
 * @defgroup fb Graphical framebuffer
 * @brief       HelenOS graphical framebuffer.
 * @ingroup fbs
 * @{
 */ 

/** @file
 */

#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <ddi.h>
#include <sysinfo.h>
#include <align.h>
#include <as.h>
#include <ipc/fb.h>
#include <ipc/ipc.h>
#include <ipc/ns.h>
#include <ipc/services.h>
#include <kernel/errno.h>
#include <kernel/genarch/fb/visuals.h>
#include <async.h>
#include <bool.h>

#include "font-8x16.h"
#include "fb.h"
#include "main.h"
#include "../console/screenbuffer.h"
#include "ppm.h"

#include "pointer.xbm"
#include "pointer_mask.xbm"

#define DEFAULT_BGCOLOR                0xf0f0f0
#define DEFAULT_FGCOLOR                0x0

/***************************************************************/
/* Pixel specific fuctions */

typedef void (*conv2scr_fn_t)(void *, int);
typedef int (*conv2rgb_fn_t)(void *);

struct {
        uint8_t *fbaddress;

        unsigned int xres;
        unsigned int yres;
        unsigned int scanline;
        unsigned int pixelbytes;
        unsigned int invert_colors;

        conv2scr_fn_t rgb2scr;
        conv2rgb_fn_t scr2rgb;
} screen;

typedef struct {
        int initialized;
        unsigned int x, y;
        unsigned int width, height;

        /* Text support in window */
        unsigned int rows, cols;
        /* Style for text printing */
        style_t style;
        /* Auto-cursor position */
        int cursor_active, cur_col, cur_row;
        int cursor_shown;
        /* Double buffering */
        uint8_t *dbdata;
        unsigned int dboffset;
        unsigned int paused;
} viewport_t;

#define MAX_ANIM_LEN    8
#define MAX_ANIMATIONS  4
typedef struct {
        int initialized;
        int enabled;
        unsigned int vp;

        unsigned int pos;
        unsigned int animlen;
        unsigned int pixmaps[MAX_ANIM_LEN];
} animation_t;
static animation_t animations[MAX_ANIMATIONS];
static int anims_enabled;

/** Maximum number of saved pixmaps 
 * Pixmap is a saved rectangle
 */
#define MAX_PIXMAPS        256
typedef struct {
        unsigned int width;
        unsigned int height;
        uint8_t *data;
} pixmap_t;
static pixmap_t pixmaps[MAX_PIXMAPS];

/* Viewport is a rectangular area on the screen */
#define MAX_VIEWPORTS 128
static viewport_t viewports[128];

/* Allow only 1 connection */
static int client_connected = 0;

#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 COL_WIDTH       8
#define ROW_BYTES       (screen.scanline * FONT_SCANLINES)

#define POINTPOS(x, y)  ((y) * screen.scanline + (x) * screen.pixelbytes)

static inline int COLOR(int color)
{
        return screen.invert_colors ? ~color : color;
}

/* Conversion routines between different color representations */
static void
rgb_byte0888(void *dst, int rgb)
{
        *(int *)dst = rgb;
}

static int
byte0888_rgb(void *src)
{
        return (*(int *)src) & 0xffffff;
}

static void
bgr_byte0888(void *dst, int rgb)
{
        *((uint32_t *) dst) = BLUE(rgb, 8) << 16 | GREEN(rgb, 8) << 8 |
                RED(rgb, 8);
}

static int
byte0888_bgr(void *src)
{
        int color = *(uint32_t *)(src);
        return ((color & 0xff) << 16) | (((color >> 8) & 0xff) << 8) |
                ((color >> 16) & 0xff);
}

static void
rgb_byte888(void *dst, int rgb)
{
        uint8_t *scr = dst;
#if defined(FB_INVERT_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
byte888_rgb(void *src)
{
        uint8_t *scr = src;
#if defined(FB_INVERT_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:5:5) */
static void
rgb_byte555(void *dst, int rgb)
{
        /* 5-bit, 5-bits, 5-bits */ 
        *((uint16_t *)(dst)) = RED(rgb, 5) << 10 | GREEN(rgb, 5) << 5 |
                BLUE(rgb, 5);
}

/** 16-bit depth (5:5:5) */
static int
byte555_rgb(void *src)
{
        int color = *(uint16_t *)(src);
        return (((color >> 10) & 0x1f) << (16 + 3)) |
                (((color >> 5) & 0x1f) << (8 + 3)) | ((color & 0x1f) << 3);
}

/**  16-bit depth (5:6:5) */
static void
rgb_byte565(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
byte565_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 (3:2:3) */
static void
rgb_byte8(void *dst, int rgb)
{
        *(uint8_t *)dst = RED(rgb, 3) << 5 | GREEN(rgb, 2) << 3 | BLUE(rgb, 3);
}

/** Return pixel color - 8-bit depth (3:2:3) */
static int
byte8_rgb(void *src)
{
        int color = *(uint8_t *)src;
        return (((color >> 5) & 0x7) << (16 + 5)) |
                (((color >> 3) & 0x3) << (8 + 6)) | ((color & 0x7) << 5);
}

/** Put pixel into viewport 
 *
 * @param vport Viewport identification
 * @param x X coord relative to viewport
 * @param y Y coord relative to viewport
 * @param color RGB color 
 */
static void
putpixel(viewport_t *vport, unsigned int x, unsigned int y, int color)
{
        int dx = vport->x + x;
        int dy = vport->y + y;

        if (! (vport->paused && vport->dbdata))
                (*screen.rgb2scr)(&screen.fbaddress[POINTPOS(dx,dy)],
                        COLOR(color));

        if (vport->dbdata) {
                int dline = (y + vport->dboffset) % vport->height;
                int doffset = screen.pixelbytes * (dline * vport->width + x);
                (*screen.rgb2scr)(&vport->dbdata[doffset], COLOR(color));
        }
}

/** Get pixel from viewport */
static int
getpixel(viewport_t *vport, unsigned int x, unsigned int y)
{
        int dx = vport->x + x;
        int dy = vport->y + y;

        return COLOR((*screen.scr2rgb)(&screen.fbaddress[POINTPOS(dx, dy)]));
}

static inline void
putpixel_mem(char *mem, unsigned int x, unsigned int y, int color)
{
        (*screen.rgb2scr)(&mem[POINTPOS(x,y)], COLOR(color));
}

static void
draw_rectangle(viewport_t *vport, unsigned int sx, unsigned int sy,
        unsigned int width, unsigned int height, int color)
{
        unsigned int x, y;
        static void *tmpline;

        if (!tmpline)
                tmpline = malloc(screen.scanline*screen.pixelbytes);

        /* Clear first line */
        for (x = 0; x < width; x++)
                putpixel_mem(tmpline, x, 0, color);

        if (!vport->paused) {
                /* Recompute to screen coords */
                sx += vport->x;
                sy += vport->y;
                /* Copy the rest */
                for (y = sy;y < sy+height; y++)
                        memcpy(&screen.fbaddress[POINTPOS(sx,y)], tmpline, 
                               screen.pixelbytes * width);
        }
        if (vport->dbdata) {
                for (y = sy; y < sy + height; y++) {
                        int rline = (y + vport->dboffset) % vport->height;
                        int rpos = (rline * vport->width + sx) *
                                screen.pixelbytes;
                        memcpy(&vport->dbdata[rpos], tmpline,
                                screen.pixelbytes * width);
                }
        }

}

/** Fill viewport with background color */
static void
clear_port(viewport_t *vport)
{
        draw_rectangle(vport, 0, 0, vport->width, vport->height,
                vport->style.bg_color);
}

/** Scroll unbuffered viewport up/down
 *
 * @param vport Viewport to scroll
 * @param lines Positive number - scroll up, negative - scroll down
 */
static void
scroll_port_nodb(viewport_t *vport, int lines)
{
        int y;

        if (lines > 0) {
                for (y = vport->y; y < vport->y+vport->height - lines; y++)
                        memcpy(&screen.fbaddress[POINTPOS(vport->x,y)],
                               &screen.fbaddress[POINTPOS(vport->x,y + lines)],
                               screen.pixelbytes * vport->width);
                draw_rectangle(vport, 0, vport->height - lines, vport->width,
                        lines, vport->style.bg_color);
        } else if (lines < 0) {
                lines = -lines;
                for (y = vport->y + vport->height-1; y >= vport->y + lines;
                         y--)
                        memcpy(&screen.fbaddress[POINTPOS(vport->x,y)],
                               &screen.fbaddress[POINTPOS(vport->x,y - lines)],
                               screen.pixelbytes * vport->width);
                draw_rectangle(vport, 0, 0, vport->width, lines,
                        vport->style.bg_color);
        }
}

/** Refresh given viewport from double buffer */
static void
refresh_viewport_db(viewport_t *vport)
{
        unsigned int y, srcy, srcoff, dsty, dstx;

        for (y = 0; y < vport->height; y++) {
                srcy = (y + vport->dboffset) % vport->height;
                srcoff = (vport->width * srcy) * screen.pixelbytes;

                dstx = vport->x;
                dsty = vport->y + y;

                memcpy(&screen.fbaddress[POINTPOS(dstx,dsty)],
                       &vport->dbdata[srcoff], 
                       vport->width*screen.pixelbytes);
        }
}

/** Scroll viewport that has double buffering enabled */
static void
scroll_port_db(viewport_t *vport, int lines)
{
        ++vport->paused;
        if (lines > 0) {
                draw_rectangle(vport, 0, 0, vport->width, lines,
                               vport->style.bg_color);
                vport->dboffset += lines;
                vport->dboffset %= vport->height;
        } else if (lines < 0) {
                lines = -lines;
                draw_rectangle(vport, 0, vport->height-lines, 
                               vport->width, lines,
                               vport->style.bg_color);

                if (vport->dboffset < lines)
                        vport->dboffset += vport->height;
                vport->dboffset -= lines;
        }
        
        --vport->paused;
        
        refresh_viewport_db(vport);
}

/** Scrolls viewport given number of lines */
static void
scroll_port(viewport_t *vport, int lines)
{
        if (vport->dbdata)
                scroll_port_db(vport, lines);
        else
                scroll_port_nodb(vport, lines);
        
}

static void
invert_pixel(viewport_t *vport, unsigned int x, unsigned int y)
{
        putpixel(vport, x, y, ~getpixel(vport, x, y));
}


/***************************************************************/
/* Character-console functions */

/** Draw character at given position
 *
 * @param vport Viewport where the character is printed
 * @param sx Coordinates of top-left of the character
 * @param sy Coordinates of top-left of the character
 * @param style Color of the character
 * @param transparent If false, print background color
 */
static void
draw_glyph(viewport_t *vport,uint8_t glyph, unsigned int sx,
         unsigned int sy, style_t style, int transparent)
{
        int i;
        unsigned int y;
        unsigned int glline;

        for (y = 0; y < FONT_SCANLINES; y++) {
                glline = fb_font[glyph * FONT_SCANLINES + y];
                for (i = 0; i < 8; i++) {
                        if (glline & (1 << (7 - i)))
                                putpixel(vport, sx + i, sy + y,
                                        style.fg_color);
                        else if (!transparent)
                                putpixel(vport, sx + i, sy + y,
                                        style.bg_color);
                }
        }
}

/** Invert character at given position */
static void
invert_char(viewport_t *vport,unsigned int row, unsigned int col)
{
        unsigned int x;
        unsigned int y;

        for (x = 0; x < COL_WIDTH; x++)
                for (y = 0; y < FONT_SCANLINES; y++)
                        invert_pixel(vport, col * COL_WIDTH + x, row *
                                FONT_SCANLINES + y);
}

/***************************************************************/
/* Stdout specific functions */


/** Create new viewport
 *
 * @return New viewport number
 */
static int
viewport_create(unsigned int x, unsigned int y,unsigned int width, 
        unsigned int height)
{
        int i;

        for (i = 0; i < MAX_VIEWPORTS; i++) {
                if (!viewports[i].initialized)
                        break;
        }
        if (i == MAX_VIEWPORTS)
                return ELIMIT;

        viewports[i].x = x;
        viewports[i].y = y;
        viewports[i].width = width;
        viewports[i].height = height;
        
        viewports[i].rows = height / FONT_SCANLINES;
        viewports[i].cols = width / COL_WIDTH;

        viewports[i].style.bg_color = DEFAULT_BGCOLOR;
        viewports[i].style.fg_color = DEFAULT_FGCOLOR;
        
        viewports[i].cur_col = 0;
        viewports[i].cur_row = 0;
        viewports[i].cursor_active = 0;

        viewports[i].initialized = 1;

        return i;
}

/** Initialize framebuffer as a chardev output device
 *
 * @param addr          Address of theframebuffer
 * @param xres          Screen width in pixels
 * @param yres          Screen height in pixels
 * @param visual        Bits per pixel (8, 16, 24, 32)
 * @param scan          Bytes per one scanline
 * @param invert_colors Inverted colors.
 *
 */
static bool
screen_init(void *addr, unsigned int xres, unsigned int yres,
        unsigned int scan, unsigned int visual, bool invert_colors)
{
        switch (visual) {
        case VISUAL_INDIRECT_8:
                screen.rgb2scr = rgb_byte8;
                screen.scr2rgb = byte8_rgb;
                screen.pixelbytes = 1;
                break;
        case VISUAL_RGB_5_5_5:
                screen.rgb2scr = rgb_byte555;
                screen.scr2rgb = byte555_rgb;
                screen.pixelbytes = 2;
                break;
        case VISUAL_RGB_5_6_5:
                screen.rgb2scr = rgb_byte565;
                screen.scr2rgb = byte565_rgb;
                screen.pixelbytes = 2;
                break;
        case VISUAL_RGB_8_8_8:
                screen.rgb2scr = rgb_byte888;
                screen.scr2rgb = byte888_rgb;
                screen.pixelbytes = 3;
                break;
        case VISUAL_RGB_8_8_8_0:
                screen.rgb2scr = rgb_byte888;
                screen.scr2rgb = byte888_rgb;
                screen.pixelbytes = 4;
                break;
        case VISUAL_RGB_0_8_8_8:
                screen.rgb2scr = rgb_byte0888;
                screen.scr2rgb = byte0888_rgb;
                screen.pixelbytes = 4;
                break;
        case VISUAL_BGR_0_8_8_8:
                screen.rgb2scr = bgr_byte0888;
                screen.scr2rgb = byte0888_bgr;
                screen.pixelbytes = 4;
                break;
        default:
                return false;
        }

        screen.fbaddress = (unsigned char *) addr;
        screen.xres = xres;
        screen.yres = yres;
        screen.scanline = scan;
        screen.invert_colors = invert_colors;
        
        /* Create first viewport */
        viewport_create(0, 0, xres, yres);
        
        return true;
}

/** Hide cursor if it is shown */
static void
cursor_hide(viewport_t *vport)
{
        if (vport->cursor_active && vport->cursor_shown) {
                invert_char(vport, vport->cur_row, vport->cur_col);
                vport->cursor_shown = 0;
        }
}

/** Show cursor if cursor showing is enabled */
static void
cursor_print(viewport_t *vport)
{
        /* Do not check for cursor_shown */
        if (vport->cursor_active) {
                invert_char(vport, vport->cur_row, vport->cur_col);
                vport->cursor_shown = 1;
        }
}

/** Invert cursor, if it is enabled */
static void
cursor_blink(viewport_t *vport)
{
        if (vport->cursor_shown)
                cursor_hide(vport);
        else
                cursor_print(vport);
}

/** Draw character at given position relative to viewport 
 * 
 * @param vport Viewport identification
 * @param c Character to print
 * @param row Screen position relative to viewport
 * @param col Screen position relative to viewport
 * @param transparent If false, print background color with character
 */
static void
draw_char(viewport_t *vport, char c, unsigned int row, unsigned int col,
        style_t style, int transparent)
{
        /* Optimize - do not hide cursor if we are going to overwrite it */
        if (vport->cursor_active && vport->cursor_shown && 
            (vport->cur_col != col || vport->cur_row != row))
                invert_char(vport, vport->cur_row, vport->cur_col);
        
        draw_glyph(vport, c, col * COL_WIDTH, row * FONT_SCANLINES, style,
                transparent);

        vport->cur_col = col;
        vport->cur_row = row;

        vport->cur_col++;
        if (vport->cur_col >= vport->cols) {
                vport->cur_col = 0;
                vport->cur_row++;
                if (vport->cur_row >= vport->rows)
                        vport->cur_row--;
        }
        cursor_print(vport);
}

/** Draw text data to viewport
 *
 * @param vport Viewport id
 * @param data Text data fitting exactly into viewport
 */
static void
draw_text_data(viewport_t *vport, keyfield_t *data)
{
        int i;
        int col,row;

        clear_port(vport);
        for (i = 0; i < vport->cols * vport->rows; i++) {
                if (data[i].character == ' ' && style_same(data[i].style,
                        vport->style))
                        continue;
                col = i % vport->cols;
                row = i / vport->cols;
                draw_glyph(vport, data[i].character, col * COL_WIDTH, row *
                        FONT_SCANLINES, data[i].style,
                        style_same(data[i].style,vport->style));
        }
        cursor_print(vport);
}

/** Return first free pixmap */
static int
find_free_pixmap(void)
{
        int i;
        
        for (i = 0;i < MAX_PIXMAPS;i++)
                if (!pixmaps[i].data)
                        return i;
        return -1;
}

static void
putpixel_pixmap(int pm, unsigned int x, unsigned int y, int color)
{
        pixmap_t *pmap = &pixmaps[pm];
        int pos = (y * pmap->width + x) * screen.pixelbytes;

        (*screen.rgb2scr)(&pmap->data[pos],COLOR(color));
}

/** Create a new pixmap and return appropriate ID */
static int
shm2pixmap(unsigned char *shm, size_t size)
{
        int pm;
        pixmap_t *pmap;

        pm = find_free_pixmap();
        if (pm == -1)
                return ELIMIT;
        pmap = &pixmaps[pm];
        
        if (ppm_get_data(shm, size, &pmap->width, &pmap->height))
                return EINVAL;
        
        pmap->data = malloc(pmap->width * pmap->height * screen.pixelbytes);
        if (!pmap->data)
                return ENOMEM;

        ppm_draw(shm, size, 0, 0, pmap->width, pmap->height, 
                 (putpixel_cb_t)putpixel_pixmap, (void *)pm);

        return pm;
}

/** Handle shared memory communication calls
 *
 * Protocol for drawing pixmaps:
 * - FB_PREPARE_SHM(client shm identification)
 * - IPC_M_AS_AREA_SEND
 * - FB_DRAW_PPM(startx,starty)
 * - FB_DROP_SHM
 *
 * Protocol for text drawing
 * - IPC_M_AS_AREA_SEND
 * - FB_DRAW_TEXT_DATA
 *
 * @param callid Callid of the current call
 * @param call Current call data
 * @param vp Active viewport
 * @return 0 if the call was not handled byt this function, 1 otherwise
 *
 * note: this function is not threads safe, you would have
 * to redefine static variables with __thread
 */
static int
shm_handle(ipc_callid_t callid, ipc_call_t *call, int vp)
{
        static keyfield_t *interbuffer = NULL;
        static size_t intersize = 0;

        static unsigned char *shm = NULL;
        static ipcarg_t shm_id = 0;
        static size_t shm_size;

        int handled = 1;
        int retval = 0;
        viewport_t *vport = &viewports[vp];
        unsigned int x, y;

        switch (IPC_GET_METHOD(*call)) {
        case IPC_M_AS_AREA_SEND:
                /* We accept one area for data interchange */
                if (IPC_GET_ARG1(*call) == shm_id) {
                        void *dest = as_get_mappable_page(IPC_GET_ARG2(*call));
                        shm_size = IPC_GET_ARG2(*call);
                        if (!ipc_answer_fast(callid, 0, (sysarg_t) dest, 0)) 
                                shm = dest;
                        else
                                shm_id = 0;
                        if (shm[0] != 'P')
                                while (1)
                                        ;
                        return 1;
                } else {
                        intersize = IPC_GET_ARG2(*call);
                        receive_comm_area(callid, call, (void *) &interbuffer);
                }
                return 1;
        case FB_PREPARE_SHM:
                if (shm_id)
                        retval = EBUSY;
                else 
                        shm_id = IPC_GET_ARG1(*call);
                break;
                
        case FB_DROP_SHM:
                if (shm) {
                        as_area_destroy(shm);
                        shm = NULL;
                }
                shm_id = 0;
                break;

        case FB_SHM2PIXMAP:
                if (!shm) {
                        retval = EINVAL;
                        break;
                }
                retval = shm2pixmap(shm, shm_size);
                break;
        case FB_DRAW_PPM:
                if (!shm) {
                        retval = EINVAL;
                        break;
                }
                x = IPC_GET_ARG1(*call);
                y = IPC_GET_ARG2(*call);
                if (x > vport->width || y > vport->height) {
                        retval = EINVAL;
                        break;
                }
                
                ppm_draw(shm, shm_size, IPC_GET_ARG1(*call),
                        IPC_GET_ARG2(*call), vport->width - x,
                        vport->height - y, (putpixel_cb_t)putpixel, vport);
                break;
        case FB_DRAW_TEXT_DATA:
                if (!interbuffer) {
                        retval = EINVAL;
                        break;
                }
                if (intersize < vport->cols * vport->rows *
                        sizeof(*interbuffer)) {
                        retval = EINVAL;
                        break;
                }
                draw_text_data(vport, interbuffer);
                break;
        default:
                handled = 0;
        }
        
        if (handled)
                ipc_answer_fast(callid, retval, 0, 0);
        return handled;
}

static void
copy_vp_to_pixmap(viewport_t *vport, pixmap_t *pmap)
{
        int y;
        int tmp, srcrowsize;
        int realwidth, realheight, realrowsize;
        int width = vport->width;
        int height = vport->height;

        if (width + vport->x > screen.xres)
                width = screen.xres - vport->x;
        if (height + vport->y > screen.yres)
                height = screen.yres - vport->y;
        
        realwidth = pmap->width <= width ? pmap->width : width;
        realheight = pmap->height <= height ? pmap->height : height;

        srcrowsize = vport->width * screen.pixelbytes;
        realrowsize = realwidth * screen.pixelbytes;
        
        for (y = 0; y < realheight; y++) {
                tmp = (vport->y + y) * screen.scanline +
                        vport->x * screen.pixelbytes;
                memcpy(pmap->data + srcrowsize * y, screen.fbaddress + tmp,
                        realrowsize); 
        }
}

/** Save viewport to pixmap */
static int
save_vp_to_pixmap(viewport_t *vport)
{
        int pm;
        pixmap_t *pmap;

        pm = find_free_pixmap();
        if (pm == -1)
                return ELIMIT;
        
        pmap = &pixmaps[pm];
        pmap->data = malloc(screen.pixelbytes * vport->width * vport->height);
        if (!pmap->data)
                return ENOMEM;

        pmap->width = vport->width;
        pmap->height = vport->height;

        copy_vp_to_pixmap(vport, pmap);
        
        return pm;
}

/** Draw pixmap on screen
 *
 * @param vp Viewport to draw on
 * @param pm Pixmap identifier
 */
static int draw_pixmap(int vp, int pm)
{
        pixmap_t *pmap = &pixmaps[pm];
        viewport_t *vport = &viewports[vp];
        int y;
        int tmp, srcrowsize;
        int realwidth, realheight, realrowsize;
        int width = vport->width;
        int height = vport->height;

        if (width + vport->x > screen.xres)
                width = screen.xres - vport->x;
        if (height + vport->y > screen.yres)
                height = screen.yres - vport->y;

        if (!pmap->data)
                return EINVAL;

        realwidth = pmap->width <= width ? pmap->width : width;
        realheight = pmap->height <= height ? pmap->height : height;

        srcrowsize = vport->width * screen.pixelbytes;
        realrowsize = realwidth * screen.pixelbytes;

        for (y = 0; y < realheight; y++) {
                tmp = (vport->y + y) * screen.scanline + 
                        vport->x * screen.pixelbytes;
                memcpy(screen.fbaddress + tmp, pmap->data + y * srcrowsize,
                        realrowsize);
        }
        return 0;
}

/** Tick animation one step forward */
static void
anims_tick(void)
{
        int i;
        static int counts = 0;
        
        /* Limit redrawing */
        counts = (counts + 1) % 8;
        if (counts)
                return;

        for (i = 0; i < MAX_ANIMATIONS; i++) {
                if (!animations[i].animlen || !animations[i].initialized ||
                        !animations[i].enabled)
                        continue;
                draw_pixmap(animations[i].vp,
                        animations[i].pixmaps[animations[i].pos]);
                animations[i].pos = (animations[i].pos + 1) %
                        animations[i].animlen;
        }
}


static int pointer_x, pointer_y;
static int pointer_shown, pointer_enabled;
static int pointer_vport = -1;
static int pointer_pixmap = -1;

static void
mouse_show(void)
{
        int i, j;
        int visibility;
        int color;
        int bytepos;

        if (pointer_shown || !pointer_enabled)
                return;

        /* Save image under the cursor */
        if (pointer_vport == -1) {
                pointer_vport = viewport_create(pointer_x, pointer_y,
                        pointer_width, pointer_height);
                if (pointer_vport < 0)
                        return;
        } else {
                viewports[pointer_vport].x = pointer_x;
                viewports[pointer_vport].y = pointer_y;
        }

        if (pointer_pixmap == -1)
                pointer_pixmap = save_vp_to_pixmap(&viewports[pointer_vport]);
        else
                copy_vp_to_pixmap(&viewports[pointer_vport],
                        &pixmaps[pointer_pixmap]);

        /* Draw cursor */
        for (i = 0; i < pointer_height; i++)
                for (j = 0; j < pointer_width; j++) {
                        bytepos = i * ((pointer_width - 1) / 8 + 1) + j / 8;
                        visibility = pointer_mask_bits[bytepos] &
                                (1 << (j % 8));
                        if (visibility) {
                                color = pointer_bits[bytepos] & (1 << (j % 8))
                                        ? 0 : 0xffffff;
                                if (pointer_x + j < screen.xres && pointer_y +
                                        i < screen.yres)
                                        putpixel(&viewports[0], pointer_x + j,
                                                pointer_y + i, color);
                        }
                }
        pointer_shown = 1;
}

static void
mouse_hide(void)
{
        /* Restore image under the cursor */
        if (pointer_shown) {
                draw_pixmap(pointer_vport, pointer_pixmap);
                pointer_shown = 0;
        }
}

static void
mouse_move(unsigned int x, unsigned int y)
{
        mouse_hide();
        pointer_x = x;
        pointer_y = y;
        mouse_show();
}

static int
anim_handle(ipc_callid_t callid, ipc_call_t *call, int vp)
{
        int handled = 1;
        int retval = 0;
        int i,nvp;
        int newval;

        switch (IPC_GET_METHOD(*call)) {
        case FB_ANIM_CREATE:
                nvp = IPC_GET_ARG1(*call);
                if (nvp == -1)
                        nvp = vp;
                if (nvp >= MAX_VIEWPORTS || nvp < 0 ||
                        !viewports[nvp].initialized) {
                        retval = EINVAL;
                        break;
                }
                for (i = 0; i < MAX_ANIMATIONS; i++) {
                        if (!animations[i].initialized)
                                break;
                }
                if (i == MAX_ANIMATIONS) {
                        retval = ELIMIT;
                        break;
                }
                animations[i].initialized = 1;
                animations[i].animlen = 0;
                animations[i].pos = 0;
                animations[i].enabled = 0;
                animations[i].vp = nvp;
                retval = i;
                break;
        case FB_ANIM_DROP:
                i = IPC_GET_ARG1(*call);
                if (i >= MAX_ANIMATIONS || i < 0) {
                        retval = EINVAL;
                        break;
                }
                animations[i].initialized = 0;
                break;
        case FB_ANIM_ADDPIXMAP:
                i = IPC_GET_ARG1(*call);
                if (i >= MAX_ANIMATIONS || i < 0 ||
                        !animations[i].initialized) {
                        retval = EINVAL;
                        break;
                }
                if (animations[i].animlen == MAX_ANIM_LEN) {
                        retval = ELIMIT;
                        break;
                }
                newval = IPC_GET_ARG2(*call);
                if (newval < 0 || newval > MAX_PIXMAPS ||
                        !pixmaps[newval].data) {
                        retval = EINVAL;
                        break;
                }
                animations[i].pixmaps[animations[i].animlen++] = newval;
                break;
        case FB_ANIM_CHGVP:
                i = IPC_GET_ARG1(*call);
                if (i >= MAX_ANIMATIONS || i < 0) {
                        retval = EINVAL;
                        break;
                }
                nvp = IPC_GET_ARG2(*call);
                if (nvp == -1)
                        nvp = vp;
                if (nvp >= MAX_VIEWPORTS || nvp < 0 ||
                        !viewports[nvp].initialized) {
                        retval = EINVAL;
                        break;
                }
                animations[i].vp = nvp;
                break;
        case FB_ANIM_START:
        case FB_ANIM_STOP:
                i = IPC_GET_ARG1(*call);
                if (i >= MAX_ANIMATIONS || i < 0) {
                        retval = EINVAL;
                        break;
                }
                newval = (IPC_GET_METHOD(*call) == FB_ANIM_START);
                if (newval ^ animations[i].enabled) {
                        animations[i].enabled = newval;
                        anims_enabled += newval ? 1 : -1;
                }
                break;
        default:
                handled = 0;
        }
        if (handled)
                ipc_answer_fast(callid, retval, 0, 0);
        return handled;
}

/** Handler for messages concerning pixmap handling */
static int
pixmap_handle(ipc_callid_t callid, ipc_call_t *call, int vp)
{
        int handled = 1;
        int retval = 0;
        int i,nvp;

        switch (IPC_GET_METHOD(*call)) {
        case FB_VP_DRAW_PIXMAP:
                nvp = IPC_GET_ARG1(*call);
                if (nvp == -1)
                        nvp = vp;
                if (nvp < 0 || nvp >= MAX_VIEWPORTS ||
                        !viewports[nvp].initialized) {
                        retval = EINVAL;
                        break;
                }
                i = IPC_GET_ARG2(*call);
                retval = draw_pixmap(nvp, i);
                break;
        case FB_VP2PIXMAP:
                nvp = IPC_GET_ARG1(*call);
                if (nvp == -1)
                        nvp = vp;
                if (nvp < 0 || nvp >= MAX_VIEWPORTS ||
                        !viewports[nvp].initialized)
                        retval = EINVAL;
                else
                        retval = save_vp_to_pixmap(&viewports[nvp]);
                break;
        case FB_DROP_PIXMAP:
                i = IPC_GET_ARG1(*call);
                if (i >= MAX_PIXMAPS) {
                        retval = EINVAL;
                        break;
                }
                if (pixmaps[i].data) {
                        free(pixmaps[i].data);
                        pixmaps[i].data = NULL;
                }
                break;
        default:
                handled = 0;
        }

        if (handled)
                ipc_answer_fast(callid, retval, 0, 0);
        return handled;
        
}

/** Function for handling connections to FB
 *
 */
static void
fb_client_connection(ipc_callid_t iid, ipc_call_t *icall)
{
        ipc_callid_t callid;
        ipc_call_t call;
        int retval;
        int i;
        unsigned int row,col;
        char c;

        int vp = 0;
        viewport_t *vport = &viewports[0];

        if (client_connected) {
                ipc_answer_fast(iid, ELIMIT, 0,0);
                return;
        }
        client_connected = 1;
        ipc_answer_fast(iid, 0, 0, 0); /* Accept connection */

        while (1) {
                if (vport->cursor_active || anims_enabled)
                        callid = async_get_call_timeout(&call, 250000);
                else
                        callid = async_get_call(&call);

                mouse_hide();
                if (!callid) {
                        cursor_blink(vport);
                        anims_tick();
                        mouse_show();
                        continue;
                }
                if (shm_handle(callid, &call, vp))
                        continue;
                if (pixmap_handle(callid, &call, vp))
                        continue;
                if (anim_handle(callid, &call, vp))
                        continue;

                switch (IPC_GET_METHOD(call)) {
                case IPC_M_PHONE_HUNGUP:
                        client_connected = 0;
                        /* cleanup other viewports */
                        for (i = 1; i < MAX_VIEWPORTS; i++)
                                vport->initialized = 0;
                        return; /* Exit thread */

                case FB_PUTCHAR:
                case FB_TRANS_PUTCHAR:
                        c = IPC_GET_ARG1(call);
                        row = IPC_GET_ARG2(call);
                        col = IPC_GET_ARG3(call);
                        if (row >= vport->rows || col >= vport->cols) {
                                retval = EINVAL;
                                break;
                        }
                        ipc_answer_fast(callid, 0, 0, 0);

                        draw_char(vport, c, row, col, vport->style,
                                IPC_GET_METHOD(call) == FB_TRANS_PUTCHAR);
                        continue; /* msg already answered */
                case FB_CLEAR:
                        clear_port(vport);
                        cursor_print(vport);
                        retval = 0;
                        break;
                case FB_CURSOR_GOTO:
                        row = IPC_GET_ARG1(call);
                        col = IPC_GET_ARG2(call);
                        if (row >= vport->rows || col >= vport->cols) {
                                retval = EINVAL;
                                break;
                        }
                        retval = 0;
                        cursor_hide(vport);
                        vport->cur_col = col;
                        vport->cur_row = row;
                        cursor_print(vport);
                        break;
                case FB_CURSOR_VISIBILITY:
                        cursor_hide(vport);
                        vport->cursor_active = IPC_GET_ARG1(call);
                        cursor_print(vport);
                        retval = 0;
                        break;
                case FB_GET_CSIZE:
                        ipc_answer_fast(callid, 0, vport->rows, vport->cols);
                        continue;
                case FB_SCROLL:
                        i = IPC_GET_ARG1(call);
                        if (i > vport->rows || i < (- (int)vport->rows)) {
                                retval = EINVAL;
                                break;
                        }
                        cursor_hide(vport);
                        scroll_port(vport, i*FONT_SCANLINES);
                        cursor_print(vport);
                        retval = 0;
                        break;
                case FB_VIEWPORT_DB:
                        /* Enable double buffering */
                        i = IPC_GET_ARG1(call);
                        if (i == -1)
                                i = vp;
                        if (i < 0 || i >= MAX_VIEWPORTS) {
                                retval = EINVAL;
                                break;
                        }
                        if (! viewports[i].initialized ) {
                                retval = EADDRNOTAVAIL;
                                break;
                        }
                        viewports[i].dboffset = 0;
                        if (IPC_GET_ARG2(call) == 1 && !viewports[i].dbdata)
                                viewports[i].dbdata = malloc(screen.pixelbytes
                                        * viewports[i].width *
                                        viewports[i].height);
                        else if (IPC_GET_ARG2(call) == 0 &&
                                viewports[i].dbdata) {
                                free(viewports[i].dbdata);
                                viewports[i].dbdata = NULL;
                        }
                        retval = 0;
                        break;
                case FB_VIEWPORT_SWITCH:
                        i = IPC_GET_ARG1(call);
                        if (i < 0 || i >= MAX_VIEWPORTS) {
                                retval = EINVAL;
                                break;
                        }
                        if (! viewports[i].initialized ) {
                                retval = EADDRNOTAVAIL;
                                break;
                        }
                        cursor_hide(vport);
                        vp = i;
                        vport = &viewports[vp];
                        cursor_print(vport);
                        retval = 0;
                        break;
                case FB_VIEWPORT_CREATE:
                        retval = viewport_create(IPC_GET_ARG1(call) >> 16,
                                IPC_GET_ARG1(call) & 0xffff,
                                IPC_GET_ARG2(call) >> 16,
                                IPC_GET_ARG2(call) & 0xffff);
                        break;
                case FB_VIEWPORT_DELETE:
                        i = IPC_GET_ARG1(call);
                        if (i < 0 || i >= MAX_VIEWPORTS) {
                                retval = EINVAL;
                                break;
                        }
                        if (! viewports[i].initialized ) {
                                retval = EADDRNOTAVAIL;
                                break;
                        }
                        viewports[i].initialized = 0;
                        if (viewports[i].dbdata) {
                                free(viewports[i].dbdata);
                                viewports[i].dbdata = NULL;
                        }
                        retval = 0;
                        break;
                case FB_SET_STYLE:
                        vport->style.fg_color = IPC_GET_ARG1(call);
                        vport->style.bg_color = IPC_GET_ARG2(call);
                        retval = 0;
                        break;
                case FB_GET_RESOLUTION:
                        ipc_answer_fast(callid, 0, screen.xres,screen.yres);
                        continue;
                case FB_POINTER_MOVE:
                        pointer_enabled = 1;
                        mouse_move(IPC_GET_ARG1(call), IPC_GET_ARG2(call));
                        retval = 0;
                        break;
                default:
                        retval = ENOENT;
                }
                ipc_answer_fast(callid,retval, 0, 0);
        }
}

/** Initialization of framebuffer */
int
fb_init(void)
{
        void *fb_ph_addr;
        unsigned int fb_width;
        unsigned int fb_height;
        unsigned int fb_scanline;
        unsigned int fb_visual;
        bool fb_invert_colors;
        void *fb_addr;
        size_t asz;

        async_set_client_connection(fb_client_connection);

        fb_ph_addr = (void *) sysinfo_value("fb.address.physical");
        fb_width = sysinfo_value("fb.width");
        fb_height = sysinfo_value("fb.height");
        fb_scanline = sysinfo_value("fb.scanline");
        fb_visual = sysinfo_value("fb.visual");
        fb_invert_colors = sysinfo_value("fb.invert-colors");

        asz = fb_scanline * fb_height;
        fb_addr = as_get_mappable_page(asz);
        
        physmem_map(fb_ph_addr, fb_addr, ALIGN_UP(asz, PAGE_SIZE) >>
                PAGE_WIDTH, AS_AREA_READ | AS_AREA_WRITE);

        if (screen_init(fb_addr, fb_width, fb_height, fb_scanline, fb_visual,
                fb_invert_colors))
                return 0;
        
        return -1;
}

/** 
 * @}
 */