1.1 --- /dev/null Thu Jan 01 00:00:00 1970 +0000
1.2 +++ b/nanonote_gpm940b0.c Sat Jun 06 23:29:51 2015 +0200
1.3 @@ -0,0 +1,415 @@
1.4 +/*
1.5 + * JzRISC lcd controller
1.6 + *
1.7 + * Xiangfu Liu <xiangfu@sharism.cc>
1.8 + *
1.9 + * This program is free software; you can redistribute it and/or
1.10 + * modify it under the terms of the GNU General Public License as
1.11 + * published by the Free Software Foundation; either version 2 of
1.12 + * the License, or (at your option) any later version.
1.13 + *
1.14 + * This program is distributed in the hope that it will be useful,
1.15 + * but WITHOUT ANY WARRANTY; without even the implied warranty of
1.16 + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
1.17 + * GNU General Public License for more details.
1.18 + *
1.19 + * You should have received a copy of the GNU General Public License
1.20 + * along with this program; if not, write to the Free Software
1.21 + * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
1.22 + * MA 02111-1307 USA
1.23 + */
1.24 +
1.25 +#include "lcd.h"
1.26 +
1.27 +/* virt_to_phys() from u-boot/arch/mips/include/asm/addrspace.h
1.28 + via u-boot/arch/mips/include/asm/io.h */
1.29 +#define virt_to_phys(n) (((int) n) & 0x1fffffff)
1.30 +
1.31 +#include "jz4740.h"
1.32 +#include "nanonote_gpm940b0.h"
1.33 +#include "board-nanonote.h"
1.34 +
1.35 +#define align2(n) (n)=((((n)+1)>>1)<<1)
1.36 +#define align4(n) (n)=((((n)+3)>>2)<<2)
1.37 +#define align8(n) (n)=((((n)+7)>>3)<<3)
1.38 +
1.39 +struct jzfb_info {
1.40 + unsigned int cfg; /* panel mode and pin usage etc. */
1.41 + unsigned int w;
1.42 + unsigned int h;
1.43 + unsigned int bpp; /* bit per pixel */
1.44 + unsigned int fclk; /* frame clk */
1.45 + unsigned int hsw; /* hsync width, in pclk */
1.46 + unsigned int vsw; /* vsync width, in line count */
1.47 + unsigned int elw; /* end of line, in pclk */
1.48 + unsigned int blw; /* begin of line, in pclk */
1.49 + unsigned int efw; /* end of frame, in line count */
1.50 + unsigned int bfw; /* begin of frame, in line count */
1.51 +};
1.52 +
1.53 +static struct jzfb_info jzfb = {
1.54 + MODE_8BIT_SERIAL_TFT | PCLK_N | HSYNC_N | VSYNC_N,
1.55 + 320, 240, 32, 70, 1, 1, 273, 140, 1, 20
1.56 +};
1.57 +
1.58 +vidinfo_t panel_info = {
1.59 + 320, 240, LCD_BPP,
1.60 +};
1.61 +
1.62 +int lcd_line_length;
1.63 +int lcd_color_fg;
1.64 +int lcd_color_bg;
1.65 +/*
1.66 + * Frame buffer memory information
1.67 + */
1.68 +void *lcd_base; /* Start of framebuffer memory */
1.69 +void *lcd_console_address; /* Start of console buffer */
1.70 +
1.71 +short console_col;
1.72 +short console_row;
1.73 +
1.74 +void lcd_ctrl_init (void *lcdbase);
1.75 +void lcd_enable (void);
1.76 +void lcd_disable (void);
1.77 +
1.78 +static int jz_lcd_init_mem(void *lcdbase, vidinfo_t *vid);
1.79 +static void jz_lcd_desc_init(vidinfo_t *vid);
1.80 +static int jz_lcd_hw_init(vidinfo_t *vid);
1.81 +/* extern int flush_cache_all(void); */
1.82 +
1.83 +void lcd_ctrl_init (void *lcdbase)
1.84 +{
1.85 + jz_lcd_init_mem(lcdbase, &panel_info);
1.86 + jz_lcd_desc_init(&panel_info);
1.87 + jz_lcd_hw_init(&panel_info);
1.88 +}
1.89 +
1.90 +/*
1.91 + * Before enabled lcd controller, lcd registers should be configured correctly.
1.92 + */
1.93 +void lcd_enable (void)
1.94 +{
1.95 + REG_LCD_CTRL &= ~(1<<4); /* LCDCTRL.DIS */
1.96 + REG_LCD_CTRL |= 1<<3; /* LCDCTRL.ENA*/
1.97 +}
1.98 +
1.99 +void lcd_disable (void)
1.100 +{
1.101 + REG_LCD_CTRL |= (1<<4); /* LCDCTRL.DIS, regular disable */
1.102 + /* REG_LCD_CTRL |= (1<<3); */ /* LCDCTRL.DIS, quikly disable */
1.103 +}
1.104 +
1.105 +static int jz_lcd_init_mem(void *lcdbase, vidinfo_t *vid)
1.106 +{
1.107 + unsigned long palette_mem_size;
1.108 + struct jz_fb_info *fbi = &vid->jz_fb;
1.109 + int fb_size = vid->vl_row * (vid->vl_col * NBITS (vid->vl_bpix)) / 8;
1.110 +
1.111 + fbi->screen = (unsigned long)lcdbase;
1.112 + fbi->palette_size = 256;
1.113 + palette_mem_size = fbi->palette_size * sizeof(u16);
1.114 +
1.115 + /* debug("jz_lcd.c palette_mem_size = 0x%08lx\n", (unsigned long) palette_mem_size); */
1.116 + /* locate palette and descs at end of page following fb */
1.117 + fbi->palette = (unsigned long)lcdbase + fb_size + PAGE_SIZE - palette_mem_size;
1.118 +
1.119 + return 0;
1.120 +}
1.121 +
1.122 +static void jz_lcd_desc_init(vidinfo_t *vid)
1.123 +{
1.124 + struct jz_fb_info * fbi;
1.125 + fbi = &vid->jz_fb;
1.126 + fbi->dmadesc_fblow = (struct jz_fb_dma_descriptor *)((unsigned int)fbi->palette - 3*16);
1.127 + fbi->dmadesc_fbhigh = (struct jz_fb_dma_descriptor *)((unsigned int)fbi->palette - 2*16);
1.128 + fbi->dmadesc_palette = (struct jz_fb_dma_descriptor *)((unsigned int)fbi->palette - 1*16);
1.129 +
1.130 + #define BYTES_PER_PANEL (vid->vl_col * vid->vl_row * NBITS(vid->vl_bpix) / 8)
1.131 +
1.132 + /* populate descriptors */
1.133 + fbi->dmadesc_fblow->fdadr = virt_to_phys(fbi->dmadesc_fblow);
1.134 + fbi->dmadesc_fblow->fsadr = virt_to_phys((void *)(fbi->screen + BYTES_PER_PANEL));
1.135 + fbi->dmadesc_fblow->fidr = 0;
1.136 + fbi->dmadesc_fblow->ldcmd = BYTES_PER_PANEL / 4 ;
1.137 +
1.138 + fbi->fdadr1 = virt_to_phys(fbi->dmadesc_fblow); /* only used in dual-panel mode */
1.139 +
1.140 + fbi->dmadesc_fbhigh->fsadr = virt_to_phys((void *)fbi->screen);
1.141 + fbi->dmadesc_fbhigh->fidr = 0;
1.142 + fbi->dmadesc_fbhigh->ldcmd = BYTES_PER_PANEL / 4; /* length in word */
1.143 +
1.144 + fbi->dmadesc_palette->fsadr = virt_to_phys((void *)fbi->palette);
1.145 + fbi->dmadesc_palette->fidr = 0;
1.146 + fbi->dmadesc_palette->ldcmd = (fbi->palette_size * 2)/4 | (1<<28);
1.147 +
1.148 + if(NBITS(vid->vl_bpix) < 12)
1.149 + {
1.150 + /* assume any mode with <12 bpp is palette driven */
1.151 + fbi->dmadesc_palette->fdadr = virt_to_phys(fbi->dmadesc_fbhigh);
1.152 + fbi->dmadesc_fbhigh->fdadr = virt_to_phys(fbi->dmadesc_palette);
1.153 + /* flips back and forth between pal and fbhigh */
1.154 + fbi->fdadr0 = virt_to_phys(fbi->dmadesc_palette);
1.155 + } else {
1.156 + /* palette shouldn't be loaded in true-color mode */
1.157 + fbi->dmadesc_fbhigh->fdadr = virt_to_phys((void *)fbi->dmadesc_fbhigh);
1.158 + fbi->fdadr0 = virt_to_phys(fbi->dmadesc_fbhigh); /* no pal just fbhigh */
1.159 + }
1.160 +
1.161 + flush_cache_all();
1.162 +}
1.163 +
1.164 +static int jz_lcd_hw_init(vidinfo_t *vid)
1.165 +{
1.166 + struct jz_fb_info *fbi = &vid->jz_fb;
1.167 + unsigned int val = 0;
1.168 + unsigned int pclk;
1.169 + unsigned int stnH;
1.170 + int pll_div;
1.171 +
1.172 + /* Setting Control register */
1.173 + switch (jzfb.bpp) {
1.174 + case 1:
1.175 + val |= LCD_CTRL_BPP_1;
1.176 + break;
1.177 + case 2:
1.178 + val |= LCD_CTRL_BPP_2;
1.179 + break;
1.180 + case 4:
1.181 + val |= LCD_CTRL_BPP_4;
1.182 + break;
1.183 + case 8:
1.184 + val |= LCD_CTRL_BPP_8;
1.185 + break;
1.186 + case 15:
1.187 + val |= LCD_CTRL_RGB555;
1.188 + case 16:
1.189 + val |= LCD_CTRL_BPP_16;
1.190 + break;
1.191 + case 17 ... 32:
1.192 + val |= LCD_CTRL_BPP_18_24; /* target is 4bytes/pixel */
1.193 + break;
1.194 +
1.195 + default:
1.196 + /* printf("jz_lcd.c The BPP %d is not supported\n", jzfb.bpp); */
1.197 + val |= LCD_CTRL_BPP_16;
1.198 + break;
1.199 + }
1.200 +
1.201 + switch (jzfb.cfg & MODE_MASK) {
1.202 + case MODE_STN_MONO_DUAL:
1.203 + case MODE_STN_COLOR_DUAL:
1.204 + case MODE_STN_MONO_SINGLE:
1.205 + case MODE_STN_COLOR_SINGLE:
1.206 + switch (jzfb.bpp) {
1.207 + case 1:
1.208 + /* val |= LCD_CTRL_PEDN; */
1.209 + case 2:
1.210 + val |= LCD_CTRL_FRC_2;
1.211 + break;
1.212 + case 4:
1.213 + val |= LCD_CTRL_FRC_4;
1.214 + break;
1.215 + case 8:
1.216 + default:
1.217 + val |= LCD_CTRL_FRC_16;
1.218 + break;
1.219 + }
1.220 + break;
1.221 + }
1.222 +
1.223 + val |= LCD_CTRL_BST_16; /* Burst Length is 16WORD=64Byte */
1.224 + val |= LCD_CTRL_OFUP; /* OutFIFO underrun protect */
1.225 +
1.226 + switch (jzfb.cfg & MODE_MASK) {
1.227 + case MODE_STN_MONO_DUAL:
1.228 + case MODE_STN_COLOR_DUAL:
1.229 + case MODE_STN_MONO_SINGLE:
1.230 + case MODE_STN_COLOR_SINGLE:
1.231 + switch (jzfb.cfg & STN_DAT_PINMASK) {
1.232 + case STN_DAT_PIN1:
1.233 + /* Do not adjust the hori-param value. */
1.234 + break;
1.235 + case STN_DAT_PIN2:
1.236 + align2(jzfb.hsw);
1.237 + align2(jzfb.elw);
1.238 + align2(jzfb.blw);
1.239 + break;
1.240 + case STN_DAT_PIN4:
1.241 + align4(jzfb.hsw);
1.242 + align4(jzfb.elw);
1.243 + align4(jzfb.blw);
1.244 + break;
1.245 + case STN_DAT_PIN8:
1.246 + align8(jzfb.hsw);
1.247 + align8(jzfb.elw);
1.248 + align8(jzfb.blw);
1.249 + break;
1.250 + }
1.251 + break;
1.252 + }
1.253 +
1.254 + REG_LCD_CTRL = val;
1.255 +
1.256 + switch (jzfb.cfg & MODE_MASK) {
1.257 + case MODE_STN_MONO_DUAL:
1.258 + case MODE_STN_COLOR_DUAL:
1.259 + case MODE_STN_MONO_SINGLE:
1.260 + case MODE_STN_COLOR_SINGLE:
1.261 + if (((jzfb.cfg & MODE_MASK) == MODE_STN_MONO_DUAL) ||
1.262 + ((jzfb.cfg & MODE_MASK) == MODE_STN_COLOR_DUAL))
1.263 + stnH = jzfb.h >> 1;
1.264 + else
1.265 + stnH = jzfb.h;
1.266 +
1.267 + REG_LCD_VSYNC = (0 << 16) | jzfb.vsw;
1.268 + REG_LCD_HSYNC = ((jzfb.blw+jzfb.w) << 16) | (jzfb.blw+jzfb.w+jzfb.hsw);
1.269 +
1.270 + /* Screen setting */
1.271 + REG_LCD_VAT = ((jzfb.blw + jzfb.w + jzfb.hsw + jzfb.elw) << 16) | (stnH + jzfb.vsw + jzfb.bfw + jzfb.efw);
1.272 + REG_LCD_DAH = (jzfb.blw << 16) | (jzfb.blw + jzfb.w);
1.273 + REG_LCD_DAV = (0 << 16) | (stnH);
1.274 +
1.275 + /* AC BIAs signal */
1.276 + REG_LCD_PS = (0 << 16) | (stnH+jzfb.vsw+jzfb.efw+jzfb.bfw);
1.277 +
1.278 + break;
1.279 +
1.280 + case MODE_TFT_GEN:
1.281 + case MODE_TFT_SHARP:
1.282 + case MODE_TFT_CASIO:
1.283 + case MODE_TFT_SAMSUNG:
1.284 + case MODE_8BIT_SERIAL_TFT:
1.285 + case MODE_TFT_18BIT:
1.286 + REG_LCD_VSYNC = (0 << 16) | jzfb.vsw;
1.287 + REG_LCD_HSYNC = (0 << 16) | jzfb.hsw;
1.288 + REG_LCD_DAV =((jzfb.vsw+jzfb.bfw) << 16) | (jzfb.vsw +jzfb.bfw+jzfb.h);
1.289 + REG_LCD_DAH = ((jzfb.hsw + jzfb.blw) << 16) | (jzfb.hsw + jzfb.blw + jzfb.w );
1.290 + REG_LCD_VAT = (((jzfb.blw + jzfb.w + jzfb.elw + jzfb.hsw)) << 16) \
1.291 + | (jzfb.vsw + jzfb.bfw + jzfb.h + jzfb.efw);
1.292 + break;
1.293 + }
1.294 +
1.295 + switch (jzfb.cfg & MODE_MASK) {
1.296 + case MODE_TFT_SAMSUNG:
1.297 + {
1.298 + unsigned int total, tp_s, tp_e, ckv_s, ckv_e;
1.299 + unsigned int rev_s, rev_e, inv_s, inv_e;
1.300 +
1.301 + pclk = val * (jzfb.w + jzfb.hsw + jzfb.elw + jzfb.blw) *
1.302 + (jzfb.h + jzfb.vsw + jzfb.efw + jzfb.bfw); /* Pixclk */
1.303 +
1.304 + total = jzfb.blw + jzfb.w + jzfb.elw + jzfb.hsw;
1.305 + tp_s = jzfb.blw + jzfb.w + 1;
1.306 + tp_e = tp_s + 1;
1.307 + /* ckv_s = tp_s - jz_clocks.pixclk/(1000000000/4100); */
1.308 + ckv_s = tp_s - pclk/(1000000000/4100);
1.309 + ckv_e = tp_s + total;
1.310 + rev_s = tp_s - 11; /* -11.5 clk */
1.311 + rev_e = rev_s + total;
1.312 + inv_s = tp_s;
1.313 + inv_e = inv_s + total;
1.314 + REG_LCD_CLS = (tp_s << 16) | tp_e;
1.315 + REG_LCD_PS = (ckv_s << 16) | ckv_e;
1.316 + REG_LCD_SPL = (rev_s << 16) | rev_e;
1.317 + REG_LCD_REV = (inv_s << 16) | inv_e;
1.318 + jzfb.cfg |= STFT_REVHI | STFT_SPLHI;
1.319 + break;
1.320 + }
1.321 + case MODE_TFT_SHARP:
1.322 + {
1.323 + unsigned int total, cls_s, cls_e, ps_s, ps_e;
1.324 + unsigned int spl_s, spl_e, rev_s, rev_e;
1.325 + total = jzfb.blw + jzfb.w + jzfb.elw + jzfb.hsw;
1.326 + spl_s = 1;
1.327 + spl_e = spl_s + 1;
1.328 + cls_s = 0;
1.329 + cls_e = total - 60; /* > 4us (pclk = 80ns) */
1.330 + ps_s = cls_s;
1.331 + ps_e = cls_e;
1.332 + rev_s = total - 40; /* > 3us (pclk = 80ns) */
1.333 + rev_e = rev_s + total;
1.334 + jzfb.cfg |= STFT_PSHI;
1.335 + REG_LCD_SPL = (spl_s << 16) | spl_e;
1.336 + REG_LCD_CLS = (cls_s << 16) | cls_e;
1.337 + REG_LCD_PS = (ps_s << 16) | ps_e;
1.338 + REG_LCD_REV = (rev_s << 16) | rev_e;
1.339 + break;
1.340 + }
1.341 + case MODE_TFT_CASIO:
1.342 + break;
1.343 + }
1.344 +
1.345 + /* Configure the LCD panel */
1.346 + REG_LCD_CFG = jzfb.cfg;
1.347 +
1.348 + /* Timing setting */
1.349 + __cpm_stop_lcd();
1.350 +
1.351 + val = jzfb.fclk; /* frame clk */
1.352 + if ( (jzfb.cfg & MODE_MASK) != MODE_8BIT_SERIAL_TFT) {
1.353 + pclk = val * (jzfb.w + jzfb.hsw + jzfb.elw + jzfb.blw) *
1.354 + (jzfb.h + jzfb.vsw + jzfb.efw + jzfb.bfw); /* Pixclk */
1.355 + } else {
1.356 + /* serial mode: Hsync period = 3*Width_Pixel */
1.357 + pclk = val * (jzfb.w*3 + jzfb.hsw + jzfb.elw + jzfb.blw) *
1.358 + (jzfb.h + jzfb.vsw + jzfb.efw + jzfb.bfw); /* Pixclk */
1.359 + }
1.360 +
1.361 + if (((jzfb.cfg & MODE_MASK) == MODE_STN_COLOR_SINGLE) ||
1.362 + ((jzfb.cfg & MODE_MASK) == MODE_STN_COLOR_DUAL))
1.363 + pclk = (pclk * 3);
1.364 +
1.365 + if (((jzfb.cfg & MODE_MASK) == MODE_STN_COLOR_SINGLE) ||
1.366 + ((jzfb.cfg & MODE_MASK) == MODE_STN_COLOR_DUAL) ||
1.367 + ((jzfb.cfg & MODE_MASK) == MODE_STN_MONO_SINGLE) ||
1.368 + ((jzfb.cfg & MODE_MASK) == MODE_STN_MONO_DUAL))
1.369 + pclk = pclk >> ((jzfb.cfg & STN_DAT_PINMASK) >> 4);
1.370 +
1.371 + if (((jzfb.cfg & MODE_MASK) == MODE_STN_COLOR_DUAL) ||
1.372 + ((jzfb.cfg & MODE_MASK) == MODE_STN_MONO_DUAL))
1.373 + pclk >>= 1;
1.374 +
1.375 + pll_div = ( REG_CPM_CPCCR & CPM_CPCCR_PCS ); /* clock source,0:pllout/2 1: pllout */
1.376 + pll_div = pll_div ? 1 : 2 ;
1.377 + val = ( __cpm_get_pllout()/pll_div ) / pclk;
1.378 + val--;
1.379 + if ( val > 0x1ff ) {
1.380 + /* printf("CPM_LPCDR too large, set it to 0x1ff\n"); */
1.381 + val = 0x1ff;
1.382 + }
1.383 + __cpm_set_pixdiv(val);
1.384 +
1.385 + val = pclk * 3 ; /* LCDClock > 2.5*Pixclock */
1.386 + if ( val > 150000000 ) {
1.387 + /* printf("Warning: LCDClock=%d\n, LCDClock must less or equal to 150MHz.\n", val); */
1.388 + /* printf("Change LCDClock to 150MHz\n"); */
1.389 + val = 150000000;
1.390 + }
1.391 + val = ( __cpm_get_pllout()/pll_div ) / val;
1.392 + val--;
1.393 + if ( val > 0x1f ) {
1.394 + /* printf("CPM_CPCCR.LDIV too large, set it to 0x1f\n"); */
1.395 + val = 0x1f;
1.396 + }
1.397 + __cpm_set_ldiv( val );
1.398 + REG_CPM_CPCCR |= CPM_CPCCR_CE ; /* update divide */
1.399 +
1.400 + __cpm_start_lcd();
1.401 + udelay(1000);
1.402 +
1.403 + REG_LCD_DA0 = fbi->fdadr0; /* frame descripter*/
1.404 +
1.405 + if (((jzfb.cfg & MODE_MASK) == MODE_STN_COLOR_DUAL) ||
1.406 + ((jzfb.cfg & MODE_MASK) == MODE_STN_MONO_DUAL))
1.407 + REG_LCD_DA1 = fbi->fdadr1; /* frame descripter*/
1.408 +
1.409 + return 0;
1.410 +}
1.411 +
1.412 +void lcd_setcolreg (unsigned short regno, unsigned short red, unsigned short green, unsigned short blue)
1.413 +{
1.414 +}
1.415 +
1.416 +void lcd_initcolregs (void)
1.417 +{
1.418 +}