Blame | Last modification | View Log | RSS feed
////// Copyright 2010 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 "s5l8701.h"#include "util.h"static struct mutex lcd_mutex;void lcd_init(){DMACON8 = 0x20590000;LCDCON = 0xd01;LCDPHTIME = 0;}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;}static void lcd_send_cmd(uint16_t cmd) ICODE_ATTR __attribute__((noinline));static void lcd_send_cmd(uint16_t cmd){while (LCDSTATUS & 0x10);LCDWCMD = cmd;}static void lcd_send_data(uint16_t data) ICODE_ATTR __attribute__((noinline));static void lcd_send_data(uint16_t data){while (LCDSTATUS & 0x10);LCDWDATA = data;}static uint32_t lcd_detect() ICODE_ATTR;static uint32_t lcd_detect(){return (PDAT13 & 1) | (PDAT14 & 2);}bool displaylcd_busy() ICODE_ATTR;bool displaylcd_busy(){return DMAALLST2 & 0x70000;}bool displaylcd_safe(){return !(DMAALLST2 & 0x70000);}void displaylcd_sync() ICODE_ATTR;void displaylcd_sync(){mutex_lock(&lcd_mutex, TIMEOUT_BLOCK);while (displaylcd_busy()) sleep(100);mutex_unlock(&lcd_mutex);}void displaylcd_setup(unsigned int startx, unsigned int endx,unsigned int starty, unsigned int endy) ICODE_ATTR;void displaylcd_setup(unsigned int startx, unsigned int endx,unsigned int starty, unsigned int endy){mutex_lock(&lcd_mutex, TIMEOUT_BLOCK);displaylcd_sync();if (lcd_detect() == 2){lcd_send_cmd(0x50);lcd_send_data(startx);lcd_send_cmd(0x51);lcd_send_data(endx);lcd_send_cmd(0x52);lcd_send_data(starty);lcd_send_cmd(0x53);lcd_send_data(endy);lcd_send_cmd(0x20);lcd_send_data(startx);lcd_send_cmd(0x21);lcd_send_data(starty);lcd_send_cmd(0x22);}else{lcd_send_cmd(0x2a);lcd_send_data(startx);lcd_send_data(endx);lcd_send_cmd(0x2b);lcd_send_data(starty);lcd_send_data(endy);lcd_send_cmd(0x2c);}}static void displaylcd_dma(void* data, int pixels) ICODE_ATTR;static void displaylcd_dma(void* data, int pixels){uint16_t* in = (uint16_t*)data;while (LCDSTATUS & 8);while (pixels & 3){LCDWDATA = *in++;pixels--;}DMABASE8 = in;DMACON8 = 0x20590000;DMATCNT8 = pixels / 4;clean_dcache();DMACOM8 = 4;}static void displaylcd_solid(uint16_t data, int pixels) ICODE_ATTR;static void displaylcd_solid(uint16_t data, int pixels){while (pixels >= 4){while (LCDSTATUS & 8);LCDWDATA = data;LCDWDATA = data;LCDWDATA = data;LCDWDATA = data;pixels -= 4;}while (LCDSTATUS & 8);while (pixels & 3){LCDWDATA = data;pixels--;}}void displaylcd_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;displaylcd_setup(startx, endx, starty, endy);displaylcd_dma(data, pixels);mutex_unlock(&lcd_mutex);}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;displaylcd_setup(startx, endx, starty, endy);displaylcd_solid(color, pixels);mutex_unlock(&lcd_mutex);}void displaylcd_dither(unsigned int x, unsigned int y, unsigned int width,unsigned int height, void* data, unsigned int datax,unsigned int datay, unsigned int stride, bool solid) ICODE_ATTR;void displaylcd_dither(unsigned int x, unsigned int y, unsigned int width,unsigned int height, void* data, unsigned int datax,unsigned int datay, unsigned int stride, bool solid){int pixels = width * height;if (pixels <= 0) return;displaylcd_setup(x, x + width - 1, y, y + height - 1);int corrsize = width * 3;signed char* corr = (signed char*)malloc(corrsize);if (!corr){mutex_unlock(&lcd_mutex);return;}memset(corr, 0, corrsize);unsigned char* in = (unsigned char*)data + (stride * datay + datax) * 3;for (y = 0; y < height; y++){int i;signed char* corrptr = corr;signed char lastcorr[3] = {0};for (x = 0; x < width; x++){unsigned int pixel = 0;signed char* lastcorrptr = lastcorr;int orig = *in++ + *corrptr + *lastcorrptr;orig = MAX(0, MIN(255, orig));unsigned int real = orig >> 3;pixel |= real << 11;int err = orig - ((real << 3) | (real >> 2));*corrptr++ = (*lastcorrptr >> 1) + err >> 2;*lastcorrptr++ = err >> 1;orig = *in++ + *corrptr + *lastcorrptr;orig = MAX(0, MIN(255, orig));real = orig >> 2;pixel |= real << 5;err = orig - ((real << 2) | (real >> 4));*corrptr++ = (*lastcorrptr >> 1) + err >> 2;*lastcorrptr++ = err >> 1;orig = *in++ + *corrptr + *lastcorrptr;orig = MAX(0, MIN(255, orig));real = orig >> 3;pixel |= real;err = orig - ((real << 3) | (real >> 2));*corrptr++ = (*lastcorrptr >> 1) + err >> 2;*lastcorrptr++ = err >> 1;LCDWDATA = pixel;if (solid) in -= 3;}if (solid) in += stride * 3;else in += (stride - width) * 3;}free(corr);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){displaylcd_dither(x, y, width, height, data, datax, datay, stride, false);}void filllcd(unsigned int x, unsigned int y, unsigned int width, unsigned int height, int color){if (width * height <= 0) return;mutex_lock(&lcd_mutex, TIMEOUT_BLOCK);displaylcd_dither(x, y, width, height, &color, 0, 0, 0, true);mutex_unlock(&lcd_mutex);}void lcd_shutdown(){displaylcd_sync();uint32_t type = lcd_detect();if (type == 2){lcd_send_cmd(0x7);lcd_send_data(0x232);lcd_send_cmd(0x13);lcd_send_data(0x1137);lcd_send_cmd(0x7);lcd_send_data(0x201);lcd_send_cmd(0x13);lcd_send_data(0x137);lcd_send_cmd(0x7);lcd_send_data(0x200);lcd_send_cmd(0x10);lcd_send_data(0x680);lcd_send_cmd(0x12);lcd_send_data(0x160);lcd_send_cmd(0x13);lcd_send_data(0x127);lcd_send_cmd(0x10);lcd_send_data(0x600);}else{lcd_send_cmd(0x28);lcd_send_cmd(0x10);}sleep(5000);}void INT_DMA8(){DMACOM8 = 7;lcdconsole_callback();}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("cmp r0, #0xff \n\t""moveq r0, #-1 \n\t""moveq pc, lr \n\t""cmp r0, #0 \n\t""movne r0, #0xff000000 \n\t""orrne r0, r0, #0xff0000 \n\t""mov r2, r2,lsr#2 \n\t""orr r0, r0, r3,lsr#3 \n\t""mov r1, r1,lsr#3 \n\t""orr r0, r0, r2,lsl#5 \n\t""orr r0, r0, r1,lsl#11 \n\t""mov pc, lr \n\t");}