Subversion Repositories freemyipod

//

//

//    Copyright 2011 TheSeven

//

//

//    This file is part of emCORE.

//

//    emCORE 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 2 of the

//    License, or (at your option) any later version.

//

//    emCORE 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 emCORE.  If not, see <http://www.gnu.org/licenses/>.

//

//

#include "global.h"

#include "thread.h"

#include "util.h"

#include "lcd.h"

static struct mutex lcd_mutex IDATA_ATTR;

#define fb ((uint32_t*)0x0fc00000)

void lcd_init()

{

    mutex_init(&lcd_mutex);

}

int lcd_get_width()

{

    return LCD_WIDTH;

}

int lcd_get_height()

{

    return LCD_HEIGHT;

}

int lcd_get_bytes_per_pixel()

{

    return LCD_BYTESPERPIXEL;

}

int lcd_get_format()

{

    return LCD_FORMAT;

}

void lcd_shutdown()

{

}

bool displaylcd_busy() ICODE_ATTR;

bool displaylcd_busy()

{

    return false;

}

void displaylcd_sync() ICODE_ATTR;

void displaylcd_sync()

{

}

void displaylcd_native(unsigned int startx, unsigned int endx,

                       unsigned int starty, unsigned int endy, void* data)

{

    mutex_lock(&lcd_mutex, TIMEOUT_BLOCK);

    displaylcd_safe_native(startx, endx, starty, endy, data);

    mutex_unlock(&lcd_mutex);

}

void displaylcd_safe_native(unsigned int startx, unsigned int endx,

                            unsigned int starty, unsigned int endy, void* data)

{

    int pixels = (endx - startx + 1) * (endy - starty + 1);

    if (pixels <= 0) return;

    uint32_t* ptr = &fb[starty * LCD_WIDTH + startx];

    int rows = endy - starty + 1;

    int rowsize = (endx - startx + 1) * 4;

    while (rows--)

    {

        memcpy(ptr, data, rowsize);

        ptr += LCD_WIDTH;

        data += rowsize;

    }

}

void filllcd_native(unsigned int startx, unsigned int endx,

                    unsigned int starty, unsigned int endy, int color)

{

    int pixels = (endx - startx + 1) * (endy - starty + 1);

    if (pixels <= 0) return;

    uint32_t* ptr = &fb[starty * LCD_WIDTH + startx];

    int rows = endy - starty + 1;

    int rowsize = (endx - startx + 1) * 4;

    while (rows--)

    {

        int i;

        for (i = 0; i < rowsize; i += 4) fb[i] = color;

        ptr += LCD_WIDTH;

    }

    mutex_unlock(&lcd_mutex);

}

void displaylcd(unsigned int x, unsigned int y, unsigned int width, unsigned int height,

                void* data, unsigned int datax, unsigned int datay, unsigned int stride)

{

    if (width * height <= 0) return;

    mutex_lock(&lcd_mutex, TIMEOUT_BLOCK);

    uint32_t* ptr = &fb[y * LCD_WIDTH + x];

    uint8_t* inptr = &((uint8_t*)data)[datay * stride + datax];

    int rowsize = stride * 3;

    while (height--)

    {

        int pixels = width;

        uint8_t* ip = inptr;

        uint32_t* op = ptr;

        while (pixels--)

        {

            uint32_t value = *ip++ << 16;

            value |= *ip++ << 8;

            value |= *ip++;

            *op++ = value;

        }

        inptr += rowsize;

        ptr += LCD_WIDTH;

    }

    mutex_unlock(&lcd_mutex);

}

void filllcd(unsigned int x, unsigned int y, unsigned int width, unsigned int height, int color)

{

    filllcd_native(x, y, width, height, color);

}

int lcd_translate_color(uint8_t alpha, uint8_t red, uint8_t green, uint8_t blue)

    ICODE_ATTR __attribute__((naked, noinline));

int lcd_translate_color(uint8_t alpha, uint8_t red, uint8_t green, uint8_t blue)

{

    asm volatile(

        "orr r0, r3, r0,lsl#24 \n\t"

        "orr r1, r2, r1,lsl#8  \n\t"

        "orr r0, r0, r1,lsl#8  \n\t"

        "mov pc, lr            \n\t"

    );

}