framebuffer.c

/*
 * This file is part of MultiROM.
 *
 * MultiROM is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 *
 * MultiROM is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with MultiROM.  If not, see <http://www.gnu.org/licenses/>.
 */

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <fcntl.h>
#include <sys/mman.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <sys/ioctl.h>
#include <errno.h>
#include <string.h>
#include <signal.h>
#include <assert.h>
#include <linux/fb.h>
#include <linux/kd.h>
#include <cutils/memory.h>
#include <pthread.h>
#include <sys/atomics.h>
#include <png.h>

#include "log.h"
#include "framebuffer.h"
#include "util.h"
#include "containers.h"
#include "animation.h"
#include "multirom.h"

#if PIXEL_SIZE == 4
#define fb_memset(dst, what, len) android_memset32(dst, what, len)
#else
#define fb_memset(dst, what, len) android_memset16(dst, what, len)
#endif


uint32_t fb_width = 0;
uint32_t fb_height = 0;
int fb_rotation = 0; // in degrees, clockwise

fb_item_pos DEFAULT_FB_PARENT = {
    .x = 0,
    .y = 0,
};

static struct framebuffer fb;
static int fb_frozen = 0;
static int fb_force_generic = 0;

static fb_context_t fb_ctx = { 
    .first_item = NULL,
    .batch_started = 0,
    .background_color = BLACK,
    .mutex = PTHREAD_MUTEX_INITIALIZER
};

static fb_context_t **inactive_ctx = NULL;
static uint8_t **fb_rot_helpers = NULL;
static pthread_t fb_draw_thread;
static pthread_mutex_t fb_update_mutex = PTHREAD_MUTEX_INITIALIZER;
static volatile int fb_draw_requested = 0;
static volatile int fb_draw_run = 0;
static volatile int fb_draw_futex = 0;
static void *fb_draw_thread_work(void*);

static void fb_destroy_item(void *item); // private!
static inline void fb_cpy_fb_with_rotation(px_type *dst, px_type *src);
static inline void fb_rotate_90deg(px_type *dst, px_type *src);
static inline void fb_rotate_270deg(px_type *dst, px_type *src);
static inline void fb_rotate_180deg(px_type *dst, px_type *src);

int vt_set_mode(int graphics)
{
    int fd, r;
    mknod("/dev/tty0", (0600 | S_IFCHR), makedev(4, 0));
    fd = open("/dev/tty0", O_RDWR | O_SYNC);
    if (fd < 0)
        return -1;
    r = ioctl(fd, KDSETMODE, (void*) (graphics ? KD_GRAPHICS : KD_TEXT));
    close(fd);
    unlink("/dev/tty0");
    return r;
}

int fb_open_impl(void)
{
    struct fb_impl **itr;
    struct fb_impl *impls[FB_IMPL_CNT];

#define ADD_IMPL(ID, N) \
    extern struct fb_impl fb_impl_ ## N; \
    impls[ID] = &fb_impl_ ## N;

    ADD_IMPL(FB_IMPL_GENERIC, generic);
#ifdef MR_USE_QCOM_OVERLAY
    ADD_IMPL(FB_IMPL_QCOM_OVERLAY, qcom_overlay);
#endif

    if(fb_force_generic)
        itr = &impls[FB_IMPL_GENERIC];
    else
        itr = impls;

    for(; *itr; ++itr)
    {
        if((*itr)->open(&fb) >= 0)
        {
            INFO("Framebuffer implementation: %s\n", (*itr)->name);
            fb.impl = *itr;
            return 0;
        }
    }

    ERROR("All framebuffer implementations have failed to open!\n");
    return -1;
}

int fb_open(int rotation)
{
    memset(&fb, 0, sizeof(struct framebuffer));

    fb.fd = open("/dev/graphics/fb0", O_RDWR);
    if (fb.fd < 0)
        return -1;

    if(ioctl(fb.fd, FBIOGET_VSCREENINFO, &fb.vi) < 0)
        goto fail;

    if(ioctl(fb.fd, FBIOGET_FSCREENINFO, &fb.fi) < 0)
        goto fail;

    /*
     * No FBIOPUT_VSCREENINFO ioctl must be called here. Flo's display drivers
     * contain a hack to set backlight while in recovery, which is triggered by
     * this ioctl (and probably other things). The hack turns *something* on
     * and it causes insane battery drain while in android (it eats at least
     * five times more energy). The device enters deep sleep just fine, the dmesg
     * says it was suspended, but it drains more energy. Qualcomm ION overlay
     * framebuffer implementation works around this hack, because it doesn't
     * require that ioctl (but we can't set pixel format without it, must use
     * framebuffer's default format in "TARGET_RECOVERY_PIXEL_FORMAT" config
     * value). This bug does not manifest when MultiROM isn't installed,
     * because nothing sets FBIOPUT_VSCREENINFO during Android's boot,
     * and well, you're not really supposed to stay long in recovery nor does
     * it have "suspend" state.
     *
     * This ioctl call was moved to framebuffer_generic implementation.
     */

    if(fb_open_impl() < 0)
        goto fail;

    fb_frozen = 0;
    fb_rotation = rotation;

    if(fb_rotation%180 == 0)
    {
        fb_width = fb.vi.xres;
        fb_height = fb.vi.yres;
    }
    else
    {
        fb_width = fb.vi.yres;
        fb_height = fb.vi.xres;
    }

#ifdef RECOVERY_GRAPHICS_USE_LINELENGTH
    fb.vi.xres_virtual = fb.fi.line_length / PIXEL_SIZE;
#endif

    fb.stride = (fb_rotation%180 == 0) ? fb.vi.xres_virtual : fb.vi.yres;
    fb.size = fb.vi.xres_virtual*fb.vi.yres*PIXEL_SIZE;
    fb.buffer = malloc(fb.size);
    fb_memset(fb.buffer, fb_convert_color(BLACK), fb.size);

#if 0
    fb_dump_info();
#endif

    DEFAULT_FB_PARENT.w = fb_width;
    DEFAULT_FB_PARENT.h = fb_height;

    fb_update();

    fb_draw_run = 1;
    pthread_create(&fb_draw_thread, NULL, fb_draw_thread_work, NULL);
    return 0;

fail:
    close(fb.fd);
    return -1;
}

void fb_close(void)
{
    fb_draw_run = 0;
    pthread_join(fb_draw_thread, NULL);

    free(fb_rot_helpers);
    fb_rot_helpers = NULL;

    fb.impl->close(&fb);
    fb.impl = NULL;

    close(fb.fd);
    free(fb.buffer);
    fb.buffer = NULL;
}

void fb_dump_info(void)
{
    ERROR("Framebuffer:\n");
    ERROR("fi.smem_len: %u\n", fb.fi.smem_len);
    ERROR("fi.type: %u\n", fb.fi.type);
    ERROR("fi.type_aux: %u\n", fb.fi.type_aux);
    ERROR("fi.visual: %u\n", fb.fi.visual);
    ERROR("fi.xpanstep: %u\n", fb.fi.xpanstep);
    ERROR("fi.ypanstep: %u\n", fb.fi.ypanstep);
    ERROR("fi.ywrapstep: %u\n", fb.fi.ywrapstep);
    ERROR("fi.line_length: %u\n", fb.fi.line_length);
    ERROR("fi.mmio_start: %p\n", (void*)fb.fi.mmio_start);
    ERROR("fi.mmio_len: %u\n", fb.fi.mmio_len);
    ERROR("fi.accel: %u\n", fb.fi.accel);
    ERROR("vi.xres: %u\n", fb.vi.xres);
    ERROR("vi.yres: %u\n", fb.vi.yres);
    ERROR("vi.xres_virtual: %u\n", fb.vi.xres_virtual);
    ERROR("vi.yres_virtual: %u\n", fb.vi.yres_virtual);
    ERROR("vi.xoffset: %u\n", fb.vi.xoffset);
    ERROR("vi.yoffset: %u\n", fb.vi.yoffset);
    ERROR("vi.bits_per_pixel: %u\n", fb.vi.bits_per_pixel);
    ERROR("vi.grayscale: %u\n", fb.vi.grayscale);
    ERROR("vi.red: offset: %u len: %u msb_right: %u\n", fb.vi.red.offset, fb.vi.red.length, fb.vi.red.msb_right);
    ERROR("vi.green: offset: %u len: %u msb_right: %u\n", fb.vi.green.offset, fb.vi.green.length, fb.vi.green.msb_right);
    ERROR("vi.blue: offset: %u len: %u msb_right: %u\n", fb.vi.blue.offset, fb.vi.blue.length, fb.vi.blue.msb_right);
    ERROR("vi.transp: offset: %u len: %u msb_right: %u\n", fb.vi.transp.offset, fb.vi.transp.length, fb.vi.transp.msb_right);
    ERROR("vi.nonstd: %u\n", fb.vi.nonstd);
    ERROR("vi.activate: %u\n", fb.vi.activate);
    ERROR("vi.height: %u\n", fb.vi.height);
    ERROR("vi.width: %u\n", fb.vi.width);
    ERROR("vi.accel_flags: %u\n", fb.vi.accel_flags);
}

int fb_get_vi_xres(void)
{
    return fb.vi.xres;
}

int fb_get_vi_yres(void)
{
    return fb.vi.yres;
}

void fb_force_generic_impl(int force)
{
    fb_force_generic = force;
}

void fb_update(void)
{
    fb_cpy_fb_with_rotation(fb.impl->get_frame_dest(&fb), fb.buffer);
    fb.impl->update(&fb);
}

void fb_cpy_fb_with_rotation(px_type *dst, px_type *src)
{
    switch(fb_rotation)
    {
        case 0:
            memcpy(dst, src, fb.vi.xres_virtual * fb.vi.yres * PIXEL_SIZE);
            break;
        case 90:
            fb_rotate_90deg(dst, src);
            break;
        case 180:
            fb_rotate_180deg(dst, src);
            break;
        case 270:
            fb_rotate_270deg(dst, src);
            break;
    }
}

void fb_rotate_90deg(px_type *dst, px_type *src)
{
    uint32_t i;
    int32_t x;

    if(!fb_rot_helpers)
        fb_rot_helpers = malloc(fb_height*sizeof(px_type*));

    px_type **helpers = (px_type**)fb_rot_helpers;

    helpers[0] = src;
    for(i = 1; i < fb_height; ++i)
        helpers[i] = helpers[i-1] + fb.stride;

    const int padding = fb.vi.xres_virtual - fb.vi.xres;
    for(i = 0; i < fb_width; ++i)
    {
        for(x = fb_height-1; x >= 0; --x)
            *dst++ = *(helpers[x]++);
        dst += padding;
    }
}

void fb_rotate_270deg(px_type *dst, px_type *src)
{
    if(!fb_rot_helpers)
        fb_rot_helpers = malloc(fb_height*sizeof(px_type*));

    uint32_t i, x;
    px_type **helpers = (px_type**)fb_rot_helpers;

    helpers[0] = src + fb_width-1;
    for(i = 1; i < fb_height; ++i)
        helpers[i] = helpers[i-1] + fb.stride;

    const int padding = fb.vi.xres_virtual - fb.vi.xres;
    for(i = 0; i < fb_width; ++i)
    {
        for(x = 0; x < fb_height; ++x)
            *dst++ = *(helpers[x]--);
        dst += padding;
    }
}

void fb_rotate_180deg(px_type *dst, px_type *src)
{
    uint32_t i, x;
    int len = fb.vi.xres_virtual * fb.vi.yres;
    src += len;

    const int padding = fb.vi.xres_virtual - fb.vi.xres;
    for(i = 0; i < fb_height; ++i)
    {
        src -= padding;
        for(x = 0; x < fb_width; ++x)
            *dst++ = *src--;
        dst += padding;
    }
}

int fb_clone(char **buff)
{
    int len = fb.size;
    *buff = malloc(len);

    pthread_mutex_lock(&fb_update_mutex);
    memcpy(*buff, fb.buffer, len);
    pthread_mutex_unlock(&fb_update_mutex);

    return len;
}

void fb_fill(uint32_t color)
{
    fb_memset(fb.buffer, fb_convert_color(color), fb.size);
}

px_type fb_convert_color(uint32_t c)
{
#ifdef RECOVERY_BGRA
    return c;
#elif defined(RECOVERY_RGBX)
    //             A              B                   G                  R
    return (c & 0xFF000000) | ((c & 0xFF) << 16) | (c & 0xFF00) | ((c & 0xFF0000) >> 16);
#elif defined(RECOVERY_RGB_565)
    //            R                                G                              B
    return (((c & 0xFF0000) >> 19) << 11) | (((c & 0xFF00) >> 10) << 5) | ((c & 0xFF) >> 3);
#else
#error "Unknown pixel format"
#endif
}

void fb_set_background(uint32_t color)
{
    fb_ctx.background_color = color;
}

void fb_batch_start(void)
{
    pthread_mutex_lock(&fb_ctx.mutex);
    fb_ctx.batch_thread = pthread_self();
    fb_ctx.batch_started = 1;
}

void fb_batch_end(void)
{
    fb_ctx.batch_started = 0;
    pthread_mutex_unlock(&fb_ctx.mutex);
}

void fb_items_lock(void)
{
    if(!fb_ctx.batch_started || !pthread_equal(fb_ctx.batch_thread, pthread_self()))
        pthread_mutex_lock(&fb_ctx.mutex);
}

void fb_items_unlock(void)
{
    if(!fb_ctx.batch_started || !pthread_equal(fb_ctx.batch_thread, pthread_self()))
        pthread_mutex_unlock(&fb_ctx.mutex);
}

static void fb_ctx_put_it_before(fb_item_header *new_it, fb_item_header *next_it)
{
    if(next_it->prev)
    {
        next_it->prev->next = new_it;
        new_it->prev = next_it->prev;
    }
    new_it->next = next_it;
    next_it->prev = new_it;
}

static void fb_ctx_put_it_after(fb_item_header *new_it, fb_item_header *prev_it)
{
    if(prev_it->next)
    {
        prev_it->next->prev = new_it;
        new_it->next = prev_it->next;
    }
    new_it->prev = prev_it;
    prev_it->next = new_it;
}

void fb_ctx_add_item(void *item)
{
    fb_item_header *h = item;

    fb_items_lock();

    if(!fb_ctx.first_item)
        fb_ctx.first_item = item;
    else
    {
        fb_item_header *itr = fb_ctx.first_item;
        while(1)
        {
            if(itr->level > h->level)
            {
                if(itr == fb_ctx.first_item)
                    fb_ctx.first_item = h;
                fb_ctx_put_it_before(h, itr);
                itr = NULL;
                break;
            }

            if(itr->next)
                itr = itr->next;
            else
                break;
        }

        if(itr)
            fb_ctx_put_it_after(h, itr);
    }

    fb_items_unlock();
}

void fb_ctx_rm_item(void *item)
{
    fb_item_header *h = item;

    fb_items_lock();

    if(!h->prev)
        fb_ctx.first_item = h->next;
    else
        h->prev->next = h->next;

    if(h->next)
        h->next->prev = h->prev;

    fb_items_unlock();
}

void fb_remove_item(void *item)
{
    switch(((fb_item_header*)item)->type)
    {
        case FB_IT_RECT:
            fb_rm_rect((fb_rect*)item);
            break;
        case FB_IT_IMG:
            fb_rm_img((fb_img*)item);
            break;
    }
}

void fb_destroy_item(void *item)
{
    anim_cancel_for(item, 0);

    switch(((fb_item_header*)item)->type)
    {
        case FB_IT_RECT:
            break;
        case FB_IT_IMG:
        {
            fb_img *i = (fb_img*)item;
            switch(i->img_type)
            {
                case FB_IMG_TYPE_PNG:
                    fb_png_release(i->data);
                    break;
                case FB_IMG_TYPE_GENERIC:
                    free(i->data);
                    break;
                case FB_IMG_TYPE_TEXT:
                    fb_text_destroy(i);
                    break;
                default:
                    ERROR("fb_destroy_item(): unknown fb_img type %d\n", i->img_type);
                    assert(0);
                    break;
            }
            break;
        }
    }
    free(item);
}

void fb_draw_rect(fb_rect *r)
{
    const uint8_t alpha = (r->color >> 24) & 0xFF;
    const uint8_t inv_alpha = 0xFF - ((r->color >> 24) & 0xFF);
    const px_type color = fb_convert_color(r->color);

    if(alpha == 0)
        return;

#ifdef RECOVERY_RGBX
    const uint32_t premult_color_rb = ((color & 0xFF00FF) * (alpha)) >> 8;
    const uint32_t premult_color_g = ((color & 0x00FF00) * (alpha)) >> 8;
#elif defined(RECOVERY_BGRA)
    const uint32_t premult_color_rb = (((color >> 8) & 0xFF00FF) * (alpha)) >> 8;
    const uint32_t premult_color_g = (((color >> 8) & 0x00FF00) * (alpha)) >> 8;
#elif defined(RECOVERY_RGB_565)
    const uint8_t alpha5b = (alpha >> 3) + 1;
    const uint8_t alpha6b = (alpha >> 2) + 1;
    const uint8_t inv_alpha5b = 32 - alpha5b;
    const uint8_t inv_alpha6b = 64 - alpha6b;
    const uint16_t premult_color_rb = ((color & 0xF81F) * alpha5b) >> 5;
    const uint16_t premult_color_g = ((color & 0x7E0) * alpha6b) >> 6;
#endif

    const int min_x = r->x >= r->parent->x ? 0 : r->parent->x - r->x;
    const int min_y = r->y >= r->parent->y ? 0 : r->parent->y - r->y;
    const int max_x = imin(r->w, r->parent->x + r->parent->w - r->x);
    const int max_y = imin(r->h, r->parent->y + r->parent->h - r->y);
    const int rendered_w = max_x - min_x;

    const int w = rendered_w*PIXEL_SIZE;

    px_type *bits = fb.buffer + (fb.stride*(r->y + min_y)) + r->x + min_x;

    int i, x;
    uint8_t *comps_bits;
    const uint8_t *comps_clr = (uint8_t*)&color;
    for(i = min_y; i < max_y; ++i)
    {
        if(alpha == 0xFF)
        {
            fb_memset(bits, color, w);
            bits += fb.stride;
        }
        // Do the blending
        else
        {
#ifdef MR_DISABLE_ALPHA
            fb_memset(bits, color, w);
            bits += fb.stride;
#else
            for(x = 0; x < rendered_w; ++x)
            {
  #ifdef RECOVERY_RGBX
                const uint32_t rb = (premult_color_rb & 0xFF00FF) + ((inv_alpha * (*bits & 0xFF00FF)) >> 8);
                const uint32_t g = (premult_color_g & 0x00FF00) + ((inv_alpha * (*bits & 0x00FF00)) >> 8);
                *bits = 0xFF000000 | (rb & 0xFF00FF) | (g & 0x00FF00);
  #elif defined(RECOVERY_BGRA)
                const uint32_t rb = (premult_color_rb & 0xFF00FF) + ((inv_alpha * ((*bits >> 8) & 0xFF00FF)) >> 8);
                const uint32_t g = (premult_color_g & 0x00FF00) + ((inv_alpha * ((*bits >> 8) & 0x00FF00)) >> 8);
                *bits = 0xFF000000 | (rb & 0xFF00FF) | (g & 0x00FF00);
  #elif defined(RECOVERY_RGB_565)
                const uint16_t rb = (premult_color_rb & 0xF81F) + ((inv_alpha5b * (*bits & 0xF81F)) >> 5);
                const uint16_t g = (premult_color_g & 0x7E0) + ((inv_alpha6b * (*bits & 0x7E0)) >> 6);
                *bits = (rb & 0xF81F) | (g & 0x7E0);
  #else
    #error "No alpha blending implementation for this format!"
  #endif
                ++bits;
            }
            bits += fb.stride - rendered_w;
#endif // MR_DISABLE_ALPHA
        }
    }
}

static inline int blend_png(int value1, int value2, int alpha) {
    int r = (0xFF-alpha)*value1 + alpha*value2;
    return (r+1 + (r >> 8)) >> 8; // divide by 255
}

void fb_draw_img(fb_img *i)
{
    int y, x;
    const int w = i->w*PIXEL_SIZE;
    uint8_t alpha;
    uint8_t *comps_img, *comps_bits;

#if PIXEL_SIZE == 4
    const uint8_t max_alpha = 0xFF;
#elif PIXEL_SIZE == 2
    const uint8_t max_alpha = 31;
#endif

    const int min_x = i->x >= i->parent->x ? 0 : i->parent->x - i->x;
    const int min_y = i->y >= i->parent->y ? 0 : i->parent->y - i->y;
    const int max_x = imin(i->w, i->parent->x + i->parent->w - i->x);
    const int max_y = imin(i->h, i->parent->y + i->parent->h - i->y);
    const int rendered_w = max_x - min_x;

    px_type *bits = fb.buffer + (fb.stride*(i->y + min_y)) + i->x + min_x;
    px_type *img = (px_type*)(((uint32_t*)i->data) + (min_y * i->w) + min_x);

    for(y = min_y; y < max_y; ++y)
    {
        for(x = min_x; x < max_x; ++x)
        {
            // Colors, 0xAABBGGRR
#if PIXEL_SIZE == 4
            alpha = PX_GET_A(*img);
#elif PIXEL_SIZE == 2
            alpha = ((uint8_t*)img)[2];
#endif
            // fully opaque
            if(alpha == max_alpha)
            {
                *bits = *img;
            }
            // do the blending
            else if(alpha != 0x00)
            {
#ifdef MR_DISABLE_ALPHA
                *bits = *img;
#else
  #if PIXEL_SIZE == 4
                comps_bits = (uint8_t*)bits;
                comps_img = (uint8_t*)img;
                comps_bits[PX_IDX_R] = blend_png(comps_bits[PX_IDX_R], comps_img[PX_IDX_R], comps_img[PX_IDX_A]);
                comps_bits[PX_IDX_G] = blend_png(comps_bits[PX_IDX_G], comps_img[PX_IDX_G], comps_img[PX_IDX_A]);
                comps_bits[PX_IDX_B] = blend_png(comps_bits[PX_IDX_B], comps_img[PX_IDX_B], comps_img[PX_IDX_A]);
                comps_bits[PX_IDX_A] = 0xFF;
  #else
                const uint8_t alpha5b = alpha;
                const uint8_t alpha6b = ((uint8_t*)img)[3];
                *bits = (((31-alpha5b)*(*bits & 0x1F)            + (alpha5b*(*img & 0x1F))) / 31) |
                        ((((63-alpha6b)*((*bits & 0x7E0) >> 5)   + (alpha6b*((*img & 0x7E0) >> 5))) / 63) << 5) |
                        ((((31-alpha5b)*((*bits & 0xF800) >> 11) + (alpha5b*((*img & 0xF800) >> 11))) / 31) << 11);
  #endif // PIXEL_SIZE
#endif // MR_DISABLE_ALPHA
            }

            ++bits;
#if PIXEL_SIZE == 4
            ++img;
#elif PIXEL_SIZE == 2
            img += 2;
#endif
        }
        bits += fb.stride - rendered_w;
        img = (px_type*)(((uint32_t*)img) + (i->w - rendered_w));
    }
}

int fb_generate_item_id(void)
{
    fb_items_lock();
    static int id = 0;
    int res = id++;
    fb_items_unlock();

    return res;
}

fb_rect *fb_add_rect_lvl(int level, int x, int y, int w, int h, uint32_t color)
{
    fb_rect *r = mzalloc(sizeof(fb_rect));
    r->id = fb_generate_item_id();
    r->type = FB_IT_RECT;
    r->parent = &DEFAULT_FB_PARENT;
    r->level = level;

    r->x = x;
    r->y = y;

    r->w = w;
    r->h = h;
    r->color = color;

    fb_ctx_add_item(r);
    return r;
}

void fb_add_rect_notfilled(int level, int x, int y, int w, int h, uint32_t color, int thickness, fb_rect ***list)
{
    fb_rect *r;
    // top
    r = fb_add_rect_lvl(level, x, y, w, thickness, color);
    list_add(r, list);

    // right
    r = fb_add_rect_lvl(level, x + w - thickness, y, thickness, h, color);
    list_add(r, list);

    // bottom
    r = fb_add_rect_lvl(level, x, y + h - thickness, w, thickness, color);
    list_add(r, list);

    // left
    r = fb_add_rect_lvl(level, x, y, thickness, h, color);
    list_add(r, list);
}

fb_img *fb_add_img(int level, int x, int y, int w, int h, int img_type, px_type *data)
{
    fb_img *result = mzalloc(sizeof(fb_img));
    result->id = fb_generate_item_id();
    result->type = FB_IT_IMG;
    result->parent = &DEFAULT_FB_PARENT;
    result->level = level;
    result->x = x;
    result->y = y;
    result->img_type = img_type;
    result->data = data;
    result->w = w;
    result->h = h;

    fb_ctx_add_item(result);
    return result;
}

fb_img* fb_add_png_img_lvl(int level, int x, int y, int w, int h, const char *path)
{
    px_type *data = NULL;
    if(strncmp(path, ":/", 2) == 0)
    {
        const int full_path_len = strlen(path) + strlen(multirom_dir) + 4;
        char *full_path = malloc(full_path_len);
        snprintf(full_path, full_path_len, "%s/res%s", multirom_dir, path+1);
        data = fb_png_get(full_path, w, h);
        free(full_path);
    }
    else
        data = fb_png_get(path, w, h);
    if(!data)
        return NULL;

    return fb_add_img(level, x, y, w, h, FB_IMG_TYPE_PNG, data);
}

void fb_rm_rect(fb_rect *r)
{
    if(!r)
        return;

    fb_ctx_rm_item(r);
    fb_destroy_item(r);
}

void fb_rm_text(fb_img *i)
{
    fb_rm_img(i);
}

void fb_rm_img(fb_img *i)
{
    if(!i)
        return;

    fb_ctx_rm_item(i);
    fb_destroy_item(i);
}

void fb_clear(void)
{
    pthread_mutex_lock(&fb_ctx.mutex);
    fb_item_header *it, *next;
    for(it = fb_ctx.first_item; it; it = next)
    {
        next = it->next;
        fb_destroy_item(it);
    }
    fb_ctx.first_item = NULL;
    pthread_mutex_unlock(&fb_ctx.mutex);

    fb_png_drop_unused();
    fb_text_drop_cache_unused();
}

static void fb_draw(void)
{
    uint32_t i;
    fb_item_header *it;

    fb_fill(fb_ctx.background_color);

    pthread_mutex_lock(&fb_ctx.mutex);
    for(it = fb_ctx.first_item; it; it = it->next)
    {
        switch(it->type)
        {
            case FB_IT_RECT:
                fb_draw_rect((fb_rect*)it);
                break;
            case FB_IT_IMG:
                fb_draw_img((fb_img*)it);
                break;
        }
    }
    pthread_mutex_unlock(&fb_ctx.mutex);

    pthread_mutex_lock(&fb_update_mutex);
    fb_update();
    pthread_mutex_unlock(&fb_update_mutex);
}

void fb_freeze(int freeze)
{
    if(freeze)
        ++fb_frozen;
    else
        --fb_frozen;
}

void fb_push_context(void)
{
    fb_context_t *ctx = mzalloc(sizeof(fb_context_t));

    pthread_mutex_lock(&fb_ctx.mutex);
    ctx->first_item = fb_ctx.first_item;
    ctx->background_color = fb_ctx.background_color;
    fb_ctx.first_item = NULL;
    pthread_mutex_unlock(&fb_ctx.mutex);

    list_add(ctx, &inactive_ctx);
}

void fb_pop_context(void)
{
    if(!inactive_ctx)
        return;

    fb_clear();

    int idx = list_item_count(inactive_ctx)-1;
    fb_context_t *ctx = inactive_ctx[idx];

    pthread_mutex_lock(&fb_ctx.mutex);
    fb_ctx.first_item = ctx->first_item;
    fb_ctx.background_color = ctx->background_color;
    pthread_mutex_unlock(&fb_ctx.mutex);

    list_rm_noreorder(ctx, &inactive_ctx, &free);

    fb_request_draw();
}

#define SLEEP_CONST 16
void *fb_draw_thread_work(void *cookie)
{
    struct timespec last, curr;
    uint32_t diff = 0, prevSleepTime = 0;
    clock_gettime(CLOCK_MONOTONIC, &last);

    while(fb_draw_run)
    {
        clock_gettime(CLOCK_MONOTONIC, &curr);
        diff = timespec_diff(&last, &curr);

        if(__atomic_cmpxchg(1, 0, &fb_draw_requested) == 0)
        {
            fb_draw();
            __futex_wake(&fb_draw_futex, INT_MAX);
        }
#ifdef MR_CONTINUOUS_FB_UPDATE
        else
        {
            pthread_mutex_lock(&fb_update_mutex);
            fb_update();
            pthread_mutex_unlock(&fb_update_mutex);
        }
#endif

        last = curr;
        if(diff <= SLEEP_CONST+prevSleepTime)
        {
            prevSleepTime = SLEEP_CONST+prevSleepTime-diff;
            usleep(prevSleepTime*1000);
        }
        else
            prevSleepTime = 0;
    }
    return NULL;
}

void fb_request_draw(void)
{
    if(!fb_frozen)
        __atomic_cmpxchg(0, 1, &fb_draw_requested);
}

void fb_force_draw(void)
{
    __atomic_swap(1, &fb_draw_requested);
    __futex_wait(&fb_draw_futex, 0, NULL);
}