/*************************************************************************** * __________ __ ___. * Open \______ \ ____ ____ | | _\_ |__ _______ ___ * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ * \/ \/ \/ \/ \/ * $Id$ * * Copyright (C) 2008 by Maurus Cuelenaere * * 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 /* off_t */ #include "config.h" #include "jz4740.h" #include "lcd.h" #include "lcd-target.h" #include "system.h" #include "kernel.h" /* Warning: code behaviour is unpredictable when switch_thread() gets called in IRQ mode! So don't update the LCD in an interrupt handler! */ static volatile bool lcd_is_on = false; static struct mutex lcd_mtx; static struct semaphore lcd_wkup; static int lcd_count = 0; void lcd_clock_enable(void) { if(++lcd_count == 1) __cpm_start_lcd(); } void lcd_clock_disable(void) { if(--lcd_count == 0) __cpm_stop_lcd(); } /* LCD init */ void lcd_init_device(void) { lcd_init_controller(); lcd_is_on = true; mutex_init(&lcd_mtx); semaphore_init(&lcd_wkup, 1, 0); system_enable_irq(DMA_IRQ(DMA_LCD_CHANNEL)); } #ifdef HAVE_LCD_ENABLE void lcd_enable(bool state) { if(lcd_is_on == state) return; if(state) { lcd_on(); send_event(LCD_EVENT_ACTIVATION, NULL); } else lcd_off(); lcd_is_on = state; } #endif bool lcd_active(void) { return lcd_is_on; } /* Update a fraction of the display. */ void lcd_update_rect(int x, int y, int width, int height) { /* Currently only do updates with full LCD width. * DMA can't handle full partial updates and CPU is too slow compared * to DMA updates */ x = 0; width = LCD_WIDTH; mutex_lock(&lcd_mtx); lcd_clock_enable(); lcd_set_target(x, y, width, height); dma_enable(); REG_DMAC_DCCSR(DMA_LCD_CHANNEL) = DMAC_DCCSR_NDES; REG_DMAC_DSAR(DMA_LCD_CHANNEL) = PHYSADDR((unsigned long)FBADDR(x,y)); REG_DMAC_DRSR(DMA_LCD_CHANNEL) = DMAC_DRSR_RS_SLCD; REG_DMAC_DTAR(DMA_LCD_CHANNEL) = PHYSADDR(SLCD_FIFO); REG_DMAC_DTCR(DMA_LCD_CHANNEL) = (width * height) >> 3; REG_DMAC_DCMD(DMA_LCD_CHANNEL) = ( DMAC_DCMD_SAI | DMAC_DCMD_RDIL_IGN | DMAC_DCMD_SWDH_32 | DMAC_DCMD_DWDH_16 | DMAC_DCMD_DS_16BYTE ); __dcache_writeback_all(); /* Size of framebuffer is way bigger than cache size. We need to find a way to make the framebuffer uncached, so this statement can get removed. */ while(REG_SLCD_STATE & SLCD_STATE_BUSY); REG_SLCD_CTRL |= SLCD_CTRL_DMA_EN; /* Enable SLCD DMA support */ REG_DMAC_DCCSR(DMA_LCD_CHANNEL) |= DMAC_DCCSR_EN; /* Enable DMA channel */ REG_DMAC_DCMD(DMA_LCD_CHANNEL) |= DMAC_DCMD_TIE; /* Enable DMA interrupt */ semaphore_wait(&lcd_wkup, TIMEOUT_BLOCK); /* Sleeping in lcd_update() should be safe */ REG_DMAC_DCCSR(DMA_LCD_CHANNEL) &= ~DMAC_DCCSR_EN; /* Disable DMA channel */ dma_disable(); while(REG_SLCD_STATE & SLCD_STATE_BUSY); REG_SLCD_CTRL &= ~SLCD_CTRL_DMA_EN; /* Disable SLCD DMA support */ lcd_clock_disable(); mutex_unlock(&lcd_mtx); } void DMA_CALLBACK(DMA_LCD_CHANNEL)(void) { if (REG_DMAC_DCCSR(DMA_LCD_CHANNEL) & DMAC_DCCSR_HLT) REG_DMAC_DCCSR(DMA_LCD_CHANNEL) &= ~DMAC_DCCSR_HLT; if (REG_DMAC_DCCSR(DMA_LCD_CHANNEL) & DMAC_DCCSR_AR) REG_DMAC_DCCSR(DMA_LCD_CHANNEL) &= ~DMAC_DCCSR_AR; if (REG_DMAC_DCCSR(DMA_LCD_CHANNEL) & DMAC_DCCSR_CT) REG_DMAC_DCCSR(DMA_LCD_CHANNEL) &= ~DMAC_DCCSR_CT; if (REG_DMAC_DCCSR(DMA_LCD_CHANNEL) & DMAC_DCCSR_TT) REG_DMAC_DCCSR(DMA_LCD_CHANNEL) &= ~DMAC_DCCSR_TT; semaphore_release(&lcd_wkup); } /* Update the display. This must be called after all other LCD functions that change the display. */ void lcd_update(void) { if(!lcd_is_on) return; lcd_update_rect(0, 0, LCD_WIDTH, LCD_HEIGHT); } /* (Mis)use LCD framebuffer as a temporary buffer */ 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) { unsigned char const * yuv_src[3]; register off_t z; if(!lcd_is_on) return; z = stride * src_y; yuv_src[0] = src[0] + z + src_x; yuv_src[1] = src[1] + (z >> 2) + (src_x >> 1); yuv_src[2] = src[2] + (yuv_src[1] - src[1]); __dcache_writeback_all(); __cpm_start_ipu(); IPU_STOP_IPU(); IPU_RESET_IPU(); IPU_CLEAR_END_FLAG(); IPU_DISABLE_RSIZE(); IPU_DISABLE_IRQ(); IPU_SET_INFMT(INFMT_YUV420); IPU_SET_OUTFMT(OUTFMT_RGB565); IPU_SET_IN_FM(width, height); IPU_SET_Y_STRIDE(stride); IPU_SET_UV_STRIDE(stride, stride); IPU_SET_Y_ADDR(PHYSADDR((unsigned long)yuv_src[0])); IPU_SET_U_ADDR(PHYSADDR((unsigned long)yuv_src[1])); IPU_SET_V_ADDR(PHYSADDR((unsigned long)yuv_src[2])); IPU_SET_OUT_ADDR(PHYSADDR((unsigned long)FBADDR(y,x))); IPU_SET_OUT_FM(height, width); IPU_SET_OUT_STRIDE(height); IPU_SET_CSC_C0_COEF(YUV_CSC_C0); IPU_SET_CSC_C1_COEF(YUV_CSC_C1); IPU_SET_CSC_C2_COEF(YUV_CSC_C2); IPU_SET_CSC_C3_COEF(YUV_CSC_C3); IPU_SET_CSC_C4_COEF(YUV_CSC_C4); IPU_RUN_IPU(); while(!(IPU_POLLING_END_FLAG()) && IPU_IS_ENABLED()); IPU_CLEAR_END_FLAG(); IPU_STOP_IPU(); IPU_RESET_IPU(); __cpm_stop_ipu(); /* YUV speed is limited by LCD speed */ lcd_update_rect(y, x, height, width); }