firmware/target/mips/ingenic_jz47xx/lcd-jz4740.c

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright (C) 2008 by Maurus Cuelenaere
  11  *
  12  * This program is free software; you can redistribute it and/or
  13  * modify it under the terms of the GNU General Public License
  14  * as published by the Free Software Foundation; either version 2
  15  * of the License, or (at your option) any later version.
  16  *
  17  * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  18  * KIND, either express or implied.
  19  *
  20  ****************************************************************************/
  21
  22 #include "config.h"
  23 #include "jz4740.h"
  24 #include "lcd.h"
  25 #include "lcd-target.h"
  26 #include "system.h"
  27 #include "kernel.h"
  28
  29 /*
  30    Warning: code behaviour is unpredictable when switch_thread() gets called in IRQ mode!
  31    So don't update the LCD in an interrupt handler!
  32  */
  33
  34 static volatile bool lcd_is_on = false;
  35 static struct mutex lcd_mtx;
  36 static struct wakeup lcd_wkup;
  37
  38 /* LCD init */
  39 void lcd_init_device(void)
  40 {
  41     __cpm_start_lcd();
  42     lcd_init_controller();
  43     __cpm_stop_lcd();
  44
  45     lcd_is_on = true;
  46     mutex_init(&lcd_mtx);
  47     wakeup_init(&lcd_wkup);
  48     system_enable_irq(DMA_IRQ(DMA_LCD_CHANNEL));
  49 }
  50
  51 void lcd_enable(bool state)
  52 {
  53     if(state)
  54     {
  55         lcd_on();
  56 #ifdef HAVE_LCD_ENABLE
  57         lcd_activation_call_hook();
  58 #endif
  59     }
  60     else
  61         lcd_off();
  62
  63     lcd_is_on = state;
  64 }
  65
  66 bool lcd_active(void)
  67 {
  68     return lcd_is_on;
  69 }
  70
  71 /* Update a fraction of the display. */
  72 void lcd_update_rect(int x, int y, int width, int height)
  73 {
  74    /* Currently only do updates with full LCD width.
  75      * DMA can't handle full partial updates and CPU is too slow compared
  76      * to DMA updates */
  77     x = 0;
  78     width = LCD_WIDTH;
  79
  80     mutex_lock(&lcd_mtx);
  81
  82     __cpm_start_lcd();
  83
  84     lcd_set_target(x, y, width, height);
  85
  86     dma_enable();
  87
  88     REG_DMAC_DCCSR(DMA_LCD_CHANNEL) = DMAC_DCCSR_NDES;
  89     REG_DMAC_DSAR(DMA_LCD_CHANNEL)  = PHYSADDR((unsigned long)&lcd_framebuffer[y][x]);
  90     REG_DMAC_DRSR(DMA_LCD_CHANNEL)  = DMAC_DRSR_RS_SLCD;
  91     REG_DMAC_DTAR(DMA_LCD_CHANNEL)  = PHYSADDR(SLCD_FIFO);
  92     REG_DMAC_DTCR(DMA_LCD_CHANNEL)  = (width * height) >> 3;
  93
  94     REG_DMAC_DCMD(DMA_LCD_CHANNEL)  = ( DMAC_DCMD_SAI     | DMAC_DCMD_RDIL_IGN | DMAC_DCMD_SWDH_32
  95                                       | DMAC_DCMD_DWDH_16 | DMAC_DCMD_DS_16BYTE );
  96
  97     __dcache_writeback_all(); /* Size of framebuffer is way bigger than cache size.
  98                                  We need to find a way to make the framebuffer uncached, so this statement can get removed. */
  99
 100     while(REG_SLCD_STATE & SLCD_STATE_BUSY);
 101     REG_SLCD_CTRL |= SLCD_CTRL_DMA_EN; /* Enable SLCD DMA support */
 102
 103     REG_DMAC_DCCSR(DMA_LCD_CHANNEL) |= DMAC_DCCSR_EN; /* Enable DMA channel */
 104     REG_DMAC_DCMD(DMA_LCD_CHANNEL) |= DMAC_DCMD_TIE; /* Enable DMA interrupt */
 105
 106     wakeup_wait(&lcd_wkup, TIMEOUT_BLOCK); /* Sleeping in lcd_update() should be safe */
 107
 108     REG_DMAC_DCCSR(DMA_LCD_CHANNEL) &= ~DMAC_DCCSR_EN; /* Disable DMA channel */
 109     dma_disable();
 110
 111     while(REG_SLCD_STATE & SLCD_STATE_BUSY);
 112     REG_SLCD_CTRL &= ~SLCD_CTRL_DMA_EN; /* Disable SLCD DMA support */
 113
 114     __cpm_stop_lcd();
 115
 116     mutex_unlock(&lcd_mtx);
 117 }
 118
 119 void DMA_CALLBACK(DMA_LCD_CHANNEL)(void)
 120 {
 121     if (REG_DMAC_DCCSR(DMA_LCD_CHANNEL) & DMAC_DCCSR_HLT)
 122         REG_DMAC_DCCSR(DMA_LCD_CHANNEL) &= ~DMAC_DCCSR_HLT;
 123
 124     if (REG_DMAC_DCCSR(DMA_LCD_CHANNEL) & DMAC_DCCSR_AR)
 125         REG_DMAC_DCCSR(DMA_LCD_CHANNEL) &= ~DMAC_DCCSR_AR;
 126
 127     if (REG_DMAC_DCCSR(DMA_LCD_CHANNEL) & DMAC_DCCSR_CT)
 128         REG_DMAC_DCCSR(DMA_LCD_CHANNEL) &= ~DMAC_DCCSR_CT;
 129
 130     if (REG_DMAC_DCCSR(DMA_LCD_CHANNEL) & DMAC_DCCSR_TT)
 131         REG_DMAC_DCCSR(DMA_LCD_CHANNEL) &= ~DMAC_DCCSR_TT;
 132
 133     wakeup_signal(&lcd_wkup);
 134 }
 135
 136 /* Update the display.
 137    This must be called after all other LCD functions that change the display. */
 138 void lcd_update(void)
 139 {
 140     if(!lcd_is_on)
 141         return;
 142
 143     lcd_update_rect(0, 0, LCD_WIDTH, LCD_HEIGHT);
 144 }
 145
 146 /* (Mis)use LCD framebuffer as a temporary buffer */
 147 void lcd_blit_yuv(unsigned char * const src[3],
 148                   int src_x, int src_y, int stride,
 149                   int x, int y, int width, int height)
 150 {
 151     unsigned char const * yuv_src[3];
 152     register off_t z;
 153
 154     if(!lcd_is_on)
 155         return;
 156
 157     z = stride * src_y;
 158     yuv_src[0] = src[0] + z + src_x;
 159     yuv_src[1] = src[1] + (z >> 2) + (src_x >> 1);
 160     yuv_src[2] = src[2] + (yuv_src[1] - src[1]);
 161
 162     __dcache_writeback_all();
 163
 164     __cpm_start_ipu();
 165
 166     IPU_STOP_IPU();
 167     IPU_RESET_IPU();
 168     IPU_CLEAR_END_FLAG();
 169
 170     IPU_DISABLE_RSIZE();
 171     IPU_DISABLE_IRQ();
 172
 173     IPU_SET_INFMT(INFMT_YUV420);
 174     IPU_SET_OUTFMT(OUTFMT_RGB565);
 175
 176     IPU_SET_IN_FM(width, height);
 177     IPU_SET_Y_STRIDE(stride);
 178     IPU_SET_UV_STRIDE(stride, stride);
 179
 180     IPU_SET_Y_ADDR(PHYSADDR((unsigned long)yuv_src[0]));
 181     IPU_SET_U_ADDR(PHYSADDR((unsigned long)yuv_src[1]));
 182     IPU_SET_V_ADDR(PHYSADDR((unsigned long)yuv_src[2]));
 183     IPU_SET_OUT_ADDR(PHYSADDR((unsigned long)&lcd_framebuffer[x][y]));
 184
 185     IPU_SET_OUT_FM(height, width);
 186     IPU_SET_OUT_STRIDE(height);
 187
 188     IPU_SET_CSC_C0_COEF(YUV_CSC_C0);
 189     IPU_SET_CSC_C1_COEF(YUV_CSC_C1);
 190     IPU_SET_CSC_C2_COEF(YUV_CSC_C2);
 191     IPU_SET_CSC_C3_COEF(YUV_CSC_C3);
 192     IPU_SET_CSC_C4_COEF(YUV_CSC_C4);
 193
 194     IPU_RUN_IPU();
 195
 196     while(!(IPU_POLLING_END_FLAG()) && IPU_IS_ENABLED());
 197
 198     IPU_CLEAR_END_FLAG();
 199     IPU_STOP_IPU();
 200     IPU_RESET_IPU();
 201
 202     __cpm_stop_ipu();
 203
 204     /* YUV speed is limited by LCD speed */
 205     lcd_update_rect(y, x, height, width);
 206 }