| 513 |
theseven |
1 |
//
|
|
|
2 |
//
|
|
|
3 |
// Copyright 2010 TheSeven
|
|
|
4 |
//
|
|
|
5 |
//
|
|
|
6 |
// This file is part of emCORE.
|
|
|
7 |
//
|
|
|
8 |
// emCORE is free software: you can redistribute it and/or
|
|
|
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 |
//
|
|
|
13 |
// emCORE is distributed in the hope that it will be useful,
|
|
|
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
|
|
|
19 |
// with emCORE. If not, see <http://www.gnu.org/licenses/>.
|
|
|
20 |
//
|
|
|
21 |
//
|
|
|
22 |
|
|
|
23 |
|
|
|
24 |
#include "global.h"
|
|
|
25 |
#include "thread.h"
|
|
|
26 |
#include "s5l8702.h"
|
|
|
27 |
#include "util.h"
|
|
|
28 |
|
|
|
29 |
|
|
|
30 |
static struct dma_lli lcd_lli[(LCD_WIDTH * LCD_HEIGHT - 1) / 0xfff]
|
|
|
31 |
IDATA_ATTR __attribute__((aligned(16)));
|
|
|
32 |
|
|
|
33 |
static uint16_t lcd_color IDATA_ATTR;
|
|
|
34 |
|
|
|
35 |
static struct mutex lcd_mutex;
|
|
|
36 |
|
|
|
37 |
|
|
|
38 |
void lcd_init()
|
|
|
39 |
{
|
|
|
40 |
}
|
|
|
41 |
|
|
|
42 |
int lcd_get_width()
|
|
|
43 |
{
|
|
|
44 |
return LCD_WIDTH;
|
|
|
45 |
}
|
|
|
46 |
|
|
|
47 |
int lcd_get_height()
|
|
|
48 |
{
|
|
|
49 |
return LCD_HEIGHT;
|
|
|
50 |
}
|
|
|
51 |
|
|
|
52 |
int lcd_get_bytes_per_pixel()
|
|
|
53 |
{
|
|
|
54 |
return LCD_BYTESPERPIXEL;
|
|
|
55 |
}
|
|
|
56 |
|
|
|
57 |
int lcd_get_format()
|
|
|
58 |
{
|
|
|
59 |
return LCD_FORMAT;
|
|
|
60 |
}
|
|
|
61 |
|
|
|
62 |
static void lcd_send_cmd(uint16_t cmd) ICODE_ATTR __attribute__((noinline));
|
|
|
63 |
static void lcd_send_cmd(uint16_t cmd)
|
|
|
64 |
{
|
|
|
65 |
while (LCDSTATUS & 0x10);
|
|
|
66 |
LCDWCMD = cmd;
|
|
|
67 |
}
|
|
|
68 |
|
|
|
69 |
static void lcd_send_data(uint16_t data) ICODE_ATTR __attribute__((noinline));
|
|
|
70 |
static void lcd_send_data(uint16_t data)
|
|
|
71 |
{
|
|
|
72 |
while (LCDSTATUS & 0x10);
|
|
|
73 |
LCDWDATA = (data & 0xff) | ((data & 0x7f00) << 1);
|
|
|
74 |
}
|
|
|
75 |
|
|
|
76 |
static uint32_t lcd_detect() ICODE_ATTR;
|
|
|
77 |
static uint32_t lcd_detect()
|
|
|
78 |
{
|
|
|
79 |
return (PDAT6 & 0x30) >> 4;
|
|
|
80 |
}
|
|
|
81 |
|
|
|
82 |
bool displaylcd_busy() ICODE_ATTR;
|
|
|
83 |
bool displaylcd_busy()
|
|
|
84 |
{
|
|
|
85 |
return DMAC0C4CONFIG & 1;
|
|
|
86 |
}
|
|
|
87 |
|
|
|
88 |
bool displaylcd_safe()
|
|
|
89 |
{
|
|
|
90 |
return !(DMAC0C4CONFIG & 1);
|
|
|
91 |
}
|
|
|
92 |
|
|
|
93 |
void displaylcd_sync() ICODE_ATTR;
|
|
|
94 |
void displaylcd_sync()
|
|
|
95 |
{
|
|
|
96 |
while (displaylcd_busy()) sleep(100);
|
|
|
97 |
}
|
|
|
98 |
|
|
|
99 |
void displaylcd_setup(unsigned int startx, unsigned int endx,
|
|
|
100 |
unsigned int starty, unsigned int endy) ICODE_ATTR;
|
|
|
101 |
void displaylcd_setup(unsigned int startx, unsigned int endx,
|
|
|
102 |
unsigned int starty, unsigned int endy)
|
|
|
103 |
{
|
| 521 |
theseven |
104 |
displaylcd_sync();
|
| 513 |
theseven |
105 |
mutex_lock(&lcd_mutex, TIMEOUT_BLOCK);
|
|
|
106 |
if (lcd_detect() & 2)
|
|
|
107 |
{
|
|
|
108 |
lcd_send_cmd(0x210);
|
|
|
109 |
lcd_send_data(startx);
|
|
|
110 |
lcd_send_cmd(0x211);
|
|
|
111 |
lcd_send_data(endx);
|
|
|
112 |
lcd_send_cmd(0x212);
|
|
|
113 |
lcd_send_data(starty);
|
|
|
114 |
lcd_send_cmd(0x213);
|
|
|
115 |
lcd_send_data(endy);
|
|
|
116 |
lcd_send_cmd(0x200);
|
|
|
117 |
lcd_send_data(startx);
|
|
|
118 |
lcd_send_cmd(0x201);
|
|
|
119 |
lcd_send_data(starty);
|
|
|
120 |
lcd_send_cmd(0x202);
|
|
|
121 |
}
|
|
|
122 |
else
|
|
|
123 |
{
|
|
|
124 |
lcd_send_cmd(0x2a);
|
|
|
125 |
lcd_send_data(startx >> 8);
|
|
|
126 |
lcd_send_data(startx & 0xff);
|
|
|
127 |
lcd_send_data(endx >> 8);
|
|
|
128 |
lcd_send_data(endx & 0xff);
|
|
|
129 |
lcd_send_cmd(0x2b);
|
|
|
130 |
lcd_send_data(starty >> 8);
|
|
|
131 |
lcd_send_data(starty & 0xff);
|
|
|
132 |
lcd_send_data(endy >> 8);
|
|
|
133 |
lcd_send_data(endy & 0xff);
|
|
|
134 |
lcd_send_cmd(0x2c);
|
|
|
135 |
}
|
|
|
136 |
}
|
|
|
137 |
|
|
|
138 |
static void displaylcd_dma(void* data, int pixels, bool solid) ICODE_ATTR;
|
|
|
139 |
static void displaylcd_dma(void* data, int pixels, bool solid)
|
|
|
140 |
{
|
|
|
141 |
int i;
|
|
|
142 |
for (i = -1; i < (int)ARRAYLEN(lcd_lli) && pixels > 0; i++, pixels -= 0xfff)
|
|
|
143 |
{
|
|
|
144 |
bool last = i + 1 >= ARRAYLEN(lcd_lli) || pixels <= 0xfff;
|
|
|
145 |
struct dma_lli* lli = i < 0 ? (struct dma_lli*)((int)&DMAC0C4LLI) : &lcd_lli[i];
|
|
|
146 |
lli->srcaddr = data;
|
|
|
147 |
lli->dstaddr = (void*)((int)&LCDWDATA);
|
|
|
148 |
lli->nextlli = last ? NULL : &lcd_lli[i + 1];
|
|
|
149 |
lli->control = 0x70240000 | (last ? pixels : 0xfff)
|
|
|
150 |
| (last ? 0x80000000 : 0) | (solid ? 0 : 0x4000000);
|
| 521 |
theseven |
151 |
if (!solid) data = (void*)(((uint32_t)data) + 0x1ffe);
|
| 513 |
theseven |
152 |
}
|
|
|
153 |
clean_dcache();
|
|
|
154 |
DMAC0C4CONFIG = 0x88c1;
|
|
|
155 |
}
|
|
|
156 |
|
|
|
157 |
void displaylcd_native(unsigned int startx, unsigned int endx,
|
|
|
158 |
unsigned int starty, unsigned int endy, void* data)
|
|
|
159 |
{
|
|
|
160 |
int pixels = (endx - startx + 1) * (endy - starty + 1);
|
|
|
161 |
if (pixels <= 0) return;
|
|
|
162 |
displaylcd_setup(startx, endx, starty, endy);
|
|
|
163 |
displaylcd_dma(data, pixels, false);
|
|
|
164 |
mutex_unlock(&lcd_mutex);
|
|
|
165 |
}
|
|
|
166 |
|
|
|
167 |
void filllcd_native(unsigned int startx, unsigned int endx,
|
|
|
168 |
unsigned int starty, unsigned int endy, int color)
|
|
|
169 |
{
|
|
|
170 |
int pixels = (endx - startx + 1) * (endy - starty + 1);
|
|
|
171 |
if (pixels <= 0) return;
|
|
|
172 |
displaylcd_setup(startx, endx, starty, endy);
|
|
|
173 |
lcd_color = color;
|
|
|
174 |
displaylcd_dma(&lcd_color, pixels, true);
|
|
|
175 |
mutex_unlock(&lcd_mutex);
|
|
|
176 |
}
|
|
|
177 |
|
|
|
178 |
void displaylcd_dither(unsigned int x, unsigned int y, unsigned int width,
|
|
|
179 |
unsigned int height, void* data, unsigned int datax,
|
|
|
180 |
unsigned int datay, unsigned int stride, bool solid)
|
|
|
181 |
ICODE_ATTR __attribute__((naked,noinline));
|
|
|
182 |
void displaylcd_dither(unsigned int x, unsigned int y, unsigned int width,
|
|
|
183 |
unsigned int height, void* data, unsigned int datax,
|
|
|
184 |
unsigned int datay, unsigned int stride, bool solid)
|
|
|
185 |
{
|
|
|
186 |
__asm__ volatile(" muls r12, r2, r3 \n");
|
|
|
187 |
__asm__ volatile(" bxeq lr \n");
|
|
|
188 |
__asm__ volatile(" stmfd sp!, {r2-r11,lr} \n");
|
|
|
189 |
__asm__ volatile(" mov r12, r2 \n");
|
|
|
190 |
__asm__ volatile(" add r8, r2, r2,lsl#1 \n");
|
|
|
191 |
__asm__ volatile(" add r3, r1, r3 \n");
|
|
|
192 |
__asm__ volatile(" sub r3, r3, #1 \n");
|
|
|
193 |
__asm__ volatile(" mov r2, r1 \n");
|
|
|
194 |
__asm__ volatile(" add r1, r0, r12 \n");
|
|
|
195 |
__asm__ volatile(" sub r1, r1, #1 \n");
|
|
|
196 |
__asm__ volatile(" bl displaylcd_setup \n");
|
|
|
197 |
__asm__ volatile(" mov r0, r8 \n");
|
|
|
198 |
__asm__ volatile(" bl malloc \n");
|
|
|
199 |
__asm__ volatile(" cmp r0, #0 \n");
|
|
|
200 |
__asm__ volatile(" beq displaylcd_dither_unlock \n");
|
|
|
201 |
__asm__ volatile(" mov r2, r8 \n");
|
|
|
202 |
__asm__ volatile(" mov r1, #0 \n");
|
|
|
203 |
__asm__ volatile(" mov r8, r0 \n");
|
|
|
204 |
__asm__ volatile(" bl memset \n");
|
|
|
205 |
__asm__ volatile(" ldr r0, [sp,#0x30] \n");
|
|
|
206 |
__asm__ volatile(" ldr r1, [sp,#0x34] \n");
|
|
|
207 |
__asm__ volatile(" ldr r11, [sp,#0x38] \n");
|
|
|
208 |
__asm__ volatile(" ldr r3, [sp,#0x2c] \n");
|
|
|
209 |
__asm__ volatile(" mla r0, r1, r11, r0 \n");
|
|
|
210 |
__asm__ volatile(" ldr r12, [sp,#0x04] \n");
|
|
|
211 |
__asm__ volatile(" ldr r2, [sp,#0x3c] \n");
|
|
|
212 |
__asm__ volatile(" add r3, r3, r0,lsl#1 \n");
|
|
|
213 |
__asm__ volatile(" cmp r2, #0 \n");
|
|
|
214 |
__asm__ volatile(" ldreq r1, [sp] \n");
|
|
|
215 |
__asm__ volatile(" add r3, r3, r0 \n");
|
|
|
216 |
__asm__ volatile(" subeq r11, r11, r1 \n");
|
|
|
217 |
__asm__ volatile(" add r11, r11, r11,lsl#1 \n");
|
|
|
218 |
__asm__ volatile(" movne r10, #3 \n");
|
|
|
219 |
__asm__ volatile(" moveq r10, #0 \n");
|
|
|
220 |
__asm__ volatile(" ldr r9, =0x38300040 \n");
|
|
|
221 |
__asm__ volatile("displaylcd_dither_y: \n");
|
|
|
222 |
__asm__ volatile(" ldr lr, [sp] \n");
|
|
|
223 |
__asm__ volatile(" mov r4, #0 \n");
|
|
|
224 |
__asm__ volatile(" mov r5, #0 \n");
|
|
|
225 |
__asm__ volatile(" mov r6, #0 \n");
|
|
|
226 |
__asm__ volatile(" mov r7, r8 \n");
|
|
|
227 |
__asm__ volatile("displaylcd_dither_x: \n");
|
|
|
228 |
__asm__ volatile(" mov r2, #0 \n");
|
|
|
229 |
__asm__ volatile(" ldrb r1, [r3], #1 \n");
|
|
|
230 |
__asm__ volatile(" ldrsb r0, [r7] \n");
|
|
|
231 |
__asm__ volatile(" add r1, r1, r4 \n");
|
|
|
232 |
__asm__ volatile(" add r1, r1, r0 \n");
|
|
|
233 |
__asm__ volatile(" cmp r1, #0 \n");
|
|
|
234 |
__asm__ volatile(" movlt r1, #0 \n");
|
|
|
235 |
__asm__ volatile(" cmp r1, #0xff \n");
|
|
|
236 |
__asm__ volatile(" movgt r1, #0xff \n");
|
|
|
237 |
__asm__ volatile(" mov r0, r1,lsr#3 \n");
|
|
|
238 |
__asm__ volatile(" orr r2, r0,lsl#11 \n");
|
|
|
239 |
__asm__ volatile(" sub r1, r1, r0,lsl#3 \n");
|
|
|
240 |
__asm__ volatile(" sub r1, r1, r0,lsr#2 \n");
|
|
|
241 |
__asm__ volatile(" mov r4, r4,lsr#1 \n");
|
|
|
242 |
__asm__ volatile(" add r4, r4, r1,lsr#2 \n");
|
|
|
243 |
__asm__ volatile(" strb r4, [r7], #1 \n");
|
|
|
244 |
__asm__ volatile(" mov r4, r1,asr#1 \n");
|
|
|
245 |
__asm__ volatile(" ldrb r1, [r3], #1 \n");
|
|
|
246 |
__asm__ volatile(" ldrsb r0, [r7] \n");
|
|
|
247 |
__asm__ volatile(" add r1, r1, r5 \n");
|
|
|
248 |
__asm__ volatile(" add r1, r1, r0 \n");
|
|
|
249 |
__asm__ volatile(" cmp r1, #0 \n");
|
|
|
250 |
__asm__ volatile(" movlt r1, #0 \n");
|
|
|
251 |
__asm__ volatile(" cmp r1, #0xff \n");
|
|
|
252 |
__asm__ volatile(" movgt r1, #0xff \n");
|
|
|
253 |
__asm__ volatile(" mov r0, r1,lsr#2 \n");
|
|
|
254 |
__asm__ volatile(" orr r2, r0,lsl#5 \n");
|
|
|
255 |
__asm__ volatile(" sub r1, r1, r0,lsl#2 \n");
|
|
|
256 |
__asm__ volatile(" sub r1, r1, r0,lsr#4 \n");
|
|
|
257 |
__asm__ volatile(" mov r5, r5,lsr#1 \n");
|
|
|
258 |
__asm__ volatile(" add r5, r5, r1,lsr#2 \n");
|
|
|
259 |
__asm__ volatile(" strb r5, [r7], #1 \n");
|
|
|
260 |
__asm__ volatile(" mov r5, r1,asr#1 \n");
|
|
|
261 |
__asm__ volatile(" ldrb r1, [r3], #1 \n");
|
|
|
262 |
__asm__ volatile(" ldrsb r0, [r7] \n");
|
|
|
263 |
__asm__ volatile(" add r1, r1, r6 \n");
|
|
|
264 |
__asm__ volatile(" add r1, r1, r0 \n");
|
|
|
265 |
__asm__ volatile(" cmp r1, #0 \n");
|
|
|
266 |
__asm__ volatile(" movlt r1, #0 \n");
|
|
|
267 |
__asm__ volatile(" cmp r1, #0xff \n");
|
|
|
268 |
__asm__ volatile(" movgt r1, #0xff \n");
|
|
|
269 |
__asm__ volatile(" mov r0, r1,lsr#3 \n");
|
|
|
270 |
__asm__ volatile(" orr r2, r0 \n");
|
|
|
271 |
__asm__ volatile(" sub r1, r1, r0,lsl#3 \n");
|
|
|
272 |
__asm__ volatile(" sub r1, r1, r0,lsr#2 \n");
|
|
|
273 |
__asm__ volatile(" mov r6, r6,lsr#1 \n");
|
|
|
274 |
__asm__ volatile(" add r6, r6, r1,lsr#2 \n");
|
|
|
275 |
__asm__ volatile(" strb r6, [r7], #1 \n");
|
|
|
276 |
__asm__ volatile(" mov r6, r1,asr#1 \n");
|
|
|
277 |
__asm__ volatile(" str r2, [r9] \n");
|
|
|
278 |
__asm__ volatile(" sub r3, r3, r10 \n");
|
|
|
279 |
__asm__ volatile(" subs lr, lr, #1 \n");
|
|
|
280 |
__asm__ volatile(" bne displaylcd_dither_x \n");
|
|
|
281 |
__asm__ volatile(" add r3, r3, r11 \n");
|
|
|
282 |
__asm__ volatile(" subs r12, r12, #1 \n");
|
|
|
283 |
__asm__ volatile(" bne displaylcd_dither_y \n");
|
|
|
284 |
__asm__ volatile("displaylcd_dither_free: \n");
|
|
|
285 |
__asm__ volatile(" mov r0, r8 \n");
|
|
|
286 |
__asm__ volatile(" bl free \n");
|
|
|
287 |
__asm__ volatile("displaylcd_dither_unlock: \n");
|
|
|
288 |
__asm__ volatile(" ldr r0, =lcd_mutex \n");
|
|
|
289 |
__asm__ volatile(" bl mutex_unlock \n");
|
|
|
290 |
__asm__ volatile(" ldmfd sp!, {r2-r11,pc} \n");
|
|
|
291 |
}
|
|
|
292 |
|
|
|
293 |
void displaylcd(unsigned int x, unsigned int y, unsigned int width, unsigned int height,
|
|
|
294 |
void* data, unsigned int datax, unsigned int datay, unsigned int stride)
|
|
|
295 |
{
|
|
|
296 |
displaylcd_dither(x, y, width, height, data, datax, datay, stride, false);
|
|
|
297 |
}
|
|
|
298 |
|
|
|
299 |
void filllcd(unsigned int x, unsigned int y, unsigned int width, unsigned int height, int color)
|
|
|
300 |
{
|
|
|
301 |
if (width * height <= 0) return;
|
| 521 |
theseven |
302 |
displaylcd_sync();
|
| 513 |
theseven |
303 |
mutex_lock(&lcd_mutex, TIMEOUT_BLOCK);
|
|
|
304 |
lcd_color = color;
|
|
|
305 |
displaylcd_dither(x, y, width, height, &lcd_color, 0, 0, 0, true);
|
|
|
306 |
mutex_unlock(&lcd_mutex);
|
|
|
307 |
}
|
|
|
308 |
|
|
|
309 |
void lcd_shutdown()
|
|
|
310 |
{
|
|
|
311 |
displaylcd_sync();
|
|
|
312 |
uint32_t type = lcd_detect();
|
|
|
313 |
if (type & 2)
|
|
|
314 |
{
|
|
|
315 |
lcd_send_cmd(0x7);
|
|
|
316 |
lcd_send_data(0x172);
|
|
|
317 |
lcd_send_cmd(0x30);
|
|
|
318 |
lcd_send_data(0x3ff);
|
|
|
319 |
sleep(90000);
|
|
|
320 |
lcd_send_cmd(0x7);
|
|
|
321 |
lcd_send_data(0x120);
|
|
|
322 |
lcd_send_cmd(0x30);
|
|
|
323 |
lcd_send_data(0x0);
|
|
|
324 |
lcd_send_cmd(0x100);
|
|
|
325 |
lcd_send_data(0x780);
|
|
|
326 |
lcd_send_cmd(0x7);
|
|
|
327 |
lcd_send_data(0x0);
|
|
|
328 |
lcd_send_cmd(0x101);
|
|
|
329 |
lcd_send_data(0x260);
|
|
|
330 |
lcd_send_cmd(0x102);
|
|
|
331 |
lcd_send_data(0xa9);
|
|
|
332 |
sleep(30000);
|
|
|
333 |
lcd_send_cmd(0x100);
|
|
|
334 |
lcd_send_data(0x700);
|
|
|
335 |
lcd_send_cmd(0x100);
|
|
|
336 |
lcd_send_data(0x704);
|
|
|
337 |
}
|
|
|
338 |
else if (type == 1)
|
|
|
339 |
{
|
|
|
340 |
lcd_send_cmd(0x28);
|
|
|
341 |
lcd_send_cmd(0x10);
|
|
|
342 |
sleep(100000);
|
|
|
343 |
}
|
|
|
344 |
else
|
|
|
345 |
{
|
|
|
346 |
lcd_send_cmd(0x28);
|
|
|
347 |
sleep(50000);
|
|
|
348 |
lcd_send_cmd(0x10);
|
|
|
349 |
sleep(50000);
|
|
|
350 |
}
|
|
|
351 |
}
|
|
|
352 |
|
|
|
353 |
void INT_DMAC0C4()
|
|
|
354 |
{
|
|
|
355 |
DMAC0INTTCCLR = 0x10;
|
|
|
356 |
lcdconsole_callback();
|
|
|
357 |
}
|
|
|
358 |
|
|
|
359 |
int lcd_translate_color(uint8_t alpha, uint8_t red, uint8_t green, uint8_t blue)
|
|
|
360 |
ICODE_ATTR __attribute__((naked, noinline));
|
|
|
361 |
int lcd_translate_color(uint8_t alpha, uint8_t red, uint8_t green, uint8_t blue)
|
|
|
362 |
{
|
|
|
363 |
asm volatile(
|
|
|
364 |
"cmp r0, #0xff \n\t"
|
|
|
365 |
"moveq r0, #-1 \n\t"
|
|
|
366 |
"moveq pc, lr \n\t"
|
|
|
367 |
"cmp r0, #0 \n\t"
|
|
|
368 |
"movne r0, #0xff000000 \n\t"
|
|
|
369 |
"orrne r0, r0, #0xff0000 \n\t"
|
|
|
370 |
"mov r2, r2,lsr#2 \n\t"
|
|
|
371 |
"orr r0, r0, r3,lsr#3 \n\t"
|
|
|
372 |
"mov r1, r1,lsr#3 \n\t"
|
|
|
373 |
"orr r0, r0, r2,lsl#5 \n\t"
|
|
|
374 |
"orr r0, r0, r1,lsl#11 \n\t"
|
|
|
375 |
"mov pc, lr \n\t"
|
|
|
376 |
);
|
|
|
377 |
}
|