Subversion Repositories freemyipod

Rev

Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
268 theseven 1 
//
2 
//
3 
//    Copyright 2010 TheSeven
4 
//
5 
//
427 farthen 6 
//    This file is part of emCORE.
268 theseven 7 
//
427 farthen 8 
//    emCORE is free software: you can redistribute it and/or
268 theseven 9 
//    modify it under the terms of the GNU General Public License as
10 
//    published by the Free Software Foundation, either version 2 of the
11 
//    License, or (at your option) any later version.
12 
//
427 farthen 13 
//    emCORE is distributed in the hope that it will be useful,
268 theseven 14 
//    but WITHOUT ANY WARRANTY; without even the implied warranty of
15 
//    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
16 
//    See the GNU General Public License for more details.
17 
//
18 
//    You should have received a copy of the GNU General Public License along
427 farthen 19 
//    with emCORE.  If not, see <http://www.gnu.org/licenses/>.
268 theseven 20 
//
21 
//
22 
 
23 
 
24 
#include "global.h"
25 
#include "thread.h"
26 
#include "s5l8720.h"
27 
#include "util.h"
28 
 
29 
 
278 theseven 30 
static struct dma_lli lcd_lli[(LCD_WIDTH * LCD_HEIGHT - 1) / 0xfff]
31 
    IDATA_ATTR __attribute__((aligned(16)));
268 theseven 32 
 
33 
static uint16_t lcd_color IDATA_ATTR;
34 
 
35 
 
36 
void lcd_init()
37 
{
38 
}
39 
 
40 
int lcd_get_width()
41 
{
42 
    return LCD_WIDTH;
43 
}
44 
 
45 
int lcd_get_height()
46 
{
47 
    return LCD_HEIGHT;
48 
}
49 
 
50 
int lcd_get_bytes_per_pixel()
51 
{
52 
    return LCD_BYTESPERPIXEL;
53 
}
54 
 
55 
static void lcd_send_cmd(uint16_t cmd)
56 
{
57 
    while (LCDSTATUS & 0x10);
58 
    LCDWCMD = cmd;
59 
}
60 
 
61 
static void lcd_send_data(uint16_t data)
62 
{
63 
    while (LCDSTATUS & 0x10);
64 
    LCDWDATA = data;
65 
}
66 
 
67 
void lcd_shutdown()
68 
{
69 
}
70 
 
71 
bool displaylcd_busy()
72 
{
73 
    return DMAC0C0CONFIG & 1;
74 
}
75 
 
76 
bool displaylcd_safe()
77 
{
78 
    return !(DMAC0C0CONFIG & 1);
79 
}
80 
 
81 
void displaylcd_sync()
82 
{
83 
    while (displaylcd_busy()) sleep(100);
84 
}
85 
 
86 
void displaylcd(unsigned int startx, unsigned int endx,
87 
                unsigned int starty, unsigned int endy, void* data, int color)
88 
{
89 
    displaylcd_sync();
90 
    lcd_send_cmd(0x2a);
91 
    lcd_send_data(((startx & 0x7f00) << 1) | (startx & 0xff));
92 
    lcd_send_data(((endx & 0x7f00) << 1) | (endx & 0xff));
93 
    lcd_send_cmd(0x2b);
94 
    lcd_send_data(((starty & 0x7f00) << 1) | (starty & 0xff));
95 
    lcd_send_data(((endy & 0x7f00) << 1) | (endy & 0xff));
96 
    lcd_send_cmd(0x2c);
97 
    int pixels = (endx - startx + 1) * (endy - starty + 1);
98 
    int i;
99 
    bool solid = (int)data == -1;
100 
    if (solid) lcd_color = color;
278 theseven 101 
    for (i = -1; i < (int)ARRAYLEN(lcd_lli) && pixels > 0; i++, pixels -= 0xfff)
268 theseven 102 
    {
278 theseven 103 
        bool last = i + 1 >= ARRAYLEN(lcd_lli) || pixels <= 0xfff;
104 
        struct dma_lli* lli = i < 0 ? (struct dma_lli*)((int)&DMAC0C0LLI) : &lcd_lli[i];
105 
        lli->srcaddr = solid ? &lcd_color : data;
106 
        lli->dstaddr = (void*)((int)&LCDWDATA);
107 
        lli->nextlli = last ? NULL : &lcd_lli[i + 1];
108 
        lli->control = 0x70240000 | (last ? pixels : 0xfff)
109 
                     | (last ? 0x80000000 : 0) | (solid ? 0 : 0x4000000);
268 theseven 110 
        data = (void*)(((uint32_t)data) + 0x1ffe);
111 
    }
112 
    clean_dcache();
113 
    DMAC0C0CONFIG = 0x88c1;
114 
}
115 
 
116 
void INT_DMAC0C0()
117 
{
118 
    DMAC0INTTCCLR = 1;
119 
    lcdconsole_callback();
120 
}
121 
 
122 
int lcd_translate_color(uint8_t alpha, uint8_t red, uint8_t green, uint8_t blue)
123 
    ICODE_ATTR __attribute__((naked, noinline));
124 
int lcd_translate_color(uint8_t alpha, uint8_t red, uint8_t green, uint8_t blue)
125 
{
126 
    asm volatile(
127 
        "cmp r0, #0xff             \n\t"
128 
        "moveq r0, #-1             \n\t"
129 
        "moveq pc, lr              \n\t"
130 
        "cmp r0, #0                \n\t"
131 
        "movne r0, #0xff000000     \n\t"
132 
        "orrne r0, r0, #0xff0000   \n\t"
133 
        "mov r2, r2,lsr#2          \n\t"
134 
        "orr r0, r0, r3,lsr#3      \n\t"
135 
        "mov r1, r1,lsr#3          \n\t"
136 
        "orr r0, r0, r2,lsl#5      \n\t"
137 
        "orr r0, r0, r1,lsl#11     \n\t"
138 
        "mov pc, lr                \n\t"
139 
    );
140 
}