drivers/video/fbdev/geode/display_gx1.c

   1 /*
   2  * drivers/video/geode/display_gx1.c
   3  *   -- Geode GX1 display controller
   4  *
   5  * Copyright (C) 2005 Arcom Control Systems Ltd.
   6  *
   7  * Based on AMD's original 2.4 driver:
   8  *   Copyright (C) 2004 Advanced Micro Devices, Inc.
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License as published by
  12  * the Free Software Foundation; either version 2 of the License, or
  13  * (at your option) any later version.
  14  */
  15 #include <linux/spinlock.h>
  16 #include <linux/fb.h>
  17 #include <linux/delay.h>
  18 #include <asm/io.h>
  19 #include <asm/div64.h>
  20 #include <asm/delay.h>
  21
  22 #include "geodefb.h"
  23 #include "display_gx1.h"
  24
  25 static DEFINE_SPINLOCK(gx1_conf_reg_lock);
  26
  27 static u8 gx1_read_conf_reg(u8 reg)
  28 {
  29         u8 val, ccr3;
  30         unsigned long flags;
  31
  32         spin_lock_irqsave(&gx1_conf_reg_lock, flags);
  33
  34         outb(CONFIG_CCR3, 0x22);
  35         ccr3 = inb(0x23);
  36         outb(CONFIG_CCR3, 0x22);
  37         outb(ccr3 | CONFIG_CCR3_MAPEN, 0x23);
  38         outb(reg, 0x22);
  39         val = inb(0x23);
  40         outb(CONFIG_CCR3, 0x22);
  41         outb(ccr3, 0x23);
  42
  43         spin_unlock_irqrestore(&gx1_conf_reg_lock, flags);
  44
  45         return val;
  46 }
  47
  48 unsigned gx1_gx_base(void)
  49 {
  50         return (gx1_read_conf_reg(CONFIG_GCR) & 0x03) << 30;
  51 }
  52
  53 int gx1_frame_buffer_size(void)
  54 {
  55         void __iomem *mc_regs;
  56         u32 bank_cfg;
  57         int d;
  58         unsigned dram_size = 0, fb_base;
  59
  60         mc_regs = ioremap(gx1_gx_base() + 0x8400, 0x100);
  61         if (!mc_regs)
  62                 return -ENOMEM;
  63
  64
  65         /* Calculate the total size of both DIMM0 and DIMM1. */
  66         bank_cfg = readl(mc_regs + MC_BANK_CFG);
  67
  68         for (d = 0; d < 2; d++) {
  69                 if ((bank_cfg & MC_BCFG_DIMM0_PG_SZ_MASK) != MC_BCFG_DIMM0_PG_SZ_NO_DIMM)
  70                         dram_size += 0x400000 << ((bank_cfg & MC_BCFG_DIMM0_SZ_MASK) >> 8);
  71                 bank_cfg >>= 16; /* look at DIMM1 next */
  72         }
  73
  74         fb_base = (readl(mc_regs + MC_GBASE_ADD) & MC_GADD_GBADD_MASK) << 19;
  75
  76         iounmap(mc_regs);
  77
  78         return dram_size - fb_base;
  79 }
  80
  81 static void gx1_set_mode(struct fb_info *info)
  82 {
  83         struct geodefb_par *par = info->par;
  84         u32 gcfg, tcfg, ocfg, dclk_div, val;
  85         int hactive, hblankstart, hsyncstart, hsyncend, hblankend, htotal;
  86         int vactive, vblankstart, vsyncstart, vsyncend, vblankend, vtotal;
  87
  88         /* Unlock the display controller registers. */
  89         readl(par->dc_regs + DC_UNLOCK);
  90         writel(DC_UNLOCK_CODE, par->dc_regs + DC_UNLOCK);
  91
  92         gcfg = readl(par->dc_regs + DC_GENERAL_CFG);
  93         tcfg = readl(par->dc_regs + DC_TIMING_CFG);
  94
  95         /* Blank the display and disable the timing generator. */
  96         tcfg &= ~(DC_TCFG_BLKE | DC_TCFG_TGEN);
  97         writel(tcfg, par->dc_regs + DC_TIMING_CFG);
  98
  99         /* Wait for pending memory requests before disabling the FIFO load. */
 100         udelay(100);
 101
 102         /* Disable FIFO load and compression. */
 103         gcfg &= ~(DC_GCFG_DFLE | DC_GCFG_CMPE | DC_GCFG_DECE);
 104         writel(gcfg, par->dc_regs + DC_GENERAL_CFG);
 105
 106         /* Setup DCLK and its divisor. */
 107         gcfg &= ~DC_GCFG_DCLK_MASK;
 108         writel(gcfg, par->dc_regs + DC_GENERAL_CFG);
 109
 110         par->vid_ops->set_dclk(info);
 111
 112         dclk_div = DC_GCFG_DCLK_DIV_1; /* FIXME: may need to divide DCLK by 2 sometimes? */
 113         gcfg |= dclk_div;
 114         writel(gcfg, par->dc_regs + DC_GENERAL_CFG);
 115
 116         /* Wait for the clock generatation to settle.  This is needed since
 117          * some of the register writes that follow require that clock to be
 118          * present. */
 119         udelay(1000); /* FIXME: seems a little long */
 120
 121         /*
 122          * Setup new mode.
 123          */
 124
 125         /* Clear all unused feature bits. */
 126         gcfg = DC_GCFG_VRDY | dclk_div;
 127
 128         /* Set FIFO priority (default 6/5) and enable. */
 129         /* FIXME: increase fifo priority for 1280x1024 modes? */
 130         gcfg |= (6 << DC_GCFG_DFHPEL_POS) | (5 << DC_GCFG_DFHPSL_POS) | DC_GCFG_DFLE;
 131
 132         /* FIXME: Set pixel and line double bits if necessary. */
 133
 134         /* Framebuffer start offset. */
 135         writel(0, par->dc_regs + DC_FB_ST_OFFSET);
 136
 137         /* Line delta and line buffer length. */
 138         writel(info->fix.line_length >> 2, par->dc_regs + DC_LINE_DELTA);
 139         writel(((info->var.xres * info->var.bits_per_pixel/8) >> 3) + 2,
 140                par->dc_regs + DC_BUF_SIZE);
 141
 142         /* Output configuration. Enable panel data, set pixel format. */
 143         ocfg = DC_OCFG_PCKE | DC_OCFG_PDEL | DC_OCFG_PDEH;
 144         if (info->var.bits_per_pixel == 8) ocfg |= DC_OCFG_8BPP;
 145
 146         /* Enable timing generator, sync and FP data. */
 147         tcfg = DC_TCFG_FPPE | DC_TCFG_HSYE | DC_TCFG_VSYE | DC_TCFG_BLKE
 148                 | DC_TCFG_TGEN;
 149
 150         /* Horizontal and vertical timings. */
 151         hactive = info->var.xres;
 152         hblankstart = hactive;
 153         hsyncstart = hblankstart + info->var.right_margin;
 154         hsyncend =  hsyncstart + info->var.hsync_len;
 155         hblankend = hsyncend + info->var.left_margin;
 156         htotal = hblankend;
 157
 158         vactive = info->var.yres;
 159         vblankstart = vactive;
 160         vsyncstart = vblankstart + info->var.lower_margin;
 161         vsyncend =  vsyncstart + info->var.vsync_len;
 162         vblankend = vsyncend + info->var.upper_margin;
 163         vtotal = vblankend;
 164
 165         val = (hactive - 1) | ((htotal - 1) << 16);
 166         writel(val, par->dc_regs + DC_H_TIMING_1);
 167         val = (hblankstart - 1) | ((hblankend - 1) << 16);
 168         writel(val, par->dc_regs + DC_H_TIMING_2);
 169         val = (hsyncstart - 1) | ((hsyncend - 1) << 16);
 170         writel(val, par->dc_regs + DC_H_TIMING_3);
 171         writel(val, par->dc_regs + DC_FP_H_TIMING);
 172         val = (vactive - 1) | ((vtotal - 1) << 16);
 173         writel(val, par->dc_regs + DC_V_TIMING_1);
 174         val = (vblankstart - 1) | ((vblankend - 1) << 16);
 175         writel(val, par->dc_regs + DC_V_TIMING_2);
 176         val = (vsyncstart - 1) | ((vsyncend - 1) << 16);
 177         writel(val, par->dc_regs + DC_V_TIMING_3);
 178         val = (vsyncstart - 2) | ((vsyncend - 2) << 16);
 179         writel(val, par->dc_regs + DC_FP_V_TIMING);
 180
 181         /* Write final register values. */
 182         writel(ocfg, par->dc_regs + DC_OUTPUT_CFG);
 183         writel(tcfg, par->dc_regs + DC_TIMING_CFG);
 184         udelay(1000); /* delay after TIMING_CFG. FIXME: perhaps a little long */
 185         writel(gcfg, par->dc_regs + DC_GENERAL_CFG);
 186
 187         par->vid_ops->configure_display(info);
 188
 189         /* Relock display controller registers */
 190         writel(0, par->dc_regs + DC_UNLOCK);
 191
 192         /* FIXME: write line_length and bpp to Graphics Pipeline GP_BLT_STATUS
 193          * register. */
 194 }
 195
 196 static void gx1_set_hw_palette_reg(struct fb_info *info, unsigned regno,
 197                                    unsigned red, unsigned green, unsigned blue)
 198 {
 199         struct geodefb_par *par = info->par;
 200         int val;
 201
 202         /* Hardware palette is in RGB 6-6-6 format. */
 203         val  = (red   <<  2) & 0x3f000;
 204         val |= (green >>  4) & 0x00fc0;
 205         val |= (blue  >> 10) & 0x0003f;
 206
 207         writel(regno, par->dc_regs + DC_PAL_ADDRESS);
 208         writel(val, par->dc_regs + DC_PAL_DATA);
 209 }
 210
 211 const struct geode_dc_ops gx1_dc_ops = {
 212         .set_mode        = gx1_set_mode,
 213         .set_palette_reg = gx1_set_hw_palette_reg,
 214 };