drivers/video/geode/video_cs5530.c

   1 /*
   2  * drivers/video/geode/video_cs5530.c
   3  *   -- CS5530 video device
   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/fb.h>
  16 #include <linux/delay.h>
  17 #include <asm/io.h>
  18 #include <asm/delay.h>
  19
  20 #include "geodefb.h"
  21 #include "video_cs5530.h"
  22
  23 /*
  24  * CS5530 PLL table. This maps pixclocks to the appropriate PLL register
  25  * value.
  26  */
  27 struct cs5530_pll_entry {
  28         long pixclock; /* ps */
  29         u32 pll_value;
  30 };
  31
  32 static const struct cs5530_pll_entry cs5530_pll_table[] = {
  33         { 39721, 0x31C45801, }, /*  25.1750 MHz */
  34         { 35308, 0x20E36802, }, /*  28.3220 */
  35         { 31746, 0x33915801, }, /*  31.5000 */
  36         { 27777, 0x31EC4801, }, /*  36.0000 */
  37         { 26666, 0x21E22801, }, /*  37.5000 */
  38         { 25000, 0x33088801, }, /*  40.0000 */
  39         { 22271, 0x33E22801, }, /*  44.9000 */
  40         { 20202, 0x336C4801, }, /*  49.5000 */
  41         { 20000, 0x23088801, }, /*  50.0000 */
  42         { 19860, 0x23088801, }, /*  50.3500 */
  43         { 18518, 0x3708A801, }, /*  54.0000 */
  44         { 17777, 0x23E36802, }, /*  56.2500 */
  45         { 17733, 0x23E36802, }, /*  56.3916 */
  46         { 17653, 0x23E36802, }, /*  56.6444 */
  47         { 16949, 0x37C45801, }, /*  59.0000 */
  48         { 15873, 0x23EC4801, }, /*  63.0000 */
  49         { 15384, 0x37911801, }, /*  65.0000 */
  50         { 14814, 0x37963803, }, /*  67.5000 */
  51         { 14124, 0x37058803, }, /*  70.8000 */
  52         { 13888, 0x3710C805, }, /*  72.0000 */
  53         { 13333, 0x37E22801, }, /*  75.0000 */
  54         { 12698, 0x27915801, }, /*  78.7500 */
  55         { 12500, 0x37D8D802, }, /*  80.0000 */
  56         { 11135, 0x27588802, }, /*  89.8000 */
  57         { 10582, 0x27EC4802, }, /*  94.5000 */
  58         { 10101, 0x27AC6803, }, /*  99.0000 */
  59         { 10000, 0x27088801, }, /* 100.0000 */
  60         {  9259, 0x2710C805, }, /* 108.0000 */
  61         {  8888, 0x27E36802, }, /* 112.5000 */
  62         {  7692, 0x27C58803, }, /* 130.0000 */
  63         {  7407, 0x27316803, }, /* 135.0000 */
  64         {  6349, 0x2F915801, }, /* 157.5000 */
  65         {  6172, 0x2F08A801, }, /* 162.0000 */
  66         {  5714, 0x2FB11802, }, /* 175.0000 */
  67         {  5291, 0x2FEC4802, }, /* 189.0000 */
  68         {  4950, 0x2F963803, }, /* 202.0000 */
  69         {  4310, 0x2FB1B802, }, /* 232.0000 */
  70 };
  71
  72 #define NUM_CS5530_FREQUENCIES sizeof(cs5530_pll_table)/sizeof(struct cs5530_pll_entry)
  73
  74 static void cs5530_set_dclk_frequency(struct fb_info *info)
  75 {
  76         struct geodefb_par *par = info->par;
  77         int i;
  78         u32 value;
  79         long min, diff;
  80
  81         /* Search the table for the closest pixclock. */
  82         value = cs5530_pll_table[0].pll_value;
  83         min = cs5530_pll_table[0].pixclock - info->var.pixclock;
  84         if (min < 0) min = -min;
  85         for (i = 1; i < NUM_CS5530_FREQUENCIES; i++) {
  86                 diff = cs5530_pll_table[i].pixclock - info->var.pixclock;
  87                 if (diff < 0L) diff = -diff;
  88                 if (diff < min) {
  89                         min = diff;
  90                         value = cs5530_pll_table[i].pll_value;
  91                 }
  92         }
  93
  94         writel(value, par->vid_regs + CS5530_DOT_CLK_CONFIG);
  95         writel(value | 0x80000100, par->vid_regs + CS5530_DOT_CLK_CONFIG); /* set reset and bypass */
  96         udelay(500); /* wait for PLL to settle */
  97         writel(value & 0x7FFFFFFF, par->vid_regs + CS5530_DOT_CLK_CONFIG); /* clear reset */
  98         writel(value & 0x7FFFFEFF, par->vid_regs + CS5530_DOT_CLK_CONFIG); /* clear bypass */
  99 }
 100
 101 static void cs5530_configure_display(struct fb_info *info)
 102 {
 103         struct geodefb_par *par = info->par;
 104         u32 dcfg;
 105
 106         dcfg = readl(par->vid_regs + CS5530_DISPLAY_CONFIG);
 107
 108         /* Clear bits from existing mode. */
 109         dcfg &= ~(CS5530_DCFG_CRT_SYNC_SKW_MASK | CS5530_DCFG_PWR_SEQ_DLY_MASK
 110                   | CS5530_DCFG_CRT_HSYNC_POL   | CS5530_DCFG_CRT_VSYNC_POL
 111                   | CS5530_DCFG_FP_PWR_EN       | CS5530_DCFG_FP_DATA_EN
 112                   | CS5530_DCFG_DAC_PWR_EN      | CS5530_DCFG_VSYNC_EN
 113                   | CS5530_DCFG_HSYNC_EN);
 114
 115         /* Set default sync skew and power sequence delays.  */
 116         dcfg |= (CS5530_DCFG_CRT_SYNC_SKW_INIT | CS5530_DCFG_PWR_SEQ_DLY_INIT
 117                  | CS5530_DCFG_GV_PAL_BYP);
 118
 119         /* Enable DACs, hsync and vsync for CRTs */
 120         if (par->enable_crt) {
 121                 dcfg |= CS5530_DCFG_DAC_PWR_EN;
 122                 dcfg |= CS5530_DCFG_HSYNC_EN | CS5530_DCFG_VSYNC_EN;
 123         }
 124         /* Enable panel power and data if using a flat panel. */
 125         if (par->panel_x > 0) {
 126                 dcfg |= CS5530_DCFG_FP_PWR_EN;
 127                 dcfg |= CS5530_DCFG_FP_DATA_EN;
 128         }
 129
 130         /* Sync polarities. */
 131         if (info->var.sync & FB_SYNC_HOR_HIGH_ACT)
 132                 dcfg |= CS5530_DCFG_CRT_HSYNC_POL;
 133         if (info->var.sync & FB_SYNC_VERT_HIGH_ACT)
 134                 dcfg |= CS5530_DCFG_CRT_VSYNC_POL;
 135
 136         writel(dcfg, par->vid_regs + CS5530_DISPLAY_CONFIG);
 137 }
 138
 139 static int cs5530_blank_display(struct fb_info *info, int blank_mode)
 140 {
 141         struct geodefb_par *par = info->par;
 142         u32 dcfg;
 143         int blank, hsync, vsync;
 144
 145         switch (blank_mode) {
 146         case FB_BLANK_UNBLANK:
 147                 blank = 0; hsync = 1; vsync = 1;
 148                 break;
 149         case FB_BLANK_NORMAL:
 150                 blank = 1; hsync = 1; vsync = 1;
 151                 break;
 152         case FB_BLANK_VSYNC_SUSPEND:
 153                 blank = 1; hsync = 1; vsync = 0;
 154                 break;
 155         case FB_BLANK_HSYNC_SUSPEND:
 156                 blank = 1; hsync = 0; vsync = 1;
 157                 break;
 158         case FB_BLANK_POWERDOWN:
 159                 blank = 1; hsync = 0; vsync = 0;
 160                 break;
 161         default:
 162                 return -EINVAL;
 163         }
 164
 165         dcfg = readl(par->vid_regs + CS5530_DISPLAY_CONFIG);
 166
 167         dcfg &= ~(CS5530_DCFG_DAC_BL_EN | CS5530_DCFG_DAC_PWR_EN
 168                   | CS5530_DCFG_HSYNC_EN | CS5530_DCFG_VSYNC_EN
 169                   | CS5530_DCFG_FP_DATA_EN | CS5530_DCFG_FP_PWR_EN);
 170
 171         if (par->enable_crt) {
 172                 if (!blank)
 173                         dcfg |= CS5530_DCFG_DAC_BL_EN | CS5530_DCFG_DAC_PWR_EN;
 174                 if (hsync)
 175                         dcfg |= CS5530_DCFG_HSYNC_EN;
 176                 if (vsync)
 177                         dcfg |= CS5530_DCFG_VSYNC_EN;
 178         }
 179         if (par->panel_x > 0) {
 180                 if (!blank)
 181                         dcfg |= CS5530_DCFG_FP_DATA_EN;
 182                 if (hsync && vsync)
 183                         dcfg |= CS5530_DCFG_FP_PWR_EN;
 184         }
 185
 186         writel(dcfg, par->vid_regs + CS5530_DISPLAY_CONFIG);
 187
 188         return 0;
 189 }
 190
 191 struct geode_vid_ops cs5530_vid_ops = {
 192         .set_dclk          = cs5530_set_dclk_frequency,
 193         .configure_display = cs5530_configure_display,
 194         .blank_display     = cs5530_blank_display,
 195 };