/*************************************************************************** * __________ __ ___. * Open \______ \ ____ ____ | | _\_ |__ _______ ___ * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ * \/ \/ \/ \/ \/ * $Id$ * * Copyright (C) 2009 by Mark Arigo * * This program 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. * * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY * KIND, either express or implied. * ****************************************************************************/ #include "config.h" #include "cpu.h" #include "lcd.h" #include "kernel.h" #include "system.h" /* Display status */ static unsigned lcd_yuv_options SHAREDBSS_ATTR = 0; /* wait for LCD */ static inline void lcd_wait_write(void) { while (LCD2_PORT & LCD2_BUSY_MASK); } /* send LCD data */ static void lcd_send_data(unsigned data) { lcd_wait_write(); LCD2_PORT = LCD2_DATA_MASK | (data & 0xff); } /* send LCD command */ static void lcd_send_reg(unsigned reg) { lcd_wait_write(); LCD2_PORT = LCD2_CMD_MASK | (reg & 0xff); lcd_wait_write(); } void lcd_init_device(void) { /* init handled by the OF bootloader */ } /*** hardware configuration ***/ int lcd_default_contrast(void) { return DEFAULT_CONTRAST_SETTING; } void lcd_set_contrast(int val) { (void)val; } void lcd_set_invert_display(bool yesno) { (void)yesno; } /* turn the display upside down (call lcd_update() afterwards) */ void lcd_set_flip(bool yesno) { (void)yesno; } void lcd_yuv_set_options(unsigned options) { lcd_yuv_options = options; } #define CSUB_X 2 #define CSUB_Y 2 /* YUV- > RGB565 conversion * |R| |1.000000 -0.000001 1.402000| |Y'| * |G| = |1.000000 -0.334136 -0.714136| |Pb| * |B| |1.000000 1.772000 0.000000| |Pr| * Scaled, normalized, rounded and tweaked to yield RGB 565: * |R| |74 0 101| |Y' - 16| >> 9 * |G| = |74 -24 -51| |Cb - 128| >> 8 * |B| |74 128 0| |Cr - 128| >> 9 */ extern void lcd_yuv_write_inner_loop(unsigned char const * const ysrc, unsigned char const * const usrc, unsigned char const * const vsrc, int width); /* Performance function to blit a YUV bitmap directly to the LCD */ void lcd_blit_yuv(unsigned char * const src[3], int src_x, int src_y, int stride, int x, int y, int width, int height) { int h; width = (width + 1) & ~1; lcd_send_reg(0x01); lcd_send_data(0x48); lcd_send_reg(0x05); lcd_send_data(0x0f); lcd_send_reg(0x08); lcd_send_data(y); lcd_send_reg(0x09); lcd_send_data(y + height - 1); lcd_send_reg(0x0a); lcd_send_data(x + 16); lcd_send_reg(0x0b); lcd_send_data(x + width - 1 + 16); lcd_send_reg(0x06); const int stride_div_csub_x = stride/CSUB_X; h=0; while (1) { /* upsampling, YUV->RGB conversion and reduction to RGB565 in one go */ const unsigned char *ysrc = src[0] + stride * src_y + src_x; const int uvoffset = stride_div_csub_x * (src_y/CSUB_Y) + (src_x/CSUB_X); const unsigned char *usrc = src[1] + uvoffset; const unsigned char *vsrc = src[2] + uvoffset; int pixels_to_write; if (h==0) { while (!(LCD2_BLOCK_CTRL & LCD2_BLOCK_READY)); LCD2_BLOCK_CONFIG = 0; if (height == 0) break; pixels_to_write = (width * height) * 2; h = height; /* calculate how much we can do in one go */ if (pixels_to_write > 0x10000) { h = (0x10000/2) / width; pixels_to_write = (width * h) * 2; } height -= h; LCD2_BLOCK_CTRL = 0x10000080; LCD2_BLOCK_CONFIG = 0xc0010000 | (pixels_to_write - 1); LCD2_BLOCK_CTRL = 0x34000000; } lcd_yuv_write_inner_loop(ysrc,usrc,vsrc,width); src_y++; h--; } while (!(LCD2_BLOCK_CTRL & LCD2_BLOCK_READY)); LCD2_BLOCK_CONFIG = 0; } /* Update the display. This must be called after all other LCD functions that change the display. */ void lcd_update(void) { lcd_update_rect(0, 0, LCD_WIDTH, LCD_HEIGHT); } /* Update a fraction of the display. */ void lcd_update_rect(int x, int y, int width, int height) { unsigned long *addr; int new_x, new_width; /* Ensure x and width are both even - so we can read 32-bit aligned data from lcd_framebuffer */ new_x = x&~1; new_width = width&~1; if (new_x+new_width < x+width) new_width += 2; x = new_x; width = new_width; if (x + width >= LCD_WIDTH) width = LCD_WIDTH - x; if (y + height >= LCD_HEIGHT) height = LCD_HEIGHT - y; if ((width <= 0) || (height <= 0)) return; /* Nothing left to do. */ lcd_send_reg(0x01); lcd_send_data(0x48); lcd_send_reg(0x05); lcd_send_data(0x0f); lcd_send_reg(0x08); lcd_send_data(y); lcd_send_reg(0x09); lcd_send_data(y + height - 1); lcd_send_reg(0x0a); lcd_send_data(x + 16); lcd_send_reg(0x0b); lcd_send_data(x + width - 1 + 16); lcd_send_reg(0x06); addr = (unsigned long*)&lcd_framebuffer[y][x]; while (height > 0) { int c, r; int h, pixels_to_write; pixels_to_write = (width * height) * 2; h = height; /* calculate how much we can do in one go */ if (pixels_to_write > 0x10000) { h = (0x10000/2) / width; pixels_to_write = (width * h) * 2; } LCD2_BLOCK_CTRL = 0x10000080; LCD2_BLOCK_CONFIG = 0xc0010000 | (pixels_to_write - 1); LCD2_BLOCK_CTRL = 0x34000000; /* for each row */ for (r = 0; r < h; r++) { /* for each column */ for (c = 0; c < width; c += 2) { while (!(LCD2_BLOCK_CTRL & LCD2_BLOCK_TXOK)); /* output 2 pixels */ LCD2_BLOCK_DATA = *addr++; } addr += (LCD_WIDTH - width)/2; } while (!(LCD2_BLOCK_CTRL & LCD2_BLOCK_READY)); LCD2_BLOCK_CONFIG = 0; height -= h; } }