git.sur5r.net Git - u-boot/blob - drivers/video/mb86r0xgdc.c

   1 /*
   2  * (C) Copyright 2010
   3  * Matthias Weisser <weisserm@arcor.de>
   4  *
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation; either version 2 of
  11  * the License, or (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21  * MA 02111-1307 USA
  22  */
  23
  24 /*
  25  * mb86r0xgdc.c - Graphic interface for Fujitsu MB86R0x integrated graphic
  26  * controller.
  27  */
  28
  29 #include <common.h>
  30
  31 #include <malloc.h>
  32 #include <asm/io.h>
  33 #include <asm/arch/hardware.h>
  34 #include <video_fb.h>
  35 #include "videomodes.h"
  36
  37 /*
  38  * 4MB (at the end of system RAM)
  39  */
  40 #define VIDEO_MEM_SIZE          0x400000
  41
  42 #define FB_SYNC_CLK_INV         (1<<16) /* pixel clock inverted */
  43
  44 /*
  45  * Graphic Device
  46  */
  47 static GraphicDevice mb86r0x;
  48
  49 static void dsp_init(struct mb86r0x_gdc_dsp *dsp, char *modestr,
  50                         u32 *videomem)
  51 {
  52         struct ctfb_res_modes var_mode;
  53         u32 dcm1, dcm2, dcm3;
  54         u16 htp, hdp, hdb, hsp, vtr, vsp, vdp;
  55         u8 hsw, vsw;
  56         u32 l2m, l2em, l2oa0, l2da0, l2oa1, l2da1;
  57         u16 l2dx, l2dy, l2wx, l2wy, l2ww, l2wh;
  58         unsigned long div;
  59         int bpp;
  60         u32 i;
  61
  62         bpp = video_get_params(&var_mode, modestr);
  63
  64         if (bpp == 0) {
  65                 var_mode.xres = 640;
  66                 var_mode.yres = 480;
  67                 var_mode.pixclock = 39721;      /* 25MHz */
  68                 var_mode.left_margin = 48;
  69                 var_mode.right_margin = 16;
  70                 var_mode.upper_margin = 33;
  71                 var_mode.lower_margin = 10;
  72                 var_mode.hsync_len = 96;
  73                 var_mode.vsync_len = 2;
  74                 var_mode.sync = 0;
  75                 var_mode.vmode = 0;
  76                 bpp = 15;
  77         }
  78
  79         /* Fill memory with white */
  80         memset(videomem, 0xFF, var_mode.xres * var_mode.yres * 2);
  81
  82         mb86r0x.winSizeX = var_mode.xres;
  83         mb86r0x.winSizeY = var_mode.yres;
  84
  85         /* LCD base clock is ~ 660MHZ. We do calculations in kHz */
  86         div = 660000 / (1000000000L / var_mode.pixclock);
  87         if (div > 64)
  88                 div = 64;
  89         if (0 == div)
  90                 div = 1;
  91
  92         dcm1 = (div - 1) << 8;
  93         dcm2 = 0x00000000;
  94         if (var_mode.sync & FB_SYNC_CLK_INV)
  95                 dcm3 = 0x00000100;
  96         else
  97                 dcm3 = 0x00000000;
  98
  99         htp = var_mode.left_margin + var_mode.xres +
 100                 var_mode.hsync_len + var_mode.right_margin;
 101         hdp = var_mode.xres;
 102         hdb = var_mode.xres;
 103         hsp = var_mode.xres + var_mode.right_margin;
 104         hsw = var_mode.hsync_len;
 105
 106         vsw = var_mode.vsync_len;
 107         vtr = var_mode.upper_margin + var_mode.yres +
 108                 var_mode.vsync_len + var_mode.lower_margin;
 109         vsp = var_mode.yres + var_mode.lower_margin;
 110         vdp = var_mode.yres;
 111
 112         l2m =   ((var_mode.yres - 1) << (0)) |
 113                 (((var_mode.xres * 2) / 64) << (16)) |
 114                 ((1) << (31));
 115
 116         l2em = (1 << 0) | (1 << 1);
 117
 118         l2oa0 = mb86r0x.frameAdrs;
 119         l2da0 = mb86r0x.frameAdrs;
 120         l2oa1 = mb86r0x.frameAdrs;
 121         l2da1 = mb86r0x.frameAdrs;
 122         l2dx = 0;
 123         l2dy = 0;
 124         l2wx = 0;
 125         l2wy = 0;
 126         l2ww = var_mode.xres;
 127         l2wh = var_mode.yres - 1;
 128
 129         writel(dcm1, &dsp->dcm1);
 130         writel(dcm2, &dsp->dcm2);
 131         writel(dcm3, &dsp->dcm3);
 132
 133         writew(htp, &dsp->htp);
 134         writew(hdp, &dsp->hdp);
 135         writew(hdb, &dsp->hdb);
 136         writew(hsp, &dsp->hsp);
 137         writeb(hsw, &dsp->hsw);
 138
 139         writeb(vsw, &dsp->vsw);
 140         writew(vtr, &dsp->vtr);
 141         writew(vsp, &dsp->vsp);
 142         writew(vdp, &dsp->vdp);
 143
 144         writel(l2m, &dsp->l2m);
 145         writel(l2em, &dsp->l2em);
 146         writel(l2oa0, &dsp->l2oa0);
 147         writel(l2da0, &dsp->l2da0);
 148         writel(l2oa1, &dsp->l2oa1);
 149         writel(l2da1, &dsp->l2da1);
 150         writew(l2dx, &dsp->l2dx);
 151         writew(l2dy, &dsp->l2dy);
 152         writew(l2wx, &dsp->l2wx);
 153         writew(l2wy, &dsp->l2wy);
 154         writew(l2ww, &dsp->l2ww);
 155         writew(l2wh, &dsp->l2wh);
 156
 157         writel(dcm1 | (1 << 18) | (1 << 31), &dsp->dcm1);
 158 }
 159
 160 void *video_hw_init(void)
 161 {
 162         struct mb86r0x_gdc *gdc = (struct mb86r0x_gdc *) MB86R0x_GDC_BASE;
 163         GraphicDevice *pGD = &mb86r0x;
 164         char *s;
 165         u32 *vid;
 166
 167         memset(pGD, 0, sizeof(GraphicDevice));
 168
 169         pGD->gdfIndex = GDF_15BIT_555RGB;
 170         pGD->gdfBytesPP = 2;
 171         pGD->memSize = VIDEO_MEM_SIZE;
 172         pGD->frameAdrs = PHYS_SDRAM + PHYS_SDRAM_SIZE - VIDEO_MEM_SIZE;
 173
 174         vid = (u32 *)pGD->frameAdrs;
 175
 176         s = getenv("videomode");
 177         if (s != NULL)
 178                 dsp_init(&gdc->dsp0, s, vid);
 179
 180         s = getenv("videomode1");
 181         if (s != NULL)
 182                 dsp_init(&gdc->dsp1, s, vid);
 183
 184         return pGD;
 185 }